PID算法控制，算法有滤波和去除噪音的效果，算法提取更多偏差，更为准确-PID control algorithm, the algorithm has the effect of filtering and noise removal algorithm to extract more bias, more accurate