CN117109583B - 一种用于农业运输设备的定位导航方法 - Google Patents
一种用于农业运输设备的定位导航方法 Download PDFInfo
- Publication number
- CN117109583B CN117109583B CN202311012089.9A CN202311012089A CN117109583B CN 117109583 B CN117109583 B CN 117109583B CN 202311012089 A CN202311012089 A CN 202311012089A CN 117109583 B CN117109583 B CN 117109583B
- Authority
- CN
- China
- Prior art keywords
- transportation equipment
- agricultural transportation
- agricultural
- positioning
- farm
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 238000005516 engineering process Methods 0.000 claims description 13
- 238000004364 calculation method Methods 0.000 claims description 7
- 238000001914 filtration Methods 0.000 claims description 3
- 238000005259 measurement Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000012271 agricultural production Methods 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 235000013399 edible fruits Nutrition 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/024—Guidance services
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/029—Location-based management or tracking services
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A40/00—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production
- Y02A40/10—Adaptation technologies in agriculture, forestry, livestock or agroalimentary production in agriculture
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02D—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN INFORMATION AND COMMUNICATION TECHNOLOGIES [ICT], I.E. INFORMATION AND COMMUNICATION TECHNOLOGIES AIMING AT THE REDUCTION OF THEIR OWN ENERGY USE
- Y02D30/00—Reducing energy consumption in communication networks
- Y02D30/70—Reducing energy consumption in communication networks in wireless communication networks
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种用于农业运输设备的定位导航方法,具体包括步骤:步骤1:建立农场的定位环境:将农业运输设备运行在农场对应的环境中,农场环境中设置有UWB定位基站,农业运输设备上安装有UWB定位标签;步骤2:制作农场的栅格地图:农业运输设备上的UWB定位标签对UWB定位基站发出请求信号,获取农业运输设备的位置信息;再操控农业运输设备在农场环境中行驶,记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;对农业运输设备轨迹进行追踪,并保存对应的轨迹地图作为农业设施栅格轨迹地图;步骤3:通过运输设备的定位信息和构建的农业设施栅格地图信息,对运输设备进行路径规划,完成对运输设备的导航。本发明操作逻辑简单,降低了运行成本。
Description
技术领域
本发明涉及电缆技术领域,具体涉及一种用于农业运输设备的定位导航方法。
背景技术
农场无人化已成为世界现代化农业发展趋势,全球各国都在加快农场无人化布局,加深人工智能、无人化等技术在农业领域的应用。农业现代化的升级转型过程中,实现现代农业生产、存储、运输、销售等各环节智能无人化是实现农业现代化的关键。
而我国目前农业产品的运输仍大量依靠人力,尤其是大棚、温室等设施内的作业空间狭小,在大棚、温室采摘过程中,果实的运输还是依靠传统的人力搬运,导致运输过程实体损耗和价值损耗严重,运输人力成本较高,农业的从业人员劳动负担大。
目前常用的定位导航技术包括卫星导航系统、激光定位导航技术、视觉定位导航技术、惯性导航技术等。卫星导航系统的信号需要经过卫星和地面设备的处理,存在一定的延迟问题,且卫星导航系统的信号无法穿透建筑物,室内覆盖效果较差,卫星定位导航的灵活性和便利性受到限制,不适用于设施农业内部的定位导航;激光定位导航技术、视觉定位导航技术、惯性导航技术虽然可以提供非常精确的三维地图和定位信息,但对于较为严苛的环境的适应性较差,不适用于大棚、温室等农业设施的环境,以及农场环境中。
发明内容
针对上述现有的无人车导航定位技术,不适用余农场环境和大棚、温室等设施环境的技术问题,本技术方案提供了一种用于农业运输设备的定位导航方法,在农场环境或大棚、温室等环境中设置UWB定位基站,并在农场环境中设置多个UWB定位模块,农业运输设备上安装有UWB定位标签,使用UWB多边定位对运输设备进行定位,通过调整定位信息获取的频率实现对运输设备的轨迹跟踪,获取设施内栅格地图信息,通过地图信息和定位信息对运输设备的作业路径进行规划,实现农业运输设备农业内的定位导航;能有效的解决上述问题。
本发明通过以下技术方案实现:
一种用于农业运输设备的定位导航方法,所述的农业运输设备运行在农场对应的环境中,通过定位导航系统对无人驾驶的农业运输设备进行导航;所述的定位导航方法具体包括步骤:
步骤1:建立农场的定位环境:
在农场对应的环境中设置UWB定位基站,并在农场环境中设置多个UWB定位模块,农业运输设备上安装有UWB定位标签;并在对应的控制软件中建立农场模型;
步骤2:制作农场的栅格地图:
根据农业运输设备的位置信息,计算得到农业运输设备在农场模型中的位置信息;再操控农业运输设备在农场环境中行驶,UWB定位基站记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;对农业运输设备轨迹进行追踪,并保存对应的轨迹地图作为农业运输设备在农场环境中运行的栅格轨迹地图;
步骤3:对运输设备进行路径规划:通过运输设备的定位信息和构建的农场环境栅格地图信息,对运输设备进行路径规划;具体的操作方式为:
根据步骤2创建的栅格轨迹地图,设置农业运输设备的终点坐标为(xE,yE),根据农业运输设备的起始位置坐标和终点坐标对农业运输设备的行驶路径进行规划;
通过基点道路规划导航法对农业运输设备进行路径规划导航,以农场环境地图中左侧纵向连接所有横向道路的道路为基点道路,确定农业运输设备的位置和需要到达的终点后,判断农业运输设备的起始位置和终点是否在同一道路上,并判断起始位置是否在基点道路上;
当农业运输设备的起始位置与终点在同一条道路上时,则农业运输设备只需要完成直线行驶到达终点位置;
当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置在基点道路上时,则农业运输设备在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;
当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置不在基点道路上时,则农业运输设备需要先返回基点道路,再在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;步骤4:按照步骤3所述的导航策略为农业运输设备设置导航路线,完成对运输设备的导航规划,操作完成。
进一步的,步骤1中所述多个UWB定位模块的设置方式为:在农场环境中每间隔10米设置1个UWB模块作为定位参考节点,使10m×10m范围内至少有3个UWB模块;并通过网络时间协议NTP对所有UWB模块的时钟源进行校正,将多个UWB模块的时间保持一致。
进一步的,步骤1中所述的建立农场模型,具体操作方式为:在UWB定位基站的控制软件中建立二维直角坐标系作为参考系,以农场环境的左下角为原点,将至少3个UWB模块的位置被定位为U1,U2,U3,...,Un,其位置坐标分别被记作(x1,y1),(x2,y2),(x3,y3),...,(xn,yn);将运输设备的UWB模块称为U0,位置坐标记为(x,y)。
进一步的,步骤2中所述的根据农业运输设备的位置信息,计算得到农业运输设备在农场模型中的位置信息,具体的操作方式为:
农业运输设备上的UWB定位标签对UWB定位基站发出请求信号,获取农业运输设备的位置信息;UWB定位基站通过参考节点U1,U2,U3,...,Un的信息,结合TOF飞行时间技术,计算U0分别到U1,U2,U3,...,Un的直线距离d,具体公式如下:
其中,d1,d2,d3,...,dn为U0分别到U1,U2,U3,...,Un的直线距离,c为信号的传播速度,t为信号的飞行时间;
t=ti-t0-tp
其中,ti为信号接收到的时间,t0为信号发出时间,tp为信号处理时间;
以U1,U2,U3,...,Un为圆心,U1,U2,U3,...,Un分别与U0的距离d为半径画圆,多个圆的交集即U0的位置,通过U0和U1,U2,U3,...,Un的距离d和U1,U2,U3,...,Un位置坐标(x1,y1),(x2,y2),(x3,y3),...,(xn,yn)可计算出U0即运输设备坐标(x,y);计算公式为:
由于测量误差的存在,定位圆并不会刚好交于一点,使用最小二乘法进行近似求解,根据上式,将前n-1个方程减去第n个方程,得到线性化方程AX=b,其中:
利用最小二乘法可以解得:
X=(ATA)-1ATb
其中,X为U0的坐标(x,y)。
进一步的,步骤2中所述的操控农业运输设备在农场环境中行驶,UWB定位基站记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;具体的操作方式为:人为的操控搭载UWB模块的农业运输设备绕农场环境的边界行驶,由UWB基站的控制软件记录农业运输设备的行驶轨迹,得到农场环境的范围;并操控农业运输设备在农场环境中内部的每条道路上行驶,记录农场环境中内可行驶的道路路线,使得控制软件得到农场环境的相关地图。
进一步的,步骤2中所述的对农业运输设备轨迹进行追踪,并保存对应的轨迹地图作为农业运输设备在农场环境中运行的栅格轨迹地图,具体的操作方式为:
在控制软件中设置:获取农业运输设备的位置信息的频率为0.1s/次,间隔0.1s获取并记录一次农业运输设备的位置坐标(x,y),对农业运输设备的运行轨迹进行跟踪;
由于农业运输设备的在实际行驶过程中并不能完全按照一条直线进行行驶,定位信息会出现摆动,导致轨迹出现扰动;在获取位置信息(x,y)后,选取该位置与相邻两个位置的yl,yr的中位数ymid代替该点的位置信息y,通过中位值进行滤波,克服行驶过程中出现的位置信息的偶然干扰;
y=Median(yl,yr,y)
过滤掉偶然干扰后,通过最小二乘直线法将获取的位置信息进行拟合,绘制并保存拟合后的轨迹地图;以1m×1m为一个栅格,将轨迹地图划分为若干个栅格,形成栅格轨迹地图;
其中,xi、yi为位置信息,a、b为拟合直线的参数;
将栅格轨迹地图坐标(xm,ym)与农业运输设备的位置坐标(x,y)进行联合标定,将栅格轨迹地图中的各个栅格和农场环境中的实际坐标对应;后期通过栅格轨迹地图的栅格坐标可对农业运输设备进行导航。
进一步的,步骤4所述的导航路线需确保农业运输设备严格按照创建的栅格轨迹地图进行行驶,避开农田,避免破坏农作物。
进一步的,步骤4所述的完成对运输设备的导航规划后,将导航规划传送至农业运输设备,农业运输设备根据规划路线进行运输作业;在运输作业时,当农业运输设备行驶到一个栅格之后,在本次任务中将该栅格设置为已到达状态,运输设备不能重复行驶已到达状态的栅格,只能在规划的导航路线上的未到达状态栅格上行驶,直到运输设备到达导航终点完成运输任务。
有益效果
本发明提出的一种用于农业运输设备的定位导航方法,与现有技术相比较,其具有以下有益效果:
(1)本发明在农场环境或大棚、温室等环境中设置UWB定位基站,并在农场环境中设置多个UWB定位模块,农业运输设备上安装有UWB定位标签,使用UWB多边定位对运输设备进行定位,通过调整定位信息获取的频率实现对运输设备的轨迹跟踪,获取设施内栅格地图信息,对超宽带多边定位技术进行改进,提高了运输设备在封闭环境下的定位精度。并通过地图信息和定位信息对运输设备的作业路径进行规划,实现农业运输设备农业内的定位导航。
(2)本发明通过二维栅格地图代替三维感知建图,可满足不同环境下的使用,操作逻辑简单,同时降低了成本。
附图说明
图1是本发明的农场环境中UWB模块的位置关系示意图。
图2是本发明中UWB模块对UWB定位标签的定位示意图。
图3是本发明中栅格轨迹地图示意图。
图4是本发明中导航策略的流程示意图。
图5是本发明中状态一的路径规划示意图。
图6是本发明中状态二的路径规划示意图。
图7是本发明中状态三的路径规划示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述。所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。在不脱离本发明设计构思的前提下,本领域普通人员对本发明的技术方案做出的各种变型和改进,均应落入到本发明的保护范围。
实施例1:
一种用于农业运输设备的定位导航方法,所述的农业运输设备运行在农场对应的环境中,通过定位导航系统对无人驾驶的农业运输设备进行导航;所述的定位导航方法具体包括步骤:
步骤1:建立农场的定位环境:
在农场对应的环境中设置UWB定位基站,并在农场环境中设置多个UWB定位模块,农业运输设备上安装有UWB定位标签。
如图1所示,在农场对应的环境中每间隔10米设置1个UWB模块作为定位参考节点,使10m×10m范围内至少有3个UWB模块;并通过网络时间协议NTP对所有UWB模块的时钟源进行校正,将多个UWB模块的时间保持一致。
在对应的控制软件中建立农场模型。具体操作方式为:在UWB定位基站的控制软件中建立二维直角坐标系作为参考系,以农场环境的左下角为原点,将至少3个UWB模块的位置被定位为U1,U2,U3,...,Un,其位置坐标分别被记作(x1,y1),(x2,y2),(x3,y3),...,(xn,yn);将运输设备的UWB模块称为U0,位置坐标记为(x,y)。
步骤2:制作农场的栅格地图:
步骤2.1:根据农业运输设备的位置信息,计算得到农业运输设备在农场模型中的位置信息;具体的操作方式为:
农业运输设备上的UWB定位标签对UWB定位基站发出请求信号,获取农业运输设备的位置信息;UWB定位基站通过参考节点U1,U2,U3,...,Un的信息,结合TOF飞行时间技术,计算U0分别到U1,U2,U3,...,Un的直线距离d,具体公式如下:
其中,d1,d2,d3,...,dn为U0分别到U1,U2,U3,...,Un的直线距离,c为信号的传播速度,t为信号的飞行时间;
t=ti-t0-tp
其中,ti为信号接收到的时间,t0为信号发出时间,tp为信号处理时间;
如图2所示,采用多边定位的具体计算方式进行计算。以U1,U2,U3,...,Un为圆心,U1,U2,U3,...,Un分别与U0的距离d为半径画圆,多个圆的交集即U0的位置,通过U0和U1,U2,U3,...,Un的距离d和U1,U2,U3,...,Un位置坐标(x1,y1),(x2,y2),(x3,y3),...,(xn,yn)可计算出U0即运输设备坐标(x,y);计算公式为:
由于测量误差的存在,定位圆并不会刚好交于一点,使用最小二乘法进行近似求解,根据上式,将前n-1个方程减去第n个方程,得到线性化方程AX=b,其中:
利用最小二乘法可以解得:
X=(ATA)-1ATb
其中,X为U0的坐标(x,y)。
步骤2.2:操控农业运输设备在农场环境中行驶,UWB定位基站记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;具体的操作方式为:
人为的操控搭载UWB模块的农业运输设备绕农场环境的边界行驶,由UWB基站的控制软件记录农业运输设备的行驶轨迹,得到农场环境的范围;并操控农业运输设备在农场环境中内部的每条道路上行驶,记录农场环境中内可行驶的道路路线,使得控制软件得到农场环境的相关地图。
步骤2.3:对农业运输设备轨迹进行追踪,并保存对应的轨迹地图作为农业运输设备在农场环境中运行的栅格轨迹地图;具体的操作方式为:
在控制软件中设置:获取农业运输设备的位置信息的频率为0.1s/次,间隔0.1s获取并记录一次农业运输设备的位置坐标(x,y),对农业运输设备的运行轨迹进行跟踪;
由于农业运输设备的在实际行驶过程中并不能完全按照一条直线进行行驶,定位信息会出现摆动,导致轨迹出现扰动;在获取位置信息(x,y)后,选取该位置与相邻两个位置的yl,yr的中位数ymid代替该点的位置信息y,通过中位值进行滤波,克服行驶过程中出现的位置信息的偶然干扰;
y=Median(yl,yr,y)
过滤掉偶然干扰后,通过最小二乘直线法将获取的位置信息进行拟合,绘制并保存拟合后的轨迹地图。
如图3所示,对于每条行驶道路选取1m×1m的区域作为一个网格;将农业设施内部所有的运输设备可行驶的道路划分为多个网格组成栅格地图;以1m×1m为一个栅格,将轨迹地图划分为若干个栅格,形成栅格轨迹地图。
其中,xi、yi为位置信息,a、b为拟合直线的参数;
将栅格轨迹地图坐标(xm,ym)与农业运输设备的位置坐标(x,y)进行联合标定,将栅格轨迹地图中的各个栅格和农场环境中的实际坐标对应。
后期通过栅格轨迹地图的栅格坐标可对农业运输设备进行导航。步骤3:对运输设备进行路径规划:通过运输设备的定位信息和构建的农场环境栅格地图信息,对运输设备进行路径规划;具体的操作方式如图4所示,包括:
步骤3.1:根据步骤2创建的栅格轨迹地图,设置农业运输设备的终点坐标为(xE,yE),根据农业运输设备的起始位置坐标和终点坐标对农业运输设备的行驶路径进行规划。
步骤3.2:通过基点道路规划导航法对农业运输设备进行路径规划导航,以农场环境地图中左侧纵向连接所有横向道路的道路为基点道路,确定农业运输设备的位置和需要到达的终点后,判断农业运输设备的起始位置和终点是否在同一道路上,并判断起始位置是否在基点道路上。
如图5所示,当农业运输设备的起始位置与终点在同一条道路上时,则农业运输设备只需要完成直线行驶到达终点位置;
如图6所示,当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置在基点道路上时,则农业运输设备在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;
如图7所示,当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置不在基点道路上时,则农业运输设备需要先返回基点道路,再在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;
步骤4:按照步骤3所述的导航策略为农业运输设备设置导航路线;
导航路线需确保农业运输设备严格按照创建的栅格轨迹地图进行行驶,避开农田,避免破坏农作物。完成对运输设备的导航规划,完成对运输设备的导航规划后,将导航规划传送至农业运输设备,农业运输设备根据规划路线进行运输作业;在运输作业时,当农业运输设备行驶到一个栅格之后,在本次任务中将该栅格设置为已到达状态,运输设备不能重复行驶已到达状态的栅格,只能在规划的导航路线上的未到达状态栅格上行驶,直到运输设备到达导航终点完成运输任务。操作完成。
Claims (7)
1.一种用于农业运输设备的定位导航方法,所述的农业运输设备运行在农场对应的环境中,通过定位导航系统对无人驾驶的农业运输设备进行导航;其特征在于:所述的定位导航方法具体包括步骤:
步骤1:建立农场的定位环境:
在农场对应的环境中设置UWB定位基站,并在农场环境中设置多个UWB定位模块,农业运输设备上安装有UWB定位标签;并在对应的控制软件中建立农场模型;
步骤2:制作农场的栅格地图:
根据农业运输设备的位置信息,计算得到农业运输设备在农场模型中的位置信息;再操控农业运输设备在农场环境中行驶,UWB定位基站记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;
对农业运输设备轨迹进行追踪,并保存对应的轨迹地图作为农业运输设备在农场环境中运行的栅格轨迹地图;具体的操作方式为:
在控制软件中设置:获取农业运输设备的位置信息的频率为0.1s/次,间隔0.1s获取并记录一次农业运输设备的位置坐标(x,y),对农业运输设备的运行轨迹进行跟踪;
由于农业运输设备的在实际行驶过程中并不能完全按照一条直线进行行驶,定位信息会出现摆动,导致轨迹出现扰动;在获取位置信息(x,y)后,选取该位置与相邻两个位置的yl,yr的中位数ymid代替该点的位置信息y,通过中位值进行滤波,克服行驶过程中出现的位置信息的偶然干扰;
y=Median(yl,yr,y)
过滤掉偶然干扰后,通过最小二乘直线法将获取的位置信息进行拟合,绘制并保存拟合后的轨迹地图;以1m×1m为一个栅格,将轨迹地图划分为若干个栅格,形成栅格轨迹地图;
其中,xi、yi为位置信息,a、b为拟合直线的参数;
将栅格轨迹地图坐标(xm,ym)与农业运输设备的位置坐标(x,y)进行联合标定,将栅格轨迹地图中的各个栅格和农场环境中的实际坐标对应;后期通过栅格轨迹地图的栅格坐标可对农业运输设备进行导航;步骤3:对运输设备进行路径规划:通过运输设备的定位信息和构建的农场环境栅格地图信息,对运输设备进行路径规划;具体的操作方式为:
根据步骤2创建的栅格轨迹地图,设置农业运输设备的终点坐标为(xE,yE),根据农业运输设备的起始位置坐标和终点坐标对农业运输设备的行驶路径进行规划;
通过基点道路规划导航法对农业运输设备进行路径规划导航,以农场环境地图中左侧纵向连接所有横向道路的道路为基点道路,确定农业运输设备的位置和需要到达的终点后,判断农业运输设备的起始位置和终点是否在同一道路上,并判断起始位置是否在基点道路上;
当农业运输设备的起始位置与终点在同一条道路上时,则农业运输设备只需要完成直线行驶到达终点位置;
当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置在基点道路上时,则农业运输设备在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;
当农业运输设备的起始位置与终点不在同一条道路上,且农业运输设备的起始位置不在基点道路上时,则农业运输设备需要先返回基点道路,再在基点道路上行驶到与终点同一横向道路的水平位置后,再进行转弯行驶到相应的横向道路上,最终直线行驶到终点位置;步骤4:按照步骤3所述的导航策略为农业运输设备设置导航路线,完成对运输设备的导航规划,操作完成。
2.根据权利要求1所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤1中所述多个UWB定位模块的设置方式为:在农场环境中每间隔10米设置1个UWB模块作为定位参考节点,使10m×10m范围内至少有3个UWB模块;并通过网络时间协议NTP对所有UWB模块的时钟源进行校正,将多个UWB模块的时间保持一致。
3.根据权利要求2所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤1中所述的建立农场模型,具体操作方式为:在UWB定位基站的控制软件中建立二维直角坐标系作为参考系,以农场环境的左下角为原点,将至少3个UWB模块的位置被定位为U1,U2,U3,...,Un,其位置坐标分别被记作(x1,y1),(x2,y2),(x3,y3),...,(xn,yn);将运输设备的UWB模块称为U0,位置坐标记为(x,y)。
4.根据权利要求3所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤2中所述的根据农业运输设备的位置信息,计算得到农业运输设备在农场模型中的位置信息,具体的操作方式为:
农业运输设备上的UWB定位标签对UWB定位基站发出请求信号,获取农业运输设备的位置信息;UWB定位基站通过参考节点U1,U2,U3,...,Un的信息,结合TOF飞行时间技术,计算U0分别到U1,U2,U3,...,Un的直线距离d,具体公式如下:
其中,d1,d2,d3,...,dn为U0分别到U1,U2,U3,...,Un的直线距离,c为信号的传播速度,t为信号的飞行时间;
t=ti-t0-tp
其中,ti为信号接收到的时间,t0为信号发出时间,tp为信号处理时间;
以U1,U2,U3,...,Un为圆心,U1,U2,U3,...,Un分别与U0的距离d为半径画圆,多个圆的交集即U0的位置,通过U0和U1,U2,U3,...,Un的距离d和U1,U2,U3,...,Un位置坐标(x1,y1),(x2,y2),(x3,y3),...,(xn,yn)可计算出U0即运输设备坐标(x,y);计算公式为:
由于测量误差的存在,定位圆并不会刚好交于一点,使用最小二乘法进行近似求解,根据上式,将前n-1个方程减去第n个方程,得到线性化方程AX=b,其中:
利用最小二乘法可以解得:
X=(ATA)-1ATb
其中,X为U0的坐标(x,y)。
5.根据权利要求1所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤2中所述的操控农业运输设备在农场环境中行驶,UWB定位基站记录农业运输设备在农场环境中的行驶轨迹,得到农场环境相关的地图;具体的操作方式为:人为的操控搭载UWB模块的农业运输设备绕农场环境的边界行驶,由UWB基站的控制软件记录农业运输设备的行驶轨迹,得到农场环境的范围;并操控农业运输设备在农场环境中内部的每条道路上行驶,记录农场环境中内可行驶的道路路线,使得控制软件得到农场环境的相关地图。
6.根据权利要求1所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤4所述的导航路线需确保农业运输设备严格按照创建的栅格轨迹地图进行行驶,避开农田,避免破坏农作物。
7.根据权利要求1所述的一种用于农业运输设备的定位导航方法,其特征在于:步骤4所述的完成对运输设备的导航规划后,将导航规划传送至农业运输设备,农业运输设备根据规划路线进行运输作业;在运输作业时,当农业运输设备行驶到一个栅格之后,在本次任务中将该栅格设置为已到达状态,运输设备不能重复行驶已到达状态的栅格,只能在规划的导航路线上的未到达状态栅格上行驶,直到运输设备到达导航终点完成运输任务。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311012089.9A CN117109583B (zh) | 2023-08-11 | 2023-08-11 | 一种用于农业运输设备的定位导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202311012089.9A CN117109583B (zh) | 2023-08-11 | 2023-08-11 | 一种用于农业运输设备的定位导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN117109583A CN117109583A (zh) | 2023-11-24 |
CN117109583B true CN117109583B (zh) | 2024-06-11 |
Family
ID=88808358
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202311012089.9A Active CN117109583B (zh) | 2023-08-11 | 2023-08-11 | 一种用于农业运输设备的定位导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117109583B (zh) |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110456820A (zh) * | 2019-08-22 | 2019-11-15 | 江苏农林职业技术学院 | 基于超带宽无线定位的农药喷施系统及控制方法 |
CN112954585A (zh) * | 2021-01-29 | 2021-06-11 | 华南农业大学 | 一种基于uwb的农业机械田间定位系统及方法 |
CN113183943A (zh) * | 2021-06-03 | 2021-07-30 | 南昌智能新能源汽车研究院 | 一种农用装备的智能驾驶系统及其作业方法 |
CN113795053A (zh) * | 2021-09-16 | 2021-12-14 | 四川智动木牛智能科技有限公司 | 一种智能农机自动出入机库方法 |
CN114371699A (zh) * | 2021-12-15 | 2022-04-19 | 江苏大学 | 面向中小农田的便携少基站组式农机uwb导航系统与方法 |
CN114689035A (zh) * | 2022-03-25 | 2022-07-01 | 中国科学院计算技术研究所 | 基于多传感器融合的长航程农田地图构建方法及系统 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2015072896A1 (en) * | 2013-11-12 | 2015-05-21 | Husqvarna Ab | Improved navigation for a robotic working tool |
-
2023
- 2023-08-11 CN CN202311012089.9A patent/CN117109583B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110456820A (zh) * | 2019-08-22 | 2019-11-15 | 江苏农林职业技术学院 | 基于超带宽无线定位的农药喷施系统及控制方法 |
CN112954585A (zh) * | 2021-01-29 | 2021-06-11 | 华南农业大学 | 一种基于uwb的农业机械田间定位系统及方法 |
CN113183943A (zh) * | 2021-06-03 | 2021-07-30 | 南昌智能新能源汽车研究院 | 一种农用装备的智能驾驶系统及其作业方法 |
CN113795053A (zh) * | 2021-09-16 | 2021-12-14 | 四川智动木牛智能科技有限公司 | 一种智能农机自动出入机库方法 |
CN114371699A (zh) * | 2021-12-15 | 2022-04-19 | 江苏大学 | 面向中小农田的便携少基站组式农机uwb导航系统与方法 |
CN114689035A (zh) * | 2022-03-25 | 2022-07-01 | 中国科学院计算技术研究所 | 基于多传感器融合的长航程农田地图构建方法及系统 |
Non-Patent Citations (1)
Title |
---|
基于UWB定位的农业机械辅助导航系统设计与试验;肖荣浩 等;《华南农业大学学报》;20221231;第116-123页 * |
Also Published As
Publication number | Publication date |
---|---|
CN117109583A (zh) | 2023-11-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110009761B (zh) | 智能设备自动巡检路径规划方法及系统 | |
CN110262545A (zh) | 一种无人机飞行三维航迹规划方法 | |
CN106020237B (zh) | 植保无人机的多机作业航线规划及其喷洒作业方法和系统 | |
WO2021093474A1 (zh) | 一种割草机导航方法、装置和割草机 | |
CN110764051B (zh) | 一种基于uwb的轨道交通车辆定位方法、服务器及系统 | |
CN111096138B (zh) | 一种基于uwb的割草机器人工作边界建立与识别系统和方法 | |
CN104698437B (zh) | 一种基于超宽带的井下车辆定位方法 | |
CN107950506A (zh) | 移动装置、基于移动装置的喷洒控制方法及装置 | |
CN106292698B (zh) | 植保无人机的精准作业方法和系统 | |
CN105657668A (zh) | 一种基于uwb的室内移动机器人定位与导航控制方法 | |
CN105182997A (zh) | 一种基于电磁仿真的无人机规划航路评估方法 | |
CN109343567A (zh) | 植保无人机精准作业系统及方法 | |
CN109917814A (zh) | 无人机作业方法与系统 | |
CN108801269A (zh) | 一种室内云机器人导航系统及方法 | |
CN107526367A (zh) | 一种基于地理信息融合技术的果树植保无人机作业系统 | |
CN106991681A (zh) | 一种火灾边界矢量信息实时提取与可视化方法及系统 | |
CN106991842A (zh) | 一种地下停车场泊车机器人停车提车定位方法 | |
CN110095108B (zh) | 一种基于bim无人机测绘装置及测绘方法 | |
CN110213713B (zh) | 一种基于时空域联合处理的集中式协作定位系统和方法 | |
CN117109583B (zh) | 一种用于农业运输设备的定位导航方法 | |
CN209070371U (zh) | 植保无人机精准作业系统 | |
CN112731934A (zh) | 基于区域分割的智能割草机快速回充电站的方法 | |
CN113741425B (zh) | 一种全覆盖路径规划方法及导航系统 | |
CN116225003A (zh) | 一种智能农机种管同辙作业方法 | |
Liu et al. | Study on path planning of intelligent mower based on UWB location |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |