Manipulability optimization for trajectory generation

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 work-space trajectory. Given such a model we prove the configuration-space trajectories generated are optimal within the limit of the discretization of the work-space trajectory