add vel PID
modified PID const
K0.7 SP5.0 SI0.02 SD0.05