Added motor control code from previous

We needed to add windows.h to motor_funcs and tic_toc