基于uwb的自主跟随机器人定位方法及系统的制作方法
【专利摘要】本发明涉及一种基于UWB的自主跟随机器人定位方法及系统，特定目标为可自由移动的人或者物；所述移动机器人上固定至少三个位置成三角形态的UWB基站，所述自由移动的人或物上放置UWB定位标签；所述的基站发送UWB信号；所述的标签接收从基站发来的UWB信号；标签与基站时间同步，利用TOA算法获得基站与标签间的距离，然后通过几何运算获得标签的坐标，确定自由移动的人或物相对于移动机器人的位置和运动信息，实现移动机器人对人或物的跟随。本发明使用UWB无线定位技术实现自主跟随机器人定位，采用窄带脉冲进行通信，不需要载波，传输功率高，功耗小，抗干扰能力和穿透能力强，提高了定位的精度和准确性，从而实现特定目标的跟随。
【专利说明】
基于UWB的自主跟随机器人定位方法及系统
技术领域
[0001] 本发明设及一种移动机器人定位领域的自主跟随机器人定位系统，具体地说，是 一种相对定位技术和机器人跟随方法。
【背景技术】
[0002] 随着工业和科学技术的发展，移动机器人的研究和发展非常迅速，并逐渐进入人 们的日常生活。目前服务机器人的一个典型技术是机器人跟踪，它能识别特定目标并跟随 其运动，同时具有一定的人机交互功能。目前自主跟随机器人的技术难点之一就是机器人 与目标之间的相对定位。通过机器人与特定目标的相对位置信息，规划自身运动。
[0003] 现有的定位技术有GPS，超声波定位技术，蓝牙技术，红外线技术，射频识别技术， 无线局域网络等。其中，GPS是目前应用最广泛的室外定位技术。然而GI^信号在经过建筑的 遮挡后衰落较严重，多径干扰严重，不适合在室内定位;其他UWB的类似定位技术，例如超声 波定位系统定位精度虽然较高，适用于室内定位，但超声波受多径效应和非视距传播影响 很大，同时需要大量的底层硬件设施投资，成本太高。利用蓝牙、RFID和红外技术组成的网 络进行定位时，传输数据速率低，因此传输距离短，定位精度也比较低。
【发明内容】
[0004] 本发明的目的是针对现有技术的不足，提供一种结构简单，抗干扰能力和穿透能 力强，准确性高的基于UWB的自主跟随机器人定位方法及系统。
[0005] 为实现上述目的，本发明采取的技术方案是:一种基于UWB的自主跟随机器人定位 系统，包括移动机器人、特定目标、UWB基站和标签，所述的特定目标为可自由移动的人或者 物;所述移动机器人上固定至少=个位置成=角形态的UWB基站，所述自由移动的人或物上 放置UWB定位标签;所述的基站发送UWB信号;所述的标签接收从基站发来的UWB信号;标签 与基站时间同步，利用TOA算法获得基站与标签间的距离，然后通过几何运算获得标签的坐 标，确定自由移动的人或物相对于移动机器人的位置和运动信息，实现移动机器人对自由 移动的人或物的跟随。
[0006] 所述的UWB基站为=个，=个UWB基站(3)在移动机器人（1)身上按等边=角形的= 个顶点位置摆放。
[0007] 所述的UWB标签穿戴于自由移动的人的手腕或腰间、或挂戴于脖子上。
[000引一种基于UWB的自主跟随机器人定位方法，包括UWB基站发射UWB信号，UWB定位标 签接收UWB信号并进行定位解算;所述接收端解算方法具体步骤如下：
[0009] 步骤1，UWB基站定时发送UWB信号，UWB定位标签接收信号，且标签与基站时间同 步，利用TOA算法，根据UWB信号在UWB基站和UWB定位标签之间的传播时间t，由d = c*t，C为 光速，得到S个UWB基站分别于UWB定位标签的距离AM，BM，CM为dl，d2，d3，根据已知的AB， BC，AC的距离W及AM，BM，CM的距离可W确定一个交点，运个交点是分别WA，B，C为圆屯、，d 1， d2，d3为半径的=个球体的交点，该交点就是标签所在的位置；
[0010] 定义S个UWB基站位置距离AB，BC，AC均为a;定义BC边上的高所在延长线为y轴，y 轴正向与机器人自身的方向一致;S个UWB基站构成的等边S角形的边AB的中点为0(0,0， 0)，标签的坐标为M(x，y，z)，其中Z为标签到基站所在水平面的高度;等边=角形的中屯、为 H;
[0011] 步骤2,根据=个UWB基站到UWB定位标签的距离，通过解析几何算出：标签M在等边 S角形所在平面的投影M'点到等边S角形中屯、的距离：
[0012]
[0013] 标签M在等边S角形所在平面的投影r点与等边S角形的中屯、H点的连线，即M'H 与y轴的夹巧邮方仿巧：
[0014]
[0015] 由上述步骤得到的化，0)即可确定特定目标具体所在位置信息，W及根据下一个 时刻化，e)可W获得特定目标的运动信息，包括速度和方向角，所得位置误差范围在±10cm W内，在误差范围内移动机器人根据位置信息确定自由移动的人或物的位置;并根据每一 时刻移动机器人获得的自由移动的人或物的位置和运动信息，对自由移动的人或物进行实 时跟随，即移动机器人可实现对自由移动的人或物的跟随任务。
[0016] 本发明的有益效果是:本发明采用UWB技术进行自主跟随机器人的定位，能在低功 率消耗的情况下实现高精度定位，增加了可靠信，并且能将通信与定位合二为一;使用=个 基站作为信号发射端，能有效的确定出特定目标的位置，误差小;=个基站相对位置固定， 只需要测出UWB信号从基站到标签的传送时间，即可确定出目标的相对位置，计算简单;通 过实时定位目标的位置，可实现机器人对人的跟随，操作方便;硬件实现简单，降低了成本， 提高了定位精度，有效的解决了多径干扰的问题;可同时准确实现室内定位和室外定位。
【附图说明】
[0017] 图1是本发明的基于UWB的自主跟随机器人定位系统示意图；
[0018] 图2是本发明的基于UWB的自主跟随机器人定位系统及方法几何原理图。
[0019] 图中：1.移动机器人，2. S个UWB基站形成的等边S角形，3. UWB基站，4.特定目标， 5. UWB定位标签。
【具体实施方式】
[0020] 下面结合附图本发明的进一步说明。
[00別]请参照图1，本发明的一种基于UWB的自主跟随机器人定位系统，UWB(Ultra Wideband)是一种无载波通信技术。该系统包括:移动机器人1，UWB基站3,特定目标4, UWB定 位标签5;所述的特定目标4为可自由移动的人或物;所述的UWB基站3共有=个;所述的UWB 定位标签5穿戴于自由移动的人或物身上，为可穿戴设备，比如穿戴于人的手腕，腰间或挂 戴于脖子上等等。所述移动机器人1上固定至少=个UWB基站3，=个UWB基站3形成的等边= 角形2，所述自由移动的人或物上放置UWB定位标签5;所述的UWB基站3发送UWB信号;所述的 UWB定位标签5接收从基站发来的UWB信号;UWB定位标签5与UWB基站3时间同步，利用TOA算 法获得基站与标签间的距离，然后通过几何运算获得标签的坐标，确定自由移动的人或物 相对于移动机器人I的位置和运动信息，实现移动机器人I对自由移动的人或物的跟随。
[0022] 请参照图2,图2是本发明的一种自主跟随机器人的定位系统及方法几何原理图。 其S个UWB基站分别标记为A，B，C，UWB定位标签标记为M，UWB定位标签在UWB基站所在平面 的投影标记为M'，S个UWB基站相互之间的距离AB，BC ,AC均标记为a。根据UWB信号在UWB基 站和UWB定位标签之间的传播时间和传播速度可W得到=个UWB基站分别于UWB定位标签的 距离 41，81，〔1为(11，(12，(13。
[0023] 本发明的一种基于UWB的自主跟随机器人定位方法，该方法包括基站发射UWB信 号，UWB定位标签接收UWB信号并进行定位解算。
[0024] 所述接收端解算方法具体步骤如下：
[0025] 步骤1，UWB基站定时发送UWB信号，UWB定位标签接收信号，且标签与基站时间同 步，利用TOAUime Of arrival)算法，根据UWB信号在UWB基站和UWB定位标签之间的传播时 间t，由d = c*t，k为光速），得到S个UWB基站分别于UWB定位标签的距离AM，BM，CM为dl，d2， d3，根据已知的AB，BC，AC的距离W及AM，BM，CM的距离可W确定一个交点，运个交点是分别 WA，B，C为圆屯、，dl，d2，d3为半径的=个球体的交点，该交点就是UWB定位标签所在的位置； [00%]定义S个UWB基站位置距离AB，BC，AC均为a;定义BC边上的高所在延长线为y轴，y 轴正向与机器人自身的方向一致;S个UWB基站构成的等边S角形的边AB的中点为0(0,0， 0 )，UWB定位标签的坐标为M( X，y，Z )，其中Z为UWB定位标签到UWB基站所在水平面的高度;等 边S角形的中屯、为H;
[0027]步骤2，根据=个UWB基站到UWB定位标签的距离，通过解析几何可W算出：
[002引标络M#望巧二佑化所#平而的巧影M'点幸Il望巧二佑化中如的阳离：
[0029]
[0030] 标签M在等边S角形所在平面的投影r点与等边S角形的中屯、H点的连线，即M'H 与y轴的赛值即节仿值.
[0031]
[0032] 由上述步骤得到的化，0)即可确定特定目标具体所在位置信息，W及根据下一个 时刻化，e)可W获得特定目标的运动信息，包括速度和方向角，所得位置误差范围在±10cm W内，位置和运动信息是基于机器人和特定目标直接计算，不存在累积误差。由于计算过程 中将自由移动的人或物作为一个质点，而实际中自由移动的人具有一定的体积，故在误差 范围内移动机器人能根据位置信息确定人或物的位置。根据每一时刻移动机器人获得的自 由移动的人或物的位置和运动信息，对自由移动的人或物进行实时跟随，即移动机器人可 实现对自由移动的人或物的跟随任务。
【主权项】
1. 一种基于UWB的自主跟随机器人定位系统，包括移动机器人（1)、特定目标、UWB基站 (3)和UWB定位标签(5 )，所述的特定目标(4)为自由移动的人或者物，其特征在于:所述移动 机器人（1)上固定至少三个位置成三角形态的UWB基站（3)，所述自由移动的人或物上放置 UWB定位标签(5);所述的UWB基站（3)发送UWB信号；所述的UWB定位标签(5)接收从UWB基站 (3)发来的UWB信号;UWB定位标签(5)与UWB基站⑶时间同步，利用TOA算法获得基站与标签 间的距离，然后通过几何运算获得标签的坐标，确定自由移动的人或物相对于移动机器(1) 人的位置和运动信息，实现移动机器人(1)对自由移动的人或物的跟随。2. 根据权利要求1所述的基于UWB的自主跟随机器人定位系统，其特征在于:所述的UWB 基站（3)为三个，三个UWB基站（3)在移动机器人（1)身上按等边三角形的三个顶点位置摆 放。3. 根据权利要求1所述的基于UWB的自主跟随机器人定位系统，其特征在于:所述的UWB 标签穿（5)戴于自由移动的人的手腕或腰间、或挂戴于脖子上。4. 一种基于UWB的自主跟随机器人定位方法，包括UWB基站发射UWB信号，UWB定位标签 接收UWB信号并进行定位解算;所述接收端解算方法具体步骤如下： 步骤1，UWB基站定时发送UWB信号，UWB定位标签接收信号，且标签与基站时间同步，利 用TOA算法，根据UWB信号在基站和标签之间的传播时间t，由d = c*t，c为光速，得到三个UWB 基站分别于UWB定位标签的距离AM，BM，CM为d 1，d2，d3，根据已知的AB，BC，AC的距离以及AM， BM，CM的距离可以确定一个交点，这个交点是分别以A，B，C为圆心，dl，d2，d3为半径的三个 球体的交点，该交点就是UWB定位标签所在的位置； 定义三个UWB基站位置距离AB，BC，AC均为a;定义BC边上的高所在延长线为y轴，y轴正 向与机器人自身的方向一致;三个UWB基站构成的等边三角形的边AB的中点为0(0，0，0 )，标 签的坐标为M(x，y，z)，其中z为标签到基站所在水平面的高度;等边三角形的中心为H; 步骤2，根据三个UWB基站到UWB定位标签的距离，通过解析几何算出：标签Μ在等边三角 形所在平面的投影Μ'点到等边三角形中心的距离：标签Μ在等边三角形所在平面的投影Μ'点与等边三角形的中心Η点的连线，即Μ'Η与y轴 的夹角即方位角：由上述步骤得到的（L，Θ)即可确定特定目标具体所在位置信息，以及根据下一个时刻 (L，0)可以获得特定目标的运动信息，包括速度和方向角，所得位置误差范围在± l〇cm以 内，在误差范围内移动机器人根据位置信息确定自由移动的人或物的位置;并根据每一时 刻移动机器人获得的自由移动的人或物的位置和运动信息，对自由移动的人或物进行实时 跟随，即移动机器人可实现对自由移动的人或物的跟随任务。
【文档编号】H04W4/00GK105828431SQ201610259595
【公开日】2016年8月3日
【申请日】2016年4月25日
【发明人】方晨晨, 邵翔, 王永雄, 饶林
【申请人】上海理工大学