论文部分内容阅读
精确定位技术是精细农业的一个重要研究内容,是实现智能农机的关键技术之一。由于我国南方水田面积小、使得成本较高的高精度DGPS难以大面积推广,为开发适于南方农业机械的低成本、高精度定位系统,本文提出了一种基于双源激光的定位技术,运用已知的两个激光发射器的距离和实时获得的激光发射器动态发射角度,实时解算出田间作业机械的坐标信息与运动姿态,为田间作业机械导航定位和田间数据定点采集提供技术支撑。本文的研究内容是湖南省自然科学基金“水田作业机器人无标识环境的导航定位技术研究(09JJ6091)”和国家科技支撑项目“轻简化水田作业关键装备研究与示范(2011BAD20B08)”的部分内容。研究以高速插秧机为对象搭建试验平台,对系统的无线交换方式、激光光斑识别算法、激光发射角初始化方法,激光接收靶跟踪算法、转向控制算法进行了详细研究,主要内容如下:1.分析田间作业机械定位与自动驾驶的特点,结合现有定位系统的技术特点和成本因素,提出了基于双源激光的田间作业机械导航定位方法。2.为保证数据交换的实时性,系统采用2.4G无线通信模块进行数据交换,针对三方数据通信(两激光发射器与接收靶)存在数据交换碰撞问题,提出采用环形链路数据交换的无线通信方法,配合相应的通信协议,确保数据的可靠传输。3.为获得精确的激光发射器初始角度和基线长度,系统采用超声波对射方式进行距离测量,同时辅以无线通信实现超声波基准时间的启动,并根据投影原理解决探头之间的高度落差问题,通过温度补偿、系统误差补偿等措施,实现了两个激光发射器与激光接收靶三者间的初始距离精确测量,进而完成激光发射器旋转角度和基线长度的初始化。4.为解决普通激光发射器的光晕、漫反射等问题,提出了基于算术均值滤波与中值滤波融合的激光光斑初始化处理算法。通过理论推导与实验,验证了算法的可行性。5.为解决目标运动过程中接收靶本身运动及车体振动导致光斑中心检测偏差问题,提出运用可变增益的递推α-p滤波算法对经过初始滤波的激光光斑中心进行二次滤波,实现对光斑中心的动态预估,从而获得了准确的光斑中心,并验证了算法的可行性和必要性。6.为保持对运动的激光接收靶的持续锁定,从而实现实时定位解算,在深入研究PID算法和卡尔曼滤波理论的基础上,提出了基于增量式PID快速修正的卡尔曼滤波算法,实现了双激光源对运动中的接收器的持续跟踪锁定,进而完成系统高精度定位。7.以方向盘的转向控制为研究目标,建立了插秧机的转向控制数学模型,深入地研究了插秧机的导航控制方法,提出了模糊免疫PID的转向控制算法。通过Matlab仿真,在模糊免疫PID的Kp,Ki,Kd,K,η分别取6,2,2,0.5,0.5时,系统可获得很好的控制效果,并通过实验验证了导航跟踪精度完全能满足田间作业设备的需要。