Robot motion planning with contact from global pseudo-inverse map

Abstract

In the robot motion planning problems, environment and its objects are often treated as obstacles to be avoided. However, there are situations where contacting with the environment is not costly. Moreover, in many cases, making contact can actually help a robot to maneuver around to reach a goal state which would not have been possible otherwise. This thesis presents a framework for motion planner that utilizes multiple contacts with the environment and its objects. The planner is targeted to autonomously generate motion, where robot has to make multiple contact with different part of its body in order to achieve a task objective. It is motivated by and has significance in developing a robust humanoid planner that is capable of recovering from a fall down. The recent DRC has been marked with compilation of humanoid robots falling down, but only one robot managed to recover to a standing up position. In a real disaster scenario, the inability to stand up would mean end of the rescue mission for what is extremely expensive machinery. A robust planner capable of recovery is must and this work contributes towards it. The developed planner autonomously generates standing up motion from fall down in the presence of torque limits. The proposed multi-contact motion planner leverages upon following two key components. Existing multi-contact planners require good initial seeds to successfully generate a motion. These are hard to find and often manually encoded. Here, we utilize pre-computed global pseudo-inverse map (inverse kinematic map for each contact-state that has property of global resolution, connected by connectivity functions) to generate multi-contact motion from current configuration to the goal without need for an initial seed. Nevertheless, constructing the global pseudo-inverse map is computationally expensive. In an effort to facilitate the construction, we utilize singular configurations as a heuristic to reduce the search space and justify its use based on the physical analysis. Although computationally expensive, once pre-computed, the global map can be used to generate plans fast online in a multi-query manner.