Box manipulation almost works.

Grasp approach works.
Kinect depth is slightly off.
Still need to test if disabling collision works properly for grasping.
Otherwise, grasping should (?) work.
Dropping works perfectly.
Need to add accumulator tanks and warning light to robot collision model.