Ctest

Added C motor control file