基于DSP的水田平地机倾角传感系统设计与试验

平地机车身倾角是水田平地机平地铲自动调平控制的重要反馈信息。为满足平地铲自动调平的倾角测量精度要求,达到水田精准平整、减少水资源的浪费、提高水稻产量的目的,设计了一种基于DSP的水田平地机倾角传感系统。采用惯性加速度计和陀螺仪作为倾角传感系统的倾角测量传感器,分析了倾角传感系统倾角测量原理、设计了硬件系统和基于卡尔曼滤波器的传感器融合算法。倾角传感系统综合利用加速度计所测的重力加速度分量和重力加速度的三角关系以及陀螺仪所测的角速度和车身倾角的导数关系测量获得平地机车身倾角;采用三轴加速计ADIS16300、陀螺仪ADXRS453和DSP处理器TMS320F28069等器件组成倾角传感系统的硬件系统,其中DSP处理器主要实现传感器数据采集、算法执行和数据通讯等功能;以平地机真实倾角和陀螺仪零位偏差作为系统状态向量,建立系统状态方程和测量方程,通过离散化卡尔曼滤波器递归融合得到平地机车身实时倾角。通过三轴多功能转台对倾角传感系统的卡尔曼滤波融合算法测量精度进行了试验。试验结果表明:该倾角传感系统在静态和动态时均能准确地测量平地机车身实时倾角。静态测量时车身角度平均绝对误差≤0.01°,均方根误差≤0.01°,最大误差0.07°。动态测量时车身角度平均绝对误差≤0.18°,均方根误差≤0.20°,最大误差0.41°。说明该系统为水田平地机平地铲自动调平控制提供了低成本倾角测量方案。