Added motor control function

Created by: emoore3

Takes four ints between -100 and 100 and converts each one to PWM for four motor controllers (front right, front left, back right, back left).