added motor controller logic to arduino
added motor controller logic to arduino

USU-Robosub/Gilligan,USU-Robosub/Gilligan,USU-Robosub/Gilligan,chris-blay/guillemot-core,USU-Robosub/Gilligan,chris-blay/guillemot-core,USU-Robosub/Gilligan,chris-blay/guillemot-core,chris-blay/guillemot-core,chris-blay/guillemot-core