corrected motor_control_cycle, declared static variables in conrols.h, corrected main.c (delete unnecessary variables)

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