CN109212470A - 一种基于uwb阵列模块的位姿估计方法、***及机器人 - Google Patents
一种基于uwb阵列模块的位姿估计方法、***及机器人 Download PDFInfo
- Publication number
- CN109212470A CN109212470A CN201710520431.4A CN201710520431A CN109212470A CN 109212470 A CN109212470 A CN 109212470A CN 201710520431 A CN201710520431 A CN 201710520431A CN 109212470 A CN109212470 A CN 109212470A
- Authority
- CN
- China
- Prior art keywords
- uwb
- label
- base station
- distance value
- towards angle
- 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 46
- 238000004891 communication Methods 0.000 claims description 11
- 238000005516 engineering process Methods 0.000 description 14
- 230000006870 function Effects 0.000 description 6
- 230000008569 process Effects 0.000 description 5
- 230000033001 locomotion Effects 0.000 description 4
- 230000008447 perception Effects 0.000 description 4
- 230000008901 benefit Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000001228 spectrum Methods 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 230000008878 coupling Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000004807 localization Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 238000005562 fading Methods 0.000 description 1
- JEIPFZHSYJVQDO-UHFFFAOYSA-N ferric oxide Chemical compound O=[Fe]O[Fe]=O JEIPFZHSYJVQDO-UHFFFAOYSA-N 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000005192 partition Methods 0.000 description 1
- 230000011514 reflex Effects 0.000 description 1
- 238000000926 separation method Methods 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 230000009131 signaling function Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
- 230000000007 visual effect Effects 0.000 description 1
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/0247—Determining attitude
-
- 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/04—Position of source determined by a plurality of spaced direction-finders
-
- 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/08—Position of single direction-finder fixed by determining direction of a plurality of spaced sources of known location
-
- 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/12—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 by co-ordinating position lines of different shape, e.g. hyperbolic, circular, elliptical or radial
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明实施例公开了一种基于UWB阵列模块的位姿估计方法、***及机器人,将UWB阵列模块布设于机器人本体,对于单UWB基站,实现机器人与该基站的距离和角度方位的估算;对于固定多UWB基站,实现机器人自身在地图中坐标稳健定位以及自身朝向位姿的稳健估算;对于多基站(基站距离固定)可移动单元,实现估算该可移动单元的朝向位姿的估算。
Description
技术领域
本发明涉及机器人定位及位姿估计技术领域,特别涉及一种基于UWB阵列模块的位姿估计方法、***及机器人。
背景技术
目前,室内移动机器人的路径控制主要是磁导航、激光导航和视觉导航等方式。磁带导航需要在作业现场铺设磁条引导机器人行进,其不足之处是:(1)灵活性不足,路径若有变更需要重新铺设磁条;(2)对于多机器人的复杂路径或交叉路径,磁条引导方式较难实现。激光引导方式需要机器人配置较高性能的激光导航部件,成本较高。视觉导航方式主要基于图像背景的匹配定位原理,存在以下不足:(1)位置精度位差较大;(2)当作业环境的改变时需要重新布置图像背景;(3)光线变化(如逆光)对于匹配定位影响较大。
针对机器人的路径规划和定位功能需求,无线定位方式从不同角度弥补了上述不足之处。目前的无线定位技术包括WIFI、RFID和蓝牙等,但这几种定位方式的精度均为米级水平,限制了这些技术在室内环境中的应用。
UWB(Ultra Wideband)技术是一种利用亚纳秒级超窄脉冲的无载波通信技术,相对于上述无线定位技术UWB技术具有通信距离远、高数据传输速率、抗干扰能力强、功耗小等优势,在实际应用中能控制误差在30cm内,相对其他定位技术使用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基站,所述第二UWB子模块包括第二UWB基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
可选地,所述外部UWB基站具有一个,所述第一UWB标签和所述第二UWB标签通过AoA方法或者TDOA方法估算出所述外部UWB基站相对所述第一UWB标签和所述第二UWB标签中心的距离值以及所述第一UWB标签和所述第二UWB标签连线的角度值。
可选地,所述外部UWB基站具有两个或两个以上,所述第一UWB标签和所述第二UWB标签通过AoA或者TDOA方法分别估算出所述第一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标签用于与所述外部UWB基站通过到达角度测距法或这到达时间差法计算第一距离值、第二距离值、第一朝向角度以及第二朝向角度值,根据第一距离值、第二距离值、第一朝向角度以及第二朝向角度值确定UWB阵列模块的姿态数据,其中,所述第一距离值为所述第一UWB标签与所述外部UWB基站的距离值,所述第二距离值为所述第二UWB标签与所述外部UWB基站的距离值,所述第一朝向角度值为所述第一UWB标签与所述外部UWB基站的朝向角度值,所述第二朝向角度值为所述第二UWB标签与所述外部UWB基站的朝向角度值。
可选地,所述第一UWB子模块包括第一UWB基站,所述第二UWB子模块包括第二UWB基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
从以上技术方案可以看出,本发明实施例具有以下优点:
本发明提出在将UWB阵列模块布设于机器人本体,对于单UWB基站,实现机器人与该基站的距离和角度方位的估算;对于固定多UWB基站,实现机器人自身在地图中坐标稳健定位以及自身朝向位姿的稳健估算;对于多基站(基站距离固定)可移动单元,实现估算该可移动单元的朝向位姿的估算。
附图说明
图1是本发明实施例中的基于UWB阵列模块的位姿估计***的结构框图。
具体实施方式
为了使本技术领域的人员更好地理解本发明方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分的实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”、“第三”、“第四”等(如果存在)是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。应该理解这样使用的数据在适当情况下可以互换,以便这里描述的实施例能够以除了在这里图示或描述的内容以外的顺序实施。此外,术语“包括”和“具有”以及他们的任何变形,意图在于覆盖不排他的包含,例如,包含了一系列步骤或单元的过程、方法、***、产品或设备不必限于清楚地列出的那些步骤或单元,而是可包括没有清楚地列出的或对于这些过程、方法、产品或设备固有的其它步骤或单元。
结合图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基站,所述第二UWB子模块包括第二UWB基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
可选地,所述外部UWB基站具有一个,所述第一UWB标签和所述第二UWB标签通过AoA方法或者TDOA方法估算出所述外部UWB基站相对所述第一UWB标签和所述第二UWB标签中心的距离值以及所述第一UWB标签和所述第二UWB标签连线的角度值。
可选地,所述外部UWB基站具有两个或两个以上,所述第一UWB标签和所述第二UWB标签通过AoA或者TDOA方法分别估算出所述第一UWB标签和所述第二UWB标签的位置坐标,再推算出所述第一UWB标签和所述第二UWB标签的中点的坐标,以及推算出所述第一UWB标签和所述第二UWB标签的朝向角度。
可选地,所述UWB阵列模块分别位于两个机器人,分别第一机器人和第二机器人。
对于前文中提到的UWB定位方法,下面进行简单介绍:
一、接收信号强度定位法
接收信号强度定位法是通过信号强度和已知信号衰弱模型来估计接收点与待测点的距离,根据多个接收点距离待测点的距离值画出圆,多个圆的重叠部分就是待测物体。
在移动装置中,接收信号强度常用接收信号强度指标RSSI来表示,在理想环境中这种方式可以获得较为精确的定位。
二、到达时间定位法(Time Difference of Arrival到达时间差)
到达时间定位法和接收信号强度定位法类似,只不过计算接收点和测量点之间的距离是采用无线信号传播时间乘以无线信号传输速度。
三、接收信号角度定位法(Angle-of-Arrival:AOA)
接收信号角度定位法的工作原理:是利用定向天线量测出信号来源方向,多个接收点同时按照接收角度画出直线,直线的交点就是目标位置。
信号角度定位法的优点是:不需要每一个接收天线都做时间同步,误差来源主要是角度解析的误差。在距离越远的时候角度解析的误差影响越大;同时由于信号反射和折射,可能造成最终计算出来的被测点,是发射点而不是被测物体本身;由于定向天线的制作对测量角度的计算影响较大,在实际应用中会比较麻烦。
采用UWB进行定位具有***容量大,带宽增加使信道容量的提高远远大于信号功率上升所带来的效应,这一点也正是提出超宽带技术的理论机理。超宽带无线电***用户数量大大高于3G***;高速的数据传输,UWB***使用上吉赫兹的超宽频带,根据香农信道容量公式,即使把发送信号功率密度控制得很低,也可以实现高的信息速率。一般情况下,其最大数据传输速度可以达到几百兆比特每秒到吉比特每秒;多径分辨能力强,UWB由于其极高的工作频率和极低的占空比而具有很高的分辨率,窄脉冲的多径信号在时间上不易重叠,很容易分离出多径分量,所以能充分利用发射信号的能量。实验表明,对常规无线电信号多径衰落深达10~30dB的多径环境,UWB信号的衰落最多不到5dB;隐蔽性好,因为UWB的频谱非常宽,能量密度非常低,因此信息传输安全性高。另一方面,由于能量密度低,UWB设备对于其他设备的干扰就非常低;定位精确,冲激脉冲具有很高的定位精度,采用超宽带无线电通信,可在室内和地下进行精确定位,精度最高可达2厘米,一般精度在15厘米内。而GPS定位***只能工作在GPS定位卫星的可视范围之内。与GPS提供绝对地理位置不同,超短脉冲***可以给出相对位置,其定位精度可达厘米级;抗干扰能力强,UWB扩频处理增益主要取决于脉冲的占空比和发送每个比特所用的脉冲数。UWB的占空比一般为0.01~0.001,具有比其他扩频***高得多的处理增益,抗干扰能力强。一般来说,UWB抗干扰处理增益在50dB以上;低成本和低功耗,UWB无线通信***接收机没有本振、功放、锁相环(PLL)、压控振荡器(VCO)、混频器等,因而结构简单,设备成本将很低。由于UWB信号无需载波,而是使用间歇的脉冲来发送数据,脉冲持续时间很短,一般在0.20~1.5ns之间,有很低的占空因数,所以它只需要很低的电源功率。一般UWB***只需要50~70mW的电源,是蓝牙技术的十分之一。
无线UWB技术最基本的工作原理是发送和接收脉冲间隔严格受控的高斯单周期超短时脉冲,超短时单周期脉冲决定了信号的带宽很宽,接收机直接用一级前端交叉相关器就把脉冲序列转换成基带信号,省去了传统通信设备中的中频级,极大地降低了设备复杂性。
无线UWB技术采用脉冲位置调制PPM单周期脉冲来携带信息和信道编码,一般工作脉宽0.1-1.5ns(1纳秒=一亿分之一秒),重复周期在25-1000ns。
对应地,本发明提供一种基于UWB阵列模块的位姿估计方法,应用在如上项所述的基于UWB阵列模块的位姿估计***,所述方法包括:
S101、获取第一UWB标签与外部UWB基站的距离值;
S102、获取第二UWB标签与外部UWB基站的距离值;
S103、获取第一UWB标签与外部UWB基站的朝向角度值;
S104、获取第二UWB标签与外部UWB基站的朝向角度值;
S105根据第一距离值、第二距离值、第一朝向角度以及第二朝向角度值确定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基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
使用本发明中提出的UWB阵列模块,可以使用成本较低(相对激光传感器)的无线定位技术,实现精度较高的定位功能,同时还能估算出布设UWB阵列模块的机器人的位姿状态(即朝向角度)信息。便于对机器人进行后续的导航运动控制或跟随运动控制。对于布设有同样UWB阵列模块的多个机器人,可以进行机器人之间的位置和位姿状态感知,便于进行后续的协调工作控制。
当外界环境是单个UWB基站的应用场景时,可仅使用模块中的两个UWB标签T1和T2,通过AoA方法或者TDOA方法估算出该基站相对T1和T2中心的距离值以及T1和T2连线的角度值。
当外界环境是多个固定UWB基站的应用场景时,可仅使用模块中的两个UWB标签T1和T2,通过AoA或者TDOA方法分别估算出T1和T2的位置坐标,再推算出机器人中心即T1和T2的中点的坐标,以及推算出T1和T2的朝向角度。
当布设有同样UWB阵列模块AM的机器人A与机器人B同在一个环境中时,阵列模块AM-A和AM-B中的基站BS1-A、BS2-A、BS1-B、BS2-B和标签T1-A、T2-A、T1-B、T2-B可以全部使用,使用T1-A、T2-A通过AoA方法或者TDOA方法对BS1-B和BS2-B(即机器人B)的朝向角度值和距离值进行估算;同理使用T1-B和T2-B通过AoA方法或者TDOA方法对BS1-A和BS2-A(即机器人A)的朝向角度值和距离值进行估算,实现机器人之间距离及朝向的相互感知功能,便于进行协调工作。
使用本发明中提出的UWB阵列模块,可以使用成本较低(相对激光传感器)的无线定位技术,实现精度较高的定位功能,同时还能估算出布设UWB阵列模块的机器人的位姿状态(即朝向角度)信息。便于对机器人进行后续的导航运动控制或跟随运动控制。对于布设有同样UWB阵列模块的多个机器人,可以进行机器人之间的位置和位姿状态感知,便于进行后续的协调工作控制。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的***,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的***,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个***,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
本领域普通技术人员可以理解上述实施例的各种方法中的全部或部分步骤是可以通过程序来指令相关的硬件来完成,该程序可以存储于一计算机可读存储介质中,存储介质可以包括:只读存储器(ROM,Read Only Memory)、随机存取存储器(RAM,RandomAccess Memory)、磁盘或光盘等。
以上对本发明所提供的一种基于UWB阵列模块的位姿估计方法、***及机器人进行了详细介绍,对于本领域的一般技术人员,依据本发明实施例的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (8)
1.一种基于UWB阵列模块的位姿估计***,其特征在于,所述***包括UWB阵列模块及位于所述UWB阵列模块外部的外部UWB基站,所述UWB阵列模块包括第一UWB子模块、第二UWB子模块,所述第一UWB子模块包括第一UWB标签,所述第二UWB子模块包括第二UWB标签,所述第一UWB标签和所述第二UWB标签与所述外部UWB基站通过到达角度测距法或这到达时间差法计算第一距离值、第二距离值、第一朝向角度以及第二朝向角度值,根据第一距离值、第二距离值、第一朝向角度以及第二朝向角度值确定UWB阵列模块的姿态数据,其中,所述第一距离值为所述第一UWB标签与所述外部UWB基站的距离值,所述第二距离值为所述第二UWB标签与所述外部UWB基站的距离值,所述第一朝向角度值为所述第一UWB标签与所述外部UWB基站的朝向角度值,所述第二朝向角度值为所述第二UWB标签与所述外部UWB基站的朝向角度值。
2.根据权利要求1所述的***,其特征在于,所述第一UWB子模块包括第一UWB基站,所述第二UWB子模块包括第二UWB基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
3.根据权利要求1所述的***,其特征在于,所述外部UWB基站具有一个,所述第一UWB标签和所述第二UWB标签通过AoA方法或者TDOA方法估算出所述外部UWB基站相对所述第一UWB标签和所述第二UWB标签中心的距离值以及所述第一UWB标签和所述第二UWB标签连线的角度值。
4.根据权利要求1所述的***,其特征在于,所述外部UWB基站具有两个或两个以上,所述第一UWB标签和所述第二UWB标签通过AoA或者TDOA方法分别估算出所述第一UWB标签和所述第二UWB标签的位置坐标,再推算出所述第一UWB标签和所述第二UWB标签的中点的坐标,以及推算出所述第一UWB标签和所述第二UWB标签的朝向角度。
5.根据权利要求1所述的***,其特征在于,所述UWB阵列模块分别位于两个机器人,分别第一机器人和第二机器人。
6.一种基于UWB阵列模块的位姿估计方法,其特征在于,应用在如权利要求1至5中任一项所述的基于UWB阵列模块的位姿估计***,所述方法包括:
获取第一UWB标签与外部UWB基站的距离值;
获取第二UWB标签与外部UWB基站的距离值;
获取第一UWB标签与外部UWB基站的朝向角度值;
获取第二UWB标签与外部UWB基站的朝向角度值;
根据第一距离值、第二距离值、第一朝向角度以及第二朝向角度值确定UWB阵列模块的姿态数据。
7.一种机器人,其特征在于,所述机器人具有UWB阵列模块,所述UWB阵列模块包括第一UWB子模块、第二UWB子模块,所述第一UWB子模块包括第一UWB标签,所述第二UWB子模块包括第二UWB标签,所述第一UWB标签和所述第二UWB标签用于与所述外部UWB基站通过到达角度测距法或这到达时间差法计算第一距离值、第二距离值、第一朝向角度以及第二朝向角度值,根据第一距离值、第二距离值、第一朝向角度以及第二朝向角度值确定UWB阵列模块的姿态数据,其中,所述第一距离值为所述第一UWB标签与所述外部UWB基站的距离值,所述第二距离值为所述第二UWB标签与所述外部UWB基站的距离值,所述第一朝向角度值为所述第一UWB标签与所述外部UWB基站的朝向角度值,所述第二朝向角度值为所述第二UWB标签与所述外部UWB基站的朝向角度值。
8.根据权利要求7所述的机器人,其特征在于,所述第一UWB子模块包括第一UWB基站,所述第二UWB子模块包括第二UWB基站,所述外部UWB基站具有外部UWB标签,所述第一UWB基站、所述第二UWB基站与所述外部UWB标签进行通讯连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710520431.4A CN109212470A (zh) | 2017-06-30 | 2017-06-30 | 一种基于uwb阵列模块的位姿估计方法、***及机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710520431.4A CN109212470A (zh) | 2017-06-30 | 2017-06-30 | 一种基于uwb阵列模块的位姿估计方法、***及机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN109212470A true CN109212470A (zh) | 2019-01-15 |
Family
ID=64960815
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710520431.4A Pending CN109212470A (zh) | 2017-06-30 | 2017-06-30 | 一种基于uwb阵列模块的位姿估计方法、***及机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109212470A (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109883419A (zh) * | 2019-01-21 | 2019-06-14 | 深圳市普渡科技有限公司 | 机器人导航方法及*** |
CN109883420A (zh) * | 2019-01-21 | 2019-06-14 | 深圳市普渡科技有限公司 | 机器人位姿识别方法、***及机器人 |
CN110842934A (zh) * | 2019-11-05 | 2020-02-28 | 广东博智林机器人有限公司 | 补给机器人及补给*** |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101103281A (zh) * | 2005-01-22 | 2008-01-09 | 莱卡地球***公开股份有限公司 | 用于确定天线阵列的取向的方法 |
TW201224496A (en) * | 2010-12-06 | 2012-06-16 | Ind Tech Res Inst | Positioning method and positioning system using the same |
CN103002576A (zh) * | 2012-10-24 | 2013-03-27 | 中国海洋大学 | 一种基于脉冲幅度比值指纹的天线阵列单基站定位方法 |
CN103984971A (zh) * | 2014-05-31 | 2014-08-13 | 范志广 | 基于天线阵列相位差测向射频识别的无线定位方法及*** |
JP2015158444A (ja) * | 2014-02-25 | 2015-09-03 | アイシン・エィ・ダブリュ株式会社 | 車両姿勢判定システム、車両姿勢判定プログラム及び車両姿勢判定方法 |
CN105303346A (zh) * | 2015-10-20 | 2016-02-03 | 南京邮电大学 | 一种基于uwb的叉车防碰撞***和方法 |
CN105657668A (zh) * | 2016-03-16 | 2016-06-08 | 南通大学 | 一种基于uwb的室内移动机器人定位与导航控制方法 |
CN105891774A (zh) * | 2016-03-29 | 2016-08-24 | 北京九星智元科技有限公司 | 一种机器人小车动态跟踪定位***及方法 |
CN106093858A (zh) * | 2016-06-22 | 2016-11-09 | 山东大学 | 一种基于uwb、rfid、ins多源联合定位技术的定位***及定位方法 |
CN106569174A (zh) * | 2016-11-15 | 2017-04-19 | 深圳市中舟智能科技有限公司 | 一种多移动机器人室内无线定位*** |
US20170108576A1 (en) * | 2015-10-16 | 2017-04-20 | Leauto Intelligent Technology (BEIJING) Co., Ltd. | Method and device for determining the distance between vehicles in internet of vehicles |
CN106900057A (zh) * | 2017-04-26 | 2017-06-27 | 深圳市尧元科技有限公司 | 一种基于测距的室内定位方法及*** |
-
2017
- 2017-06-30 CN CN201710520431.4A patent/CN109212470A/zh active Pending
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101103281A (zh) * | 2005-01-22 | 2008-01-09 | 莱卡地球***公开股份有限公司 | 用于确定天线阵列的取向的方法 |
TW201224496A (en) * | 2010-12-06 | 2012-06-16 | Ind Tech Res Inst | Positioning method and positioning system using the same |
CN103002576A (zh) * | 2012-10-24 | 2013-03-27 | 中国海洋大学 | 一种基于脉冲幅度比值指纹的天线阵列单基站定位方法 |
JP2015158444A (ja) * | 2014-02-25 | 2015-09-03 | アイシン・エィ・ダブリュ株式会社 | 車両姿勢判定システム、車両姿勢判定プログラム及び車両姿勢判定方法 |
CN103984971A (zh) * | 2014-05-31 | 2014-08-13 | 范志广 | 基于天线阵列相位差测向射频识别的无线定位方法及*** |
US20170108576A1 (en) * | 2015-10-16 | 2017-04-20 | Leauto Intelligent Technology (BEIJING) Co., Ltd. | Method and device for determining the distance between vehicles in internet of vehicles |
CN105303346A (zh) * | 2015-10-20 | 2016-02-03 | 南京邮电大学 | 一种基于uwb的叉车防碰撞***和方法 |
CN105657668A (zh) * | 2016-03-16 | 2016-06-08 | 南通大学 | 一种基于uwb的室内移动机器人定位与导航控制方法 |
CN105891774A (zh) * | 2016-03-29 | 2016-08-24 | 北京九星智元科技有限公司 | 一种机器人小车动态跟踪定位***及方法 |
CN106093858A (zh) * | 2016-06-22 | 2016-11-09 | 山东大学 | 一种基于uwb、rfid、ins多源联合定位技术的定位***及定位方法 |
CN106569174A (zh) * | 2016-11-15 | 2017-04-19 | 深圳市中舟智能科技有限公司 | 一种多移动机器人室内无线定位*** |
CN106900057A (zh) * | 2017-04-26 | 2017-06-27 | 深圳市尧元科技有限公司 | 一种基于测距的室内定位方法及*** |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109883419A (zh) * | 2019-01-21 | 2019-06-14 | 深圳市普渡科技有限公司 | 机器人导航方法及*** |
CN109883420A (zh) * | 2019-01-21 | 2019-06-14 | 深圳市普渡科技有限公司 | 机器人位姿识别方法、***及机器人 |
CN110842934A (zh) * | 2019-11-05 | 2020-02-28 | 广东博智林机器人有限公司 | 补给机器人及补给*** |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Dotlic et al. | Angle of arrival estimation using decawave DW1000 integrated circuits | |
US11171685B2 (en) | System and method for pulse shaping interoperability for ultra wideband systems | |
Vossiek et al. | Wireless local positioning | |
Krishnan et al. | A UWB based localization system for indoor robot navigation | |
Pahlavan et al. | Indoor geolocation in the absence of direct path | |
US10708876B2 (en) | System and method for determining location information for a mobile radio transmitter | |
US8116350B1 (en) | Ultrawideband asynchronous tracking system and method | |
CN107566065A (zh) | 基于uwb的tof定位方法 | |
EP2494829B1 (en) | System for wireless locations estimation using radio transceivers with polarization diversity | |
JP2006080681A (ja) | 位置検出システムおよび位置検出方法 | |
US20130324150A1 (en) | Location estimation apparatus and method | |
CN106017479B (zh) | 室内移动目标的三维实时追踪方法及*** | |
CN109212470A (zh) | 一种基于uwb阵列模块的位姿估计方法、***及机器人 | |
CN105929364B (zh) | 利用无线电定位的相对位置测量方法及测量装置 | |
CN103874020A (zh) | 非直达径环境下单接收器的超宽带定位方法 | |
Kilani et al. | RSSI-based indoor tracking using the extended Kalman filter and circularly polarized antennas | |
CN108520640A (zh) | 基于超宽带的无人机导航方法、导航设备、无人机 | |
Kolakowski et al. | UWB localization in EIGER indoor/outdoor positioning system | |
CN104459675A (zh) | 一种基于测距的物体定位和跟踪方法及使用该方法的定位设备 | |
Martinelli et al. | Ultra-wide band positioning in sport: How the relative height between the transmitting and the receiving antenna affects the system performance | |
Polonelli et al. | Performance Comparison between Decawave DW1000 and DW3000 in low-power double side ranging applications | |
Hu et al. | Accuracy improvement of indoor real-time location tracking algorithm for smart supermarket based on ultra-wideband | |
Müller et al. | Outdoor ranging and positioning based on LoRa modulation | |
Hu et al. | Vehicle positioning based on UWB technology | |
CN112799014A (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20190115 |