智能农机自动导航系统应用研究

1、智能农机自动导航系统应用研究戴增辉何凤琴上海立达职业技术学院上海师范大学摘要：首先设计了农机自动导航系统硬件及软件，分析了常见四轮农机结构，并以此 作为研究平台展开模型分析，为后续自动导航算法奠定基础。研究了定位坐标系, 分析了大地坐标系、直角坐标系及二者相互转化，确定导航定位解算原理及差分 定位原理，在此基础上设计导航系统关键组成部分。最后，基于农机导航定位系 统原理进行农机姿态测量及路径追踪，在此基础上提出路径追踪改善方法，从 而为后续农机自动导航系统设计提供参考。关键词：农机;导航;坐标系;定位;作者简介：戴增辉(1975-),女，哈尔滨人，讲师，(e-mail) lvvytjo收稿日期

2、：2016-12-15基金：国家自然科学基金项目(51608325)research on the application ofintelligent automatic navigation system of agricultural machinerydai zenghui he fengqinshanghai lida polytechnic institute; shanghainormal university;abstract：this paper focuses on the application of intelligent agricultural machinery n

3、avigation system. first, design the hardware and software of farm machinery auto-navigation system, analyze the common four-wheel farm machinery structure, and then analyze it as the research platform, and lay the foundation for the following automatic navigation algorithm. after the study of locati

4、on coordinate analysis, geodetic coordinate system, coordinate system and the two mutual conversion, determine the positioning and navigation solution principle and the differential positioning principle, on the basis of the design of the key component of navigation systcm. finally, based on the pri

5、nciple of the agricultural machinery navigation and positioning system for attitude measurement and path tracking, on this basis, the path tracking improvement method is proposed to provide reference for the follow-up of the automatic navigation system of agricultural machinery.keyword：agricultural

6、machinery; navigation; coordinate system; location;received： 2016-12-150引言目前，我国耕地面积位居世界前列，但种植效率远低于世界发达国家，究其原 因是农业机械化程度较低，种植过程中需要耗费大量人力。随着我国农业种植模 式由小面积分散型种植向大面积集中种植不断转变，传统种植模式已经无法满 足实际需求，因此亟待提升我国农业牛产机械化程度。当前，农业机械作业速度 不断提高，人工操作难度越来越大，为提高农业机械操作效率和安全性，需在 我国农机控制过程屮引进智能化农机导航系统。为此，笔者展开了智能农机自动 导航系统研究。首先，以当前

7、常见农机作为研究对象，探究具有一定实用性的农 业机械导航系统;其次，对农业机械导航系统的导航控制、组合定位、转向等关 键技术展开研究，提升农业机械导航系统可操作性、稳定性、定位精度，为农业 机械智能化控制奠定坚实基础。1智能农机自动导航系统在常见农机基础上设计一套完整的液压系统，主要包括电机、油箱、油缸、油泵、 液压阀、转向控制器及安全阀，装有无线卫星接收系统，结合角度传感器设计出 硬件模拟平台;模拟拖拉机运行状况，对导航算法精确度、编程可行性等展开研 究，并为后续程序改进及算法改善奠定坚实基础。1.1模型车结构分析农机自动导航主要是实现农业机械的自动转向和提升转向精确度。为提高农机自 动导航

8、系统实用性，木研究将常用农机配备一整套硬件平台，模拟大型拖拉机 工作过程，结合软件导航系统设计一套农机自动导航系统硬件设施。模型机构如 图1所示。i1i电力驱动子系统车轮回定速比变速| 自虫器 |1控制器v_转换器v吐动机1 1a加速能量 亍匕系绞1 '辅助 动力源蓄电池向系统i转向盘iia充屯器1主源子系统l|制功 |辅助控制子系统丨|图1电动模型车的机构图下载原图模型车系统主要包括车体结构、电子控制器、电机、电源、充电器及显示器等部 分，结合可拆装液压系统，便于展开多次实验。其主要功能如下：1）车体。主要包括车身结构、车轮、转向结构，另外还包括指示灯、座椅、喇 叭、反光镜等。电子2

