Updated MotorDemo control code

By teammate ken taylor: http://www.hackster.io/penguinx24