An Optimization-based Motion and Grasp Planner - View it on GitHub