joint limits
path wi manipulability