Replace RosSotRobotModel with the modified RosRobotModel from dynamic_graph_bridge