Added velocity publisher from RoboTeq controller
Added implement control to navigation demo