more progress on robot_model