Implemented Gains and reference setpoint adjustments.