Cleaned up more of robot_control.c // added comment blocks