Fixed collision issues on MoveIt! Corrected color in URDF