Collision checking in robot arm using MoveIt!