Added no_pose_subscribe mode
Began implementing code for robot to drive path