robot_model.cpp and robot_model.hh are now reverted to the original version