Whole-Body Motion and Landing Force Control for Quadrupedal Stair Climbing

摘要

In this paper, we present a novel framework for quadrupedal stair climbing, which considers force interaction with stairs. For stable and robust climbing, a key issue is to avoid falling down on the stairs. From this point of view, control to minimize rate of change of angular momentum about Center of Mass (CoM) which is produced by ground reaction force (GRF) at contact of robot`s foot is necessary. Using this approach, direct force-based Zero Moment Point (ZMP) for motion planning of the CoM and landing force control are implemented. The direct force-based ZMP method allows the robot to lift its foot with reduced possibility of tilting on the stairs, and the landing force control prevents instant increase of the moment by impact of the GRFs. In addition, terrain recognition to estimate parameters of the stairs and find proper footholds by vision system mounted on the robot is presented. Proposed framework is implemented to quadruped robot, AiDIN-VI, that has torque sensor at each joint, through experiments, capability of ascending several stairs including 3-step stairs which have 21cm height (31% of its maximum leg length) and 26.5° inclination is validated.