MotionState class added to ramp_planner, Added a node to test imminent
collision in ramp_debug