ROS controller based on ros_control architecture - View it on GitHub