基于简化卡尔曼滤波的双惯量伺服系统测速算法

Speed Measurement for Two-inertia Servo System Based on Simplified Kalman Filter

  • 摘要: 针对低精度位置传感器应用下传统速度测量方式难以均衡测量噪声与测量延迟的问题,设计一种针对双惯量伺服系统应用的简化卡尔曼滤波测速算法。通过状态量预估计将核心部分卡尔曼滤波的观测模型简化为一阶模型,给出了一阶模型构建方式以及额外所需的转速预测量以及轴转矩预估计设计方式,均衡测量误差与噪声的同时,相较于基于高阶模型的卡尔曼滤波测速大幅减小运算成本与调试复杂度。最后将本文所设计的测速算法与其他测速算法进行对比,仿真与试验结果表明相较于传统算法在相同的测量延迟下误差更小;与相同计算成本的卡尔曼滤波测速相比也具有更好的误差抑制能力。

     

    Abstract: Aiming at the problem that it is difficult to equalize the measurement noise and delay in the traditional speed measurement method under the application of low-precision position sensors, a simplified Kalman filter speed measurement algorithm is designed for the application of dual-inertia servo system. The observed model of the core Kalman filtering part is simplified to a first-order model by state pre-estimation, and the way of constructing the first-order model as well as the way of designing the additional required speed prediction and shaft torque pre-estimation are given, the computational cost and debugging complexity are greatly reduced compared to the higher-order model-based Kalman filter speed measurement while maintaining the measurement error and noise balance. Finally, the proposed speed measurement algorithm is compared with other speed measurement algorithms, and the simulation and experimental results show that compared with the traditional algorithm, the error is smaller under the same measurement delay; and compared with the Kalman filter speed measurement with the same computational cost, it also has better error suppression ability.

     

/

返回文章
返回