Get Leon's example going under CMake, only ROS-end required