用于三点定位的激光发射追踪系统

为研制适用于南方小面积农田的小型农机定位系统,基于激光三点定位原理设计了一套应用双激光源三点定位的激光发射追踪系统。讨论了双激光源三点定位原理,重点描述了激光发射追踪系统的机械结构设计与控制处理电路设计,并提出了基于增量式PID、具有快速修正功能的卡尔曼滤波追踪算法,解决了激光追踪中的移动目标预估与转弯及变速过程中的误差补偿问题。一系列实验结果表明:不同速度下,两个激光发射器所发射的激光均能较好地追踪激光接收器靶标中心,最大偏差为±2.8 cm,能满足200 m内误差小于±4 cm的作业机械定位需求。所提出的算法可靠有效,为农田作业机械无人驾驶和田间数据定点采集奠定了基础。