Minor fixes to robot_model class