Moved parts in Collision_Systems and MotionPlanning to enigma_user.

The changes have been tested and verified to work.