Add 2 SVR to control Setpoint and conkP.

1. Add 2 SVR to control Setpoint and conkP.
2. Change the PID library.