位置环，速度环PID控制的C代码,使用该代码，能是电机运行更好。(the function of the code is used to control the motor, force the motor to run in the position and speed ring.)