CN113325367A - 基于uwb技术的四向穿梭车相对位置定位方法和系统 - Google Patents

基于uwb技术的四向穿梭车相对位置定位方法和系统 Download PDF

Info

Publication number
CN113325367A
CN113325367A CN202110718762.5A CN202110718762A CN113325367A CN 113325367 A CN113325367 A CN 113325367A CN 202110718762 A CN202110718762 A CN 202110718762A CN 113325367 A CN113325367 A CN 113325367A
Authority
CN
China
Prior art keywords
way shuttle
key point
distance
base station
uwb
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.)
Granted
Application number
CN202110718762.5A
Other languages
English (en)
Other versions
CN113325367B (zh
Inventor
蔡传玉
王东玥
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Jiangsu Think Tank Intelligent Technology Co ltd
Original Assignee
Jiangsu Think Tank Intelligent Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Jiangsu Think Tank Intelligent Technology Co ltd filed Critical Jiangsu Think Tank Intelligent Technology Co ltd
Priority to CN202110718762.5A priority Critical patent/CN113325367B/zh
Publication of CN113325367A publication Critical patent/CN113325367A/zh
Application granted granted Critical
Publication of CN113325367B publication Critical patent/CN113325367B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
    • G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
    • G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
    • G01S5/10—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements, e.g. omega or decca systems
    • 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0285—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Mobile Radio Communication Systems (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及基于UWB技术的四向穿梭车相对位置定位方法和系统，手动控制四向穿梭车遍历整个仓库，在每一个仓库关键点位，通过上位机系统记录四向穿梭车到各基站的直线距离，作为该关键点位到各基站的直线距离，基于关键点位编号和前述距离建立标识库；四向穿梭车行驶时，基于车载的UWB接收器实时测量四向穿梭车到各基站的距离；基于当前距离和关键点位数据标志计算四向穿梭车与其运行路径上下一个关键点位的距离，判断四向穿梭车是否到达关键点位；重复以对四向穿梭车进行相对位置的持续跟踪定位。本发明的方法和系统实施方式简单，易于操作且成本低，对后续的运维没有特殊要求。

Description

基于UWB技术的四向穿梭车相对位置定位方法和系统
技术领域
本发明属于自动化仓储设备及其控制技术领域，具体涉及基于UWB技术的四向穿梭车相对位置定位方法和系统。
背景技术
四向穿梭车为应用于立库存储货物搬运用途，可以在货架轨道上四向换向行驶的搬运车辆，包括传感、行驶、换向、顶升、控制、通讯5大功能模块，四向穿梭车和四向穿梭车提升机、穿梭车货架共同构成四向穿梭车立库的硬件设施；
四向穿梭车的运行由部署在局域网内服务器上的调度控制系统进行车辆运行调度和控制，为了执行准确的调度和控制判断，需要四向穿梭车实时向调度控制系统反馈自身的绝对位置信息。
现有的四向穿梭车绝对位置确定有两大类方式：
1.根据相对运行距离推算绝对位置
通过电机上的编码器计算四向穿梭车的相对运行距离，通过根据起点位置叠加相对运行距离确定目前四向穿梭车的绝对位置。
这种方式的根本问题是其并非是真正的绝对位置反馈，容错率较低，编码器的误差、轨道的形变、四向穿梭车换向行驶导致的误差等持续积累均后可能导致计算的绝对位置不准确。所以这种方式虽成本较低，但一般只能用于库内同层只有一台四向穿梭车工作的场景下，否则容易因绝对位置偏差较大导致调度系统在控制时依据错误信息进行判断导致的车辆碰撞等风险，或因车辆路径交叉虽未碰撞但触发避障传感器导致车辆急停。
而即使在一台四向穿梭车工作的情况下，如果编码器发生异常也可能导致车辆在库中“迷失”，需要人工协助其重新初始化，在穿梭车位于高层且搬运较重货物时极为困难。
2.在各个货位和通道处均部署RFID标签、贴二维码或条形码(可选的)，同时在车体上部署对应的传感器，通过车辆行驶到对应位置后传感器的读数来进行绝对定位。这种方式虽可以在功能上满足绝对定位的需求，但实际操作上还是会有诸多困难。
采用RFID的方式：每个货位均需要额外设置专用的位置部署RFID标签，增加实施的复杂度和成本，同时工业RFID读码器本身成本也较高；相邻位置的RFID标签容易误读。
贴二维码或条码方式：每个货位均需要额外设置专用的位置贴条码，且对贴码的位置精度要求较高，增加实施的复杂度和成本；随仓库长时间运行，贴码易产生积灰或污损影响相机识读，导致错误或失效，而立库高层清理或换码困难。
发明内容
本发明的目的在于克服现有技术存在的问题，提供基于UWB技术的四向穿梭车相对位置定位方法和系统。
为实现上述技术目的，本发明采用如下技术方案：
一种基于UWB技术的四向穿梭车相对位置定位方法，包括：
S1手动控制四向穿梭车遍历整个仓库，在每一个仓库关键点位，通过上位机系统记录四向穿梭车到各基站的直线距离，作为该关键点位到各基站的直线距离；
S2以每个关键点位的编号及该关键点位到各基站的直线距离为该关键点位的数据标识，建立整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
S3四向穿梭车行驶时，基于车载的UWB接收器实时测量四向穿梭车到各基站的距离；
S4基于当前距离和关键点位数据标志计算四向穿梭车与其运行路径上下一个关键点位的距离ε，如果距离ε小于预设的标准允许差距值，则认为四向穿梭车到达下一个关键点位；
S5基于该关键点位的编号更新当前位置，并从标识库中获取下一个关键点位的数据标识，重复S4～S5以对四向穿梭车进行相对位置的持续跟踪定位。
作为一种优选的实施方式，所述仓库中布置至少3台UWB基站。
作为一种优选的实施方式，UWB基站通过市电供电，UWB接收器通过四向穿梭车自身锂电池供电，无需考虑断电失效问题。
作为一种优选的实施方式，所述UWB接收器安装于四向穿梭车钢制外壳上，不易受信号干扰。
作为一种优选的实施方式，将四向穿梭车立体库的货位图划分为方格图，其中一个货位/通道位为一个方格，以方格作为关键点位，对方格编号。
作为一种优选的实施方式，所述S3中，四向穿梭车到基站的实时距离基于TOA法或TDOA法计算。
作为一种优选的实施方式，所述S4中，基于下式计算四向穿梭车到下一个点位的距离ε：
Figure BDA0003136115360000021
式中，RiM为下一个关键点位的数据标识，M为关键点位的编号；ri为四向穿梭车到各基站的实时距离；n为基站数目。
作为一种优选的实施方式，所述S4中，通过四向穿梭车的控制器或上位机系统的调度控制模块进行定位计算。
作为一种优选的实施方式，将四向穿梭车到各基站的实时距离通过通讯模块上报至调度控制模块，由调度控制模块进行定位计算。
本发明的另一目的在于提供基于UWB技术的四向穿梭车相对位置定位系统，包括：
UWB基站，布设于仓库内；
UWB发射器，搭载于四向穿梭车上；
上位机系统，包括：
标识库创建模块，基于关键点位的编号及关键点位到各基站的直线距离组成的关键点位数据标识，创建由整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
调度控制模块，用于四向穿梭车调度控制；
四向穿梭车控制器，包括：
数据存储模块，存储整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
数据采集模块，获取UWB发射器实时发送的信号，并发送至测距模块；
测距模块，基于UWB发射器的信号计算四向穿梭车与各基站的当前距离；
和/或定位模块，基于当前距离和关键点位数据标志计算四向穿梭车与其运行路径上下一个关键点位的距离ε，预设标准允许差距值，如果距离ε小于标准允许差距值，则认为四向穿梭车到达下一个关键点位；
基于该关键点位的编号更新当前位置，并从标识库中获取下一个关键点位的数据标识，重复前述步骤，以对四向穿梭车进行相对位置的持续跟踪定位；
所述定位模块设置于上位机系统的调度控制模块中，或四向穿梭车控制器中。
本发明考虑到四向穿梭车在仓库内行驶时路径相对受约束(只能在轨道上行走而不能脱离轨道)，将其绝对位置(X，Y，Z)由三维进行降维，对四向穿梭车的定位方式进行简化，以降低运算处理难度，该方法和系统实施方式简单，易于操作且成本低，对后续的运维没有特殊要求。
附图说明
图1是本发明方法流程图。
具体实施方式
下面结合附图说明和具体实施方式对本发明的技术方案进行进一步阐述。
实施例中基于UWB信号的距离采用现有的TOA(time of arrival)到达时间法或TDOA(Time Difference 0fArrival)到达时间差法计算。
在四向穿梭车的钢制外壳外部搭载UWB接收器。其与四向穿梭车的控制器相连，控制器通过通讯模块将UWB接收器接收到的强度信号发送给部署在服务器上的上位机系统。
在仓库内初步部署n个UWB基站(n≥3)，UWB基站初步部署后，控制四向穿梭车行走经过每一个仓库的每一个库位(货位/通道)，将其接收器读取到的UWB强度信号通过控制模块和通讯模块反馈到上位机系统，上位机系统自动记录并判断信号强度是否满足预设的最小值要求，无法满足的应通过增设基站或调整基站位置的方式进行优化，避免局部库位信号不能可靠的覆盖。完成UWB基站部署后基站位置固定。
UWB基站通过市电供电，UWB接收器通过四向穿梭车自身锂电池供电。
将四向穿梭车立体库的货位图划分为方格图，其中一个货位/通道位为一个方格，以方格作为关键点位，对方格编号。
手动控制四向穿梭车遍历整个仓库，在每一个仓库关键点位(货位、通道位)，均通过上位机系统的标识库创建模块记录其对应的四向穿梭车到基站i的直线距离Ri(利用UWB信号计算)，这样遍历结束后，针对每一个位置均可形成(R1M，R2M，R3M……RnM，M)的关联信息，其中M代表该位置的编号，R1M代表编号为M的方格位置和UWB基站1的距离，将其作为该方格的数据标识，建立整个四向穿梭车立体库包含的关键点位数据标识组成的标识库。并将标识库存储于四向穿梭车控制器中的数据存储模块。
实际工作中，上位机系统的调度控制模块依据四向穿梭车的当前位置和出入库任务情况计算出需要调度哪台四向穿梭车执行任务，将任务动作及运行路径下发给四向穿梭车的控制器。
若四向穿梭车运行路径上的下一个位置m数据标识为(R1m，R2m，R3m……Rnm，m)，四向穿梭车运行时通过控制器的数据采集模块获取UWB发射器实时发送的信号，并发送至测距模块，测距模块实时测量到的距各个基站的距离为(r1，r2，r3……rn)，并发送至控制器的定位模块用于定位计算。定位模块通过以下公式计算其差距：
Figure BDA0003136115360000041
式中，RiM为下一个关键点位的数据标识，M为关键点位的编号；ri为四向穿梭车到各基站的实时距离；n为基站数目。
同时预先设定一个标准允许差距值ε0
若ε＜ε0，则认为四向穿梭车目前到位置m。将m更新为当前位置，同时从地图中查询出下一个位置j的数据标识(R1j，R2j，R3j……Rnj，j)，重复这一过程。
另一种实施方式中，考虑到四向穿梭车本体控制器一般选用计算能力较为受限的PLC，为进一步减轻四向穿梭车本地的计算负担，将四向穿梭车将运行时实时测量到的距各个基站的距离(r1，r2，r3……rn)通过通讯模块上报给上位机系统的调度控制模块，由调度控制模块进行ε的计算和到位判定。

Claims (10)

1.一种基于UWB技术的四向穿梭车相对位置定位方法，其特征在于，包括：
S1手动控制四向穿梭车遍历整个仓库，在每一个仓库关键点位，通过上位机系统记录四向穿梭车到各基站的直线距离，作为该关键点位到各基站的直线距离；
S2以每个关键点位的编号及该关键点位到各基站的直线距离为该关键点位的数据标识，建立整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
S3四向穿梭车行驶时，基于车载的UWB接收器实时测量四向穿梭车到各基站的距离；
S4基于当前距离和关键点位数据标志计算四向穿梭车与其运行路径上下一个关键点位的距离ε，如果距离ε小于预设的标准允许差距值，则认为四向穿梭车到达下一个关键点位；
S5基于该关键点位的编号更新当前位置，并从标识库中获取下一个关键点位的数据标识，重复S4～S5以对四向穿梭车进行相对位置的持续跟踪定位。
2.根据权利要求1所述的方法，其特征在于，所述仓库中布置至少3台UWB基站。
3.根据权利要求1或2所述的方法，其特征在于，UWB基站通过市电供电，UWB接收器通过四向穿梭车自身锂电池供电。
4.根据权利要求1所述的方法，其特征在于，所述UWB接收器安装于四向穿梭车钢制外壳上。
5.根据权利要求1所述的方法，其特征在于，将四向穿梭车立体库的货位图划分为方格图，其中一个货位/通道位为一个方格，以方格作为关键点位，对方格编号。
6.根据权利要求1所述的方法，其特征在于，所述S3中，四向穿梭车到基站的实时距离基于TOA法或TDOA法计算。
7.根据权利要求1所述的方法，其特征在于，所述S4中，基于下式计算四向穿梭车到下一个点位的距离ε：
Figure FDA0003136115350000011
式中，RiM为下一个关键点位的数据标识，M为关键点位的编号；ri为四向穿梭车到各基站的实时距离；n为基站数目。
8.根据权利要求1所述的方法，其特征在于，所述S4中，通过四向穿梭车的控制器或上位机系统的调度控制模块进行定位计算。
9.根据权利要求8所述的方法，其特征在于，将四向穿梭车到各基站的实时距离通过通讯模块上报至调度控制模块，由调度控制系统进行定位计算。
10.一种基于UWB技术的四向穿梭车相对位置定位系统，其特征在于，包括：
UWB基站，布设于仓库内；
UWB发射器，搭载于四向穿梭车上；
上位机系统，包括：
标识库创建模块，基于关键点位的编号及关键点位到各基站的直线距离组成的关键点位数据标识，创建由整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
调度控制模块，用于四向穿梭车调度控制；
四向穿梭车控制器，包括：
数据存储模块，存储整个四向穿梭车立体库包含的关键点位数据标识组成的标识库；
数据采集模块，获取UWB发射器实时发送的信号，并发送至测距模块；
测距模块，基于UWB发射器的信号计算四向穿梭车与各基站的当前距离；
和/或定位模块，基于当前距离和关键点位数据标志计算四向穿梭车与其运行路径上下一个关键点位的距离ε，预设标准允许差距值，如果距离ε小于标准允许差距值，则认为四向穿梭车到达下一个关键点位；
基于该关键点位的编号更新当前位置，并从标识库中获取下一个关键点位的数据标识，重复前述步骤，以对四向穿梭车进行相对位置的持续跟踪定位；
所述定位模块设置于上位机系统的调度控制模块中，或四向穿梭车控制器中。
CN202110718762.5A 2021-06-28 2021-06-28 基于uwb技术的四向穿梭车相对位置定位方法和系统 Active CN113325367B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110718762.5A CN113325367B (zh) 2021-06-28 2021-06-28 基于uwb技术的四向穿梭车相对位置定位方法和系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110718762.5A CN113325367B (zh) 2021-06-28 2021-06-28 基于uwb技术的四向穿梭车相对位置定位方法和系统

Publications (2)

Publication Number Publication Date
CN113325367A true CN113325367A (zh) 2021-08-31
CN113325367B CN113325367B (zh) 2024-09-13

Family

ID=77425009

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110718762.5A Active CN113325367B (zh) 2021-06-28 2021-06-28 基于uwb技术的四向穿梭车相对位置定位方法和系统

Country Status (1)

Country Link
CN (1) CN113325367B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114051206A (zh) * 2021-11-11 2022-02-15 珠海格力智能装备有限公司 一种rgv小车系统的定位控制方法、装置、存储介质和设备
CN114229302A (zh) * 2021-12-28 2022-03-25 江苏智库智能科技有限公司 四向穿梭车立体库仓库管理系统仿真模拟方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160116290A1 (en) * 2014-10-27 2016-04-28 Indooratlas Oy Simultaneous localization and mapping by using earth's magnetic fields
CN106023631A (zh) * 2016-06-20 2016-10-12 上海交通大学 基于iBeacon技术的仓储物流车辆监控系统
TW201818766A (zh) * 2016-11-03 2018-05-16 司圖科技股份有限公司 室內環境中採集位置參考資料的裝置及方法與室內定位方法
US10070270B1 (en) * 2017-11-30 2018-09-04 Mapsted Corp. Mobile device localization based on spatial derivative magnetic fingerprint
CN109809210A (zh) * 2019-02-01 2019-05-28 云南柔控科技有限公司 一种烟包全自动装车柔性机器人系统
CN110893967A (zh) * 2019-12-12 2020-03-20 普罗格智芯科技(湖北)有限公司 一种四向穿梭车全库rfid定位系统
CN112009507A (zh) * 2020-09-07 2020-12-01 合肥工大高科信息科技股份有限公司 一种矿井下机车无人驾驶系统及控制方法
CN112566027A (zh) * 2020-11-26 2021-03-26 腾讯科技（深圳）有限公司 室内定位指纹更新方法、装置、电子设备及存储介质

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160116290A1 (en) * 2014-10-27 2016-04-28 Indooratlas Oy Simultaneous localization and mapping by using earth's magnetic fields
CN106023631A (zh) * 2016-06-20 2016-10-12 上海交通大学 基于iBeacon技术的仓储物流车辆监控系统
TW201818766A (zh) * 2016-11-03 2018-05-16 司圖科技股份有限公司 室內環境中採集位置參考資料的裝置及方法與室內定位方法
US10070270B1 (en) * 2017-11-30 2018-09-04 Mapsted Corp. Mobile device localization based on spatial derivative magnetic fingerprint
CN109809210A (zh) * 2019-02-01 2019-05-28 云南柔控科技有限公司 一种烟包全自动装车柔性机器人系统
CN110893967A (zh) * 2019-12-12 2020-03-20 普罗格智芯科技(湖北)有限公司 一种四向穿梭车全库rfid定位系统
CN112009507A (zh) * 2020-09-07 2020-12-01 合肥工大高科信息科技股份有限公司 一种矿井下机车无人驾驶系统及控制方法
CN112566027A (zh) * 2020-11-26 2021-03-26 腾讯科技（深圳）有限公司 室内定位指纹更新方法、装置、电子设备及存储介质

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114051206A (zh) * 2021-11-11 2022-02-15 珠海格力智能装备有限公司 一种rgv小车系统的定位控制方法、装置、存储介质和设备
CN114051206B (zh) * 2021-11-11 2023-12-01 珠海格力智能装备有限公司 一种rgv小车系统的定位控制方法、装置、存储介质和设备
CN114229302A (zh) * 2021-12-28 2022-03-25 江苏智库智能科技有限公司 四向穿梭车立体库仓库管理系统仿真模拟方法

Also Published As

Publication number Publication date
CN113325367B (zh) 2024-09-13

Similar Documents

Publication Publication Date Title
CN109323696B (zh) 一种无人叉车室内定位导航系统及导航方法
CN113325367A (zh) 基于uwb技术的四向穿梭车相对位置定位方法和系统
CN102303588B (zh) 基于直角坐标机器人的电动乘用车底盘电池快换系统
CN103347802B (zh) 用于检测销售装置和/或储存装置的货物库存的设备和方法，以及装配有该设备的储存管理系统
US8868235B2 (en) Battery quick-change system for an electric passenger car chassis having a cartesian coordinate robot
CN108776884A (zh) 一种智能仓储作业方法
CN112009507B (zh) 一种矿井下机车无人驾驶系统及控制方法
CN103662724B (zh) 一种智能轨道车控制系统
CN108995677B (zh) 股道自动化监控管理方法
CN103523055A (zh) 一种大坡度盾构隧道内运输车防碰撞预警系统及其工作方法
CN112926712B (zh) 一种四向穿梭车连续定位系统与方法
CN104787088A (zh) 一种轨道交通车辆基地车辆身份识别及位置跟踪管理系统
CN111027912A (zh) 一种基于rfid技术的agv盘点仓库托盘的方法
CN102642776A (zh) 天车定位系统以及定位方法
CN110217264A (zh) 车辆轮对检测装置、方法及系统
CN112526995A (zh) 一种挂轨式巡检机器人系统及其检测方法
CN104950895A (zh) 仓储物流用rfid及视觉识别导航车的导航控制方法
CN115392853A (zh) 一种透明化智能工厂的运营系统
CN114735030B (zh) 高铁多车型安全门定位装置、对准方法及系统
CN115900687B (zh) 液压支架机器人轨道定位方法及装置
CN115619203B (zh) 一种汽车总装车间agv运行监管方法及系统
KR20020078442A (ko) 디지피에스 정보 및 철도 선로 정보를 이용한 철도차량위치 추적장치 및 방법
CN111308529A (zh) 一种车载检测设备的定位系统和定位方法
US20220075381A1 (en) Required transfer time prediction device and required transfer time prediction method
CN114859924A (zh) 基于视觉slam的磁导引agv的自动纠偏控制方法及存储介质

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