CN113415561B - 一种基于uwb技术的四向穿梭车防撞避障方法及*** - Google Patents
一种基于uwb技术的四向穿梭车防撞避障方法及*** Download PDFInfo
- Publication number
- CN113415561B CN113415561B CN202110721367.2A CN202110721367A CN113415561B CN 113415561 B CN113415561 B CN 113415561B CN 202110721367 A CN202110721367 A CN 202110721367A CN 113415561 B CN113415561 B CN 113415561B
- Authority
- CN
- China
- Prior art keywords
- way shuttle
- vehicle
- signals
- uwb
- distance
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G1/00—Storing articles, individually or in orderly arrangement, in warehouses or magazines
- B65G1/02—Storage devices
- B65G1/04—Storage devices mechanical
- B65G1/0492—Storage devices mechanical with cars adapted to travel in storage aisles
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种基于UWB技术的四向穿梭车防撞避障方法及***,四向穿梭车UWB模块持续发射包含车辆编码信息的信号,并接收来自其他四向穿梭车UWB模块的发射信号;根据接收到的信号计算车辆间距;设置安全距离W1和W2,其中W1为减速停止距离,W2为紧急制动距离;当车辆间距小于等于W1时,四向穿梭车的控制器控制车辆减速并停在下一个货位的正到位,并将停止位置、车辆编码、减速事件触发信息反馈给上游四向穿梭车调度控制***;当车辆间距小于等于W2时,四向穿梭车本体的控制器控制车辆紧急制动并将停止位置、车辆编码、急停事件触发信息反馈给上游四向穿梭车调度控制***。本发明的方法和***弥补了现有避障方法存在的缺陷,且成本较低。
Description
技术领域
本发明属于自动化仓储设备及其控制技术领域,具体涉及一种基于UWB技术的四向穿梭车防撞避障方法及***。
背景技术
四向穿梭车为应用于立库存储货物搬运用途,可以在货架轨道上四向换向行驶的搬运车辆,包括传感、行驶、换向、顶升、控制、通讯5大功能模块,四向穿梭车和四向穿梭车提升机、穿梭车货架共同构成四向穿梭车立库的硬件设施。
四向穿梭车运行于穿梭车货架上,和开放环境不同,穿梭车货架存在较多的立柱、横梁、货物支撑板等部件,需要穿梭车能够仅识别可能与之发生碰撞的物体,而对于立柱、横梁、货物支撑板等尽管与穿梭车可能距离极近但不会与穿梭车发生碰撞的部件不做避障动作。
目前穿梭车多采用在前后左右四个方向的车体上安装开关型激光传感器的方法进行避障,该类型传感器可以探测传感器正前方的障碍物,如车体或者异常掉落的货物,但是对于穿梭车之间的交叉碰撞无法形成实质保护。
类似的开放环境下工作的AGV等自动行驶设备可以通过在对角线处安装激光雷达或超声波雷达,但由于穿梭车工作在货架环境中,立柱、横梁、货物挡板等天然距离穿梭车极近,因而不能采用这种方式进行穿梭车的防撞避障。目前市场上尚无针对这种场景有效的穿梭车本体避障设计。
发明内容
本发明的目的在于克服现有技术存在的问题,提供一种基于UWB技术的四向穿梭车防撞避障方法和***。
为实现上述技术目的,本发明采用如下技术方案:
一种基于UWB技术的四向穿梭车防撞避障方法,包括:
S100四向穿梭车UWB模块持续发射信号,并接收来自其他四向穿梭车UWB模块的发射信号,所述发射信号中包含车辆编码信息;
S200根据接收到的信号,基于双向飞行时间法计算车辆间距;
S300设置安全距离W1和W2,其中W1为减速停止距离,长度为n个货位,W2为紧急制动距离,长度为m个货位,n>m;当车辆间距小于等于W1时,四向穿梭车的控制器控制车辆减速并停在下一个货位的正到位,并将停止位置、车辆编码、减速事件触发信息反馈给上游四向穿梭车调度控制***;当车辆间距小于等于W2时,四向穿梭车本体的控制器控制车辆紧急制动并将停止位置、车辆编码、急停事件触发信息反馈给上游四向穿梭车调度控制***。
作为一种优选的实施方式,所述S100还包括,将四向穿梭车沿主通道行驶时定义为沿X轴行驶,在货道中行驶时定义为沿Y轴行驶;
所述发射信号中还包含该四向穿梭车自身当前行驶轴信息。
作为一种优选的实施方式,所述S100还包括:
获取接收到的信号后,计算其RSSI值,筛选出RSSI值超出阈值的信号,对筛选出的信号对应的四向穿梭车进行跟踪,持续接收其UWB信号。
进一步的,所述阈值基于仓库大小、货物类型和/或货架材质确定。
作为一种优选的实施方式,所述S100还包括:
从接收到的信号中获取四向穿梭车行驶轴信息,并与自身行驶轴信息进行对比判断,
当两台四向穿梭车同轴行驶时,重复S100,否则进入S200。
作为一种优选的实施方式,还包括,采用开关型激光传感器完成同轴方向的避障传感。
作为一种优选的实施方式,采用到位传感器进行正到位判断,使四向穿梭车停在货位的正到位。
作为一种优选的实施方式,所述W1设置为3个货位距离,W2设置为1个货位距离。
本发明的另一目的在于提供一种基于UWB技术的四向穿梭车防撞避障***,包括:
UWB模块,设置于四向穿梭车上,用于收发UWB信号,并将接收的UWB信号发送至控制器;
到位传感器,用于检测四向穿梭车是否停止于货位的正到位位置,并将检测信号发送至控制器;
控制器,接收UWB模块、到位传感器发送的信号,执行权利要求1~8任一项所述方法;
上位调度***通讯模块,根据控制器发送的指令与上位调度***通信。
作为一种优选的实施方式,所述***还包括激光避障传感器,设置于四向穿梭车四周,用于收发激光信号,并将接收到的激光信号发送至控制器。
本发明的四向穿梭车结合UWB技术实现交叉碰撞情况下的防撞避障,UWB技术可以实现较好的信号穿透能力,从而能够在立柱遮挡的立库环境下使用,且四向穿梭车避障这一场景对测距精度的要求并不高,UWB技术cm级的定位精度即可完美适应该场景的需求,弥补了现有避障方法存在的缺陷,可以保证在调度控制***失灵等异常情况下均不会发生四向穿梭车碰撞这一严重的安全问题,且成本较低。
附图说明
图1是本发明***结构示意图。
图2是碰撞情况示意图。
图3是四向穿梭车行驶状态示意图。
具体实施方式
下面结合附图说明和具体实施方式对本发明的技术方案进行进一步阐述。
应用了UWB技术的四向穿梭车防撞避障***结构如图1所示,四向穿梭车至少包括控制器、UWB模块、上位调度***通讯模块、激光避障传感器、到位传感器,其中控制器用于接收各传感器信号、进行运算判定、下发控制指令、接收上位调度***指令、向上位调度***上报状态等;UWB模块用于接收和发送UWB信号;上位调度***通讯模块用于和部署于局域网或云端的调度***进行通讯;激光避障传感器用于检测前后左右四个方向正向的障碍物情况;到位传感器用于检测并确保四向穿梭车精确的停止于货位的正到位位置,每台四向穿梭车均预先配置一特定编码,每一四向穿梭车的编码不同,以便互相识别。
以四向穿梭车A为例,基于上述***执行防撞避障的流程如下:
S100将四向穿梭车沿主通道行驶时定义为沿X轴行驶,在货道中行驶时定义为沿Y轴行驶,四向穿梭车A上的UWB模块持续发射含有其四向穿梭车编码及行驶轴信息的UWB信号,并将接收到的信号(来自其他四向穿梭车发射的UWB信号)发送至控制器;
同时激光避障传感器在行驶方向常开,将障碍物情况发送至控制器;
控制器根据行驶轴信息判断四向穿梭车A是否与接收信号所属的四向穿梭车同轴,如果同轴,则采用激光避障传感器避障,重复S100;否则进入S200;
S200控制器中预设RSSI阈值;
阈值可以根据具体的仓库情况(如货物类型、仓库大小、货架材质等)进行确定。如将距离定为四个货位,则预先计算直线距离为四个货位的两辆四向穿梭车接收到的信号的RSSI值,作为阈值。
控制器计算接收到信号的RSSI值,根据预设的阈值筛选出RSSI值≥阈值的信号;
S300控制器预设安全距离W1、W2。W1作为正常减速停止距离,W2作为紧急制动距离,一般建议对W1设置为3个货位距离,W2设置为1个货位距离。
采用如下方式计算得出两台四向穿梭车之间的距离D:
每个UWB模块从启动开始即会生成一条独立的时间戳。UWB模块A的发射机在其时间戳上的Ta1发射请求性质的脉冲信号,UWB模块B接收机在其时间戳上的Tb1接收到该信号。
对UWB信号加以一定的处理手段后,UWB模块B在Tb2时刻发射一个响应性质的信号,被UWB模块A在自己的时间戳Ta时刻接收。由此可以计算出脉冲信号在两个UWB模块之间的飞行时间,从而确定飞行距离。距离D=光速C×[(Ta2-Ta1) -(Tb2-Tb1)]
多台四向穿梭车同时在库中运行时,将D记为Dij,表示i车辆检测到的距离j车辆的距离,i和j为预设的车辆编码。
对RSSI范围内的车辆,四向穿梭车持续接收UWB信号并计算Dij,当Dij小于等于W1时,四向穿梭车本体的控制器控制车辆减速并停止到下一个正到位的货位位置(正常情况),并将停止位置、车辆编码反馈给上游四向穿梭车调度控制***;当Dij小于等于W2时,四向穿梭车本体的控制器控制车辆紧急制动(异常情况)并将情况反馈给上游四向穿梭车调度控制***。
两车触发避障动作停止后,需等待上位控制***(可以是电脑、手持遥控设备或车辆本体上的控制按钮)的操作指令,按指令由其中一辆车为另一辆车让行。
Claims (5)
1.一种基于UWB技术的四向穿梭车防撞避障方法,其特征在于,包括:
S100四向穿梭车UWB模块持续发射信号,并接收来自其他四向穿梭车UWB模块的发射信号,将四向穿梭车沿主通道行驶时定义为沿X轴行驶,在货道中行驶时定义为沿Y轴行驶,所述发射信号中包含车辆编码信息和该四向穿梭车自身当前行驶轴信息;
从接收到的信号中获取四向穿梭车行驶轴信息,并与自身行驶轴信息进行对比判断,
当两台四向穿梭车同轴行驶时,则采用开关型激光传感器完成同轴方向的避障传感,重复S100,否则进入S200;
S200获取接收到的信号后,计算其RSSI值,筛选出RSSI值超出阈值的信号,对筛选出的信号对应的四向穿梭车进行跟踪,持续接收其UWB信号,根据接收到的信号,基于双向飞行时间法计算车辆间距;
S300设置安全距离W1和W2,其中W1为减速停止距离,长度为n个货位,W2为紧急制动距离,长度为m个货位,n>m;当车辆间距小于等于W1时,四向穿梭车的控制器控制车辆减速并停在下一个货位的正到位,并将停止位置、车辆编码、减速事件触发信息反馈给上游四向穿梭车调度控制***;当车辆间距小于等于W2时,四向穿梭车本体的控制器控制车辆紧急制动并将停止位置、车辆编码、急停事件触发信息反馈给上游四向穿梭车调度控制***。
2.根据权利要求1所述的方法,其特征在于,所述阈值基于仓库大小、货物类型和/或货架材质确定。
3.根据权利要求1所述的方法,其特征在于,采用到位传感器进行正到位判断,使四向穿梭车停在货位的正到位。
4.根据权利要求1所述的方法,其特征在于,所述W1设置为3个货位距离,W2设置为1个货位距离。
5.一种基于UWB技术的四向穿梭车防撞避障***,其特征在于,包括:
UWB模块,设置于四向穿梭车上,用于收发UWB信号,并将接收的UWB信号发送至控制器;
到位传感器,用于检测四向穿梭车是否停止于货位的正到位位置,并将检测信号发送至控制器;
激光避障传感器,设置于四向穿梭车四周,用于收发激光信号,并将接收到的激光信号发送至控制器;
控制器,接收UWB模块、到位传感器发送的信号,执行权利要求1~4任一项所述方法;
上位调度***通讯模块,根据控制器发送的指令与上位调度***通信。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110721367.2A CN113415561B (zh) | 2021-06-28 | 2021-06-28 | 一种基于uwb技术的四向穿梭车防撞避障方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110721367.2A CN113415561B (zh) | 2021-06-28 | 2021-06-28 | 一种基于uwb技术的四向穿梭车防撞避障方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113415561A CN113415561A (zh) | 2021-09-21 |
CN113415561B true CN113415561B (zh) | 2023-03-03 |
Family
ID=77717802
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110721367.2A Active CN113415561B (zh) | 2021-06-28 | 2021-06-28 | 一种基于uwb技术的四向穿梭车防撞避障方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113415561B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114634133B (zh) * | 2022-05-17 | 2022-09-09 | 江苏智库智能科技有限公司 | 一种窄巷道全向agv叉车及其控制方法 |
CN115179978B (zh) * | 2022-07-18 | 2023-05-16 | 内蒙古工业大学 | 一种基于立体声耳机的梭车避障预警*** |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN207468161U (zh) * | 2017-11-16 | 2018-06-08 | 国网江苏省电力公司泰州供电公司 | 一种基于UWB技术和LoRa技术的叉车防撞智能报警*** |
CN109814548A (zh) * | 2018-12-29 | 2019-05-28 | 广州蓝海机器人***有限公司 | 一种基于室内微波基站的导航方法和agv |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
BR112020012279A2 (pt) * | 2017-12-21 | 2020-11-24 | Ocado Innovation Limited | dispositivo de posicionamento, sistema de comunicações e método |
-
2021
- 2021-06-28 CN CN202110721367.2A patent/CN113415561B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN207468161U (zh) * | 2017-11-16 | 2018-06-08 | 国网江苏省电力公司泰州供电公司 | 一种基于UWB技术和LoRa技术的叉车防撞智能报警*** |
CN109814548A (zh) * | 2018-12-29 | 2019-05-28 | 广州蓝海机器人***有限公司 | 一种基于室内微波基站的导航方法和agv |
Non-Patent Citations (3)
Title |
---|
单磊等.超宽带双向测距定位技术在地下集装箱运输***中的应用.《集装箱化》.2018, * |
基于UWB技术的自动跟随避障***设计研究;杜美玉等;《电子元器件与信息技术》;20200831;第62,63,77页 * |
超宽带双向测距定位技术在地下集装箱运输***中的应用;单磊等;《集装箱化》;20180331;第11-12页 * |
Also Published As
Publication number | Publication date |
---|---|
CN113415561A (zh) | 2021-09-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113415561B (zh) | 一种基于uwb技术的四向穿梭车防撞避障方法及*** | |
US8862397B2 (en) | Article transport facility | |
CN103935365B (zh) | 一种新型物料搬运自动引导车智能防撞*** | |
CN102439644B (zh) | 车辆用周边监控装置及车辆用周边监控方法 | |
CN108572645B (zh) | 无人驾驶运输*** | |
EP2620828B1 (en) | Vehicle fleet management system and inter vehicle distance control method | |
US20070233304A1 (en) | Industrial truck with a data bus and a second sending receiving unit | |
CN106297240B (zh) | 一种矿山机车运输监控***及方法 | |
CN102079320B (zh) | 轨道车防撞控制方法、***及轨道车*** | |
MX2007010497A (es) | Equipamiento de seguridad para la instalacion de ascensores, e instalacion de ascensores con un equipamiento de seguridad de este tipo. | |
US20110077814A1 (en) | Safety scanner | |
CN105894858B (zh) | 一种车辆紧急刹车预警*** | |
US20210340805A1 (en) | Gate safety system for preventing collisions between a vehicle and a gate | |
KR20200075917A (ko) | 적재물 추락 발생 감지에 따른 차량 제어 방법 및 시스템 | |
CN108291374B (zh) | 用于保障机动车在倾斜坡道上的运动的方法和设备 | |
CN113341417B (zh) | 基于探测雷达的路面障碍检测方法、车辆及存储介质 | |
US20230148011A1 (en) | Dock area control system | |
CN113795802A (zh) | 自主矿车操作 | |
CN110989618A (zh) | 一种蜂群式运载车协同运载控制***及方法 | |
CN112433199A (zh) | 一种安全传感器的故障检测方法和装置 | |
CN213423473U (zh) | 一种桥式抓斗卸船机雷达测距防撞*** | |
US20230111226A1 (en) | Method for supporting an automatically driving vehicle | |
CN212685521U (zh) | 基于车路协同的自动紧急制动*** | |
CN106114681B (zh) | 车辆泊车预警***和载车 | |
KR102027456B1 (ko) | 낙하물 또는 전방추돌 방지장치를 구비한 스마트 이동랙 및 이를 이용한 제어방법 |
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 |