CN115437299A - 一种伴随运输机器人行进控制方法及系统 - Google Patents
一种伴随运输机器人行进控制方法及系统 Download PDFInfo
- Publication number
- CN115437299A CN115437299A CN202211234378.9A CN202211234378A CN115437299A CN 115437299 A CN115437299 A CN 115437299A CN 202211234378 A CN202211234378 A CN 202211234378A CN 115437299 A CN115437299 A CN 115437299A
- Authority
- CN
- China
- Prior art keywords
- data
- vehicle
- robot
- uwb
- position information
- 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 39
- 230000033001 locomotion Effects 0.000 claims abstract description 62
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 20
- 238000004364 calculation method Methods 0.000 claims description 13
- 238000004590 computer program Methods 0.000 claims description 12
- 238000012545 processing Methods 0.000 claims description 8
- 238000001914 filtration Methods 0.000 claims description 4
- 230000006870 function Effects 0.000 claims description 3
- 230000007812 deficiency Effects 0.000 abstract description 3
- 238000004891 communication Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000004927 fusion Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000003702 image correction Methods 0.000 description 2
- 238000010801 machine learning Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000196324 Embryophyta Species 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000004888 barrier function Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 238000012216 screening Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
- G05B19/0423—Input/output
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/20—Pc systems
- G05B2219/25—Pc structure of the system
- G05B2219/25257—Microcontroller
Landscapes
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种伴随运输机器人行进控制方法，通过获取UWB信标与车载UWB基站的位置信息以及多个车载采集装置相应采集到的多组数据。在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动，在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。从而有效避免UWB跟随方式的不足。强大的冗余控制算法，保证系统长时间稳定运行，代价便宜且适合长时间使用。
Description
技术领域
本申请涉及机器人技术领域，特别是涉及一种伴随运输机器人行进控制方法及系统。
背景技术
随着科技的发展，人工智能机器人被越来越多的应用于各行各业当中，以替代传统的劳动力。
伴随机器人顾名思义是一种可陪伴在人的一侧，并随着人的运动而运动的机器人。而现在应用更多的是跟随机器人，即机器人以一定的距离跟随在人的身后，一般跟随机器人多处于人的视野之后。
尤其是，在山地跟随场景下，现有伴随运输机器人行进控制方案主要为：拉线控制、UWB控制和激光控制，其中，拉线控制是通过拉线的方式来实现跟随控制；UWB控制是通过非正弦波窄脉冲传输数据控制；激光控制是通过激光扫描方式确定目标点进行跟踪控制。然而，现有的机器人伴随方案，存在以下问题：单纯UWB控制方法不稳定容易跟丢；拉线控制方法在密集障碍区难以实现；激光控制方法代价高，且算法复杂。
发明内容
基于此，针对上述技术问题，提供一种伴随运输机器人行进控制方法、系统、计算机设备和存储介质，能够解决现有机器人不稳定容易跟丢且代价高的问题。
第一方面，一种伴随运输机器人行进控制方法，所述方法包括：
实时获取UWB信标与车载UWB基站的位置信息；
实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
上述方案中，可选的，所述车载UWB基站包括第一车载UWB基站和第二车载UWB基站；
所述获取UWB信标与车载UWB基站之间的位置信息，包括：
获取所述UWB信标与所述第一车载UWB基站之间的第一距离数据；
获取所述UWB信标与所述第二车载UWB基站之间的第二距离数据；
根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息；
其中，所述第三距离数据为所述第一车载UWB基站和所述第二车载UWB基站之间的距离数据。
上述方案中，进一步可选的，根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息，包括：
根据卡尔曼滤波算法和三角函数计算方法，对所述第一距离数据、所述第二距离数据和所述第三距离数据进行计算，得到所述获取UWB信标与车载UWB基站之间的位置信息。
上述方案中，进一步可选的，所述位置信息包括第四距离数据和偏转角度数据；
所述第四距离数据为所述UWB信标与目标点之间的距离数据；
所述偏转角度数据为第一方向与第二方向之间的夹角数据；
其中，所述目标点为所述第一车载UWB基站与所述第二车载UWB的连线的中点；
所述第一方向为所述UWB信标与目标点的连线所在的方向；
所述第二方向为所述第一车载UWB基站与所述第二车载UWB的连线所在的方向。
上述方案中，进一步可选的，所述根据所述位置信息计算得到机器人的第一运动参数，包括：
根据FOC控制算法，对所述第四距离数据和所述偏转角度数据进行计算，得到所述机器人的第一转向数据和第一电机转速数据。
上述方案中，进一步可选的，所述车载采集装置包括车载镜头和车载激光测距仪；
所述获取多个车载采集装置相应采集到的多组数据，包括：
针对每个所述车载采集装置，获取每个所述车载采集装置中车载镜头采集到的图像数据；
获取每个所述车载采集装置中车载激光测距仪采集到的距离数据。
上述方案中，进一步可选的，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，包括:
将所述多组数据内图像数据进行空间对比和位置对比，并按照预设顺序对所述多组数据内图像数据进行排列组合，得到第一图像数据集合；
通过AI算法去除所述第一图像数据集合中的无效图像数据，得到第二图像数据集合；
对所述第二图像数据集合进行空间数据计算；
将所述多个距离数据与所述空间数据进行数据对比，以建立空间三维立体模型；
根据所述空间三维立体模型，得到跟随目标位置，进而根据跟随目标位置计算得到所述机器人第二转向数据和第二电机转速数据。
第二方面，一种伴随运输机器人行进控制系统，所述系统包括：
第一获取模块：用于实时获取UWB信标与车载UWB基站的位置信息；
第二获取模块：用于实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
第一处理模块：用于在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
第二处理模块：用于在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
第三方面，一种计算机设备，包括存储器和处理器，所述存储器存储有计算机程序，所述处理器执行所述计算机程序时实现以下步骤：
实时获取UWB信标与车载UWB基站的位置信息；
实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
第四方面，一种计算机可读存储介质，其上存储有计算机程序，所述计算机程序被处理器执行时实现以下步骤：
实时获取UWB信标与车载UWB基站的位置信息；
实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
本发明至少具有以下有益效果：
本发明基于对现有技术问题的进一步分析和研究，认识到现有伴随运输机器人行进控制不稳定容易跟丢且代价高的问题，本发明通过获取UWB信标与车载UWB基站的位置信息以及多个车载采集装置相应采集到的多组数据。在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动，在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。从而有效避免UWB跟随方式的不足。强大的冗余控制算法，保证系统长时间稳定运行，代价便宜且适合长时间使用。
附图说明
图1为本发明一个实施例提供的伴随运输机器人行进控制方法的流程示意图；
图2为本发明一个实施例提供的伴随运输机器人行进控制系统的模块架构框图；
图3为一个实施例中计算机设备的内部结构图。
具体实施方式
为了使本申请的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本申请进行进一步详细说明。应当理解，此处描述的具体实施例仅仅用以解释本申请，并不用于限定本申请。
在一个实施例中，如图1所示，提供了一种伴随运输机器人行进控制方法，包括以下步骤：
实时获取UWB信标与车载UWB基站的位置信息；
其中，所述车载UWB基站包括第一车载UWB基站和第二车载UWB基站，所述获取UWB信标与车载UWB基站之间的位置信息，包括：
获取所述UWB信标与所述第一车载UWB基站之间的第一距离数据；
获取所述UWB信标与所述第二车载UWB基站之间的第二距离数据；
根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息。其中，所述第三距离数据为所述第一车载UWB基站和所述第二车载UWB基站之间的距离数据。
根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息，包括：
根据卡尔曼滤波算法和三角函数计算方法，对所述第一距离数据、所述第二距离数据和所述第三距离数据进行计算，得到所述获取UWB信标与车载UWB基站之间的位置信息。
所述第四距离数据为所述UWB信标与目标点之间的距离数据，所述偏转角度数据为第一方向与第二方向之间的夹角数据，其中，所述目标点为所述第一车载UWB基站与所述第二车载UWB的连线的中点，所述第一方向为所述UWB信标与目标点的连线所在的方向，所述第二方向为所述第一车载UWB基站与所述第二车载UWB的连线所在的方向。
根据FOC控制算法，对所述第四距离数据和所述偏转角度数据进行计算，得到所述机器人的第一转向数据和第一电机转速数据。
在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动。
实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据。
在一个实施例中，获取多个车载采集装置采集到的多组图像数据和多个距离数据，具体为：针对每个所述车载采集装置，获取每个所述车载采集装置中车载镜头采集到的图像数据，获取每个所述车载采集装置中车载激光测距仪采集到的距离数据。
例如：在山地跟随场景下，机器人在运动时需要避开车体周围的障碍物，如周围树木、杂草以及石块等，具体可以通过车体周围安装的各个摄像头以及测距单元测出障碍物图像数据以及距离数据。通过车体周围安装的各个摄像头得到的多组图像数据进行空间对比和位置对比，并按照预设顺序对所述多组图像数据进行排列组合，得到第一图像数据集合。其中，第一图像数据包括每个摄像头实时拍摄的所有张图片，通过AI算法去除所述第一图像数据集合中的无效图像数据，得到第二图像数据集合，其中，第二图像数据包括能够表征车体周围全景影像的图像数据。对所述第二图像数据集合进行空间数据计算，将所述多个距离数据与所述空间数据进行数据对比，以建立空间三维立体模型。根据所述空间三维立体模型，得到所述机器人第二转向数据和第二电机转速数据。
在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。其中，所述跟随目标可以为人，也可以为车，在此不做限定。
例如：在机器人未接收到所述UWB信标位置信息的情况下，通过获取多个车载采集装置采集到的同一时刻多帧图像数据，通过AI算法去除同一时刻多帧图像数据中的无效图像数据，得到最清晰的各个方位的图像数据集合构成该车体的全景影像图像。对该车体的全景影像图像进行空间数据计算，再将获取到的多个车载采集装置采集到的多个距离数据与所述空间数据进行数据对比，以建立空间三维立体模型，其中，多个距离数据为20、60或200米，其中，所述多组激光测距单元测距用于在全景图像内标定距离。在此不做限定。根据所述空间三维立体模型，得到所述机器人第二转向数据和第二电机转速数据。其中，所述空间三维立体模型内有包括目标障碍物清楚的图像信息以及与机器人车体的对应位置信息，根据目标障碍物清楚的图像信息以及与机器人车体的对应位置信息，得到所述机器人转向数据和电机转速数据。
本实施例基于对现有技术问题的进一步分析和研究，认识到现有伴随运输机器人行进控制方案稳定性差、在密集障碍区难以实现且代价高的问题，本发明通过同时获取UWB信标与车载UWB基站的位置信息和多个车载采集装置采集到的多组图像数据和多个距离数据，在未接收到所述位置信息的情况下，根据所述多组图像数据和所述多个距离数据计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。从而有效避免UWB跟随方式的不足。强大的冗余控制算法，保证系统长时间稳定运行，代价便宜且适合长时间使用。
在一个实施例中，伴随运输机器人搭载全景系统通过在车身周围前后左右安装4个鱼眼镜头，运用图像矫正和图像拼接技术，最终生成机器人周围360度鸟瞰图，指定跟随目标后，通过图像机器学习AI算法辅助跟随，其中，所述AI算法为将全景影像得到的多张照片进行空间比对位置比对，并进行按序排列组合优化，同时筛选有用的照片，进行空间数据计算；将激光测距的距离数据与图像对比后的数据进行数据对比，进行空间三维立体建模，弥补图片建模距离误差，根据所述三维立体建模计算得到第二运动参数。根据所述第二运动参数控制所述机器人运动。
从而有效避免UWB跟随方式的不足。强大的冗余控制算法，保证系统长时间稳定运行。
在一个实施例中，所述根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动以及根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动可以同时进行，例如：在能接收到UWB信标与车载UWB基站的位置信息的情况下，且机器人车体遇到障碍物，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动，在避开障碍物后，继续根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动。
通过本实施例，不仅可以实现机器人长时间稳定跟随目标运行，也可实现机器人避障。
在一个实施例中，如图2所示，提供了一种伴随运输机器人行进控制系统的模块架构框图，包括：在接收到UWB定位模块发送的UWB数据的情况下，数据融合模块用于接收UWB定位模块发送的UWB数据，并通过UWB导航定位及滤波算法计算机器人运动数据，根据机器人运动数据控制机器人行走控制模块控制机器人车体运动。在不能接收到UWB定位模块发送的UWB数据的情况下，数据融合模块用于接收全景影像系统发送的机器人车体全景影像数据以及激光测距单元发送的多组固定距离数据，并运用图像矫正和图像拼接技术，最终生成机器人周围360度鸟瞰图，指定跟随目标后，通过图像机器学习AI算法辅助跟随，从而有效避免UWB跟随方式的不足。强大的冗余控制算法，保证系统长时间稳定运行。该系统还包括，车体状态反馈模块用于实时向数据融合模块反馈机器人车体实时运行状态，其中，车体实时运行状态可以包括，车体运行方向以及车体运行速度等。
应该理解的是，虽然图1的流程图中的各个步骤按照箭头的指示依次显示，但是这些步骤并不是必然按照箭头指示的顺序依次执行。除非本文中有明确的说明，这些步骤的执行并没有严格的顺序限制，这些步骤可以以其它的顺序执行。而且，图1中的至少一部分步骤可以包括多个步骤或者多个阶段，这些步骤或者阶段并不必然是在同一时刻执行完成，而是可以在不同的时刻执行，这些步骤或者阶段的执行顺序也不必然是依次进行，而是可以与其它步骤或者其它步骤中的步骤或者阶段的至少一部分轮流或者交替地执行。
在一个实施例中，提供了一种伴随运输机器人行进控制系统，包括以下程序模块：
第一获取模块：用于实时获取UWB信标与车载UWB基站的位置信息；
第二获取模块：用于实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
第一处理模块：用于在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
第二处理模块：用于在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
关于伴随运输机器人行进控制系统的具体限定可以参见上文中对于伴随运输机器人行进控制方法的限定，在此不再赘述。上述伴随运输机器人行进控制系统中的各个模块可全部或部分通过软件、硬件及其组合来实现。上述各模块可以硬件形式内嵌于或独立于计算机设备中的处理器中，也可以以软件形式存储于计算机设备中的存储器中，以便于处理器调用执行以上各个模块对应的操作。
在一个实施例中，提供了一种计算机设备，该计算机设备可以是终端，其内部结构图可以如图3所示。该计算机设备包括通过系统总线连接的处理器、存储器、通信接口、显示屏和输入系统。其中，该计算机设备的处理器用于提供计算和控制能力。该计算机设备的存储器包括非易失性存储介质、内存储器。该非易失性存储介质存储有操作系统和计算机程序。该内存储器为非易失性存储介质中的操作系统和计算机程序的运行提供环境。该计算机设备的通信接口用于与外部的终端进行有线或无线方式的通信，无线方式可通过WIFI、运营商网络、NFC(近场通信)或其他技术实现。该计算机程序被处理器执行时以实现一种伴随运输机器人行进控制方法。该计算机设备的显示屏可以是液晶显示屏或者电子墨水显示屏，该计算机设备的输入系统可以是显示屏上覆盖的触摸层，也可以是计算机设备外壳上设置的按键、轨迹球或触控板，还可以是外接的键盘、触控板或鼠标等。
本领域技术人员可以理解，图3中示出的结构，仅仅是与本申请方案相关的部分结构的框图，并不构成对本申请方案所应用于其上的计算机设备的限定，具体的计算机设备可以包括比图中所示更多或更少的部件，或者组合某些部件，或者具有不同的部件布置。
在一个实施例中，提供了一种计算机设备，包括存储器和处理器，存储器中存储有计算机程序，涉及上述实施例方法中的全部或部分流程。
在一个实施例中，提供了一种计算机可读存储介质，其上存储有计算机程序，涉及上述实施例方法中的全部或部分流程。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程，是可以通过计算机程序来指令相关的硬件来完成，所述的计算机程序可存储于一非易失性计算机可读取存储介质中，该计算机程序在执行时，可包括如上述各方法的实施例的流程。其中，本申请所提供的各实施例中所使用的对存储器、存储、数据库或其它介质的任何引用，均可包括非易失性和易失性存储器中的至少一种。非易失性存储器可包括只读存储器(Read-Only Memory，ROM)、磁带、软盘、闪存或光存储器等。易失性存储器可包括随机存取存储器(Random Access Memory，RAM)或外部高速缓冲存储器。作为说明而非局限，RAM可以是多种形式，比如静态随机存取存储器(Static Random Access Memory，SRAM)或动态随机存取存储器(Dynamic Random Access Memory，DRAM)等。
以上实施例的各技术特征可以进行任意的组合，为使描述简洁，未对上述实施例中的各个技术特征所有可能的组合都进行描述，然而，只要这些技术特征的组合不存在矛盾，都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本申请的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本申请构思的前提下，还可以做出若干变形和改进，这些都属于本申请的保护范围。因此，本申请专利的保护范围应以所附权利要求为准。
Claims (10)
1.一种伴随运输机器人行进控制方法，其特征在于，所述方法包括：
实时获取UWB信标与车载UWB基站的位置信息；
实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
2.根据权利要求1所述的方法，其特征在于，所述车载UWB基站包括第一车载UWB基站和第二车载UWB基站；
所述获取UWB信标与车载UWB基站之间的位置信息，包括：
获取所述UWB信标与所述第一车载UWB基站之间的第一距离数据；
获取所述UWB信标与所述第二车载UWB基站之间的第二距离数据；
根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息；
其中，所述第三距离数据为所述第一车载UWB基站和所述第二车载UWB基站之间的距离数据。
3.根据权利要求2所述的方法，其特征在于，根据所述第一距离数据、所述第二距离数据和第三距离数据，计算得到所述获取UWB信标与车载UWB基站之间的位置信息，包括：
根据卡尔曼滤波算法和三角函数计算方法，对所述第一距离数据、所述第二距离数据和所述第三距离数据进行计算，得到所述获取UWB信标与车载UWB基站之间的位置信息。
4.根据权利要求2所述的方法，其特征在于，所述位置信息包括第四距离数据和偏转角度数据；
所述第四距离数据为所述UWB信标与目标点之间的距离数据；
所述偏转角度数据为第一方向与第二方向之间的夹角数据；
其中，所述目标点为所述第一车载UWB基站与所述第二车载UWB的连线的中点；
所述第一方向为所述UWB信标与目标点的连线所在的方向；
所述第二方向为所述第一车载UWB基站与所述第二车载UWB的连线所在的方向。
5.根据权利要求4所述的方法，其特征在于，所述根据所述位置信息计算得到机器人的第一运动参数，包括：
根据FOC控制算法，对所述第四距离数据和所述偏转角度数据进行计算，得到所述机器人的第一转向数据和第一电机转速数据。
6.根据权利要求1所述的方法，其特征在于，所述车载采集装置包括车载镜头和车载激光测距仪；
所述获取多个车载采集装置相应采集到的多组数据，包括：
针对每个所述车载采集装置，获取每个所述车载采集装置中车载镜头采集到的图像数据；
获取每个所述车载采集装置中车载激光测距仪采集到的距离数据。
7.根据权利要求1所述的方法，其特征在于，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，包括:
将所述多组数据内图像数据进行空间对比和位置对比，并按照预设顺序对所述多组数据内图像数据进行排列组合，得到第一图像数据集合；
通过AI算法去除所述第一图像数据集合中的无效图像数据，得到第二图像数据集合；
对所述第二图像数据集合进行空间数据计算；
将所述多个距离数据与所述空间数据进行数据对比，以建立空间三维立体模型；
根据所述空间三维立体模型，得到跟随目标位置，进而根据跟随目标位置计算得到所述机器人第二转向数据和第二电机转速数据。
8.一种伴随运输机器人行进控制系统，其特征在于，所述系统包括：
第一获取模块：用于实时获取UWB信标与车载UWB基站的位置信息；
第二获取模块：用于实时获取多个车载采集装置相应采集到的多组数据，所述多个车载采集装置面向车体周围不同方位，每一组数据包括图像数据和距离数据；
第一处理模块：用于在接收到所述位置信息的情况下，根据所述位置信息计算得到机器人的第一运动参数，并根据所述第一运动参数控制所述机器人运动；
第二处理模块：用于在未接收到所述位置信息的情况下，根据所述多组数据计算得到跟随目标位置，根据跟随目标位置计算得到所述机器人的第二运动参数，并根据所述第二运动参数控制所述机器人运动。
9.一种机器人，包括机器人本体和安装于机器人本体的控制器以及车载UWB基站；所述控制器包括存储器和处理器，所述存储器存储有计算机程序；其特征在于，该机器人还包括安装于机器人本体的图像采集模块，用于获取机器人周围全景影像；所述处理器执行所述计算机程序时实现权利要求1至7中任一项所述的方法的步骤。
10.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，所述计算机程序被处理器执行时实现权利要求1至7中任一项所述的方法的步骤。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211234378.9A CN115437299A (zh) | 2022-10-10 | 2022-10-10 | 一种伴随运输机器人行进控制方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202211234378.9A CN115437299A (zh) | 2022-10-10 | 2022-10-10 | 一种伴随运输机器人行进控制方法及系统 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN115437299A true CN115437299A (zh) | 2022-12-06 |
Family
ID=84251768
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202211234378.9A Pending CN115437299A (zh) | 2022-10-10 | 2022-10-10 | 一种伴随运输机器人行进控制方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN115437299A (zh) |
Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108012326A (zh) * | 2017-12-07 | 2018-05-08 | 珠海市微半导体有限公司 | 基于栅格地图的机器人监视宠物的方法及芯片 |
| CN108536145A (zh) * | 2018-04-10 | 2018-09-14 | 深圳市开心橙子科技有限公司 | 一种使用机器视觉进行智能跟随的机器人系统及运行方法 |
| CN109947119A (zh) * | 2019-04-23 | 2019-06-28 | 东北大学 | 一种基于多传感器融合的移动机器人自主跟随系统及方法 |
| US20200206921A1 (en) * | 2018-12-30 | 2020-07-02 | Ubtech Robotics Corp | Robot movement control method, apparatus and robot using the same |
| CN112462782A (zh) * | 2020-11-30 | 2021-03-09 | 北京航天光华电子技术有限公司 | 一种多功能智能跟随小车系统 |
| CN113126600A (zh) * | 2019-12-26 | 2021-07-16 | 沈阳新松机器人自动化股份有限公司 | 基于uwb的跟随系统及物品运送车 |
| CN113301828A (zh) * | 2019-01-18 | 2021-08-24 | 灵动科技（北京）有限公司 | 具有基于超宽带的目标跟踪系统的智能行李系统 |
| CN114625122A (zh) * | 2022-01-25 | 2022-06-14 | 浙江国自机器人技术股份有限公司 | 一种基于uwb与激光雷达的机器人跟随和避障方法及系统 |
| CN114905512A (zh) * | 2022-05-16 | 2022-08-16 | 安徽元古纪智能科技有限公司 | 一种智能巡检机器人全景追踪及避障方法及系统 |
| CN115129050A (zh) * | 2022-06-17 | 2022-09-30 | 青岛慧拓智能机器有限公司 | 一种港口牵引车无人运输短倒系统及方法 |
-
2022
- 2022-10-10 CN CN202211234378.9A patent/CN115437299A/zh active Pending
Patent Citations (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108012326A (zh) * | 2017-12-07 | 2018-05-08 | 珠海市微半导体有限公司 | 基于栅格地图的机器人监视宠物的方法及芯片 |
| CN108536145A (zh) * | 2018-04-10 | 2018-09-14 | 深圳市开心橙子科技有限公司 | 一种使用机器视觉进行智能跟随的机器人系统及运行方法 |
| US20200206921A1 (en) * | 2018-12-30 | 2020-07-02 | Ubtech Robotics Corp | Robot movement control method, apparatus and robot using the same |
| CN113301828A (zh) * | 2019-01-18 | 2021-08-24 | 灵动科技（北京）有限公司 | 具有基于超宽带的目标跟踪系统的智能行李系统 |
| CN109947119A (zh) * | 2019-04-23 | 2019-06-28 | 东北大学 | 一种基于多传感器融合的移动机器人自主跟随系统及方法 |
| CN113126600A (zh) * | 2019-12-26 | 2021-07-16 | 沈阳新松机器人自动化股份有限公司 | 基于uwb的跟随系统及物品运送车 |
| CN112462782A (zh) * | 2020-11-30 | 2021-03-09 | 北京航天光华电子技术有限公司 | 一种多功能智能跟随小车系统 |
| CN114625122A (zh) * | 2022-01-25 | 2022-06-14 | 浙江国自机器人技术股份有限公司 | 一种基于uwb与激光雷达的机器人跟随和避障方法及系统 |
| CN114905512A (zh) * | 2022-05-16 | 2022-08-16 | 安徽元古纪智能科技有限公司 | 一种智能巡检机器人全景追踪及避障方法及系统 |
| CN115129050A (zh) * | 2022-06-17 | 2022-09-30 | 青岛慧拓智能机器有限公司 | 一种港口牵引车无人运输短倒系统及方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN108051002B (zh) | 基于惯性测量辅助视觉的运输车空间定位方法及系统 | |
| CN110068335B (zh) | 一种gps拒止环境下无人机集群实时定位方法及系统 | |
| CN109506642B (zh) | 一种机器人多相机视觉惯性实时定位方法及装置 | |
| CN109885080B (zh) | 自主控制系统及自主控制方法 | |
| US20180190014A1 (en) | Collaborative multi sensor system for site exploitation | |
| US11906983B2 (en) | System and method for tracking targets | |
| JP2020030204A (ja) | 距離測定方法、プログラム、距離測定システム、および可動物体 | |
| JP2020144101A (ja) | 走行経路を生成するための方法及び装置 | |
| CN109737981B (zh) | 基于多传感器的无人车目标搜索装置及方法 | |
| CN115082549A (zh) | 位姿估计方法及装置、以及相关设备和存储介质 | |
| JP2013187862A (ja) | 画像データ処理装置、画像データ処理方法および画像データ処理用のプログラム | |
| CN112634370A (zh) | 一种无人机打点方法、装置、设备及存储介质 | |
| CN113033280A (zh) | 拖车姿态估计的系统和方法 | |
| JP2022027593A (ja) | 可移動機器の測位方法、装置及び可移動機器 | |
| CN112447058B (zh) | 泊车方法、装置、计算机设备及存储介质 | |
| CN112991440B (zh) | 车辆的定位方法和装置、存储介质和电子装置 | |
| CN110780325B (zh) | 运动对象的定位方法及装置、电子设备 | |
| Fragoso et al. | Dynamically feasible motion planning for micro air vehicles using an egocylinder | |
| JP2021193538A (ja) | 情報処理装置、移動装置、情報処理システム、および方法、並びにプログラム | |
| CN114529585A (zh) | 基于深度视觉和惯性测量的移动设备自主定位方法 | |
| CN110411449B (zh) | 一种航空侦察载荷目标定位方法、系统及终端设备 | |
| CN115437299A (zh) | 一种伴随运输机器人行进控制方法及系统 | |
| CN115496873A (zh) | 一种基于单目视觉的大场景车道建图方法及电子设备 | |
| CN108344972A (zh) | 基于光栅投射立体视觉的机器人视觉系统及导航方法 | |
| JP2023072353A (ja) | 移動体の移動経路決定装置、移動体の移動経路決定方法及び移動体の移動経路決定プログラム |
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: 20221206 |
|
| RJ01 | Rejection of invention patent application after publication |