C++ version of the simple_arm ROS package - View it on GitHub