improving motor_control.cc and adding motor_control.h...backed up old motor_control.cc to motor_control_old.cc