Motors1.0

All functions there. Tested code works. Need to test logic further.