CN114047519A - 基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 - Google Patents
基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 Download PDFInfo
- Publication number
- CN114047519A CN114047519A CN202111126574.XA CN202111126574A CN114047519A CN 114047519 A CN114047519 A CN 114047519A CN 202111126574 A CN202111126574 A CN 202111126574A CN 114047519 A CN114047519 A CN 114047519A
- Authority
- CN
- China
- Prior art keywords
- positioning
- agv
- uwb
- module
- navigation
- 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
- 238000000034 method Methods 0.000 title claims abstract description 38
- 238000005516 engineering process Methods 0.000 title claims abstract description 36
- 230000001360 synchronised effect Effects 0.000 title claims abstract description 23
- 239000002131 composite material Substances 0.000 title claims abstract description 17
- 230000033001 locomotion Effects 0.000 claims abstract description 24
- 238000004364 calculation method Methods 0.000 claims abstract description 16
- 230000004927 fusion Effects 0.000 claims abstract description 6
- 238000001514 detection method Methods 0.000 claims abstract description 4
- 238000004891 communication Methods 0.000 claims description 27
- 230000008569 process Effects 0.000 claims description 24
- 238000012545 processing Methods 0.000 claims description 17
- 238000001914 filtration Methods 0.000 claims description 10
- 238000005259 measurement Methods 0.000 claims description 9
- 150000001875 compounds Chemical class 0.000 claims 1
- 230000007613 environmental effect Effects 0.000 abstract description 14
- 238000009825 accumulation Methods 0.000 abstract description 8
- 230000007547 defect Effects 0.000 abstract description 3
- 230000008901 benefit Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 230000008859 change Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000004807 localization Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000035515 penetration Effects 0.000 description 1
- 238000011897 real-time detection Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003595 spectral effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
-
- 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
- G01C21/206—Instruments for performing navigational calculations specially adapted for indoor navigation
-
- 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
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/88—Lidar systems specially adapted for specific applications
- G01S17/93—Lidar systems specially adapted for specific applications for anti-collision purposes
- G01S17/931—Lidar systems specially adapted for specific applications for anti-collision purposes of land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Traffic Control Systems (AREA)
Abstract
本发明提供基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位系统及方法，主控装置分别与UWB模块和激光雷达模块电连接，UWB模块将AGV运动位置信息传送给主控装置，激光雷达模块将AGV观测位置信息传送给主控装置，主控装置对AGV运动位置信息与AGV观测位置信息进行计算融合，并根据计算结果控制驱动装置动作；主控装置与上位机连接通信，将AGV运动位置信息与AGV观测位置信息计算融合的结果传送给上位机，进行数据检测；驱动装置与主控装置电连接，且驱动装置与AGV的驱动组件连接，主控装置通过驱动装置控制AGV的导航定位及调度。本发明的有益效果是改善了因遮挡等环境问题和时间积累产生的状态累积误差导致的定位精度低的缺点，避免了因环境问题产生的布线难得问题。
Description
技术领域
本发明属于AGV导航定位系统技术领域，尤其是涉及基于超宽带和激光 SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统及方法。
背景技术
随着科技的发展，作为智能移动机器人重要分支之一的AGV小车越来越多的被使用在物流搬运、智能仓库等方面，由于AGV代替人工货运，极大的提高了自动化程度，因此具有相当大的意义与研究价值。目前AGV的导航主要分为以下几种：(1)激光雷达导航：通过SLAM(Simultaneous localization and mapping)建立三维地图，并确定AGV车辆所在位置坐标。(2)UWB定位导航：在室内定位中，超宽带(Ultra wide band，UWB)技术利用功率谱密度极低、脉冲宽度极窄的脉冲信号传输数据，具有时间分辨率极高、障碍穿透能力强等特点。在视距(Line of sight，LOS)环境下能获得厘米甚至毫米级的测距和定位精度。
激光雷达定位具有自主导航、鲁棒性强的突出优点，但是由于激光雷达布置于AGV车体，若周围环境发生大幅度改变，或者雷达本身遭到一定遮挡，其定位误差显著增加甚至失去定位信息。除此之外复杂的室内环境，往往会存在遮挡使得UWB信号产生反射和折射，从而导致非视距(NLOS)误差。
发明内容
鉴于上述问题，本发明要解决的问题是提供基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统及方法，改善了AGV在运动过程中，因遮挡等环境问题以及时间积累产生的状态累积误差导致的定位精度低的缺点，避免了因环境问题产生的布线难得问题，使得AGV 系统更加灵活可靠。
为解决上述技术问题，本发明采用的技术方案是：基于超宽带和激光 SLAM(地图同步定位和导航)复合导航技术的AGV定位系统，包括主控装置、 UWB模块、驱动装置、激光雷达模块和上位机，其中，
主控装置分别与UWB模块和激光雷达模块电连接，UWB模块将AGV运动位置信息传送给主控装置，激光雷达模块将AGV观测位置信息传送给主控装置，主控装置对AGV运动位置信息与AGV观测位置信息进行计算融合，并根据计算结果控制驱动装置动作；
主控装置与上位机连接通信，将AGV运动位置信息与AGV观测位置信息计算融合的结果传送给上位机，进行数据检测；
驱动装置与主控装置电连接，且驱动装置与AGV的驱动组件连接，主控装置通过驱动装置控制AGV的导航定位及调度。
具体地，激光雷达模块包括多线激光雷达和图像处理器，多线激光雷达设于AGV上，采集三维定位信息；
图像处理器分别与图像采集装置和主控装置电连接，对图像采集装置采集到的激光雷达三维定位信息进行处理，并将该处理结果传送至主控装置。
进一步的，图像处理器为S5PV210控制器。
进一步的，图像采集装置为多线激光雷达。
进一步的，激光雷达处理器带有全局坐标系下的坐标信息。
具体地，UWB模块包括UWB定位标签、UWB定位基站和UWB处理器，UWB 定位标签设于AGV上，UWB定位标签与UWB定位基站通信连接，发送AGV位置信息给UWB定位基站；
UWB定位基站数量为多个，布设于AGV移动地图中，接收UWB定位标签发送的信息，并将该信息传送至UWB处理器，UWB处理对该信息进行处理，并将该处理结果传送给主控装置。
进一步的，UWB处理器为基于TOF测距的自解算标签模块。
具体地，主控装置包括主控模块、通信模块、存储模块和Flash模块，通信模块、存储模块与Flash模块均与主控模块电连接，通信模块与上位机连接通信，主控模块对UWB模块与激光雷达模块传送的信号进行处理，并将处理结果存储于存储模块内，并通过通信模块传送给上位机；
优选的，主控模块为STM32F407VET6；优选的，通信模块为ATK－LORA－01 无线通信模块。
进一步的，还包括电源模块和紧急功能按键，电源模块分别与主控装置、 UWB模块和激光雷达模块电连接，为主控装置、UWB模块和激光雷达模块供电；
紧急功能按键与主控装置电连接，紧急功能按键为急停按钮，用于控制 AGV动作。
基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位方法，包括以下步骤，
步骤1：在AGV移动地图中设定若干个点设置UWB定位基站，设定其中任一个UWB定位基站为原点定位标记，设定原点定位标记的坐标轴为全局坐标轴，其他的UWB定位基站标记在全局坐标轴上，且均具备相应的定位数据；
步骤2：将UWB定位标签设于AGV上，在AGV移动过程中，UWB定位标签发送信号至UWB定位基站，UWB定位基站将该信号传送至UWB处理器处， UWB对信号进行处理计算，得出UWB定位标签移动过程中的位置信息；
步骤3：采用多线激光雷达生成带有全局坐标系下的位置信息，将对应点的多线激光雷达设置在对应于所建立3维地图的坐标下；
步骤4：多线激光雷达，将所采集的激光雷达定位信息传送至图像处理器，图像处理器对激光雷达信息进行处理计算，得到AGV当前的位置信息和偏转角；
步骤5：主控模块根据UWB模块得到的位置信息和激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡曼滤波算法计算出AGV的最优位置估计；
步骤6：主控模块将融合后的位置信息发送至驱动装置，控制AGV运动，完成AGV的导航定位和调度。
由于采用上述技术方案，采用模块化的设计方式，不需要使用传统的在地面上布线来进行AGV的导航定位，使得系统运行更加稳定可靠；具有UWB 模块和激光雷达模块，主控模块根据UWB模块得到的位置信息与激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡尔曼滤波算法求出AGV的最优位置估计，融合了UWB与视觉的定位数据，与传统AGV定位系统相比，解决了因环境问题导致的布线难题，降低了UWB因环境问题导致的非视距(Non－Line－of－Sight，NLOS)定位误差，以及周围环境发生大幅度改变，或者雷达本身遭到一定遮挡，其定位误差显著增加甚至失去定位信息的问题，简化了系统复杂度，提高了AGV在室内工作的定位精度，改善了AGV在室内运动过程中，因遮挡等环境问题以及时间积累产生的状态累积误差导致的定位精度低的缺点，使得AGV系统更加灵活可靠。
附图说明
图1是本发明的一实施例的结构框图；
图2是本发明的一实施例的工作流程图；
图3是本发明的一实施例的UWB模块的结构框图；
图4是本发明的一实施例的激光雷达模块的结构框图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步的说明。
图1示出了本发明一实施例的结构框图，本实施例涉及基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位系统及方法，具有 UWB模块和激光雷达模块，主控装置根据UWB自解算标签得到的位置信息，与视觉激光雷达处理器得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡尔曼滤波算法求出AGV的最优位置估计，融合了UWB与激光雷达的定位数据，解决了因环境问题导致的布线难题，同时，降低了UWB因环境问题导致的非视距定位误差，或周围环境发生大幅度改变，或者雷达本身遭到一定遮挡，其定位误差显著增加甚至失去定位信息的问题你，简化了系统复杂度，提高了AGV在室内工作的定位精度。
基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，如图1和2所示，包括主控装置、UWB模块、驱动装置、激光雷达模块和上位机，其中，主控装置用于控制该AGV定位系统动作，主控装置分别与UWB模块和激光雷达模块电连接，UWB模块用于获取AGV运动位置信息，UWB模块将AGV运动位置信息传送给主控装置，激光雷达模块用于获取AGV观测位置信息，激光雷达模块将AGV观测位置信息传送给主控装置，主控装置对AGV运动位置信息与AGV观测位置信息进行计算融合，并根据计算结果控制驱动装置动作；主控装置与上位机连接通信，将AGV运动位置信息与AGV观测位置信息计算融合的结果传送给上位机，进行数据检测；驱动装置与主控装置电连接，且驱动装置与AGV的驱动组件连接，主控装置通过驱动装置控制AGV的导航定位及调度。驱动装置为伺服驱动器，AGV的驱动组件为电机。
该基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV 定位系统还包括电源模块和紧急功能按键，电源模块分别与主控装置、UWB 模块和激光雷达模块电连接，为主控装置、UWB模块和激光雷达模块供电，保证主控装置、UWB模块和激光雷达模块正常工作；紧急功能按键与主控装置电连接，紧急功能按键为急停按钮，用于控制AGV动作，是为了当AGV在定位导航过程中所采取的安全措施，保证AGV定位导航过程中的运行的安全。
如图4所示，上述的激光雷达模块包括图像采集装置、激光雷达贴片和图像处理器，图像采集装置设于AGV上，采集激光雷达三维地图和定位信息。多线激光雷达设于全局坐标系下的激光雷达信息坐标下，激光雷达带有全局坐标系下的坐标信息，是由多线激光雷达生成器生成的。图像处理器分别与图像采集装置和主控装置电连接，对图像采集装置采集到的激光雷达信息进行处理，并将该处理结果传送至主控装置，该图像处理器为S5PV210控制器，该控制器是基于CortexA8架构的ARM处理器，带有SPI通信接口，可以处理图像信息并直接输出数据，将该输出数据传送给主控装置。多线激光雷达将获得的激光雷达图像信息传输到图像处理器，由图像处理器对激光雷达信息进行处理，由激光雷达信息包含的位置信息以及计算相机图像帧中心和激光雷达中心的偏心距和激光雷达的旋转角度，计算得到AGV车辆当前的位置信息和偏转角。
如图3所示，上述的UWB模块包括UWB定位标签、UWB定位基站和UWB 处理器，UWB定位标签设于AGV上，UWB定位标签与UWB定位基站通信连接， UWB定位标签发送AGV位置信息给UWB定位基站，该UWB定位标签被设置为移动标签；UWB定位基站数量为多个，布设于AGV移动地图中，该UWB定位基站作为参考的固定基站，被设置为锚点，接收UWB定位标签发送的信息，并将该信息传送至UWB处理器，UWB处理对该信息进行处理，并将该处理结果传送给主控装置。该UWB处理器为基于TOF测距的自解算标签模块，优选为清讯科技提供的基于TOF测距的自解算标签模块，且自解算标签模块在使用时直接插接在主控装置上即可，进行数据的传输。上述的UWB定位标签采用的发送芯片与UWB定位基站采用的接收芯片均为DWM1000芯片，且超宽带节点在使用时直接插接在主控装置上。由UWB定位标签将脉冲电波发送给UWB定位基站，由UWB定位基站发送回计算得到的UWB定位基站与UWB定位标签之间的距离，由多个UWB定位标签到不同的UWB定位基站的距离计算出 UWB定位标签的位置信息，并将该位置信息发送给UWB处理器，对位置信息进行处理计算，将计算结果发送至主控装置。
主控装置包括主控模块、通信模块、存储模块和Flash模块，通信模块、存储模块与Flash模块均与主控模块电连接，与主控模块进行通信，通信模块与上位机连接通信，主控模块对UWB模块与激光雷达模块传送的信号进行处理，将处理结果存储于存储模块内，并通过通信模块传送给上位机。
该主控模块为STM32F407VET6，能够在电压允许的范围内稳定工作。
该通信模块为ATK－LORA－01无线通信模块，能够与主控模块通过串口进行通信，使得主控模块更方便的对通信模块进行操作。
该存储模块为DDR内存模块。
该基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统在室内工作时，主控模块发送位置请求信号给UWB模块和激光雷达模块。其中，UWB模块的UWB定位标签将脉冲电波发送给室内地图内的UWB定位基站，由UWB定位基站发送回计算得到的UWB定位基站与UWB 定位标签间的距离，由三个标签到不同基站的距离计算出UWB定位标签的位置信息；而激光雷达模块由车载激光雷达采集和定位AGV所在区域的地图和位置，通过S5PV210控制器对图像信息进行处理，将处理计算后的数据发送到主控模块；为了能快速地反馈给上位机，两者的位置信息保存到DDR内存模块中；当上位机询问AGV的位置信息时，主控模块通过USB总线将简单处理之后储存起来得位置信息通过ATK－LORA－01无线通信模块发送至上位机；主控模块对于接收到的由UWB模块和激光雷达模块采集的数据通过KF/EKF 进行滤波计算融合，将融合后的定位数据通过ATK－LORA－01无线通信模块发送给PC端上位机实时检测数据，并由主控模块通过CAN总线将融合后的定位数据发送给伺服驱动器来控制AGV电机的转速，完成AGV车辆的导航定位和调度。
该基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV 定位系统主要包括在移动地图中选择若干个点布置UWB定位基站，车载多线激光雷达。主控模块根据UWB模块得到的位置信息与激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡尔曼滤波算法求出AGV的最优位置估计。此AGV的导航定位系统由于融合了UWB与视觉的定位数据，与传统AGV定位系统相比，解决了因环境问题导致的布线难题，同时，该定位系统更大程度上降低了UWB因环境问题导致的非视距 (Non－Line－of－Sight，NLOS)定位误差，以及周围环境发生大幅度改变，或者雷达本身遭到一定遮挡，其定位误差显著增加甚至失去定位信息的问题，简化了系统复杂度，提高了AGV在室内工作的定位精度。
基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位方法，以在室内移动为例进行说明，包括以下步骤：
步骤1：在AGV移动地图中设定若干个点设置UWB定位基站，设定其中任一个UWB定位基站为原点定位标记，设定原点定位标记的坐标轴为全局坐标轴，其他的UWB定位基站标记在全局坐标轴上，且均具备相应的定位数据：具体地，在室内地图中选择若干个点布置UWB定位基站；设定其中一个UWB 定位基站为原点定位标记，定义原点定位标记的坐标轴为全局坐标轴，其余 UWB定位基站标记在全局坐标轴上，均具备相应的定位数据。
步骤2：将UWB定位标签设于AGV上，在AGV移动过程中，UWB定位标签发送信号至UWB定位基站，UWB定位基站将该信号传送至UWB处理器处， UWB对信号进行处理计算出UWB定位标签移动过程中的位置信息，该UWB定位标签发送的信号为由超宽频脉冲组成的脉冲数据包，该UWB处理器对该信号的处理方式为：按照TDOA方式进行解算处理。具体地，将一个UWB定位标签设置在AGV上；在AGV移动过程中，UWB定位标签发送由超宽频脉冲组成的脉冲数据包信号给UWB定位基站，UWB定位基站通过交换机并将该信号传给UWB处理器，UWB处理器按照TDOA方式对该信号进行解算处理，在通过滤波处理计算出移动UWB定位标签的位置信息。
步骤3：预先采用车载多线激光雷达对所行驶的空间进行三维地图编制，并存储与激光雷达图像处理器之中；
步骤4：由车载多线激光雷达信息包含的当前位置信息以及存储于激光雷达图像处理器的三维地图坐标做匹配，计算得到车辆当前的位置信息和偏转角。
步骤5：主控模块根据UWB模块得到的位置信息和激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡曼滤波算法计算出AGV的最优位置估计；具体地，主控模块根据UWB处理器得到的位置信息，与激光雷达模块的图像处理器得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡尔曼滤波算法求出AGV的最优位置估计。
步骤6：主控模块将融合后的位置信息发送至驱动装置，控制AGV运动，完成AGV的导航定位和调度；具体地，由主控模块通过CAN总线将融合后的定位数据发送给伺服驱动器来控制AGV电机的转速，完成AGV车辆的导航定位和调度。
由于采用上述技术方案，采用模块化的设计方式，不需要使用传统的在地面上布线来进行AGV的导航定位，使得系统运行更加稳定可靠；具有UWB 模块和激光雷达模块，主控模块根据UWB模块得到的位置信息与激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡尔曼滤波算法求出AGV的最优位置估计，融合了UWB与视觉的定位数据，与传统AGV定位系统相比，解决了因环境问题导致的布线难题，降低了UWB因环境问题导致的非视距(Non－Line－of－Sight，NLOS)定位误差，以及周围环境发生大幅度改变，或者雷达本身遭到一定遮挡，其定位误差显著增加甚至失去定位信息的问题，简化了系统复杂度，提高了AGV在室内工作的定位精度，改善了AGV在室内运动过程中，因遮挡等环境问题以及时间积累产生的状态累积误差导致的定位精度低的缺点，使得AGV系统更加灵活可靠。
以上对本发明的实施例进行了详细说明，但所述内容仅为本发明的较佳实施例，不能被认为用于限定本发明的实施范围。凡依本发明申请范围所作的均等变化与改进等，均应仍归属于本发明的专利涵盖范围之内。
Claims (10)
1.基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术，其特征在于：包括主控装置、UWB模块、驱动装置、和上位机，其中，
所述主控装置分别与所述UWB模块和所述激光雷达模块电连接，所述UWB模块将AGV运动位置信息传送给所述主控装置，所述激光雷达模块将AGV观测位置信息传送给所述主控装置，所述主控装置对所述AGV运动位置信息与所述AGV观测位置信息进行计算融合，并根据计算结果控制所述驱动装置动作；
所述主控装置与所述上位机连接通信，将所述AGV运动位置信息与所述AGV观测位置信息计算融合的结果传送给所述上位机，进行数据检测；
所述驱动装置与所述主控装置电连接，且所述驱动装置与所述AGV的驱动组件连接，所述主控装置通过所述驱动装置控制所述AGV的导航定位及调度。
2.根据权利要求1所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，其特征在于：所述激光雷达模块包括多线激光雷达和图像处理器，所述多线激光雷达设于所述AGV车辆上，采集所述激光雷达定位信息；
所述多线激光雷达设于全局坐标系下对应的激光雷达信息坐标下；
所述图像处理器分别与所述图像采集装置和所述主控装置电连接，对所述图像采集装置采集到的激光雷达信息进行处理，并将该处理结果传送至所述主控装置。
3.根据权利要求2所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位系统，其特征在于：所述图像处理器为S5PV210控制器。
4.根据权利要求3所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，其特征在于：所述三维地图建立和定位装置为多线激光雷达。
5.根据权利要求4所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位系统，其特征在于：所述激光雷达带有所述全局坐标系下的坐标信息。
6.根据权利要求1－5任一项所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术的AGV定位系统，其特征在于：所述UWB模块包括UWB定位标签、UWB定位基站和UWB处理器，所述UWB定位标签设于所述AGV上，所述UWB定位标签与所述UWB定位基站通信连接，发送AGV位置信息给所述UWB定位基站；
所述UWB定位基站数量为多个，布设于所述AGV移动地图中，接收所述UWB定位标签发送的信息，并将该信息传送至所述UWB处理器，所述UWB处理对该信息进行处理，并将该处理结果传送给所述主控装置。
7.根据权利要求6所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，其特征在于：所述UWB处理器为基于TOF测距的自解算标签模块。
8.根据权利要求1－5、7任一项所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，其特征在于：所述主控装置包括主控模块、通信模块、存储模块和Flash模块，所述通信模块、所述存储模块与所述Flash模块均与所述主控模块电连接，所述通信模块与所述上位机连接通信，所述主控模块对所述UWB模块与所述激光雷达模块传送的信号进行处理，并将处理结果存储于所述存储模块内，并通过所述通信模块传送给所述上位机；
优选的，所述主控模块为STM32F407VET6；优选的，所述通信模块为ATK－LORA－01无线通信模块。
9.根据权利要求1所述的基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位系统，其特征在于：还包括电源模块和紧急功能按键，所述电源模块分别与所述主控装置、所述UWB模块和所述激光雷达模块电连接，为所述主控装置、所述UWB模块和所述激光雷达模块供电；
所述紧急功能按键与所述主控装置电连接，所述紧急功能按键为急停按钮，用于控制所述AGV动作。
10.基于超宽带和激光SLAM(地图同步定位和导航)复合导航技术系统技术的AGV定位方法，其特征在于：包括以下步骤，
步骤1：在AGV移动地图中设定若干个点设置UWB定位基站，设定其中任一个所述UWB定位基站为原点定位标记，设定所述原点定位标记的坐标轴为全局坐标轴，其他的所述UWB定位基站标记在所述全局坐标轴上，且均具备相应的定位数据；
步骤2：将UWB定位标签设于所述AGV上，在AGV移动过程中，所述UWB定位标签发送信号至所述UWB定位基站，所述UWB定位基站将该信号传送至所述UWB处理器处，所述UWB对所述信号进行处理计算，得出所述UWB定位标签移动过程中的位置信息；
步骤3：采用多线激光雷达建立行驶区域的三维坐标，将对应点的所述车载多线激光雷达模块设置在对应于激光雷达建立的三维坐标下；
步骤4：将多线激光雷达采集的三维定位坐标传送至图像处理器，所述图像处理器对所述激光雷达信息进行处理计算，得到所述AGV当前的位置信息和偏转角；
步骤5：主控模块根据所述UWB模块得到的位置信息和所述激光雷达模块得到的位置信息，建立位置测量系统运动方程与观测方程，并通过扩展卡曼滤波算法计算出所述AGV的最优位置估计；
步骤6：所述主控模块将融合后的位置信息发送至驱动装置，控制所述AGV运动，完成所述AGV的导航定位和调度。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111126574.XA CN114047519A (zh) | 2021-09-26 | 2021-09-26 | 基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111126574.XA CN114047519A (zh) | 2021-09-26 | 2021-09-26 | 基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN114047519A true CN114047519A (zh) | 2022-02-15 |
Family
ID=80204786
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111126574.XA Pending CN114047519A (zh) | 2021-09-26 | 2021-09-26 | 基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114047519A (zh) |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114739388A (zh) * | 2022-04-20 | 2022-07-12 | 中国移动通信集团广东有限公司 | 基于uwb和激光雷达的室内定位导航方法及系统 |
| CN115421153A (zh) * | 2022-08-04 | 2022-12-02 | 南京航空航天大学 | 一种基于扩展卡尔曼滤波的激光雷达和uwb组合定位方法及系统 |
| CN117459898A (zh) * | 2023-12-22 | 2024-01-26 | 浙江深寻科技有限公司 | 一种应急定位通信方法及系统 |
-
2021
- 2021-09-26 CN CN202111126574.XA patent/CN114047519A/zh active Pending
Cited By (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN114739388A (zh) * | 2022-04-20 | 2022-07-12 | 中国移动通信集团广东有限公司 | 基于uwb和激光雷达的室内定位导航方法及系统 |
| CN115421153A (zh) * | 2022-08-04 | 2022-12-02 | 南京航空航天大学 | 一种基于扩展卡尔曼滤波的激光雷达和uwb组合定位方法及系统 |
| CN115421153B (zh) * | 2022-08-04 | 2024-02-13 | 南京航空航天大学 | 一种基于扩展卡尔曼滤波的激光雷达和uwb组合定位方法及系统 |
| CN117459898A (zh) * | 2023-12-22 | 2024-01-26 | 浙江深寻科技有限公司 | 一种应急定位通信方法及系统 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN114047519A (zh) | 基于超宽带和激光slam(地图同步定位和导航)复合导航技术的agv定位系统及方法 | |
| CN108898880B (zh) | 车辆控制方法及系统 | |
| CN101661098B (zh) | 机器人餐厅多机器人自动定位系统 | |
| EP3913328B1 (en) | Vehicle positioning system and method, and vehicle | |
| WO2019182830A1 (en) | Localization by vision | |
| CN109425346B (zh) | 用于自动化车辆的导航系统 | |
| CN108616810A (zh) | 一种车队自主跟车系统、便携式装置及方法 | |
| CN112513576B (zh) | 定位方法及装置 | |
| CN110716549A (zh) | 用于无地图区域巡逻的自主导航机器人系统及其导航方法 | |
| CN109781120B (zh) | 一种基于同步定位构图的车辆组合定位方法 | |
| US20230213946A1 (en) | Vehicle Navigation Positioning Method and Apparatus, and Base Station, System and Readable Storage Medium | |
| CN211317332U (zh) | 基于超宽带和视觉二维码导航技术的agv定位系统 | |
| US20190001831A1 (en) | Method for implementing power supply procedures from at least one power supply unit to a plurality of transportation vehicles to be supplied with power | |
| CN109828510A (zh) | 一种基于超宽带和惯性导航技术的agv定位系统及定位方法 | |
| KR20160133806A (ko) | 무인 비행체 유도 방법 및 장치 | |
| CN107830832A (zh) | 工件轮廓扫描系统及方法 | |
| CN113758482B (zh) | 车辆导航定位方法、装置、基站、系统及可读存储介质 | |
| CN104089616A (zh) | 移动机器人定位系统 | |
| CN110988949A (zh) | 定位方法、定位装置、计算机可读存储介质与可移动设备 | |
| CN112622928A (zh) | 自动驾驶系统及车辆 | |
| CN112415540A (zh) | 多源定位数据的无人机自主飞行系统 | |
| CN212721458U (zh) | 定位设备及包括定位设备的车辆 | |
| CN106382916B (zh) | 自建参考系的双六足机器人复杂地形三维立体测绘系统与方法 | |
| KR102446517B1 (ko) | 실내환경 및 실외환경에서 경로주행이 가능한 무인 운반차 | |
| CN114281109A (zh) | 一种无人机引导的多机协作控制系统 |
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 | ||
| WD01 | Invention patent application deemed withdrawn after publication | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20220215 |