Removed redundant variables. Overloaded PositionControl now calls reduced PositionControl. Output signal clamping is now done in a single method
Cleaned up and fixed PID control. Signal clamping is now done in a single method, integral and derivatives are now calculated correctly.
Removed class-scope control signal. ClampSaturation now takes and returns a double. Normalizing now takes a double