Terrain navigation apparatus for a legged animal traversing terrain

摘要

Terrain navigation apparatus (1) for a legged animal (2) traversing terrain (3) including a first system (4) for determining position, velocity and heading of the legged animal incorporating sensing means for sensing inertial motion in six degrees of freedom operable to provide signals indicative of a first velocity (5a), a first heading (7a) and a first position (9a) of the legged animal (2), contact means (11) for establishing, in a velocity profile describing motion of either foot of the legged animal, a period where the velocity should be zero (17), which period corresponds to full or partial contact of the respective foot (13a, 13b) with surrounding terrain (3), and error-estimating means (15) for receiving as input signals the velocity profile during the period and for providing as output signals estimates of errors (19) associated with the sensing means output signals, which errors operatively interact with the output signals of the first system to effect terrain navigation of the legged animal (2).