用惯性传感器实时补偿机器人棱镜倾斜,提升农机导航定位精度。
Smart Prism with Tilt Compensation for CAN bus on Mobile Machinery Using Robotic Total Stations
- 在棱镜上加惯性单元,通过自适应互补滤波算出俯仰翻滚角。
- 实测三维误差2.9~23.6mm,支持厘米级导航系统验证。
- 可接入CAN总线,把车辆位置当虚拟传感器用,适合农机自动驾驶测试。
为验证农业机器人与高自动化非公路车辆在真实田间条件下的自主性能,需精准参考轨迹。实际中,机器人全站仪可提供毫米级棱镜中心坐标,但车辆感兴趣点通常存在从分米到数米的杠杆臂偏移。越野机械常见的俯仰与翻滚运动,导致感兴趣点水平误差远超全站仪测量精度。本文设计并验证了一种智能棱镜原型,将惯性测量单元(IMU)集成于机器人全站仪棱镜上,实现姿态实时补偿。系统采用STM32H7微控制器与Murata SCH16T系列IMU,利用自适应互补滤波估计俯仰和翻滚角,通过校准的杠杆臂从车身坐标系变换至导航坐标系,结合全站仪棱镜位置计算出倾斜补偿后的感兴趣点坐标。为支持车辆端集成,系统可通过控制器局域网(CAN)传输棱镜与补偿后坐标,使感兴趣点可视为虚拟位置传感器(如与后轴参考点共位)。固定地面基准点实验中,杠杆臂约1.07m,手动模拟最大60°俯仰/翻滚,五组测试的三维均方根误差在2.9mm至23.6mm之间。结果表明,基于IMU的倾斜补偿可实现动态田间条件下厘米级导航系统的参考测量。
原文摘要 · Abstract (English)
Accurate reference trajectories are required to validate autonomous agricultural robots and highly automated off-road vehicles under real-world field conditions. In practice, robotic total stations provide millimeter-level prism center coordinates, but the point of interest on the vehicle is typically displaced by a lever arm, ranging from decimeters to multiple meters. Roll and pitch motions, as typically observed in off-road machinery, therefore introduce horizontal point of interest errors far exceeding the measurement accuracy of robotic total stations observations. This paper presents the design, implementation, and validation of a Smart Prism prototype that augments a robotic total station prism with an inertial measurement unit to enable real-time tilt compensation. The prototype integrates an STM32H7 microcontroller and a Murata SCH16T-series IMU and estimates roll and pitch angles using an adaptive complementary filter. The tilt-compensated point of interest coordinates are obtained by transforming a calibrated lever arm from the body frame into the navigation frame and combining it with robotic total station prism positions. To support vehicle-side integration, the system can transmit prism and tilt-compensated point of interest coordinates on the Controller Area Network bus, allowing the point of interest to be treated as a virtual position sensor (e.g., co-located with a rear-axle reference point). Experiments with a fixed ground reference point, using a prism to point of interest lever arm of approximately 1.07m and manual roll/pitch excursions of up to 60 deg, yield three-dimensional root-mean-square errors between 2.9mm and 23.6mm across five test series. The results demonstrate that IMU-based tilt compensation enables reference measurements suitable for validating centimeter-level navigation systems under dynamic field conditions.
Thank you to arXiv for use of its open access interoperability. PaperDance 不是 arXiv 官方产品;中文卡片由大模型生成,请以原文为准。