[00336404]一种农业机械自动导航控制方法

交易价格： 8 万元

类型： 专利

专利所属地：

专利号：CN201610228933.5

交易方式： 完全转让

联系人：

所在地：

服务承诺: 产权明晰; 资料保密
对所交付的所有资料进行保密; 如实描述

咨询平台客服试试在线客服吧发布技术需求服务免费

技术详细介绍

浙江理工大学

一种农业机械自动导航控制方法

专利（申请号）： CN201610228933.5	申请人：浙江理工大学	IPC分类号： G05D1/02(2006.01)I
专利类型: 发明专利	公开号： CN105867377B	保护年限：
代理机构：杭州求是专利事务所有限公司 33200	代理人：邱启旺	公开日： 2019.01.08
发明设计人：李革;王宇;吴苗苗;章铁成;王嘉鹏;郭刘粉

摘要

本发明公开了一种农业机械自动导航控制方法，该方法包括如下步骤：(1)GPS接收机实时测得当前时刻农业机械的运动状态数据；(2)采用预瞄控制方法，将运动状态数据与预定义路径数据进行比对分析，推算出横向偏差和航向偏差；(3)通过模糊控制算法进行模糊化，然后将模糊量导入模糊控制器中，得到前轮转角；通过改进型纯追踪算法建立几何模型，从而导求出前轮转角；将两种算法得到的前轮转角合成一个前轮转角；(4)最后根据前轮转角实时对农业机械进行控制，实现路径跟踪。本发明由两种导航方法结合在一起实现自动控制，是稳定性良好，抗干扰能力强，能够提高系统的鲁棒性。两种方法的结合，优势互补，使其满足旱地和水田的作业需要。

主权项

1.一种农业机械自动导航控制方法，其特征在于，该方法包括如下步骤：(1)通过GPS接收机实时测得当前时刻农业机械的运动状态数据；(2)采用预瞄控制方法，动态搜索目标点，将步骤(1)得到运动状态数据与预定义路径数据进行比对分析，推算出横向偏差和航向偏差；(3)通过模糊控制算法将步骤(2)得到的横向偏差和航向偏差模糊化，然后将模糊量导入模糊控制器中，得到前轮转角；通过改进型纯追踪算法建立几何模型，从而由步骤(2)中得到的航向偏差推导求出前轮转角；将模糊控制算法和改进型纯追踪算法得到的前轮转角合成一个最终的前轮转角；所述的改进型纯追踪算法为：利用航向偏差建立几何模型，Pr为当前农业机械的位置，Pk+j为目标点，R为转弯半径，C为圆心点，qe为航向偏差，L为农业机械前后轮轴间距，d2为改进型纯追踪算法求得的前轮转角，那么在直角三角形BPrC中可以得出：由于qe为圆C的弦切角，因此可得：—PrCPk+j＝2qe在等腰三角形PrCPk+j中，由正弦定理可得：由上述三式消去R可得到前轮转角：式中PrPk+j为农业机械当前位置与目标点的之间的距离；另外，将横向偏差作为控制器的一个观测量，再设定一个预设值dr，当观测到横向偏差d≠dr时，则将改进纯追型踪算法求得的前轮转角d2乘以一个比例系数kdr，由此可以增大前轮转角，使其快速到达目标点；(4)最后根据前轮转角实时对农业机械进行控制，实现路径跟踪。

成果推荐需求推荐评估专家推荐评估机构推荐

更多>

上海平正评估有限公司

服务分类：资产评估、无形资产评...

进入主页
连城资产评估有限公司

服务分类：资产评估、无形资产评...

进入主页

更多>