PID Loop

Added minimum and maximum values for the motors to operate at. Added the
D component and tuned both P and D components.