ROS and Orocos project with C++