Create motorControl.c

moved functions from motorControl.h to here