Added turn to heading portion of waypoint control law to Miabot sim.
Added run_time and init poses support to dcsl_robot for ROS control