Modified motor code

- Added code to run servo
- Modifed motor code section to only run the relay motor, temporarily
eliminated MOSFET and run those motors manually.