Preliminary planning and control software developments for efficient manipulation

Summary
Preliminary software development on efficient planning and control algorithms for picking of objects in relative motion w.r.t. the manipulator and placing objects in moving boxes.