Changed the analog read calculations to use the map function
Finished Motor Controller code to a functional state