基于Kalman滤波和纯追踪模型的农业机械导航控制

以KUBOTA SPU-68水田插秧机为试验平台,以RTK-DGPS为主要导航方式,辅以航向姿态参考系统AHRS500GA-227,研究提高农业机械导航控制精度的方法.在重点对GPS倾斜误差校正的基础上,设计了Kalman滤波器对定位数据进行平滑处理,同时实现磁航向传感器偏移误差的在线辨识与航向校正.采用纯追踪模型实现农业机械直线跟踪控制,基于ITAE优化准则,仿真研究了最佳前视距离的确定方法.试验结果表明:GPS倾斜误差校正和Kalman滤波后的导航参数可以更真实地反映插秧机水田实际运动状态;纯追踪模型可以用于插秧机田间作业直线导航,当行进速度0.6m/s时,直线跟踪最大误差小于0.17m,平均误差小于0.02m.     

东方红X-804拖拉机的DGPS自动导航控制系统

该文在东方红X-804拖拉机上开发了基于RTK-DGPS的自动导航控制系统。系统主要包括RTK-DGPS接收机、导航控制器、转向操纵控制器、电控液压转向装置和转向轮偏角检测传感器。其中转向操纵控制器、转向轮偏角检测传感器和电控液压转向装置构成转向轮偏角的闭环控制回路,该回路可根据导航控制器提供的期望转向轮偏角实现偏转角的随动控制。将拖拉机运动学模型和转向操纵控制模型相结合,建立了拖拉机直线跟踪的导航控制传递函数模型,模型的输入是横向跟踪误差,输出是期望的转向轮偏角。设计了基于PID算法的导航控制器,仿真分析了系统稳定性和动态响应性能,确定了PID控制参数的较佳取值。针对东方红X-804拖拉机转弯半径大的特点,采用跨行地头转向控制方式,提出了具体的控制流程及算法。田间试验结果表明：采用所设计的DGPS自动导航控制系统,在拖拉机行进速度为0.8 m/s时,直线跟踪的最大误差小于0.15 m,平均跟踪误差小于0.03 m,所提出的跨行地头转向控制方法对试验拖拉机具有良好的适用性。     

基于星基增强精密单点定位的农机自动导航系统开发与测试

目的 开发基于星基增强精密单点定位的农机自动导航系统。方法 以国产雷沃TX1204拖拉机为平台,采用国产星基增强定位板卡的输出数据作为农机位置反馈量,设计位速卡尔曼滤波器对定位数据进行滤波处理,开发预瞄跟随PID路径跟踪控制算法进行导航控制,整定不同行驶速度条件下的模型控制参数,采用地基增强RTK高精度定位接收机输出数据作为参考量,搭建农机自动导航测试系统并开展系统性能测试。结果 在直线跟踪误差方面,所开发的农机自动导航系统平均误差为?0.0009436 m,标准差为0.02452 m,最大误差绝对值为0.08472 m;在邻接行误差方面,平均误差为0.0007128 m,标准差为0.02986 m,最大误差绝对值为0.15444 m。这一精度可满足大部分农机自动导航作业需求。结论 将国产星基增强精密单点定位技术用于农机自动导航是可行的;本文设计的预瞄跟随PID路径跟踪控制模型和提出的不同速度条件下PID参数与前视距离的整定方法,提高了系统对不同速度的自适应能力。     

基层如何贯彻执行新的《农药管理条例》

通过对新修订的《农药管理条例》进行解析,从宣传培训、建立健全制度、重点加强管理工作等8个方面,较为详细地阐述基层农药管理机构如何更好地贯彻实施新的《农药管理条例》。     

农机具姿态倾角测量系统设计与试验

农机具姿态倾角测量技术是实现农机装备精准作业的关键技术之一。为进一步提高农机装备作业质量,以ADIS16445微惯性MEMS传感器和STM32F446核心处理器搭建硬件平台,以欧拉角法解算姿态,建立卡尔曼滤波模型融合加速度计与陀螺仪信息,实现农机具姿态倾角的精准测量。融合算法模型考虑陀螺仪零偏特性,并根据MEMS微传感器运动特性,自适应模型误差协方差矩阵Q与R,适应不同工况下农机具姿态倾角测量。采用SGT320E三轴多功能转台与BD982双天线定位测姿模块对系统进行测试与验证。三轴多功能转台试验结果表明,ADIS16445内置陀螺仪与加速度计性能合格,满足系统设计硬件要求;卡尔曼滤波融合模型精准有效,倾角静态测量误差精度为0.15°,动态测量精度典型值为0.3°,最大测量误差为0.5°。田间作业试验结果表明,自适应模型能保证农机具姿态倾角测量系统在不同工况下的测量精度,更稳定可靠,测量平均误差为0.55°。该文研究的农机具姿态倾角测量系统可满足农机装备精准作业要求。     

插秧机电控操作机构和控制算法设计

为了进行农业机械导航和变量作业试验研究,以久保田SPU-68型插秧机为试验平台,对插秧机转向机构、变速机构和插秧机具升降机构进行了改造,实现自动控制。采用小功率直流电机为动力,设计了带双阈值死区的PD电机位置控制算法。转向操纵机构导向信号跟踪试验及与驾驶员操作的对比试验结果表明,转向系统具有良好的响应特性,电控操作装置控制作业效果与驾驶员操作作业效果相当。     

轮式农业机械自动转向控制系统研究

以日本久保田SPU－60型插秧机为对象进行轮式农业机械自动转向控制研究,提出了基于速度的自适应PD控制方法,利用航向偏差作为控制器输入,控制器可根据插秧机行进速度在线调整其PD参数,进而输出前轮期望偏角。仿真和试验结果表明,该方法可以较好地适应农业机械作业速度的变化,提高其转向的快速响应特性和稳定性,航向跟踪效果好。该研究为进一步开展轮式农业机械自动导航控制研究提供了依据。     

农业机械导航中的航向角度估计算法

研究农业机械航向角度的动态测量与估计方法,对其导航定位和导航控制具有重要意义.该文以日本久保田插秧机为研究对象,采用HMR3000电子罗盘和ADXRS300微机械陀螺仪组合进行农业机械航向角度动态测试的研究.提出了基于协方差函数的加窗估计算法,用于在线估计电子罗盘和微机械陀螺的测量方差.在此基础上,提出利用自适应加权融合算法,融合电子罗盘和微机械陀螺信息,实现农业机械航向角度的动态测试与精确估计.试验结果表明,所提出的自适应加权融合估计算法适用于农业机械动态条件下的航向角度测试,具有良好的抗干扰能力,可以平滑和滤除测试噪声,为导航控制提供更为精确和可靠的航向角度估计数据且经济性较好.     

基于余摆运动的株间机械除草爪齿避苗控制算法

为准确控制以余摆运动为原理的株间机械除草装置的除草爪齿避让作物,提出了基于余摆运动的株间机械除草爪齿避苗控制算法,介绍了爪齿余摆运动株间机械除草爪齿避苗控制算法的基本原理,根据余摆线运动特点推导出了除草爪齿避苗判断表达式,并设计了除草爪齿的旋转角速度控制器和除草爪齿避苗控制器。利用MATLAB对除草爪齿避苗控制算法进行了仿真分析,结果表明该算法能准确控制除草爪齿避让作物,前进速度对株间区域除草覆盖率影响小,但会受除草爪齿爪尖旋转半径影响,除草爪齿旋转半径越大,进入株间区域的除草爪齿根数越少,株间区域除草覆盖率降低。在试验平台上进行了验证试验,平均每个株间区域进入的爪齿根数和株间区域除草覆盖率与仿真分析结果一致。