Initial commit of ROS based controller