Abstract— In this paper, we present an algorithm for manipulability based trajectory generation for any serial manipulator that has an inverse kinematic model that can obtain all solutions. Our strategy is a search-based approach that analyzes candidate configurations at discrete points along the workspace trajectory. Given such a model we prove the configuration space trajectories generated by our method are optimal within the limit of the discretization of the workspace trajectory.
Luis Guilamo, James J. Kuffner Jr., Koichi Nishiwa