一种基于rtk技术的农机直线行驶的方法及装置的制造方法
【技术领域】
[0001] 本发明属于数据处理技术领域、电子技术领域，尤其设及一种基于位置状态信息 的直线跟踪方法。
【背景技术】
[0002] 随着国家农业经济的发展，对于农业自动化的要求越来越高。传统农业中通过人 工驾驶农机在田间进行直线作业时无法保证作业的直线度，运样势必造成±地资源的浪 费，增加了生产成本;而在精密农业机械自动耕种、播种等作业过程中，精确地控制农机自 动进行直线驾驶是精密农业自动导航驾驶中的难点。为了提高直线作业精度，传统方法多 采用划线器或者喷洒泡沫方法在田间进行标记作为驾驶员进行直线作业导航的依据。随着 近几年国内精准农业技术研究的开展，研究人员开发了农机导航指示系统，系统采用GPS导 航指示光标棒(将指示光标棒分别放置在农田的两端，结合GPS定位，利用发光二极管进行 直线标定），能为农机田间作业提供直线导航指标，驾驶员根据指示光标进行直线作业。
[0003] 对于上述两种用于农机直线作业的指示方法而言，（1)采用划线器或者喷洒泡沫 的方法在田间作业环境可见度较低、农田表面没有明显参考物和地表起伏较大的情况下， 基本不可行或者导航指示效果很差，达不到导航和提高作业质量的目的；（2)现有的GPS导 航指示光标棒系统采用CAN总线，系统接线复杂，可靠性差，且系统各模块的通用性不强，兼 容性差；导航指示光标棒系统中的两个发光二极管之间的距离只能通过预设的方式实现， 精度很差(1米），且不方便设置。
【发明内容】
[0004] 本发明的目的在于提供了一种能够通过自动进行直线跟踪的，能够适应复杂环境 的基于RTK技术的农机直线行驶的方法及装置。
[0005] -种基于RTK技术的农机直线行驶方法：
[0006] S1:获取预先设定在RTK测量设备上所要走的直线信息；
[0007] S2:根据RTK测量设备来获取农机的当前位置坐标和农机的当前航向角；
[000引S3:根据农机的当前位置坐标和设定的目标直线信息来计算得到农机与设定直线 之间的横向误差和农机的理论航向角；
[0009] S4:根据所述的横向误差和理论航向角来计算得到农机的转向角度，W使转向控 制器通过转向角度来控制农机的转向；
[0010] S5:根据RTK测量设备来获取农机转向后的位置，并对该位置进行判断，当农机转 向后的横向误差为零的时候，转向控制器保持当前转向角度，车辆继续行驶;当农机转向后 的横向误差不为零的时候，则返回S2。
[OOW 优选地，设定的直线信息记为直线AB，其中A点的坐标为(Xa，Ya)，B点的坐标为(Xb， Yb)，则可得直线AB的方程为
[0012] 优选地，通过RTK测量设备来实时获取农机的位置信息，得到农机的位置坐标(Xv， Υν)和农机的当前航向角Φ。
[0013] 优选地，根据农机的位置坐标和直线ΑΒ来得到的与直线ΑΒ垂直的直线方程，从而 得到，农机的位置坐标与直线ΑΒ的垂直交点，将垂直交点的坐标记为(XEh，YEh)，横向误差e 关
理论航向角0为
，其中，1为农机的轴间距。
[0014] 优选的，转向角度通过
杉计算得到，其中，V为农机的速度， 并通过转向控制器来控制农机的转向，将农机的转向调整至相应的位置。
[0015] -种基于RTK技术的农机直线行驶方法的装置，包括：
[0016] 设定模块:用于在RTK测量设备上设定的所要走的目标直线信息；
[0017] 定位模块:用于获取农机的当前位置坐标和农机的当前航向角；
[0018] 计算模块:用于根据农机的当前位置坐标和设定的直线信息来计算得到农机与设 定直线之间的横向误差和农机的理论航向角；
[0019] 控制模块：用于根据所述的横向误差和理论航向角计算得到的农机的转向角度， W使转向控制器通过转向角度来控制农机的转向；
[0020] 判断处理模块:用于根据RTK测量设备来获取农机转向后的位置，并对该位置进行 判断，当农机转向后的横向误差为零的时候，转向控制器保持当前转向角度，车辆继续行 驶;当农机转向后的横向误差不为零的时候，则返回定位模块。
[0021] 优选地，在所述设定模块中，所设定的直线信息记为直线AB，其中A点的坐标为 (乂4，￥4)，8点的坐标为(姑，￥6)，则可得直线48的方程为
[0022] 优选地，在所述定位模块中，通过RTK测量设备来实时获取农机的位置信息，得到 农机的位置坐标(Xv，Υν)和农机的当前航向角Φ。
[0023] 优选地，在所述计算模块中，根据农机的位置坐标和直线ΑΒ来得到的与直线ΑΒ垂 直的直线方程，从而得到，农机的位置坐标与直线ΑΒ的垂直交点，将垂直交点记为（Xch, ￥。4)，横向误差6关
理论航向角由
得到，其中，1为 农机的轴间距。
[0024] 优选地，在所述判断模块中，转向角度通过
来计算得到，其 中，V为农机的速度，并通过转向控制器来控制农机的转向，将农机的转向调整至相应的位 置。
[0025] 与现有技术相比，本发明的有益效果有：
[00%] 1、使用RTK卫星定位技术实时获得农机当前运动的位置信息，精度高达2.5畑1。2、 只要能捜索到卫星，都能使用实时的位置信息时刻解算前轮目标转角进行直线跟踪，故能 适应复杂环境(可见度较低、表面没有明显参考物和地表起伏较大的农田环境）。3、设定完 目标直线后，软件能够自动进行直线跟踪，免去人工驾驶的麻烦。
【附图说明】
[0027] 图1为本发明的基于RTK技术的农机直线行驶方法的流程示意图；
[0028] 图2为本发明的农机位置信息的定义图；
[0029] 图3为本发明的基于RTK技术的农机直线行驶方法跟踪目标直线过程图。
【具体实施方式】
[0030] 下面，结合附图W及【具体实施方式】，对本发明做进一步描述：
[0031] 在下述说明中，首先针对本发明的基于RTK技术的农机直线行驶方法的实施例进 行进一步的详细说明，在对本发明的基于RTK技术的农机直线行驶的装置的各实施例进行 说明。
[0032] 参见图1所示，为本发明的基于RTK技术的农机直线行驶方法的实施例的流程示意 图，图2为对本发明的各个物理量进行了定义。如图1所示，本实施例的基于RTK技术的农机 直线行驶方法包括如下步骤：
[0033] S1:获取预先设定在RTK测量设备上所要走的目标直线信息，其中将设定的目标直 线信息记为直线AB，其中A点的坐标为(Xa，Ya)，B点的坐标为(Χβ,Υβ)，则可得直线AB的方程 为
[0034] S2:通过RTK测量设备来实时获取农机的位置信息，得到农机的位置坐标(Χν,Υν)和 农机的当前航向角Φ。
[0035] S3:根据农机的当前位置坐标和设定的目标直线信息来计算得到农机与设定直线 之间的横向误差和农机的理论航向角，根据农机位置坐标和直线ΑΒ来得到的与直线ΑΒ的垂 直交点将垂直交点记为(Xch，Ych)，横向误差e为
理论航向角β 为
其中，1为农机的轴间距；
[0036] S4:根据所述的横向误差和理论航向角来计算得到农机的转向角度，转向控制器 通过转向角度来控制农机的转向