many changes/fixes around colliding end effectors and IK, fixed PR2 ik