9、）电动机。类型为三相感应电动机，是模型动力装置。3）中央控制器。主要功能是控制电动机开关、速度、转向。4）蓄电池。提供模型所需动力及照明电力。当前，大多农机均采用液压系统作为转向动力，本设计转向油路构成包括方向 盘、转向器、转向油泵、液压转向油缸及油箱，结构如图2所示。图2农机原配转向油路示意图 下载原图农机液压机构包括装箱机构、油缸、油泵、溢流阀、单向阀、过滤器、转向轮及 辅助元件。液压装置及转向机构在设计时应该根据功率需求及农机实际作用选取 适当信号。若功率较大，则选用开芯且无反应转向器，当转向器位于中间位置时,可有效实现自主卸荷;若功率较小，则选用闭芯转向器，当转向器位于中间位置 吋，需

10、经过相互匹配变量泵后完成卸荷。可编程控制器主要通过编程实现对系统的控制过程。农机上安装的接收机接收无 线卫星信号，并将信号传输至车载电脑；自动导航软件系统对所接收信号进行处 理后传送至可编程控制器，之后控制液压系统、转向机构，控制转向角度，实现 农机口动导航。设计过程中，在模型车上安装小型液压系统及拖拉机液压系统， 结合导航算法设计程序，并通过可编程控制器自带触摸控制显示器进行编程及 系统控制。1.2软件控制系统软件设计可有效提升农机自动导航系统控制便利性，且可通过软件调试纠正提 升算法稳定性，实现农机行走控制及农机作业控制o拖拉机自动驾驶模拟软件通 过qt平台开发两次，在实际控制中通过界面对

11、追踪结果进行动态显示，并通过 对话框设置拖拉机行走路径及原始状态;通过定吋器结合算法推算拖拉机路径信 息，并在系统屮自动规划出下一单位时间行走路径及方向。软件主流程图如图3 所示。图3软件主流程图下载原图2导航定位与航向角度测量2. 1定位原理 农机导航主要通过卫星导航系统实现，在定位吋需要将地球作为参考系，建立 地球坐标系。地球坐标系又可分为直角坐标系和大地坐标系。直角坐标系主要指 以设定地球质心作为原点0,北极与原点0连线所在直线作为z轴，0°经线与 质心连线作为x轴，将垂直于x轴和z轴且经过两轴交点的直线作为y轴，记作 坐标系xyz,坐标系所在点可表示为（x, y, z）;大地

12、坐标系主要指地球椭球中 心与地球球心重合，地球椭球短轴与其自转轴重合，纬度为过地球椭球中心与 地球球心重合点椭球法线与赤道夹角为"，经度为地球椭球屮心与地球球心重 合点所在椭球子午面和格林威治大地子午面之间的夹角入。高度h为地球椭球 中心与地球球心重合点沿着椭球法线方向所在直线到球面距离，坐标系所在点 可表示为（d, x, h） o直角坐标系与大地坐标系间可互相转换，如某点p直 角坐标系为（x, y, z）,在大地坐标系屮为（“，入，h）,转换关系为 x ( n + a)cos(pcosa "y(n + b)cos®sin入l z-几(1 /) + h sinp-

13、其中，n为曲率半径;e为第一偏心率。设地球所在椭球长半径和短半径分别为a、 b,贝9n 二一 e sin入二 arctan x通过叠加法求得arc tan其中，认为地心纬度;s表示椭圆率。假设初始值e二叽吋进行叠代，当小于某一门限时为止，则q二1 一他 一一 _直角坐标系和大地坐标系经常进行过互相转换。在大地坐标系中进行定位，得出 定位点坐标属于经纬度坐标位置;在直角坐标系中进行定位，得出定位点坐标属 于地表坐标位置。实际应用中，不可育接将大地坐标系用于农机导航，肓角坐标 系可直接用于农机导航。2. 2定位解算若要实现精准定位，则需保证移动站和卫星标准时间同步，在此基础上进行三 维定位，在此过

14、程中存在3个未知量，因此需要3个独立方程求解。实际上，难 以实现移动站和卫星标准时间同步，在实际作业定位过程中将移动站和卫星标 准吋间差量作为第4个未知量，因此需要4个独立方程进行求解，即需要在空中 具备4颗定位卫星。图4为定位原理图，分别有定位卫星1、2、3、4,其坐标在图4中标出。由图4 可知:4颗卫星分别对待测点进行定位量测，得出4个方程为仏二。严 +（丫1 一 九）2 + （引一知）2 +4个未知量分别为待测点三维坐标参数(xo, y0, z0)和vi。其中，di (i=l, 2, 3,4)为4颗卫星到接收机间距;(i=l, 2, 3, 4)为4颗卫星钟差，可通过卫 星星历得到;是接收

