Add servomotor.h to robot.h