CN106996767A - 一种自主导航拖拉机转向角无线测量系统及方法 - Google Patents
一种自主导航拖拉机转向角无线测量系统及方法 Download PDFInfo
- Publication number
- CN106996767A CN106996767A CN201710228481.5A CN201710228481A CN106996767A CN 106996767 A CN106996767 A CN 106996767A CN 201710228481 A CN201710228481 A CN 201710228481A CN 106996767 A CN106996767 A CN 106996767A
- Authority
- CN
- China
- Prior art keywords
- steering angle
- tractor
- attitude
- data
- measuring system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Arrangements For Transmission Of Measured Signals (AREA)
Abstract
本发明涉及一种自主导航拖拉机转向角无线测量系统及方法,包括1套数传电台,所述数传电台包括3个发射端和1个接收端;所述3个发射端分别与1号、2号和3号姿态传感器相连;所述1号和3号姿态传感器分别安装在拖拉机的左、右转向轮与前桥横梁连接的转轴顶部;所述2号姿态传感器安装在拖拉机前桥横梁的中间位置;所述数传电台的接收端与工控机相连,能够接受所述3个发射端的数据。通过计算1号和2号姿态传感器,以及2号和3号姿态传感器的航向角之差,即可确定左右转向轮的转向角。本发明结构简单,安装方便,可以避免传统技术中复杂的物理传输线路,极大地提高了拖拉机导航系统工作的可靠性,为无人驾驶拖拉机技术的发展创造有利条件。
Description
技术领域
本发明涉及农业机械自主导航技术,尤其是一种适用于无人驾驶拖拉机的自主导航技术,具体的说是一种自主导航拖拉机转向角无线测量系统及方法。
背景技术
在拖拉机自主导航系统的研制中,前轮(转向轮)转向角的测量尤为关键。目前常用电位计或编码器测量前轮转向角。将电位计或编码器底座固定在拖拉机前桥和前轮连接的转轴上,电位计或编码器的轴心通过传动机构与前桥的固定装置相连。当拖拉机转向轮发生偏转时,电位计或编码器的转轴和底座发生相对角位移,进而产生变化的电信号(电位计输出模拟电压信号,编码器输出脉冲信号)。通过信号采集单元接收电信号,解算出相应角度,并通过物理线路传输到工控机,完成了转向角的测量。
然而在工程实践中,上述方法存在的突出问题:(1)电位计或编码器安装方式复杂,安装精度要求较高,同时还需要对原有机械结构改造;(2)拖拉机工作环境恶劣,作物、杂草等容易对传输线路刮伤、刮断,影响传感器的正常使用。
发明内容
本发明的目的是针对目前在无人驾驶拖拉机自主导航技术方面存在的问题,提供一种自主导航拖拉机转向角无线测量系统及方法,具有结构简单,安装方便,适应性强,便于操控等特点,为无人驾驶拖拉机技术的发展创造有利条件。
本发明的技术方案是:
一种自主导航拖拉机转向角无线测量系统,包括1套数传电台,所述数传电台包括3个发射端和1个接收端;所述3个发射端分别与1号、2号和3号姿态传感器相连;所述1号和3号姿态传感器分别安装在拖拉机的左、右转向轮与前桥横梁连接的转轴顶部;所述2号姿态传感器安装在拖拉机前桥横梁的中间位置;所述数传电台的接收端与工控机相连,能够接受所述3个发射端的数据。
进一步的,所述数传电台为低功耗433MHz。
进一步的,所述1号、2号和3号姿态传感器的输出频率均为20Hz,输出信息为航向角。
进一步的,所述将3个发射端通过TTL串行通信接口与所述1号、2号和3号姿态传感器分别连接。
进一步的,所述1号和3号姿态传感器的x轴分别平行于拖拉机左、右转向轮并指向前方;所述2号姿态传感器的x轴垂直于前桥横梁并指向前方。
一种自主导航拖拉机转向角无线测量系统进行测量的方法,包括以下步骤:
1)从数传电台接收端读取当前时刻3个姿态传感器的航向角数据h1(T)、h2(T)、h3(T);
2)分别检测3个姿态传感器当前时刻数据是否为异常数据。若发现接收到异常数据,则立即剔除,用前一次测量的正常数据代替;
3)通过计算1号和2号姿态传感器发送的航向角之差,确定左轮转向角a L;通过计算2号和3号姿态传感器发送的航向角之差,确定右轮转向角a R;即:a L= h1(T)- h2(T) ,a R =h3(T)- h2(T);
4)重复上述步骤1)至3),实现循环检测左、右转向轮的转向角。
本发明的有益效果:
本发明结构简单,安装方便,可以避免传统技术中复杂的物理传输线路,极大地提高了拖拉机导航系统工作的可靠性,为无人驾驶拖拉机技术的发展创造有利条件。
附图说明
图1是本发明的系统结构示意图。
图2是本发明中的姿态传感器的安装示意图。
图3是本发明中的数据流程示意图。
其中:1-左转向轮;2-1号姿态传感器;3-前桥横梁;4-2号姿态传感器;5-3号姿态传感器;6-右转向轮。
具体实施方式
下面结合附图和实施例对本发明作进一步的说明。
如图1所示,一种自主导航拖拉机转向角无线测量系统,包括1套数传电台。该数传电台为低功耗433MHz,包括3个发射端和1个接收端。所述3个发射端分别通过TTL串行通信接口与1号、2号和3号姿态传感器相连,以便将各姿态传感器感测到的信息发送给所述接收端。所述接收端与工控机相连,能够接受所述3个发射端的数据,并传输给工控机。优选的,所述1号、2号和3号姿态传感器均为微型姿态传感器。
如图2所示,所述1号姿态传感器2安装在左转向轮1与前桥横梁3连接的转轴顶部,其x轴正方向X1与左转向轮1平行的指向前方。所述3号姿态传感器5安装在右转向轮6与前桥横梁3连接的转轴顶部,其x轴正方向X3与右转向轮6平行的指向前方。由此,可保证左、右转向轮发生偏转时,1号和3号姿态传感器能够同步运动。所述2号姿态传感器4安装在前桥横梁3的中心,其x轴正方向X2垂直于前桥横梁3指向前方。
所述1号、2号和3号姿态传感器的输出频率均为20Hz,输出信息为航向角,同时,设置通信参数为波特率9600bps,校验位:N,数据位:8,停止位:1,即可感测拖拉机左、右转向轮相对于前桥横梁垂直方向之间的角度变化,并通过数传电台传输到工控机上。
如图3所示,使用上述自主导航拖拉机转向角无线测量系统进行测量的方法包括以下步骤:
1)从数传电台接收端读取当前时刻3个姿态传感器的航向角数据h1(T)、h2(T)、h3(T);
2)分别检测3个姿态传感器当前时刻数据是否为异常数据。若发现接收到异常数据,则立即剔除,用前一次测量的正常数据代替;
3)通过计算1号和2号姿态传感器发送的航向角之差,确定左轮转向角a L;通过计算2号和3号姿态传感器发送的航向角之差,确定右轮转向角a R;即:a L= h1(T)- h2(T) ,a R =h3(T)- h2(T);
4)重复上述步骤1)至3),实现循环检测左、右转向轮的转向角。
所述步骤2)中,奇异值的检测算法为,以1号姿态传感器为例:
a. 获取当前时刻航向角h1(T)和邻近连续8个时刻的航向角h1(T-1) h1(T-2) …… h1(T-8);
b. 计算连续8个距离增量△h1(T)、△h1(T-1) ……△h1(T-7),表达式中△h1(T-n)= |h1(T-n)- h1(T-n-1)|;
c. 计算上述8个距离增量的算术平均值d(T);
d. 若h1(T)>3 d(T),则认为h1(T)为异常数据,然后将h1(T)的数值用h1(T-1)代替。反之,则认为h1(T)为正常数据。
本发明未涉及部分均与现有技术相同或可采用现有技术加以实现。
Claims (6)
1.一种自主导航拖拉机转向角无线测量系统,包括1套数传电台,其特征是所述数传电台包括3个发射端和1个接收端;所述3个发射端分别与1号、2号和3号姿态传感器相连;所述1号和3号姿态传感器分别安装在拖拉机的左、右转向轮与前桥连接的转轴顶部;所述2号姿态传感器安装在拖拉机前桥的中间位置;所述数传电台的接收端与工控机相连,能够接受所述3个发射端的数据。
2.根据权利要求1所述的自主导航拖拉机转向角无线测量系统,其特征是所述数传电台为低功耗433MHz。
3.根据权利要求1所述的自主导航拖拉机转向角无线测量系统,其特征是所述1号、2号和3号姿态传感器的输出频率均为20Hz,输出信息为航向角。
4.根据权利要求1所述的自主导航拖拉机转向角无线测量系统,其特征是所述将3个发射端通过TTL串行通信接口与所述1号、2号和3号姿态传感器分别连接。
5.根据权利要求1所述的自主导航拖拉机转向角无线测量系统,其特征是所述1号和3号姿态传感器的x轴分别平行于拖拉机左、右转向轮并指向前方;所述2号姿态传感器的x轴垂直于前桥并指向前方。
6.一种自主导航拖拉机转向角无线测量系统进行测量的方法,其特征是包括以下步骤:
1)从数传电台接收端读取当前时刻3个姿态传感器的航向角数据h1(T)、h2(T)、h3(T);
2)分别检测3个姿态传感器当前时刻数据是否为异常数据;若发现接收到异常数据,则立即剔除,用前一次测量的正常数据代替;
3)通过计算1号和2号姿态传感器发送的航向角之差,确定左轮转向角a L;通过计算2号和3号姿态传感器发送的航向角之差,确定右轮转向角a R;即:a L= h1(T)- h2(T) ,a R =h3(T)- h2(T);
4)重复上述步骤1)至3),实现循环检测左、右转向轮的转向角。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710228481.5A CN106996767A (zh) | 2017-04-10 | 2017-04-10 | 一种自主导航拖拉机转向角无线测量系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710228481.5A CN106996767A (zh) | 2017-04-10 | 2017-04-10 | 一种自主导航拖拉机转向角无线测量系统及方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN106996767A true CN106996767A (zh) | 2017-08-01 |
Family
ID=59435629
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710228481.5A Pending CN106996767A (zh) | 2017-04-10 | 2017-04-10 | 一种自主导航拖拉机转向角无线测量系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106996767A (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000089827A (ja) * | 1998-09-16 | 2000-03-31 | Kawasaki Heavy Ind Ltd | 車両の計測装置 |
CN101148176A (zh) * | 2006-09-22 | 2008-03-26 | 日产自动车株式会社 | 可变车轮定位车辆 |
CN101326094A (zh) * | 2005-10-15 | 2008-12-17 | 天宝导航有限公司 | 基于转向组件角度及角速率传感器的车辆陀螺仪 |
CN202783354U (zh) * | 2012-09-12 | 2013-03-13 | 苏州工业园区驿力机车科技有限公司 | 一种汽车转向车轮的转向角修正装置 |
CN203780462U (zh) * | 2014-03-11 | 2014-08-20 | 梧州职业学院 | 一种汽车姿态快速检测平台 |
CN105946970A (zh) * | 2016-03-27 | 2016-09-21 | 林洪立 | 电动汽车智能转角驱动装置 |
CN106114621A (zh) * | 2015-05-08 | 2016-11-16 | 克拉斯工业技术有限责任公司 | 农业作业机械 |
CN106526644A (zh) * | 2016-10-10 | 2017-03-22 | 上海联适导航技术有限公司 | 一种用于计算载具部件之间相对角度变化量的方法 |
-
2017
- 2017-04-10 CN CN201710228481.5A patent/CN106996767A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2000089827A (ja) * | 1998-09-16 | 2000-03-31 | Kawasaki Heavy Ind Ltd | 車両の計測装置 |
CN101326094A (zh) * | 2005-10-15 | 2008-12-17 | 天宝导航有限公司 | 基于转向组件角度及角速率传感器的车辆陀螺仪 |
CN101148176A (zh) * | 2006-09-22 | 2008-03-26 | 日产自动车株式会社 | 可变车轮定位车辆 |
CN202783354U (zh) * | 2012-09-12 | 2013-03-13 | 苏州工业园区驿力机车科技有限公司 | 一种汽车转向车轮的转向角修正装置 |
CN203780462U (zh) * | 2014-03-11 | 2014-08-20 | 梧州职业学院 | 一种汽车姿态快速检测平台 |
CN106114621A (zh) * | 2015-05-08 | 2016-11-16 | 克拉斯工业技术有限责任公司 | 农业作业机械 |
CN105946970A (zh) * | 2016-03-27 | 2016-09-21 | 林洪立 | 电动汽车智能转角驱动装置 |
CN106526644A (zh) * | 2016-10-10 | 2017-03-22 | 上海联适导航技术有限公司 | 一种用于计算载具部件之间相对角度变化量的方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114179825B (zh) | 多传感器融合获取量测值置信度方法及自动驾驶车辆 | |
CN209167539U (zh) | 一种基于激光测距传感器组的相对姿态测量系统 | |
US11304292B2 (en) | Circuit board and unmanned aerial vehicle including the same | |
CN112748421A (zh) | 一种基于直行路段自动驾驶的激光雷达校准方法 | |
CN110587603A (zh) | 基于多传感器数据融合的位姿自感应关节模组运动控制系统 | |
CN104655340B (zh) | 基于无线供电与无线信号传输的转矩传感器模块 | |
EP2630438B1 (en) | Alignment head system | |
CN106996767A (zh) | 一种自主导航拖拉机转向角无线测量系统及方法 | |
CN105913628B (zh) | 磁传感器输出电路及数据无线传输与控制系统方法 | |
CN203224630U (zh) | 无接触式导航的电力巡检机器人 | |
CN109093623B (zh) | 一种基于闭环结构的扭矩计算、碰撞检测与拖动示教方法 | |
CN107884593A (zh) | 一种以拖拉机为动力的农业机具速度监测系统与方法 | |
CN214253011U (zh) | 一种多功能平衡二轮小车 | |
CN103471860A (zh) | 基于wifi无线传输的四轮定位系统及方法 | |
CN104764419B (zh) | 一种基于激光光源的车辆转角传感器系统 | |
CN211978194U (zh) | 一种数字型六维高精度力变送器 | |
CN201203798Y (zh) | 一种分布式铁路微机监测采集系统 | |
CN106405606A (zh) | 一种高精度卫星定位的实现方法 | |
CN209765051U (zh) | 一种旋转扫描超声波测距装置 | |
CN202494923U (zh) | 与上位机通信的无线遥控测温小车 | |
CN112212957A (zh) | 一种贴片式车载称重方法及其系统 | |
CN200989778Y (zh) | 一种can总线输出型倾角传感器 | |
CN211552795U (zh) | 高车架农用机转向角度测量装置 | |
CN206578605U (zh) | 一种加工机热变位补偿装置 | |
CN214540051U (zh) | 基于rtk的车辆定位装置及车辆 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20170801 |
|
RJ01 | Rejection of invention patent application after publication |