kiwiwan/trajectory_optimization_manipulation_box

using drake and trajectory optimization to planning and control point contact manipulation(push etc) box trajectory