Added PID Controllers with the setpoint that don't work properly.