Changed control speed to use a PID method. Need to implement Ziegler-Nichols method tuning