Constrained kinematic-only manipulation of toy blocks. Grasp of player toy still broken.

Signed-off-by: Kevin Wagrez <kevin.wagrez@gmail.com>