CN107992035A - 一种基于室内全局定位的多移动机器人编队控制方法 - Google Patents
一种基于室内全局定位的多移动机器人编队控制方法 Download PDFInfo
- Publication number
- CN107992035A CN107992035A CN201711125796.3A CN201711125796A CN107992035A CN 107992035 A CN107992035 A CN 107992035A CN 201711125796 A CN201711125796 A CN 201711125796A CN 107992035 A CN107992035 A CN 107992035A
- Authority
- CN
- China
- Prior art keywords
- beacon
- mobile
- robot
- fixed
- msup
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 60
- 230000004807 localization Effects 0.000 title claims abstract description 47
- 238000000034 method Methods 0.000 title claims abstract description 46
- 230000033001 locomotion Effects 0.000 claims abstract description 36
- 238000004891 communication Methods 0.000 claims description 7
- 238000013461 design Methods 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 239000007787 solid Substances 0.000 claims description 4
- 230000005540 biological transmission Effects 0.000 claims description 3
- 230000000903 blocking effect Effects 0.000 claims description 3
- 238000010276 construction Methods 0.000 claims description 3
- 238000007667 floating Methods 0.000 claims description 3
- 238000012360 testing method Methods 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 description 14
- 238000004458 analytical method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 239000000523 sample Substances 0.000 description 2
- 230000002123 temporal effect Effects 0.000 description 2
- 238000002604 ultrasonography Methods 0.000 description 2
- 238000012795 verification Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000000052 comparative effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- DMBHHRLKUKUOEG-UHFFFAOYSA-N diphenylamine Chemical compound C=1C=CC=CC=1NC1=CC=CC=C1 DMBHHRLKUKUOEG-UHFFFAOYSA-N 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 210000001258 synovial membrane Anatomy 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/0287—Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
- G05D1/0291—Fleet control
-
- 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Acoustics & Sound (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种基于室内全局定位的多移动机器人编队控制方法，涉及机器人导航领域，本发明通过安装在固定信标和移动信标上的超声波发生接收器，计算出编队运动中各个移动机器人的位置坐标，并由此获得各移动机器人的实时位姿，控制跟随机器人的跟踪位姿，从而实现基于领航跟随型的多机编队作业任务。本发明解决了移动机器人自主导航中的基础性定位问题；该定位方法具有容易部署、简单实用、定位精度高、可扩展性好等特点，适用于单个移动机器人的自主导航，也可适用于多移动机器人的编队协作，同时也支持无人***的三维坐标定位，为无人机、空地协同等的室内定位提供使能技术支撑。
Description
技术领域
本发明涉及机器人导航领域，尤其是一种移动机器人的定位和编队控制方法。
背景技术
移动机器人作为一种自主、智能的运输平台和载体，适用于侦查、盯梢、搜索和跟踪等危险、污染、极端的环境。自主导航是移动机器人在未知、非结构环境下进行自主作业的核心技术，而定位技术又是机器人完成自主导航任务的最基本环节。与应用比较成熟的GPS、北斗等室外定位与导航技术不同，精准室内定位技术目前相对较弱，而消防救援、抢险救灾、冲突反恐、自主对接、合作搬运等应用领域又对室内定位技术提出了现实需求。
根据定位技术和传感器的不同，移动机器人室内定位技术主要包含航迹推算、图形匹配和信标定位。航迹推算定位是一种基于位姿递推方式的相对定位方法，但该方法存在定位误差随时间累积的缺陷；图形匹配定位方法需依据外部环境建立全局或局部地图，该方法受外部环境影响较大，且大多适用于确定性静态环境；基于信标定位方法可以提供稳定、精确的全局绝对位置信息，但该方法的前期部署、后期维护工作量较大。
目前，移动机器人室内信标定位技术主要包括基于无线传感网络和超声波的两种定位方法。采用WLAN、ZigBee、Bluetooth等的无线传感网络定位技术通过信号特征信息来分析推算机器人的当前位置信息，该定位技术不受视距约束，但定位精度相对较低；而基于超声波的信标定位技术具有抗电磁干扰能力强、信标铺设位置灵活、定位精度相对较高等优点。
多机编队控制问题是多移动机器人技术领域的一个重要分支，其在联合侦查、群体盯梢、协作救援、合作搬运、传感网络等军事和民用领域具有广阔的应用背景。多机编队控制问题是多个移动机器人自主协作形成一个预期的几何图形以完成特定的目标任务，并在未知、非结构环境条件下执行作业任务时尽可能保持既定编队队形不变。在多机编队问题的自主成形、队形保持、队形变换等过程中，一个最基本的问题就是各个移动机器人需要实时获取自身的位置指标，因此，精确定位方法是实现多移动机器人编队控制的先决条件和支撑技术。
在多移动机器人编队控制领域，国内目前的现状是学术研究多于实际应用，而学术研究绝大部分都是在假设已知各个机器人位置坐标基础上进行理论分析与仿真计算，真正结合实物机器人的应用验证甚少，其中一个重要原因就是缺乏室内全局定位方法与硬件的有效支持。在专利“基于无线传感网络的多机器人编队***和编队方法(CN102662377A)”中，利用Zigbee协议建立无线局域网，依据移动机器人自身接收信号的强度实时确定自身位置，该方法因定位精度相对较低而导致多机编队效果欠佳。在专利“一种基于蓝牙通讯的多机器人编队控制路径跟踪方法(CN103901889)”中，采用iSpace摄像头位置捕捉***来获取移动机器人的位置信息，并通过蓝牙将位置信息发送给移动机器人，该定位方法存在通讯距离短、成本相对较高等问题。
发明内容
为了克服现有技术的不足，针对室内移动机器人定位精度低、适用范围有限，以及多移动机器人编队控制领域缺乏有效的室内定位方法等实际问题，本发明提出一种基于室内全局定位的多移动机器人编队控制方法，将一种新型的室内全局定位方法引入多移动机器人编队控制问题中，旨在解决室内移动机器人的自主定位问题，从而为多移动机器人的自主成形、队形保持、主动避障、队形变换和目标跟踪等提供一种有效、实时、准确的室内全局定位方法支持。
本发明解决其技术问题所采用的技术方案包括如下步骤：
步骤1、本发明包括一套室内全局定位***和N个移动机器人，其中室内全局定位***包括四个固定信标、一台定位基站控制器和N个搭载在移动机器人上的移动信标，将四个固定信标安装在高于移动机器人运动平面的墙面上，在避免遮挡的情况下使固定信标两两相对且不在同一平面内，并保证移动机器人运动区域无遮挡；
固定信标是整个室内定位***用来构建全局坐标系的基准，接收每个移动信标发出的超声波信号并记录其ID码，在接收过程中四个固定信标将会接收所有移动信标的超声波信号；
移动信标携带唯一的ID码以标识每个移动机器人，并以固定频率发射超声波信号，该固定频率设定在10-20Hz之间；
所述固定信标和移动信标均采用相同结构，均包含一个正方形底座和5个超声波发生接收器，5个超声波发生接收器分别安装在正方形底座的四边和中心，其中一个超声波发生接收器安装在底座中心位置且发生接收探头竖直向上，其余四个安装在正方形底座各边的中点处，且四个超声波发生接收器的发生接收探头与正方形底座保持15度仰角向上倾斜，超声波发生接收器以实现信标的全向发送和接收，同时每个移动信标配备角度姿态传感器，可动态测量移动机器人的偏角信息，移动信标和固定信标都有各自唯一的ID标识码，整套定位***同时测定所有的移动信标的位置坐标，在定位***的覆盖区域内，定位***利用固定信标对所有的移动信标进行实时测量，从而满足多机编队运动中对各个移动机器人的位置坐标计算需求；
定位基站控制器是整个室内全局定位***的中心控制器，其信号覆盖定位区域内的所有固定信标和移动信标；
步骤2、在室内全局定位***初始化过程中，以地面为基准对各固定信标的高度进行标定，并选择其中任一固定信标作为Z轴，以相邻的任一固定信标的正下方为X轴建立三维坐标系，其他各固定信标以该坐标系为基准，确定其余固定信标在坐标系中的位置坐标，整个坐标系建立完成后，设置固定信标为接收模式；
步骤3、采用三边测量法对移动信标的位置坐标进行计算：固定信标接收移动信标的超声波信号并记录接收到该信号的时间点；定位基站控制器通过计算移动信标到达各固定信标的时间间隔，依此计算出该移动信标和四个固定信标之间的直线距离分别为d1、d2、d3、d4，当某一移动信标发射的超声波信号被3个或3个以上的固定信标接收到后，基站控制器通过三边测量法计算得到该移动信标在全局坐标系内的位置信息；
详细计算步骤为：假设定位***在初始标定时，从4个固定信标中任选3个，即可得1号固定信标、2号固定信标和3号固定信标的坐标分别为(0,0,z1)、(a,0,z2)、(0,b,z3)，当这3个固定信标分别接收到移动信标发送的超声波信号时，依据三边测量计算原理，该移动信标的当前位置坐标(X,Y,Z)可计算如下：
即通过式(1)计算，即可得到某一移动信标在全局坐标内的当前位置坐标(X,Y,Z)；
步骤4、构建基于超声波信标的室内全局定位***，用以获取各移动机器人的实时位姿；
1)部署室内全局定位***：将固定信标安装在四个顶角位置，选择其中两个固定信标作为坐标系基准建立三维坐标系，移动信标分别安装在每个移动机器人上，移动信标与移动机器人控制器均采用串口通讯连接方式；定位基站控制器实时计算各移动机器人的位置坐标信息，并结合偏角信息以位姿数据包的形式下传至对应的移动信标；
2)移动机器人解析位姿数据包：移动机器人通过串口通讯方式读取移动信标接收到的位姿数据包，采用奇偶校验位进行判断，并判断校验位是否正确，当校验位为1则为正确，校验位为0则为错误，当校验位信息正确，则移动机器人将正确的位姿坐标信息存入处理器的缓存中，并进行字符串格式的数据类型转换为浮点型的位姿数据，并存入位姿数组中，如果校验位信息错误，将舍弃此次位姿坐标信息；
3)位姿数据依次存储：随着移动机器人的自主运动，其位置信息进行实时更新，通过定位基站控制器向各移动信标发送并解析位姿数据包后，位姿坐标信息遵循“先进先出”的顺序原则依次更新到移动机器人控制器的位姿坐标数组中；
步骤5：移动机器人的初始化
移动机器人的初始化主要包括：分配领航、跟随两种移动机器人角色，即任意选择一个机器人为领航机，其它均为跟随机器人，根据需求设定移动机器人编队需要保持的队形图案，配置领航机器人为发送数据状态，跟随机器人为接收数据状态；
设计移动机器人运动控制器，实现多机器人编队作业任务，详细步骤如下：
1)根据移动机器人车体结构及驱动方式，建立移动机器人运动学模型，并依此构建多移动机器人编队的运动学模型；
2)基于上述超声波信标的室内全局定位方法，实时获取领航机器人和跟随机器人的当前位姿；再根据预设的多机编队队形几何信息，计算出各跟随机器人当前时刻的理想位姿，将跟随机器人任意放置，然后，跟随机器人依据各自的理想位姿和实际位姿，计算得到各跟随机器人的跟踪位姿误差；最后，运用控制方法，设计运动控制器使跟随机器人的跟踪位姿误差满足精度要求，依此控制跟随机器人的跟踪位姿误差满足精度要求，从而实现基于领航跟随型的多机编队作业任务。
本发明的有益效果在于由于采用基于超声波信标的室内全局定位方法，对移动机器人进行室内定位服务，解决了移动机器人自主导航中的基础性定位问题；该定位方法具有容易部署、简单实用、定位精度高、可扩展性好等特点，它适用于单个移动机器人的自主导航，也可适用于多移动机器人的编队协作，同时也支持无人***的三维坐标定位，为无人机、空地协同等的室内定位提供使能技术支撑。
附图说明
图1是基于室内全局定位的多移动机器人编队***总体部署图，其中：1为固定信标，2为定位基站控制器，3是移动机器人，4为安装在各移动机器人上的移动信标。
图2是超声波信标结构图，其中，①、②、③、④和⑤均为固定信标超声波接收探头或移动信标的超声波发送探头。
图3是基于超声波信标和三边测量法的室内全局定位原理图，其中，d1、d2、d3和d4分别为固定信标到移动信标的直线距离。
图4是基于领航跟随型的多移动机器人编队场景图，其中，3-1为领航机器人，3-4、3-5为两个跟随机器人，3-2、3-3分别是两个跟随机器人对应的理想位置的虚拟机器人。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
基于超声波信标的室内全局定位技术，解决了移动机器人自主导航领域中的基本定位问题；并依此定位方法为支撑，提出一种适用于领航跟随型(Leader-follower)多机编队问题的机器人运动控制方法。该发明为移动机器人在自主导航、主动避障、目标跟踪，以及多机器人的协作救援、合作搬运等应用领域提供定位方案支持。
本发明是从室内全局定位的角度入手，采用超声波信标定位方式，提供一种新的室内定位方法；并在该定位技术基础上，提出一种较为通用的多机编队控制方法，旨在为室内移动机器人自主导航、多移动机器人编队协作等提供定位方法支持。
步骤1、本发明包括一套室内全局定位***和N个移动机器人，其中室内全局定位***包括四个固定信标、一台定位基站控制器和N个搭载在移动机器人上的移动信标，将四个固定信标安装在高于移动机器人运动平面的墙面上，在避免遮挡的情况下使固定信标两两相对且不在同一平面内，并保证移动机器人运动区域无遮挡；
固定信标是整个室内定位***用来构建全局坐标系的基准，接收每个移动信标发出的超声波信号并记录其ID码，在接收过程中四个固定信标将会接收所有移动信标的超声波信号；
移动信标携带唯一的ID码以标识每个移动机器人，并以固定频率发射超声波信号，该固定频率设定在10-20Hz之间；
所述固定信标和移动信标均采用相同结构，如图2所示，其中，①、②、③、④和⑤均为固定信标超声波接收探头或移动信标的超声波发送探头，各探头均匀布置以实现定位覆盖范围的最大化。固定信标和移动信标均包含一个正方形底座和5个超声波发生接收器，5个超声波发生接收器分别安装在正方形底座的四边和中心，其中一个超声波发生接收器安装在底座中心位置且发生接收探头竖直向上，其余四个安装在正方形底座各边的中点处，且四个超声波发生接收器的发生接收探头与正方形底座保持15度仰角向上倾斜，超声波发生接收器以实现信标的全向发送和接收，同时每个移动信标配备角度姿态传感器，可动态测量移动机器人的偏角信息，移动信标和固定信标都有各自唯一的ID标识码，整套定位***同时测定所有的移动信标的位置坐标，在定位***的覆盖区域内，定位***利用固定信标对所有的移动信标进行实时测量，从而满足多机编队运动中对各个移动机器人的位置坐标计算需求；
定位基站控制器是整个室内全局定位***的中心控制器，其信号覆盖定位区域内的所有固定信标和移动信标，以四个固定信标建立的全局坐标系作为基准，根据固定信标所采集的距离信息计算各个移动信标在全局坐标系下的位置坐标，定位基站控制器并将位置信息以数据包形式发送给移动信标，以供各个移动机器人解析各自所在全局坐标系中的位置信息；
步骤2、在室内全局定位***初始化过程中，以地面为基准对各固定信标的高度进行标定，并选择其中任一固定信标作为Z轴，以相邻的任一固定信标的正下方为X轴建立三维坐标系，其他各固定信标以该坐标系为基准，确定其余固定信标在坐标系中的位置坐标，整个坐标系建立完成后，设置固定信标为接收模式；
步骤3、采用三边测量法对移动信标的位置坐标进行计算：固定信标接收移动信标的超声波信号并记录接收到该信号的时间点；定位基站控制器通过计算移动信标到达各固定信标的时间间隔，依此计算出该移动信标和四个固定信标之间的直线距离分别为d1、d2、d3、d4，当某一移动信标发射的超声波信号被3个或3个以上的固定信标接收到后，基站控制器通过三边测量法计算得到该移动信标在全局坐标系内的位置信息；
详细计算步骤为：假设定位***在初始标定时，从4个固定信标中任选3个，即可得1号固定信标、2号固定信标和3号固定信标的坐标分别为(0,0,z1)、(a,0,z2)、(0,b,z3)，当这3个固定信标分别接收到移动信标发送的超声波信号时，依据三边测量计算原理，该移动信标的当前位置坐标(X,Y,Z)可计算如下：
即通过式(1)计算，即可得到某一移动信标在全局坐标内的当前位置坐标(X,Y,Z)；
图3是基于超声波信标和三边测量法的室内全局定位原理图，其中，d1、d2、d3和d4分别为固定信标(1-1、1-2、1-3、1-4)到移动信标(4)的直线距离。
基于上述超声波信标室内定位方法，实时获取各个移动机器人的当前位置坐标，并依此定位技术为支撑，最终形成一种简单、易用的多移动机器人编队控制解决方案，具体实现步骤见步骤4；
步骤4、构建基于超声波信标的室内全局定位***，用以获取各移动机器人的实时位姿；
1)部署室内全局定位***：将固定信标安装在四个顶角位置，本发明选择50m2室内，如图1所示，其中：1为固定信标，2为定位基站控制器，3是移动机器人，4为安装在各移动机器人上的移动信标。选择其中两个固定信标作为坐标系基准建立三维坐标系，使其完全覆盖移动机器人的运动范围；移动信标分别安装在每个移动机器人上，移动信标与移动机器人控制器均采用串口通讯连接方式；定位基站控制器实时计算各移动机器人的位置坐标信息，并结合偏角信息以位姿数据包的形式下传至对应的移动信标；
2)移动机器人解析位姿数据包：移动机器人通过串口通讯方式读取移动信标接收到的位姿数据包，采用奇偶校验位进行判断，并判断校验位是否正确，当校验位为1则为正确，校验位为0则为错误，当校验位信息正确，则移动机器人将正确的位姿坐标信息存入处理器的缓存中，并进行字符串格式的数据类型转换为浮点型的位姿数据，并存入位姿数组中，如果校验位信息错误，将舍弃此次位姿坐标信息；
3)位姿数据依次存储：随着移动机器人的自主运动，其位置信息进行实时更新，通过定位基站控制器向各移动信标发送并解析位姿数据包后，位姿坐标信息遵循“先进先出”的顺序原则依次更新到移动机器人控制器的位姿坐标数组中；
步骤5：移动机器人的初始化
移动机器人的初始化主要包括：分配领航、跟随两种移动机器人角色，即任意选择一个机器人为领航机，其它均为跟随机器人，根据需求设定移动机器人编队需要保持的队形图案，配置领航机器人为发送数据状态，跟随机器人为接收数据状态；
设计移动机器人运动控制器，实现多机器人编队作业任务，详细步骤如下：
1)根据移动机器人车体结构及驱动方式，建立移动机器人运动学模型，并依此构建多移动机器人编队的运动学模型；
2)基于上述超声波信标的室内全局定位方法，实时获取领航机器人和跟随机器人的当前位姿；再根据预设的多机编队队形几何信息，计算出各跟随机器人当前时刻的理想位姿，将跟随机器人任意放置，然后，跟随机器人依据各自的理想位姿和实际位姿，计算得到各跟随机器人的跟踪位姿误差；最后，运用控制方法，如：PID控制、滑膜控制法等，设计运动控制器使跟随机器人的跟踪位姿误差满足精度要求，依此控制跟随机器人的跟踪位姿误差满足精度要求，从而实现基于领航跟随型的多机编队作业任务。
以下结合我们已经成功实现的原理样机与原型***，以领航跟随型的三角形多机编队为例，对该发明的具体实施方式说明如下：
1、搭建基于超声波信标的室内全局定位***
以地面为基准对每个固定信标的高度进行标定，选择其中一个固定信标作为坐标系的Z轴，并以另一固定信标正下方为X轴建立三维坐标系。如图3所示，选择固定信标1-1作为Z轴，并以固定信标1-2正下方为X轴建立三维坐标系。其他各固定信标以该坐标系为基准相互测距确定其所在坐标系中的位置坐标；将移动信标固定在移动机器人上，并使得移动信标的中心点与移动机器人驱动轴中点相重合；启动定位***的定位基站控制器，设置固定信标超声波接收模式和移动信标超声波发送模式，并测试定位***是否启动成功。
移动信标与其所属的移动机器人采用串口通讯方式，移动信标的位置数据包包含：X轴的位置坐标(单位:厘米)，Y轴的位置坐标(单位:厘米)，Z轴的位置坐标(单位:厘米)，偏角信息(单位：rad)、校验位、移动信标ID等。
移动机器人接收到该位置数据包后：首先，判断该数据包的校验位是否正确，若正确则保留该位置信息，否则舍弃；然后，将通过校验的数据包存入移动机器人处理器的缓存中；最后，将该数据包中的位姿坐标(包含坐标和偏角信息)数据位进行数据类型转换，转换后的数据单独存入位置信息数组中。至此，移动机器人当前的位姿信息读取成功并释放缓存。
伴随着移动机器人的自主运动，其位置信息按照固定频率更新，并通过基站控制器向各移动信标发送，经解析后将这些位姿坐标依据“先进先出”的顺序方式依次更新到位姿坐标数组中。
2、移动机器人初始化。
移动机器人初始化主要包括：初始化编队图形信息，配置多机之间的无线通讯单元等。以图4所示的三角形多机编队为例进行说明，其中，3-1为领航机器人，3-4、3-5为两个跟随机器人，3-2、3-3分别是两个跟随机器人对应的理想位置的虚拟机器人。
初始化多机编队的几何图形：领航机器人(3-1)为三角形队形的顶点，跟随机器人(3-4、3-5)为三角形编队底边的两个端点，而且分别与领航机器人距离为L、夹角为
配置领航机器人与跟随机器人的无线通讯单元：选用无线通讯单元ESP8266作为多机器人之间的通讯模块。ESP8266具有三种工作模式即SoftAP模式、Station模式和SoftAP+Station共存模式。在图4所示的三角形多机编队中，领航机器人(3-1)采用SoftAP模式建立无线局域网，并将其位置信息通过无线局域网向跟随机器人传播；跟随机器人采用SoftAP+Station共存模式，这种共存模式可以避免因领航机器人故障而导致整个编队功能失效现象的发生，即：如果领航机器人出现故障，则跟随机器人根据优先级顺序可以自主切换成SoftAP模式，并在该模式下建立局域网，从而替代领航机器人继续完成预期的编队作业任务。
3、设计移动机器人的运动控制器，实现多移动机器人的编队作业任务。
基于超声波信标的室内全局定位***，可以实时获得领航机器人(3-1)、跟随机器人(3-4、3-5)的当前位姿信息，且该位姿包括位置坐标和方向角信息。
以跟随机器人(3-4)为例进行说明，假设当前时刻领航机器人(3-1)位姿为(x1 y1θ1)T，跟随机器人(3-4)位姿(x2 y2 θ2)T。若要保持既定边长为L的三角形编队队形，则需要实时跟踪虚拟机器人(3-2)，而虚拟机器人(3-2)的位姿坐标可计算如下：
依据该虚拟机器人(3-2)的位姿坐标，可计算得到跟随机器人(3-4)的跟踪位姿误差(xe ye θe)T，其中，(xe ye θe)T＝(x2-xr y2-yr θ2-θr)T。根据各跟随机器人的跟踪位姿误差来设计对应的运动控制器，以确保各跟随机器人的跟踪位姿误差趋近于0并满足精度要求，从而使得多移动机器人在尽可能保持既定几何形状的条件下执行作业任务。
对于移动机器人运动控制器的设计可以结合李雅普诺夫稳定性定理、反步法、反馈线性化等经典方法；根据运动控制器求解编队所需的运动控制率，并设计控制率中的相关参数；再与当前速度信息结合，可求出采样周期内每个跟随机器人保持编队队形所需的线速度和角速度。跟随机器人按照所得的线速度和角速度进行运动，使得多移动机器人编队队形得以保持。
Claims (1)
1.一种基于室内全局定位的多移动机器人编队控制方法，其特征在于包括下述步骤：
步骤1、本发明包括一套室内全局定位***和N个移动机器人，其中室内全局定位***包括四个固定信标、一台定位基站控制器和N个搭载在移动机器人上的移动信标，将四个固定信标安装在高于移动机器人运动平面的墙面上，在避免遮挡的情况下使固定信标两两相对且不在同一平面内，并保证移动机器人运动区域无遮挡；
固定信标是整个室内定位***用来构建全局坐标系的基准，接收每个移动信标发出的超声波信号并记录其ID码，在接收过程中四个固定信标将会接收所有移动信标的超声波信号；
移动信标携带唯一的ID码以标识每个移动机器人，并以固定频率发射超声波信号，该固定频率设定在10-20Hz之间；
所述固定信标和移动信标均采用相同结构，均包含一个正方形底座和5个超声波发生接收器，5个超声波发生接收器分别安装在正方形底座的四边和中心，其中一个超声波发生接收器安装在底座中心位置且发生接收探头竖直向上，其余四个安装在正方形底座各边的中点处，且四个超声波发生接收器的发生接收探头与正方形底座保持15度仰角向上倾斜，超声波发生接收器以实现信标的全向发送和接收，同时每个移动信标配备角度姿态传感器，可动态测量移动机器人的偏角信息，移动信标和固定信标都有各自唯一的ID标识码，整套定位***同时测定所有的移动信标的位置坐标，在定位***的覆盖区域内，定位***利用固定信标对所有的移动信标进行实时测量，从而满足多机编队运动中对各个移动机器人的位置坐标计算需求；
定位基站控制器是整个室内全局定位***的中心控制器，其信号覆盖定位区域内的所有固定信标和移动信标；
步骤2、在室内全局定位***初始化过程中，以地面为基准对各固定信标的高度进行标定，并选择其中任一固定信标作为Z轴，以相邻的任一固定信标的正下方为X轴建立三维坐标系，其他各固定信标以该坐标系为基准，确定其余固定信标在坐标系中的位置坐标，整个坐标系建立完成后，设置固定信标为接收模式；
步骤3、采用三边测量法对移动信标的位置坐标进行计算：固定信标接收移动信标的超声波信号并记录接收到该信号的时间点；定位基站控制器通过计算移动信标到达各固定信标的时间间隔，依此计算出该移动信标和四个固定信标之间的直线距离分别为d1、d2、d3、d4，当某一移动信标发射的超声波信号被3个或3个以上的固定信标接收到后，基站控制器通过三边测量法计算得到该移动信标在全局坐标系内的位置信息；
详细计算步骤为：假设定位***在初始标定时，从4个固定信标中任选3个，即可得1号固定信标、2号固定信标和3号固定信标的坐标分别为(0,0,z1)、(a,0,z2)、(0,b,z3)，当这3个固定信标分别接收到移动信标发送的超声波信号时，依据三边测量计算原理，该移动信标的当前位置坐标(X,Y,Z)可计算如下：
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msup>
<mi>X</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>Y</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>Z</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>1</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>=</mo>
<msup>
<msub>
<mi>d</mi>
<mn>1</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mrow>
<mo>(</mo>
<mi>X</mi>
<mo>-</mo>
<mi>a</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>Y</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>Z</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>2</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>=</mo>
<msup>
<msub>
<mi>d</mi>
<mn>2</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msup>
<mi>X</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>Y</mi>
<mo>-</mo>
<mi>b</mi>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mrow>
<mo>(</mo>
<mi>Z</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mn>3</mn>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>=</mo>
<msup>
<msub>
<mi>d</mi>
<mn>3</mn>
</msub>
<mn>2</mn>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
即通过式(1)计算，即可得到某一移动信标在全局坐标内的当前位置坐标(X,Y,Z)；
步骤4、构建基于超声波信标的室内全局定位***，用以获取各移动机器人的实时位姿；
1)部署室内全局定位***：将固定信标安装在四个顶角位置，选择其中两个固定信标作为坐标系基准建立三维坐标系，移动信标分别安装在每个移动机器人上，移动信标与移动机器人控制器均采用串口通讯连接方式；定位基站控制器实时计算各移动机器人的位置坐标信息，并结合偏角信息以位姿数据包的形式下传至对应的移动信标；
2)移动机器人解析位姿数据包：移动机器人通过串口通讯方式读取移动信标接收到的位姿数据包，采用奇偶校验位进行判断，并判断校验位是否正确，当校验位为1则为正确，校验位为0则为错误，当校验位信息正确，则移动机器人将正确的位姿坐标信息存入处理器的缓存中，并进行字符串格式的数据类型转换为浮点型的位姿数据，并存入位姿数组中，如果校验位信息错误，将舍弃此次位姿坐标信息；
3)位姿数据依次存储：随着移动机器人的自主运动，其位置信息进行实时更新，通过定位基站控制器向各移动信标发送并解析位姿数据包后，位姿坐标信息遵循“先进先出”的顺序原则依次更新到移动机器人控制器的位姿坐标数组中；
步骤5：移动机器人的初始化
移动机器人的初始化主要包括：分配领航、跟随两种移动机器人角色，即任意选择一个机器人为领航机，其它均为跟随机器人，根据需求设定移动机器人编队需要保持的队形图案，配置领航机器人为发送数据状态，跟随机器人为接收数据状态；
设计移动机器人运动控制器，实现多机器人编队作业任务，详细步骤如下：
1)根据移动机器人车体结构及驱动方式，建立移动机器人运动学模型，并依此构建多移动机器人编队的运动学模型；
2)基于上述超声波信标的室内全局定位方法，实时获取领航机器人和跟随机器人的当前位姿；再根据预设的多机编队队形几何信息，计算出各跟随机器人当前时刻的理想位姿，将跟随机器人任意放置，然后，跟随机器人依据各自的理想位姿和实际位姿，计算得到各跟随机器人的跟踪位姿误差；最后，运用控制方法，设计运动控制器使跟随机器人的跟踪位姿误差满足精度要求，依此控制跟随机器人的跟踪位姿误差满足精度要求，从而实现基于领航跟随型的多机编队作业任务。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711125796.3A CN107992035A (zh) | 2017-11-15 | 2017-11-15 | 一种基于室内全局定位的多移动机器人编队控制方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201711125796.3A CN107992035A (zh) | 2017-11-15 | 2017-11-15 | 一种基于室内全局定位的多移动机器人编队控制方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN107992035A true CN107992035A (zh) | 2018-05-04 |
Family
ID=62031457
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201711125796.3A Pending CN107992035A (zh) | 2017-11-15 | 2017-11-15 | 一种基于室内全局定位的多移动机器人编队控制方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN107992035A (zh) |
Cited By (16)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108507580A (zh) * | 2018-06-19 | 2018-09-07 | 南昌大学 | 一种移动机器人平台自定位***及自定位方法 |
| CN109282817A (zh) * | 2018-10-16 | 2019-01-29 | 中山大学 | 一种多机器人协同定位与控制方法 |
| CN109298714A (zh) * | 2018-11-09 | 2019-02-01 | 浙江国自机器人技术有限公司 | 机器人移动控制方法、***、设备及计算机可读存储介质 |
| CN109828580A (zh) * | 2019-02-27 | 2019-05-31 | 华南理工大学 | 一种基于分离式超声波的移动机器人编队跟踪控制方法 |
| CN110133597A (zh) * | 2019-06-04 | 2019-08-16 | 南开大学 | 一种基于超声波信标***的融合定位方法及*** |
| CN110147101A (zh) * | 2019-05-13 | 2019-08-20 | 中山大学 | 一种基于深度强化学习的端到端分布式多机器人编队导航方法 |
| CN110398975A (zh) * | 2019-09-04 | 2019-11-01 | 西北工业大学 | 一种基于广播式通信架构的领航跟随型多机编队容错控制方法 |
| CN111077901A (zh) * | 2019-12-04 | 2020-04-28 | 淮阴工学院 | 基于一致性的多翼伞编队协同控制方法和控制*** |
| CN111207754A (zh) * | 2020-02-28 | 2020-05-29 | 上海交通大学 | 基于粒子滤波器的多机器人编队定位方法及机器人设备 |
| CN111666215A (zh) * | 2020-06-04 | 2020-09-15 | 清华大学 | 用于分布式算法测试和人机交互研究的桌面集群硬件平台 |
| CN112388634A (zh) * | 2020-10-30 | 2021-02-23 | 北京京东乾石科技有限公司 | 协同搬运*** |
| CN112596420A (zh) * | 2020-11-24 | 2021-04-02 | 江苏科技大学 | 一种仿生爬行机器人及其自主控制方法 |
| CN113168179A (zh) * | 2018-11-19 | 2021-07-23 | 莫比奥工业机器人有限公司 | 检测自主设备的位置 |
| CN113203986A (zh) * | 2021-03-30 | 2021-08-03 | 南京信息工程大学 | 机器人集群编队定位方法及定位*** |
| CN115202349A (zh) * | 2022-07-14 | 2022-10-18 | 广州大学 | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 |
| CN115202349B (zh) * | 2022-07-14 | 2024-07-05 | 广州大学 | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 |
Citations (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0854926A (ja) * | 1994-08-08 | 1996-02-27 | Toshiba Corp | 自律移動ロボットの誘導装置 |
| WO2007130526A2 (en) * | 2006-05-02 | 2007-11-15 | U-Systems, Inc. | Ultrasound scanning and ultrasound- assisted biopsy |
| KR20090128631A (ko) * | 2008-06-11 | 2009-12-16 | 주식회사 한울로보틱스 | 지능로봇실습키트 및 지능로봇을 이용한 지능로봇교육시스템 |
| CN102096415A (zh) * | 2010-12-31 | 2011-06-15 | 重庆邮电大学 | 基于Ad-Hoc网络和leader-follower算法的多机器人编队方法 |
| CN102662377A (zh) * | 2012-05-17 | 2012-09-12 | 哈尔滨工业大学 | 基于无线传感器网络的多移动机器人编队***和编队方法 |
| CN103901889A (zh) * | 2014-03-27 | 2014-07-02 | 浙江大学 | 一种基于蓝牙通信的多机器人编队控制路径跟踪方法 |
| CN104898090A (zh) * | 2014-03-03 | 2015-09-09 | 罗斯蒙特公司 | 室内定位*** |
| CN104898656A (zh) * | 2014-03-06 | 2015-09-09 | 西北农林科技大学 | 一种基于立体视觉的农田多机器人跟随耕地***及方法 |
| CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
| CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
| CN106405492A (zh) * | 2016-08-31 | 2017-02-15 | 广西科技大学 | 基于声波和无线定位的移动目标检测方法 |
| CN106405502A (zh) * | 2016-08-31 | 2017-02-15 | 广西科技大学 | 基于声波和无线定位的移动目标检测方法 |
| CN106502250A (zh) * | 2016-11-23 | 2017-03-15 | 北京邮电大学 | 三维空间内多机器人编队的路径规划算法 |
| CN107336251A (zh) * | 2016-09-20 | 2017-11-10 | 苏州小璐机器人有限公司 | 一种机器人队列的控制方法及*** |
-
2017
- 2017-11-15 CN CN201711125796.3A patent/CN107992035A/zh active Pending
Patent Citations (14)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH0854926A (ja) * | 1994-08-08 | 1996-02-27 | Toshiba Corp | 自律移動ロボットの誘導装置 |
| WO2007130526A2 (en) * | 2006-05-02 | 2007-11-15 | U-Systems, Inc. | Ultrasound scanning and ultrasound- assisted biopsy |
| KR20090128631A (ko) * | 2008-06-11 | 2009-12-16 | 주식회사 한울로보틱스 | 지능로봇실습키트 및 지능로봇을 이용한 지능로봇교육시스템 |
| CN102096415A (zh) * | 2010-12-31 | 2011-06-15 | 重庆邮电大学 | 基于Ad-Hoc网络和leader-follower算法的多机器人编队方法 |
| CN102662377A (zh) * | 2012-05-17 | 2012-09-12 | 哈尔滨工业大学 | 基于无线传感器网络的多移动机器人编队***和编队方法 |
| CN104898090A (zh) * | 2014-03-03 | 2015-09-09 | 罗斯蒙特公司 | 室内定位*** |
| CN104898656A (zh) * | 2014-03-06 | 2015-09-09 | 西北农林科技大学 | 一种基于立体视觉的农田多机器人跟随耕地***及方法 |
| CN103901889A (zh) * | 2014-03-27 | 2014-07-02 | 浙江大学 | 一种基于蓝牙通信的多机器人编队控制路径跟踪方法 |
| CN105527960A (zh) * | 2015-12-18 | 2016-04-27 | 燕山大学 | 一种基于领航跟随的移动机器人编队控制方法 |
| CN105607636A (zh) * | 2016-01-21 | 2016-05-25 | 浙江工业大学 | 一种基于积分滑模算法的轮式移动机器人主从式编队控制方法 |
| CN106405492A (zh) * | 2016-08-31 | 2017-02-15 | 广西科技大学 | 基于声波和无线定位的移动目标检测方法 |
| CN106405502A (zh) * | 2016-08-31 | 2017-02-15 | 广西科技大学 | 基于声波和无线定位的移动目标检测方法 |
| CN107336251A (zh) * | 2016-09-20 | 2017-11-10 | 苏州小璐机器人有限公司 | 一种机器人队列的控制方法及*** |
| CN106502250A (zh) * | 2016-11-23 | 2017-03-15 | 北京邮电大学 | 三维空间内多机器人编队的路径规划算法 |
Non-Patent Citations (1)
| Title |
|---|
| 李娟，等: "基于CC1101射频技术的室内超声定位***", 《控制***》 * |
Cited By (18)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN108507580A (zh) * | 2018-06-19 | 2018-09-07 | 南昌大学 | 一种移动机器人平台自定位***及自定位方法 |
| CN109282817A (zh) * | 2018-10-16 | 2019-01-29 | 中山大学 | 一种多机器人协同定位与控制方法 |
| CN109282817B (zh) * | 2018-10-16 | 2022-04-12 | 中山大学 | 一种多机器人协同定位与控制方法 |
| CN109298714A (zh) * | 2018-11-09 | 2019-02-01 | 浙江国自机器人技术有限公司 | 机器人移动控制方法、***、设备及计算机可读存储介质 |
| CN113168179A (zh) * | 2018-11-19 | 2021-07-23 | 莫比奥工业机器人有限公司 | 检测自主设备的位置 |
| CN109828580A (zh) * | 2019-02-27 | 2019-05-31 | 华南理工大学 | 一种基于分离式超声波的移动机器人编队跟踪控制方法 |
| CN109828580B (zh) * | 2019-02-27 | 2022-05-24 | 华南理工大学 | 一种基于分离式超声波的移动机器人编队跟踪控制方法 |
| CN110147101A (zh) * | 2019-05-13 | 2019-08-20 | 中山大学 | 一种基于深度强化学习的端到端分布式多机器人编队导航方法 |
| CN110133597A (zh) * | 2019-06-04 | 2019-08-16 | 南开大学 | 一种基于超声波信标***的融合定位方法及*** |
| CN110398975A (zh) * | 2019-09-04 | 2019-11-01 | 西北工业大学 | 一种基于广播式通信架构的领航跟随型多机编队容错控制方法 |
| CN111077901A (zh) * | 2019-12-04 | 2020-04-28 | 淮阴工学院 | 基于一致性的多翼伞编队协同控制方法和控制*** |
| CN111207754A (zh) * | 2020-02-28 | 2020-05-29 | 上海交通大学 | 基于粒子滤波器的多机器人编队定位方法及机器人设备 |
| CN111666215A (zh) * | 2020-06-04 | 2020-09-15 | 清华大学 | 用于分布式算法测试和人机交互研究的桌面集群硬件平台 |
| CN112388634A (zh) * | 2020-10-30 | 2021-02-23 | 北京京东乾石科技有限公司 | 协同搬运*** |
| CN112596420A (zh) * | 2020-11-24 | 2021-04-02 | 江苏科技大学 | 一种仿生爬行机器人及其自主控制方法 |
| CN113203986A (zh) * | 2021-03-30 | 2021-08-03 | 南京信息工程大学 | 机器人集群编队定位方法及定位*** |
| CN115202349A (zh) * | 2022-07-14 | 2022-10-18 | 广州大学 | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 |
| CN115202349B (zh) * | 2022-07-14 | 2024-07-05 | 广州大学 | 基于通信干扰的多移动机器人协同编队控制方法、装置、设备及存储介质 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN107992035A (zh) | 一种基于室内全局定位的多移动机器人编队控制方法 | |
| JP6377169B2 (ja) | Ｕａｖの位置を推定するシステム及び方法 | |
| CN108521670B (zh) | 面向多机紧密编队飞行基于uwb通信与定位方法及一体化*** | |
| Johnson et al. | Mobile emulab: A robotic wireless and sensor network testbed | |
| CN102869090B (zh) | 一种基于auv协助的水下无线传感器网络定位方法 | |
| CN108919825A (zh) | 具备避障功能的无人机室内定位***及方法 | |
| Liu et al. | HAWK: An unmanned mini-helicopter-based aerial wireless kit for localization | |
| CN206649345U (zh) | 一种基于超宽带通信的无人机导航装置 | |
| CN107765220A (zh) | 基于uwb和激光雷达混合定位的行人跟随***及方法 | |
| CN105022394B (zh) | 动态环境下的移动机器人可靠定位方法 | |
| Piao et al. | Automating CSI measurement with UAVs: From problem formulation to energy-optimal solution | |
| CN106525044B (zh) | 基于船体结构图的大型舰艇的人员定位导航***及其方法 | |
| CN108844543A (zh) | 基于uwb定位及航位推算的室内agv导航控制方法 | |
| CN107271951A (zh) | 基于WiFi指纹定位的无人机导航***及其导航方法 | |
| CN105353341A (zh) | 一种基于无人自主飞行器的无线传感器网络定位方法 | |
| Rullán-Lara et al. | Real-time localization of an UAV using Kalman filter and a Wireless Sensor Network | |
| De Silva et al. | Development of a relative localization scheme for ground-aerial multi-robot systems | |
| Sorbelli et al. | Measurement errors in range-based localization algorithms for UAVs: Analysis and experimentation | |
| CN109669173A (zh) | 一种基于无人机和信号相对强弱的地面目标定位方法 | |
| CN107197498A (zh) | 一种用于通信中继的无人机拓扑生成方法 | |
| CN111487587A (zh) | 一种基于超带宽定位的危岩崩塌灾害变形监测方法及*** | |
| CN108919297A (zh) | 一种无人机室内定位***及方法 | |
| CN207798960U (zh) | 大型外场天线测试*** | |
| JP2019007964A (ja) | Ｕａｖの位置を推定するシステム及び方法 | |
| Zhou et al. | RSSI-based mobile robot navigation in grid-pattern wireless sensor network |
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: 20180504 |