15、机钟差。在此基础上可得其中，(i=l, 2, 3, 4)分别为4颗卫星发射信号到达接收机花费时间;c 为光速，即为信号传播速度。在此基础上便可计算出坐标。待测点图4定位原理图下载原图2.3双天线航向测量航向测量坐标系即农机工作地点水平坐标系（lls）,原点为gnss天线阵列主天 线相位中心，将正北方向作为x轴正方向，将正东方向作为y轴正方向，xy互 相垂直，z轴与x轴、y轴均垂直且满足右手定则oo-xyz为大地坐标系，设i1-xyz 为lls坐标系，对其中某点设其lls坐标系和经纬度（b, l）情况下，对其进行 坐标变换：1）围绕z'轴旋转角度（180+l） ° ,从而获得坐

16、标系h-xy'z'2）围绕y'轴旋转角度（270+b） ° ,从而获得坐标系h-x'y'z'3）在上述两步基础上，围绕x'轴旋转角度180° o转换过程如图5所示。7；z 4a图5坐标系转换过程下载原图 通过以上步骤可将大地坐标系转换为lls坐标系。在此基础上可得尤血二 rz（ 180°） ry 270° 4- l）乩（180。+ l） x wgswgs（x一尤0 ）1 0 0亿（180。）=0-100 0 - 1/?r（270° + b）=cos（270° + b）0- sin

17、（270 ° + b）010sin（270 ° + b）0cos（270° + b）r2（ 180° 4- l）皿（180。+厶）$加（180。+ £）o°cos（ 180。+厶）0° 0 1鸚'l鷲以嚣薜关野管测得。在此基础上可得知对某点m其大地坐标九- 一 sinbcosl一 sinl一 cosbcosl 一 sinbsinlcosl一 cosbsinsl一 cosb0_ sinb 妙 lls其中，b、l分别为经纬度，么人必人分别为点m及点h在在大地坐标系中测 量值。将接收天线安装于需自动导航农机上，使用双天线测

18、量农机姿态可得出其航向 角及俯仰角；之后固定天线，便可实现精确测量。双天线航向测量图如图6所示。其中，ai和a?的坐标分别为(0, 0, 0)、(l2,arctany20, 0) ;l2表示两天线间距。由此可知f0 = arctan ,1 y（4）2 +（72）2其中，*为航向角，0为俯仰角。3航向追踪和路径追踪3.1航向追踪自动转向控制系统目的首先是实现对农机精确导航，控制农机航向及路径;其次 为路径追踪及导航控制奠定基础。航向追踪主要指在已知农机当前航向下通过控 制技术使其航向与目标航向一致。1）航向追踪控制的pid校正。一般pid控制属于线性控制技术，控制算法比较 复杂，具有良好控制效果

19、。根据校正方式不同可将其分为比例、微分、积分3 个校正环节。比例环节按比例对系统误差做出响应，并迅速推动控制器作用，缩 小系统误差;调节速度与比例系数为正比关系；最后通过积分环节消除系统存在 的稳态误差，消除效果与积分常数呈正相关，消除过程中易出现稳定性及振荡 问题。因此，在微分环节需要根据误差信号做出应对，并在误差信号变大前输入 早期矫正信号，以此降低调节吋间，提升系统响应速度。2）基于速度的自适应pid控制。农机实际作业过程中会出现以下几种情况：（1） 正常作业时，其速度保持不变：（2）转弯时，速度连续变小；（3）曲线行驶时， 速度随曲率变化不断改变；（4）操作结束时，速度连续降低直至为零

20、。实际设计中，将速度改变作为基本依据，设计自适应pid控制器，通过pid自适 应控制器实现航向追踪控制目的。首先计算得出农机实际航向与目标航向误差， 并将其作为控制器输入录入系统，控制器结合农机实际运行状况生成在线调节 参数，并输出控制参数控制转向轮。图6双天线航向测量图下载原图3. 2路径追踪路径追踪可分为3个步骤:首先是获取农机相对预期目标的动态参数;其次对操 纵控制量进行决策;最后实现精确控制操作。在实际操作中，采用位置信息接收 机接受农机相对预期a标的动态参数，并将其作为基本信息展开分析；设定预瞄 点，确定横向追踪误差和纵向航向偏差两个参数，并结合程序算法得出最佳控 制动作，在指定时间点执行该动作;农机在运行过程中其运动状态参数被不断传 送至系统，处于不断循环控制动态过程。4结论设计了一套完整的液压系统，包括电机、油箱