CN110262489A - 用于蔬菜立体栽培agv导航磁条布局方法 - Google Patents
用于蔬菜立体栽培agv导航磁条布局方法 Download PDFInfo
- Publication number
- CN110262489A CN110262489A CN201910540330.2A CN201910540330A CN110262489A CN 110262489 A CN110262489 A CN 110262489A CN 201910540330 A CN201910540330 A CN 201910540330A CN 110262489 A CN110262489 A CN 110262489A
- Authority
- CN
- China
- Prior art keywords
- agv
- vehicle
- magnetic stripe
- navigation magnetic
- speed
- 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
- 235000013311 vegetables Nutrition 0.000 title claims abstract description 22
- 238000000034 method Methods 0.000 title claims abstract description 15
- 230000005540 biological transmission Effects 0.000 claims abstract description 13
- 238000001514 detection method Methods 0.000 claims description 70
- 238000004364 calculation method Methods 0.000 claims description 14
- 238000012544 monitoring process Methods 0.000 claims description 10
- 230000009467 reduction Effects 0.000 claims description 9
- 230000001174 ascending effect Effects 0.000 claims description 6
- 238000005299 abrasion Methods 0.000 claims description 3
- 230000005611 electricity Effects 0.000 claims description 3
- 238000012423 maintenance Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 239000007787 solid Substances 0.000 description 9
- 238000010586 diagram Methods 0.000 description 4
- 229910000831 Steel Inorganic materials 0.000 description 3
- 238000009313 farming Methods 0.000 description 3
- 239000010959 steel Substances 0.000 description 3
- 241000196324 Embryophyta Species 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 240000007594 Oryza sativa Species 0.000 description 1
- 235000007164 Oryza sativa Nutrition 0.000 description 1
- 238000010923 batch production Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000007599 discharging Methods 0.000 description 1
- 238000003306 harvesting Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 235000009566 rice Nutrition 0.000 description 1
- 238000003860 storage Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0217—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with energy consumption, time reduction or distance reduction criteria
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0259—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
- G05D1/0263—Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Electromagnetism (AREA)
- Navigation (AREA)
Abstract
本发明提出了一种用于蔬菜立体栽培AGV导航磁条布局方法,包括铺设于蔬菜立体栽培工厂内的导航磁条和地标网络,以及行走在导航磁条和地标网络上的AGV车,AGV车接收到控制中心发送的目标位置后,AGV车根据当前位置行驶至目标位置。本发明能够根据铺设于蔬菜立体栽培工厂内的导航磁条和地标网络实现AGV车快速精确的抵达目标位置。
Description
技术领域
本发明涉及一种蔬菜立体栽培工厂化技术领域,特别是涉及一种用于蔬菜立体栽培AGV导航磁条布局方法。
背景技术
农业作物耕种的发展目标大多为提高耕种效率、提高耕种收成上限和缩短耕种周期这几大方面。近年来随着区域性人口密度不断增加,导致许多非农业区域的耕作压力大幅上升,特别表现在人均耕作面积紧缺,耕作效率无法和供求条件匹配。虽然近几年出现了蔬菜工厂化立体栽培,但是仍然需要大量人力的干预,才能实现蔬菜工厂化立体栽培。
发明内容
本发明旨在至少解决现有技术中存在的技术问题,特别创新地提出了一种用于蔬菜立体栽培AGV导航磁条布局方法。
为了实现本发明的上述目的,本发明提供了一种用于蔬菜立体栽培AGV导航磁条布局方法,包括铺设于蔬菜立体栽培工厂内的导航磁条和地标网络,以及行走在导航磁条和地标网络上的AGV车,AGV车接收到控制中心发送的目标位置后,AGV 车根据当前位置行驶至目标位置。
在本发明的一种优选实施方式中,包括以下步骤:
S1,控制中心查询AGV车的状态:若AGV车处于行走在导航磁条和地标网络上,则忽略行走在导航磁条和地标网络上的AGV车;若AGV车处于待命状态,则将处于待命状态的AGV车作为控制中心接收任务的车辆;
S2,控制中心将目标位置发送给待命AGV车,待命AGV车接收到目标位置后,待命AGV车开始行走于导航磁条和地标网络上;
S3,当AGV车行走到两条或两条以上交叉导航磁条时,AGV车查询当前所处位置,将当前位置与目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xB,yB)为AGV车当前位置B点的坐标,(XC,YC)为目标位置C点的坐标,为当前位置B点与目标位置C点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;
S4,将计算得到的导航磁条与直线所成的夹角由小到大排列,并将最小夹角的导航磁条作为AGV车将要行驶的路径;
S5,控制中心检测最小夹角的导航磁条上是否有AGV车行走:若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为同方向,或者最小夹角的导航磁条上无AGV车行走,则AGV车在最小夹角的导航磁条上行走;若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为反方向,则将第二小夹角的导航磁条作为AGV车将要行驶的路径;
S6,控制中心检测第二小夹角的导航磁条上是否有AGV车行走:若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV 车为同方向,或者第二小夹角的导航磁条上无AGV车行走,则AGV车在第二小夹角的导航磁条上行走;若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV车为反方向,则将第三小夹角的导航磁条作为 AGV车将要行驶的路径;
S7,控制中心检测第三小夹角的导航磁条上是否有AGV车行走:若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV 车为同方向,或者最三小夹角的导航磁条上无AGV车行走,则AGV车在第三小夹角的导航磁条上行走;若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV车为反方向,则将第四小夹角的导航磁条作为 AGV车将要行驶的路径;……,直至确定在第K小夹角的导航磁条上行走的AGV 车与将要行走于第K小夹角的导航磁条上行走的AGV车为同方向,所述K为小于或者等于M的正整数,所述M为导航磁条条数,或者第K小夹角的导航磁条上无 AGV车行走为止。
在本发明的一种优选实施方式中,还包括以下步骤:
S31,当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值不在预设倾倒阈值范围内,则AGV控制器向报警模块发送报警信号,报警模块开始发出报警;当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值在预设倾倒阈值范围内,则报警模块解除报警;当在预设报警时间内,报警模块未解除报警状态,则AGV控制器向控制中心发送倾倒报警信号,并将倾倒的 AGV车的倾倒位置发送到控制中心,当倾倒的AGV车接收到控制中心的反馈处理信号,倾倒的AGV车解除报警;有利于提醒工作人员发现倾倒的AGV车的位置,及时的处理,将其扶正。
S32,AGV控制器比较接收到电池电量检测模块发送的电池电量值与预设电池电量预设阈值大小:若AGV控制器接收到电池电量检测模块发送的电池电量值小于或者等于预设电池电量预设阈值,则控制中心向AGV车发送充电位目标位置,AGV 车至充电位目标位置途中,若AGV车行走到两条或两条以上交叉导航磁条时,则 AGV车查询当前所处位置,将当前位置与充电位目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xE,yE)为AGV车当前位置E点的坐标,(XF,YF)为目标位置F点的坐标,为当前位置E点与目标位置F点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;将计算得到的导航磁条与直线所成的夹角由小到大排列,并将最小夹角的导航磁条作为AGV车行驶的路径;AGV车电池电量不足时,及时的到充电位充电,路线选择合理。
S33,当AGV车在转弯时,AGV控制器比较接收到AGV车速检测模块发送的车速值与预设第一车速阈值大小,若AGV控制器接收到AGV车速检测模块发送的车速值大于或者等于预设第一车速阈值,则AGV控制器控制AGV车减速;防止AGV 车车速过大,脱离导航磁条和地标,更有甚者倾倒。
S34,AGV控制器比较计算得到的路程值与控制中心发送的路程值大小,其AGV 控制器计算得到的路程值的计算方法为:
S=N×2πR,
其中,N为AGV车轮转数检测模块检测的车轮转数,R为AGV车的车轮半径, S为AGV控制器计算得到的路程值;
若AGV控制器计算得到的路程值大于控制中心发送的路程值,则比较AGV控制器计算得到的路程值与控制中心发送的路程值的差值是否大于或者等于预设路程值;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值大于或者等于预设路程值,则AGV车轮胎磨损,需要更换轮胎;控制中心将AGV车维修目标位置发送给AGV车;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值小于预设路程值,或者AGV控制器计算得到的路程值小于或者等于控制中心发送的路程值,则等待AGV车轮胎磨损值达到预设磨损阈值。及时对磨损轮胎进行更换维修。
在本发明的一种优选实施方式中,还包括行走在同一条导航磁条上的同方向的AGV车,包括以下步骤:
S41,控制中心统计行驶在同一条导航磁条上AGV车的数量,由前至后依次编号为第1AGV车、第2AGV车、第3AGV车、……、第PAGV车,所述P为在同一条导航磁条上的总数量;
S42,获取第1AGV车的车速,若第2AGV车的车速大于第1AGV车的车速,且第1AGV车与第2AGV车间的距离小于或者等于预设车距阈值;其第pAGV车与第p+1AGV车间的距离的计算方法为:
dp,p+1=|N第pAGV车-N第(p+1)AGV车|×2πR,
其中,N第pAGV车为第pAGV车的车轮转数,N第(p+1)AGV车为第(p+1)AGV车的车轮转数,dp,p+1为第pAGV车与第p+1AGV车间的距离;所述p为小于或者等于P-1的正整数;
则控制中心向第2AGV车发送控制其第2AGV车降低车速命令,第2AGV车接收到降低车速命令后,第2AGV车降低车速使其车速小于或者等于第1AGV车的车速;
S43,获取第2AGV车的车速,若第3AGV车的车速大于第2AGV车的车速,且第2AGV车与第3AGV车间的距离小于或者等于预设车距阈值;则控制中心向第 3AGV车发送控制其第3AGV车降低车速命令,第3AGV车接收到降低车速命令后,第3AGV车降低车速使其车速小于或者等于第2AGV车的车速;
S43,获取第3AGV车的车速,若第4AGV车的车速大于第3AGV车的车速,且第3AGV车与第4AGV车间的距离小于或者等于预设车距阈值;则控制中心向第 4AGV车发送控制其第4AGV车降低车速命令,第4AGV车接收到降低车速命令后,第4AGV车降低车速使其车速小于或者等于第3AGV车的车速;……,直至获取第 PAGV车的车速,若第PAGV车的车速大于第(P-1)AGV车的车速,且第(P-1) AGV车与第PAGV车间的距离小于或者等于预设车距阈值;则控制中心向第PAGV 车发送控制其第PAGV车降低车速命令,第PAGV车接收到降低车速命令后,第 PAGV车降低车速使其车速小于或者等于第(P-1)AGV车的车速。防止同一条导航磁条上的同方向的AGV车相撞。
在本发明的一种优选实施方式中,AGV车包括AGV车本体,还包括设置于AGV 车内的用于检测AGV车电池电量的电池电量检测模块、用于检测AGV车倾倒的陀螺仪倾倒检测模块、用于检测AGV车车速的AGV车速检测模块、用于检测AGV 车车轮转数的AGV车轮转数检测模块以及用于报警的报警模块;
电池电量检测模块的电池电量信号输出端与AGV控制器的电池电量信号输出端相;陀螺仪倾倒检测模块的倾倒信号输出端与AGV控制器的倾倒信号输入端相连; AGV车速检测模块的车速信号输出端与AGV控制器的车速信号输入端相连;AGV 车轮转数检测模块的车轮转数信号输出端与AGV控制器的车轮转数信号输入端相连;AGV控制器的报警信号输出端与报警模块的报警信号输入端相连。
在本发明的一种优选实施方式中,电池电量检测模块包括充电计时单元、放电计时单元、充电电流检测单元、放电电流检测单元;
放电电流检测单元的电流信号输入端与AGV电池的放电回路相连,放电电流检测单元的计时信号输出端与放电计时单元的计时信号输入端相连,放电计时单元的计时信号输出端与AGV控制器的放电计时输入端相连,放电电流检测单元的电流大小输出端与AGV控制器的放电电流大小输入端相连;
充电电流检测单元的电流信号输入端与AGV电池的充电回路相连,充电电流检测单元的计时信号输出端与充电计时单元的计时信号输入端相连,充电计时单元的计时信号输出端与AGV控制器的充电计时输入端相连,充电电流检测单元的电流大小输出端与AGV控制器的充电电流大小输入端相连;
其AGV电池电量的计算方法为:
Q剩=Q+(∫I充t充dt充+∫(-I放)t放dt放),
其中,Q为AGV电池电量额定值,I充为AGV电池充电电流大小,t充为AGV电池充电时长,I放为AGV电池放电电流大小,t放为AGV电池放电时长。
综上所述,由于采用了上述技术方案,本发明能够根据铺设于蔬菜立体栽培工厂内的导航磁条和地标网络实现AGV车快速精确的抵达目标位置。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1是本发明流程示意图。
图2是本发明AGV导航磁条及地标总布置示意图。
图3是本发明立体栽培区导航磁条及地标布置示意图。
图4是本发明每个栽培架处背负式AGV和潜伏牵引式AGV停止地标布置示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例的示例在附图中示出,其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的,仅用于解释本发明,而不能理解为对本发明的限制。
本发明提供了一种用于蔬菜立体栽培AGV导航磁条布局方法,包括铺设于蔬菜立体栽培工厂内的导航磁条和地标网络,以及行走在导航磁条和地标网络上的AGV 车,如图1所示,AGV车接收到控制中心发送的目标位置后,AGV车根据当前位置行驶至目标位置。
在本发明的一种优选实施方式中,包括以下步骤:
S1,控制中心查询AGV车的状态:若AGV车处于行走在导航磁条和地标网络上,则忽略行走在导航磁条和地标网络上的AGV车;若AGV车处于待命状态,则将处于待命状态的AGV车作为控制中心接收任务的车辆;
S2,控制中心将目标位置发送给待命AGV车,待命AGV车接收到目标位置后,待命AGV车开始行走于导航磁条和地标网络上;
S3,当AGV车行走到两条或两条以上交叉导航磁条时,AGV车查询当前所处位置,将当前位置与目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xB,yB)为AGV车当前位置B点的坐标,(XC,YC)为目标位置C点的坐标,为当前位置B点与目标位置C点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;
S4,将计算得到的导航磁条与直线所成的夹角由小到大排列,依次分别为最小夹角、第二小夹角、第三小夹角、……、第M小夹角,并将最小夹角的导航磁条作为AGV车将要行驶的路径;
S5,控制中心检测最小夹角的导航磁条上是否有AGV车行走:若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为同方向,或者最小夹角的导航磁条上无AGV车行走,则AGV车在最小夹角的导航磁条上行走;若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为反方向,则将第二小夹角的导航磁条作为AGV车将要行驶的路径;
S6,控制中心检测第二小夹角的导航磁条上是否有AGV车行走:若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV 车为同方向,或者第二小夹角的导航磁条上无AGV车行走,则AGV车在第二小夹角的导航磁条上行走;若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV车为反方向,则将第三小夹角的导航磁条作为 AGV车将要行驶的路径;
S7,控制中心检测第三小夹角的导航磁条上是否有AGV车行走:若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV 车为同方向,或者最三小夹角的导航磁条上无AGV车行走,则AGV车在第三小夹角的导航磁条上行走;若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV车为反方向,则将第四小夹角的导航磁条作为 AGV车将要行驶的路径;……,直至确定在第K小夹角的导航磁条上行走的AGV 车与将要行走于第K小夹角的导航磁条上行走的AGV车为同方向,所述K为小于或者等于M的正整数,所述M为导航磁条条数,或者第K小夹角的导航磁条上无 AGV车行走为止。
在本发明的一种优选实施方式中,还包括以下步骤:
S31,当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值不在预设倾倒阈值范围内,则AGV控制器向报警模块发送报警信号,报警模块开始发出报警;当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值在预设倾倒阈值范围内,则报警模块解除报警;当在预设报警时间内,报警模块未解除报警状态,则AGV控制器向控制中心发送倾倒报警信号,并将倾倒的 AGV车的倾倒位置发送到控制中心,当倾倒的AGV车接收到控制中心的反馈处理信号,倾倒的AGV车解除报警;
S32,AGV控制器比较接收到电池电量检测模块发送的电池电量值与预设电池电量预设阈值大小:若AGV控制器接收到电池电量检测模块发送的电池电量值小于或者等于预设电池电量预设阈值,则控制中心向AGV车发送充电位目标位置,AGV 车至充电位目标位置途中,若AGV车行走到两条或两条以上交叉导航磁条时,则 AGV车查询当前所处位置,将当前位置与充电位目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xE,yE)为AGV车当前位置E点的坐标,(XF,YF)为目标位置F点的坐标,为当前位置E点与目标位置F点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;将计算得到的导航磁条与直线所成的夹角由小到大排列,依次分别为最小夹角、第二小夹角、第三小夹角、……、第M小夹角,并将最小夹角的导航磁条作为AGV车行驶的路径;
S33,当AGV车在转弯时,AGV控制器比较接收到AGV车速检测模块发送的车速值与预设第一车速阈值大小,若AGV控制器接收到AGV车速检测模块发送的车速值大于或者等于预设第一车速阈值,则AGV控制器控制AGV车减速;
S34,AGV控制器比较计算得到的路程值与控制中心发送的路程值大小,其AGV 控制器计算得到的路程值的计算方法为:
S=N×2πR,
其中,N为AGV车轮转数检测模块检测的车轮转数,R为AGV车的车轮半径, S为AGV控制器计算得到的路程值;
若AGV控制器计算得到的路程值大于控制中心发送的路程值,则比较AGV控制器计算得到的路程值与控制中心发送的路程值的差值是否大于或者等于预设路程值;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值大于或者等于预设路程值,则AGV车轮胎磨损,需要更换轮胎;控制中心将AGV车维修目标位置发送给AGV车;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值小于预设路程值,或者AGV控制器计算得到的路程值小于或者等于控制中心发送的路程值,则等待AGV车轮胎磨损值达到预设磨损阈值。
如图2所示,1)AGV运行时需要导航磁条为其指引路径,需要地标为其提供定位依据和明确运动目标点。
2)背负式AGV和潜伏牵引式AGV共用一套导航磁条和地标。
3)导航磁条不间断铺设到所有AGV需要到达的地方,包括转运架上盘/下盘区、AGV充电区、转运架存放区、大棚主干道、立体栽培区巷道等。
4)导航磁条在每个转弯处的半径为1米。
5)地标是贴在导航磁条上的供AGV识别的实心圆点,是间断的。在主干道上,每隔1米贴一个地标,其他区域每隔0.5米贴一个地标。
6)在转弯处弧形磁条的两端必各贴一个地标,在磁条交叉处必贴一个地标。
如图3所示,立体栽培区一共108个栽培架,分成22列、每列5个。AGV导航磁条所形成的路径必须保证AGV能够到达每个栽培架的旁边。
立体栽培区内既有横向的钢梁也有纵向的钢梁,两个方向的钢梁的交叉处有柱子,导致AGV无法通行。所以AGV导航磁条铺设时要避开有柱子的巷道。
一共在立体栽培区的14个巷道中铺设了AGV导航磁条和地标,如图4所示的1 到14编号的巷道。
自动抓取盘机对栽培架取或放定植盘时都是连续地取或放6个,这个过程中自动抓取盘机保持其中心位置对准栽培架的中心位置、潜伏牵引式AGV要与自动抓取盘机保持固定的距离。当取或放完6个定植盘后,自动抓取盘机和潜伏牵引式AGV 向下一个栽培架移动,停止后,它们的距离还是保持不变。这就要求对应每个栽培架都要有一个地标对准它的中心,另外有个一地标和这个地标保持固定的距离,这个距离正好是背负式AGV和潜伏牵引式AGV在立体栽培区工作时中心的距离。如图4所示,地标A正对栽培架中心,是背负式AGV的停止点;地标B和地标A距离1.5米,是潜伏牵引式AGV的停止点。
在本发明的一种优选实施方式中,还包括行走在同一条导航磁条上的同方向的AGV车,包括以下步骤:
S41,控制中心统计行驶在同一条导航磁条上AGV车的数量,由前至后依次编号为第1AGV车、第2AGV车、第3AGV车、……、第PAGV车,所述P为在同一条导航磁条上的总数量;
S42,获取第1AGV车的车速,若第2AGV车的车速大于第1AGV车的车速,且第1AGV车与第2AGV车间的距离小于或者等于预设车距阈值;其第pAGV车与第p+1AGV车间的距离的计算方法为:
dp,p+1=|N第pAGV车-N第(p+1)AGV车|×2πR,
其中,N第pAGV车为第pAGV车的车轮转数,N第(p+1)AGV车为第(p+1)AGV车的车轮转数,dp,p+1为第pAGV车与第p+1AGV车间的距离;所述p为小于或者等于P-1的正整数;
则控制中心向第2AGV车发送控制其第2AGV车降低车速命令,第2AGV车接收到降低车速命令后,第2AGV车降低车速使其车速小于或者等于第1AGV车的车速;
S43,获取第2AGV车的车速,若第3AGV车的车速大于第2AGV车的车速,且第2AGV车与第3AGV车间的距离小于或者等于预设车距阈值;则控制中心向第 3AGV车发送控制其第3AGV车降低车速命令,第3AGV车接收到降低车速命令后,第3AGV车降低车速使其车速小于或者等于第2AGV车的车速;
S43,获取第3AGV车的车速,若第4AGV车的车速大于第3AGV车的车速,且第3AGV车与第4AGV车间的距离小于或者等于预设车距阈值;则控制中心向第 4AGV车发送控制其第4AGV车降低车速命令,第4AGV车接收到降低车速命令后,第4AGV车降低车速使其车速小于或者等于第3AGV车的车速;……,直至获取第PAGV车的车速,若第PAGV车的车速大于第(P-1)AGV车的车速,且第(P-1) AGV车与第PAGV车间的距离小于或者等于预设车距阈值;则控制中心向第PAGV 车发送控制其第PAGV车降低车速命令,第PAGV车接收到降低车速命令后,第 PAGV车降低车速使其车速小于或者等于第(P-1)AGV车的车速;防止同一条导航磁条上的同方向的AGV车相撞。
在本发明的一种优选实施方式中,AGV车包括AGV车本体,还包括设置于AGV 车内的用于检测AGV车电池电量的电池电量检测模块、用于检测AGV车倾倒的陀螺仪倾倒检测模块、用于检测AGV车车速的AGV车速检测模块、用于检测AGV 车车轮转数的AGV车轮转数检测模块以及用于报警的报警模块;
电池电量检测模块的电池电量信号输出端与AGV控制器的电池电量信号输出端相;陀螺仪倾倒检测模块的倾倒信号输出端与AGV控制器的倾倒信号输入端相连; AGV车速检测模块的车速信号输出端与AGV控制器的车速信号输入端相连;AGV 车轮转数检测模块的车轮转数信号输出端与AGV控制器的车轮转数信号输入端相连;AGV控制器的报警信号输出端与报警模块的报警信号输入端相连。
在本发明的一种优选实施方式中,电池电量检测模块包括充电计时单元、放电计时单元、充电电流检测单元、放电电流检测单元;
放电电流检测单元的电流信号输入端与AGV电池的放电回路相连,放电电流检测单元的计时信号输出端与放电计时单元的计时信号输入端相连,放电计时单元的计时信号输出端与AGV控制器的放电计时输入端相连,放电电流检测单元的电流大小输出端与AGV控制器的放电电流大小输入端相连;
充电电流检测单元的电流信号输入端与AGV电池的充电回路相连,充电电流检测单元的计时信号输出端与充电计时单元的计时信号输入端相连,充电计时单元的计时信号输出端与AGV控制器的充电计时输入端相连,充电电流检测单元的电流大小输出端与AGV控制器的充电电流大小输入端相连;
其AGV电池电量的计算方法为:
Q剩=Q+(∫I充t充dt充+∫(-I放)t放dt放),
其中,Q为AGV电池电量额定值,I充为AGV电池充电电流大小,t充为AGV电池充电时长,I放为AGV电池放电电流大小,t放为AGV电池放电时长。
尽管已经示出和描述了本发明的实施例,本领域的普通技术人员可以理解:在不脱离本发明的原理和宗旨的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由权利要求及其等同物限定。
Claims (6)
1.一种用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,包括铺设于蔬菜立体栽培工厂内的导航磁条和地标网络,以及行走在导航磁条和地标网络上的AGV车,AGV车接收到控制中心发送的目标位置后,AGV车根据当前位置行驶至目标位置。
2.根据权利要求1所述的用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,包括以下步骤:
S1,控制中心查询AGV车的状态:若AGV车处于行走在导航磁条和地标网络上,则忽略行走在导航磁条和地标网络上的AGV车;若AGV车处于待命状态,则将处于待命状态的AGV车作为控制中心接收任务的车辆;
S2,控制中心将目标位置发送给待命AGV车,待命AGV车接收到目标位置后,待命AGV车开始行走于导航磁条和地标网络上;
S3,当AGV车行走到两条或两条以上交叉导航磁条时,AGV车查询当前所处位置,将当前位置与目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xB,yB)为AGV车当前位置B点的坐标,(XC,YC)为目标位置C点的坐标,为当前位置B点与目标位置C点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;
S4,将计算得到的导航磁条与直线所成的夹角由小到大排列,并将最小夹角的导航磁条作为AGV车将要行驶的路径;
S5,控制中心检测最小夹角的导航磁条上是否有AGV车行走:若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为同方向,或者最小夹角的导航磁条上无AGV车行走,则AGV车在最小夹角的导航磁条上行走;若在最小夹角的导航磁条上行走的AGV车与将要行走于最小夹角的导航磁条上行走的AGV车为反方向,则将第二小夹角的导航磁条作为AGV车将要行驶的路径;
S6,控制中心检测第二小夹角的导航磁条上是否有AGV车行走:若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV车为同方向,或者第二小夹角的导航磁条上无AGV车行走,则AGV车在第二小夹角的导航磁条上行走;若在第二小夹角的导航磁条上行走的AGV车与将要行走于第二小夹角的导航磁条上行走的AGV车为反方向,则将第三小夹角的导航磁条作为AGV车将要行驶的路径;
S7,控制中心检测第三小夹角的导航磁条上是否有AGV车行走:若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV车为同方向,或者最三小夹角的导航磁条上无AGV车行走,则AGV车在第三小夹角的导航磁条上行走;若在第三小夹角的导航磁条上行走的AGV车与将要行走于第三小夹角的导航磁条上行走的AGV车为反方向,则将第四小夹角的导航磁条作为AGV车将要行驶的路径;……,直至确定在第K小夹角的导航磁条上行走的AGV车与将要行走于第K小夹角的导航磁条上行走的AGV车为同方向,所述K为小于或者等于M的正整数,所述M为导航磁条条数,或者第K小夹角的导航磁条上无AGV车行走为止。
3.根据权利要求1所述的用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,还包括以下步骤:
S31,当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值不在预设倾倒阈值范围内,则AGV控制器向报警模块发送报警信号,报警模块开始发出报警;当AGV控制器接收到安装在AGV车内的陀螺仪倾倒检测模块输出的倾倒值在预设倾倒阈值范围内,则报警模块解除报警;当在预设报警时间内,报警模块未解除报警状态,则AGV控制器向控制中心发送倾倒报警信号,并将倾倒的AGV车的倾倒位置发送到控制中心,当倾倒的AGV车接收到控制中心的反馈处理信号,倾倒的AGV车解除报警;
S32,AGV控制器比较接收到电池电量检测模块发送的电池电量值与预设电池电量预设阈值大小:若AGV控制器接收到电池电量检测模块发送的电池电量值小于或者等于预设电池电量预设阈值,则控制中心向AGV车发送充电位目标位置,AGV车至充电位目标位置途中,若AGV车行走到两条或两条以上交叉导航磁条时,则AGV车查询当前所处位置,将当前位置与充电位目标位置连成直线,计算各条导航磁条与直线所成的夹角,其导航磁条与直线所成的夹角的计算方法为:
其中,(xE,yE)为AGV车当前位置E点的坐标,(XF,YF)为目标位置F点的坐标,为当前位置E点与目标位置F点所成直线的向量,为导航磁条j的向量,为导航磁条j的长度,j为导航磁条的编号,θj为导航磁条j与直线所成的夹角;将计算得到的导航磁条与直线所成的夹角由小到大排列,并将最小夹角的导航磁条作为AGV车行驶的路径;
S33,当AGV车在转弯时,AGV控制器比较接收到AGV车速检测模块发送的车速值与预设第一车速阈值大小,若AGV控制器接收到AGV车速检测模块发送的车速值大于或者等于预设第一车速阈值,则AGV控制器控制AGV车减速;
S34,AGV控制器比较计算得到的路程值与控制中心发送的路程值大小,其AGV控制器计算得到的路程值的计算方法为:
S=N×2πR,
其中,N为AGV车轮转数检测模块检测的车轮转数,R为AGV车的车轮半径,S为AGV控制器计算得到的路程值;
若AGV控制器计算得到的路程值大于控制中心发送的路程值,则比较AGV控制器计算得到的路程值与控制中心发送的路程值的差值是否大于或者等于预设路程值;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值大于或者等于预设路程值,则AGV车轮胎磨损,需要更换轮胎;控制中心将AGV车维修目标位置发送给AGV车;若AGV控制器计算得到的路程值与控制中心发送的路程值的差值小于预设路程值,或者AGV控制器计算得到的路程值小于或者等于控制中心发送的路程值,则等待AGV车轮胎磨损值达到预设磨损阈值。
4.根据权利要求1所述的用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,还包括行走在同一条导航磁条上的同方向的AGV车,包括以下步骤:
S41,控制中心统计行驶在同一条导航磁条上AGV车的数量,由前至后依次编号为第1AGV车、第2AGV车、第3AGV车、……、第PAGV车,所述P为在同一条导航磁条上的总数量;
S42,获取第1AGV车的车速,若第2AGV车的车速大于第1AGV车的车速,且第1AGV车与第2AGV车间的距离小于或者等于预设车距阈值;其第pAGV车与第p+1AGV车间的距离的计算方法为:
dp,p+1=|N第pAGV车-N第(p+1)AGV车|×2πR,
其中,N第pAGV车为第pAGV车的车轮转数,N第(p+1)AGV车为第(p+1)AGV车的车轮转数,dp,p+1为第pAGV车与第p+1AGV车间的距离;所述p为小于或者等于P-1的正整数;
则控制中心向第2AGV车发送控制其第2AGV车降低车速命令,第2AGV车接收到降低车速命令后,第2AGV车降低车速使其车速小于或者等于第1AGV车的车速;
S43,获取第2AGV车的车速,若第3AGV车的车速大于第2AGV车的车速,且第2AGV车与第3AGV车间的距离小于或者等于预设车距阈值;则控制中心向第3AGV车发送控制其第3AGV车降低车速命令,第3AGV车接收到降低车速命令后,第3AGV车降低车速使其车速小于或者等于第2AGV车的车速;
S43,获取第3AGV车的车速,若第4AGV车的车速大于第3AGV车的车速,且第3AGV车与第4AGV车间的距离小于或者等于预设车距阈值;则控制中心向第4AGV车发送控制其第4AGV车降低车速命令,第4AGV车接收到降低车速命令后,第4AGV车降低车速使其车速小于或者等于第3AGV车的车速;……,直至获取第PAGV车的车速,若第PAGV车的车速大于第(P-1)AGV车的车速,且第(P-1)AGV车与第PAGV车间的距离小于或者等于预设车距阈值;则控制中心向第PAGV车发送控制其第PAGV车降低车速命令,第PAGV车接收到降低车速命令后,第PAGV车降低车速使其车速小于或者等于第(P-1)AGV车的车速。
5.根据权利要求1所述的用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,AGV车包括AGV车本体,还包括设置于AGV车内的用于检测AGV车电池电量的电池电量检测模块、用于检测AGV车倾倒的陀螺仪倾倒检测模块、用于检测AGV车车速的AGV车速检测模块、用于检测AGV车车轮转数的AGV车轮转数检测模块以及用于报警的报警模块;
电池电量检测模块的电池电量信号输出端与AGV控制器的电池电量信号输出端相;陀螺仪倾倒检测模块的倾倒信号输出端与AGV控制器的倾倒信号输入端相连;AGV车速检测模块的车速信号输出端与AGV控制器的车速信号输入端相连;AGV车轮转数检测模块的车轮转数信号输出端与AGV控制器的车轮转数信号输入端相连;AGV控制器的报警信号输出端与报警模块的报警信号输入端相连。
6.根据权利要求5所述的用于蔬菜立体栽培AGV导航磁条布局方法,其特征在于,电池电量检测模块包括充电计时单元、放电计时单元、充电电流检测单元、放电电流检测单元;
放电电流检测单元的电流信号输入端与AGV电池的放电回路相连,放电电流检测单元的计时信号输出端与放电计时单元的计时信号输入端相连,放电计时单元的计时信号输出端与AGV控制器的放电计时输入端相连,放电电流检测单元的电流大小输出端与AGV控制器的放电电流大小输入端相连;
充电电流检测单元的电流信号输入端与AGV电池的充电回路相连,充电电流检测单元的计时信号输出端与充电计时单元的计时信号输入端相连,充电计时单元的计时信号输出端与AGV控制器的充电计时输入端相连,充电电流检测单元的电流大小输出端与AGV控制器的充电电流大小输入端相连;
其AGV电池电量的计算方法为:
Q剩=Q+(∫I充t充dt充+∫(-I放)t放dt放),
其中,Q为AGV电池电量额定值,I充为AGV电池充电电流大小,t充为AGV电池充电时长,I放为AGV电池放电电流大小,t放为AGV电池放电时长。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910540330.2A CN110262489A (zh) | 2019-06-21 | 2019-06-21 | 用于蔬菜立体栽培agv导航磁条布局方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910540330.2A CN110262489A (zh) | 2019-06-21 | 2019-06-21 | 用于蔬菜立体栽培agv导航磁条布局方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110262489A true CN110262489A (zh) | 2019-09-20 |
Family
ID=67920067
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910540330.2A Pending CN110262489A (zh) | 2019-06-21 | 2019-06-21 | 用于蔬菜立体栽培agv导航磁条布局方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110262489A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487965A (zh) * | 2020-04-08 | 2020-08-04 | 新石器慧通(北京)科技有限公司 | 机器的自动行驶方法及装置、电子设备、存储介质 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408430A (zh) * | 2007-10-09 | 2009-04-15 | 罗剑 | 基于无源射频地标的汽车导航与自动驾驶*** |
JP2010004587A (ja) * | 2008-06-18 | 2010-01-07 | Meidensha Corp | 物流用搬送車の充電装置及び充電システム |
US20140253043A1 (en) * | 2013-03-05 | 2014-09-11 | Lg Chem, Ltd. | Apparatus and method for warning charge amount of battery |
CN105973239A (zh) * | 2016-07-06 | 2016-09-28 | 深圳市高巨创新科技开发有限公司 | 无人机最短路径搜索方法 |
CN106254455A (zh) * | 2016-08-03 | 2016-12-21 | 深圳市永兴元科技有限公司 | 车辆保养提醒方法及云服务器 |
CN106515318A (zh) * | 2016-11-23 | 2017-03-22 | 彩虹无线(北京)新技术有限公司 | 一种基于车联网大数据的汽车轮胎磨损故障预警的方法 |
CN106681321A (zh) * | 2016-12-16 | 2017-05-17 | 盐城工学院 | 基于rfid的无人搬运智能导航小车的在线调度控制*** |
CN107065888A (zh) * | 2017-05-26 | 2017-08-18 | 金陵科技学院 | 一种基于磁导航机器人及导航调度***和方法 |
CN108022041A (zh) * | 2017-11-25 | 2018-05-11 | 东南大学 | 电动物流车能源管理与实时调度决策***及其运行方法 |
CN108279664A (zh) * | 2018-03-05 | 2018-07-13 | 刘李辉 | 一种车载信息服务平台 |
CN207663509U (zh) * | 2017-12-14 | 2018-07-27 | 深圳卓和云投资控股有限公司 | 一种自动巡航售卖机及售卖*** |
CN109782757A (zh) * | 2018-12-30 | 2019-05-21 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于分段调度的多agv***的路径调度方法 |
-
2019
- 2019-06-21 CN CN201910540330.2A patent/CN110262489A/zh active Pending
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101408430A (zh) * | 2007-10-09 | 2009-04-15 | 罗剑 | 基于无源射频地标的汽车导航与自动驾驶*** |
JP2010004587A (ja) * | 2008-06-18 | 2010-01-07 | Meidensha Corp | 物流用搬送車の充電装置及び充電システム |
US20140253043A1 (en) * | 2013-03-05 | 2014-09-11 | Lg Chem, Ltd. | Apparatus and method for warning charge amount of battery |
CN105973239A (zh) * | 2016-07-06 | 2016-09-28 | 深圳市高巨创新科技开发有限公司 | 无人机最短路径搜索方法 |
CN106254455A (zh) * | 2016-08-03 | 2016-12-21 | 深圳市永兴元科技有限公司 | 车辆保养提醒方法及云服务器 |
CN106515318A (zh) * | 2016-11-23 | 2017-03-22 | 彩虹无线(北京)新技术有限公司 | 一种基于车联网大数据的汽车轮胎磨损故障预警的方法 |
CN106681321A (zh) * | 2016-12-16 | 2017-05-17 | 盐城工学院 | 基于rfid的无人搬运智能导航小车的在线调度控制*** |
CN107065888A (zh) * | 2017-05-26 | 2017-08-18 | 金陵科技学院 | 一种基于磁导航机器人及导航调度***和方法 |
CN108022041A (zh) * | 2017-11-25 | 2018-05-11 | 东南大学 | 电动物流车能源管理与实时调度决策***及其运行方法 |
CN207663509U (zh) * | 2017-12-14 | 2018-07-27 | 深圳卓和云投资控股有限公司 | 一种自动巡航售卖机及售卖*** |
CN108279664A (zh) * | 2018-03-05 | 2018-07-13 | 刘李辉 | 一种车载信息服务平台 |
CN109782757A (zh) * | 2018-12-30 | 2019-05-21 | 芜湖哈特机器人产业技术研究院有限公司 | 一种基于分段调度的多agv***的路径调度方法 |
Non-Patent Citations (3)
Title |
---|
任向阳 等: "基于主动防护的车辆侧翻预警***设计", 《工业仪表与自动化装置》 * |
任向阳: "基于车联网车载终端及车辆侧翻预警***设计", 《中国优秀硕士学位论文全文数据库 工程科技II辑》 * |
祝全涛 等: "车辆侧翻预警***的设计与实现", 《湖北汽车工业学院学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111487965A (zh) * | 2020-04-08 | 2020-08-04 | 新石器慧通(北京)科技有限公司 | 机器的自动行驶方法及装置、电子设备、存储介质 |
CN111487965B (zh) * | 2020-04-08 | 2023-06-20 | 新石器慧通(北京)科技有限公司 | 机器的自动行驶方法及装置、电子设备、存储介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US11037379B2 (en) | Resource replenishment system and work vehicle | |
US8998117B2 (en) | Irrigation system with smart hydrants and related method | |
US8942862B2 (en) | Method and system for guiding a robotic garden tool to a predetermined position | |
US8915692B2 (en) | Adaptable container handling system | |
CA2566604C (en) | Satellite based vehicle guidance control in straight and contour modes | |
JP6253538B2 (ja) | 作業車 | |
US20130030609A1 (en) | Robotic Garden Tool Following Wires at a Distance Using Multiple Signals | |
CN108052107A (zh) | 一种融合磁条、磁钉和惯导的agv室内外复合导航***及方法 | |
CN104597905B (zh) | 磁导航agv的路径跟踪方法 | |
CN105980948A (zh) | 自主行驶作业车辆的行驶路径的设定方法 | |
KR101153857B1 (ko) | 어린모 검출 장치를 구비한 제초용 로봇 | |
KR101451592B1 (ko) | 골프 필드용 무선 조정 카트 제어 시스템 | |
CN205950750U (zh) | 基于惯性导航的变电站巡检机器人导航控制*** | |
CN102754538A (zh) | 用于连栋温室的机器人 | |
CN106417234A (zh) | 一种智能农药喷洒*** | |
JP6968216B2 (ja) | 資源補給システム、及び、作業車 | |
CN110262489A (zh) | 用于蔬菜立体栽培agv导航磁条布局方法 | |
CN105917828A (zh) | 一种自动施肥机及其控制方法 | |
JP6870464B2 (ja) | 作業車両 | |
EP3986111A1 (en) | Crop input application systems, methods, and apparatus | |
CN110308706A (zh) | 用于蔬菜立体栽培定植的agv智能工作方法 | |
CN108157324B (zh) | 一种基于均匀化喷洒装置的施药流程 | |
CN106094617A (zh) | 无线传输三核八轴履带式高速天然气管道机器人控制*** | |
CN114371699B (zh) | 面向中小农田的便携少基站组式农机uwb导航***与方法 | |
US20230039718A1 (en) | Systems and methods for controlling a work vehicle |
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: 20190920 |
|
RJ01 | Rejection of invention patent application after publication |