This paper presents a Center of Mass (CoM) based manipulation and regrasp planner that implements stability constraints to preserve the robot balance. The planner provides a graph of IK-feasible, collision-free and stable motion sequences, constructed using an energy based motion planning algorithm. It assures that the assembly motions are stable and prevent the robot from falling while performing dexterous tasks in different situations. Furthermore, the constraints are also used to perform an RRT-inspired task-related stability estimation in several simulations. The estimation can be used to select between single-arm and dual-arm regrasping configurations to achieve more stability and robustness for a given manipulation task. To validate the planner and the task-related stability estimations, several tests are performed in simulations and real-world experiments involving the HRP5P humanoid robot, the 5th generation of the HRP robot family. The experiment results suggest that the planner and the task-related stability estimation provide robust behavior for the humanoid robot while performing regrasp tasks.
The CoM constrained planner is an enhanced version of our previous planner @cite_24 , it builds a regrasp graph by connecting nodes between given initial and goal placements for an object, and searches the graph to find a sequence of pick-and-place sub-tasks. This generates a sequence of states, grasps, transit and transfer motion, connecting the starting and ending nodes. This paper improves the previous planner by evaluating if the state of the robot-object system is stable, in order to preserve its balance during searching. If the state is IK-unfeasible, generates a collision, or makes the robot fall out of balance, the corresponding node is removed and the search continues until a set of nodes connecting the initial and goal poses is found.
@cite_24
2225490378
The goal of this paper is to develop efficient regrasp algorithms for single-arm and dual-arm regrasp and compares the performance of single-arm and dual-arm regrasp by running the two algorithms thousands of times. We focus on pick-and-place regrasp which reorients an object from one placement to another by using a sequence of pick-ups and place-downs. After analyzing the simulation results, we find dual-arm regrasp is not necessarily better than single-arm regrasp: Dual-arm regrasp is flexible. When the two hands can grasp the object with good clearance, dual-arm regrasp is better and has higher successful rate than single-arm regrasp. However, dual-arm regrasp suffers from geometric constraints caused by the two arms. When the grasps overlap, dual-arm regrasp is bad. Developers need to sample grasps with high density to reduce overlapping. This leads to exploded combinatorics in previous methods, but is possible with the algorithms presented in this paper. Following the results, practitioners may choose single-arm or dual-arm robots by considering the object shapes and grasps. Meanwhile, they can reduce overlapping and implement practical dual-arm regrasp by using the presented algorithms.