Turned on collision checking for torso
Merge branch 'master' into baxter_with_gripper