Update Setpoint and debug info.

Update Setpoint and debug info.