MotionPlanning

Finished homework in MotionPlaning