edited motor_control.py v1