added motor_control_cycle in main.c controls.c controls.h, added static variables for motor_control_cycle

Signed-off-by: Kevin <kevin@eichenbergs.info>