Update robot_states.h