CN113154989A - 一种uwb***的动态精度标定方法 - Google Patents

一种uwb***的动态精度标定方法 Download PDF

Info

Publication number
CN113154989A
CN113154989A CN202011564384.1A CN202011564384A CN113154989A CN 113154989 A CN113154989 A CN 113154989A CN 202011564384 A CN202011564384 A CN 202011564384A CN 113154989 A CN113154989 A CN 113154989A
Authority
CN
China
Prior art keywords
uwb
position information
industrial robot
tag
dynamic
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
Application number
CN202011564384.1A
Other languages
English (en)
Inventor
李广云
罗豪龙
王力
王安成
欧阳文
王鹏
李帅鑫
项学泳
李枭凯
高杨骏
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Information Engineering University of PLA Strategic Support Force
Original Assignee
Information Engineering University of PLA Strategic Support Force
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Information Engineering University of PLA Strategic Support Force filed Critical Information Engineering University of PLA Strategic Support Force
Priority to CN202011564384.1A priority Critical patent/CN113154989A/zh
Publication of CN113154989A publication Critical patent/CN113154989A/zh
Pending legal-status Critical Current

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B5/00—Measuring arrangements characterised by the use of mechanical techniques
    • G01B5/004—Measuring arrangements characterised by the use of mechanical techniques for measuring coordinates of points
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B5/00—Measuring arrangements characterised by the use of mechanical techniques
    • G01B5/0023—Measuring of sport goods, e.g. bowling accessories, golfclubs, game balls

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及一种UWB***的动态精度标定方法，属于精度标定技术领域。标定方法包括：将UWB标签固定在工业机器人的末端，测量得到UWB标签相对于工业机器人末端的距离；控制机器人按照预先规划好的轨迹运动，工业机器人记录UWB标签的运动轨迹，得到UWB标签的真实位置信息；同时通过UWB***监测UWB标签，得到UWB标签的观测位置信息；将真实位置信息和观测位置信息进行统一；在统一坐标系下，比较真实位置信息和观测位置信息的差异；根据差异计算UWB***的动态运动误差，完成UWB***的动态精度标定。本发明利用工业机器人精度高、稳定性好、且能够三维运动特点，提高了UWB***动态精度标定的准确性，并且本发明整体标定过程简单，可靠。

Description

一种UWB***的动态精度标定方法
技术领域
本发明涉及一种UWB***的动态精度标定方法，属于精度标定技术领域。
背景技术
随着人们对室内环境下LBS(location based service)的需求愈加强烈，室内定位技术受到学者的广泛研究和关注。超声波、红外线、WIFI、蓝牙、RFID、如图1所示的UWB超宽带等多种室内定位技术的发展，使人们在商场购物、地下停车和展厅参观时能快速地进行自身定位和目的地导航。
其中，UWB(Ultra Wide Band)超宽带室内定位技术作为一种新兴的一种室内定位技术，具有穿透能力强、***结构简单和定位精度高的优点，在生产车间、博物馆和展厅等场所应用广泛。研究UWB室内定位***的动态精度标定方法对于和改善UWB的定位精度和拓展UWB技术的应用领域具有重要作用。
UWB***的动态精度标定难度较高，例如：期刊为《测绘科学技术学报》、期刊号为1673-6338(2017)02-0147-05的期刊文章公开了一种基于运动捕捉***的UWB室内定位精度标定方法，该方法的实现是基于两个实验完成的：一是使用全站仪对运动捕捉***进行精度验证，通过布尔莎七参数坐标转换模型对实验数据进行处理，表明了运动捕捉***的精度满足要求，可以用于标定UWB室内定位***的精度；二是通过运动捕捉***来标定UWB室内定位***的精度，以运动捕捉***采集的数据为真值，将UWB室内定位***采集的数据与运动捕捉***采集的数据进行比较，完成了UWB***的精度标定。
然而上述标定方法复杂、标定结果(尤其是Z轴)并不准确。
发明内容
本申请的目的在于提供一种UWB***的动态精度标定方法，用以解决现有标定方案标定复杂且不准确的问题。
为实现上述目的，本申请提出了一种UWB***的动态精度标定方法的技术方案，包括以下步骤：
1)将UWB标签固定在工业机器人的末端，测量得到UWB标签相对于工业机器人末端的距离；
2)控制工业机器人按照预先规划的轨迹运动；工业机器人记录UWB标签的运动轨迹，得到UWB标签的真实位置信息；同时通过UWB***监测所述UWB标签，得到UWB标签的观测位置信息；
3)将上述UWB标签的真实位置信息和UWB标签的观测位置信息的坐标进行统一；
4)在统一坐标系下，比较UWB标签的真实位置信息和UWB标签的观测位置信息的差异；
5)根据所述差异计算UWB***的动态运动误差，完成UWB***的动态精度标定。
本发明的UWB***的动态精度标定方法的技术方案的有益效果是：本发明利用工业机器人精度高、稳定性好、且根据用户能够自主规划其三维运动轨迹的特点，将UWB标签固定在工业机器人的末端，通过工具坐标系标定得到UWB标签相对于机器人法兰末端的位置；利用控制程序控制工业机器人运动，得到工业机器人坐标系下的UWB标签的真实位置信息，以及UWB坐标系下的UWB标签的观测位置信息，由于机器人和UWB***的坐标系不统一，因此需要对坐标系进行统一，方可实现位置的比较。比较后得到UWB***动态运动的误差，完成UWB***的精度标定。本发明充分利用工业机器人的特点，可以使得UWB标签在三维空间中任意运动，提高了UWB***动态精度标定的准确性，并且本发明整体标定过程简单，可靠。
进一步的，所述步骤3)中通过转换矩阵进行坐标统一，所述转换矩阵通过控制工业机器人使UWB标签运动到不同静态位置，根据使UWB标签在工业机器人坐标系和UWB***坐标系下的不同坐标，采用公共点转换的方法得到。
进一步的，所述UWB***的动态运动误差为：
ei＝||ΔPi||2；
其中，ei为UWB***的第i个位置信息的动态运动误差；ΔP为第i个真实位置信息和观测位置信息的差异。
进一步的，为了提高标定的准确性和可靠性，所述步骤2)中，控制工业机器人按照预先设定的不同的姿态、速度、路线进行运动。
进一步的，所述路线包括直线路线和曲线路线。
附图说明
图1是本发明UWB***的原理框图；
图2是本发明UWB***的动态精度标定方法的流程图；
图3是本发明动态标定***的示意图；
图中：1为UWB基站、2为UWB标签、3为工业机器人。
具体实施方式
UWB***的动态精度标定方法实施例：
UWB***的动态精度标定方法的主要构思在于，将工业机器人作为运动载体和高精度测量***，把UWB标签固定在工业机器人的末端，驱动UWB标签以不同姿态、不同速度、以及不同路线进行运动；进而将工业机器人坐标系下的工业机器人记录的UWB标签的运动数据作为真实值，UWB***坐标系下采集的UWB标签运动数据为观测值，将两个坐标***一到一个坐标系之后，将观测值和真实值作比较，完成UWB***的动态精度标定。
具体的，UWB***的动态精度标定方法如图2所示，包括以下步骤：
1)搭建如图3所示的动态标定***。
动态标定***包括工业机器人3、UWB标签2、若干个UWB基站1(不少于3个)以及PC端。
将UWB基站1架设在工业机器人3四周，UWB标签2固定在工业机器人3的末端，UWB标签2与UWB基站1尽可能保持通视以减少NLOS(non-line of sight)误差对UWB***位置解算的影响；同时工业机器人3、以及各UWB基站1均与PC端连接，PC端作为工业机器人和UWB***数据输出的接收端，同时对所采集的数据进行误差分析。
该动态标定***包括两个坐标系：UWB***坐标系，具体为根据基站位置分布所建立的某个UWB基站1的UWB局部坐标系OU；工业机器人3坐标系，具体为工业机器人3底部建立起的基坐标系OB，并且局部的大地坐标系OW默认与基坐标系OB重合。
2)将UWB标签2固定到机器人末端，测量UWB标签2相对于工业机器人3法兰末端的距离，完成工具坐标系标定，使工业机器人能够实时获取UWB标签2的位置。
UWB标签2固定到机器人末端后，UWB标签2即为工业机器人所安装的工具，工具坐标系的原点即为UWB标签发送数据的天线端口，工具坐标系标定的目的是为了获取天线端口相对于工业机器人法兰末端坐标系的位置，以便工业机器人能够实时获取UWB标签2在工业机器人坐标系下的位置。标定方法可以通过游标卡尺等精密仪器测量得到工业机器人对于法兰末端坐标系的位置，也可以通过四点法、对尖法等方法实现工具坐标系标定。
3)通过离线编程规划工业机器人3的运动状态(包括控制工业机器人的速度、姿态和运动轨迹等参数)。控制工业机器人3运动，分别得到UWB标签2在UWB局部坐标系OU和基坐标系OB下的位置信息。
所编写的程序包括工业机器人3以不同姿态、不同路线和不同速度运动的程序，利用控制变量法控制工业机器人3每次改变一个变量因素，使固定在工业机器人3末端的标签分别以不同姿态、不同运动路线和不同速度运动时的UWB***动态定位精度。
变量因素包括姿态变量、速度变量以及路线变量。
其中，姿态变量：UWB标签2固定在工业机器人3末端，UWB标签2的运动姿态会随着工业机器人3末端的姿态变化一同发生变化。由于UWB标签2在不同姿态下接收的基站信息会发生变化，从而对动态定结果产生影响。因此，为探究标签运动姿态对UWB***定位精度的影响，在其他变量保持不变的情况下，控制工业机器人3以多种不同的姿态运动相同的路线，对比不同姿态下UWB***的动态定位精度。
速度变量：速度对UWB***的动态定位精度影响往往较大。为探究标签运动速度对UWB***定位精度的影响，在其他变量保持不变的情况下，控制工业机器人3以不同的速度运动相同的路线，对比不同速度下UWB***的动态定位精度。
路线变量：UWB标签2进行直线运动和曲线运动时的动态运动精度往往是不同的。为探究UWB标签2路线对定位精度的影响，在其他变量保持不变的情况下，控制工业机器人3使UWB标签2在空间分别运动一个长方形运动轨迹(直线)和一个圆形运动轨迹(曲线)，对比不同路线下UWB***的动态运动精度。同时，为减少其他因素对UWB定位经过的影响，圆形的圆心与长方形的几何中心重合，圆形的周长应和长方形的周长因保持相同，并且长方形路线和圆形路线应位于同一个空间平面上。
工业机器人3的优点在于用户可以离线编程自主规划工业机器人3运动轨迹、运动姿态、运动速度等参数，这对于控制标签的运动变量进行动态精度标定实验非常方便。根据步骤2)中编写程序使工业机器人3工具末端(即UWB标签2)在空间在不同的速度、姿态和路线的条件下运动。
4)以基坐标系OB下的位置信息为真实位置信息，UWB局部坐标系OU下的位置信息为观测位置信息，将UWB局部坐标系OU下的位置信息转换到基坐标系OB下，得到UWB***的动态运动误差，完成UWB***的动态精度标定。
本步骤中，通过socket通信将UWB标签2的位置和姿态实时输出给PC，根据UWB***的采样数据解算得到UWB标签2在UWB局部坐标系OU下的运动位置。为了方便对比工业机器人3和UWB***的采样数据，使工业机器人3的输出频率和UWB***的采样频率保持一致，如采样频率统一设置为10HZ。为了解决两套坐标系的采样点匹配问题，控制工业机器人3每次运动前在起始点位置停止数秒，以便于两套***的起始采样点匹配。
通过公共点转换的方法将UWB局部坐标系OU下的运动数据转换到基坐标系OB下，转换矩阵的获取过程如下：
控制工业机器人3依次移动到空间任意30个位置处，每个位置停留的时间约为1分钟。通过对30个静态点采样得到UWB标签2在两个坐标系下30个位置处的静态位置数据。
对静态采样点取均值得到UWB标签2在UWB局部坐标系OU下第i个静态点的坐标UPi0：
UPi0＝(xui,yui,zui)T(i＝1…30)；
UWB标签2在基坐标系OB下记录的第i个静态点的坐标BPi0：
BPi0＝(xbi,ybi,zbi)T。
根据坐标系转换公式建立如下方程组：
Figure BDA0002861449140000051
令：
Figure BDA0002861449140000052
得到：A·X＝B，根据最小二乘迭代得到两套坐标系的转换矩阵X＝(ATA)-1ATB。
基于所得到的转换矩阵，将步骤3)中得到的UWB标签2在UWB局部坐标系OU下的动态位置信息转换到基坐标系OB下：BPi'＝UPi·X；
进而得到第i个真实位置信息和观测位置信息的差异ΔPi：ΔPi＝BPi'-BPi；UWB***的第i个位置信息的动态运动误差ei为：ei＝||ΔPi||2；
其中，UPi为UWB标签2在UWB局部坐标系OU下的第i个位置信息；BPi'为UWB标签2从UWB局部坐标系OU转换到基坐标系OB下的第i个位置信息，也即第i个观测位置信息；BPi为UWB标签2在基坐标系OB下的第i个真实位置信息。
同时还可以根据以下公式求得UWB***的最大误差Emax、算术平均值误差E和均方根误差ERMS：
Figure BDA0002861449140000053
Figure BDA0002861449140000054
Figure BDA0002861449140000061
其中，n为位置信息的总数。
上述实施例中，设定工业机器人3的运动路线为矩形和圆形，作为其他实施方式，运动路线也可以为三角形，梯形等其他形状的路线，同时关于姿态和速度的控制也可以根据人为进行设定，本发明对此不做限制。
关于转换矩阵的确定方式，上述实施例中，为了提高转换矩阵的精度，采用工业机器人3的不同静态点得到，当然作为其他实施方式，也可以采用动态线路得到转换矩阵。
本发明提出的标定方法只需要将UWB标签2固定在工业机器人3末端，首先通过多个静态点得到基坐标系和UWB局部坐标系间的转换矩阵；其次控制机器人按事先运动规划的轨迹运动，进行UWB***的动态精度标定，标定方法操作过程简单；工业机器人3的动态运动精度在1mm左右，而UWB***的动态定位精度在分米级，利用工业机器人3进行UWB***的标定精度较高；同时，由于工业机器人3的运动姿态、运动速度和运动路线可以人为自主规划，因此可以探究UWB标签2在不同姿态、不同速度、和不同运动路线的情况下的UWB***的动态定位精度，标定结果更可靠、具有说服力。由于用户能够通过离线编程规划工业机器人的运动轨迹，使工业机器人按照事先规划好的程序自动运行，减少了人为因素对标定过程的干扰，同时降低了工作人员的劳动强度，提高了标定效率。
本发明提出的标定方法不仅可以用于UWB***的动态精度标定，而且可以用于蓝牙、超声波等其他室内导航定位***的动态定位精度标定。

Claims (5)

1.一种UWB***的动态精度标定方法，其特征在于，包括以下步骤：
1)将UWB标签固定在工业机器人的末端，测量得到UWB标签相对于工业机器人末端的距离；
2)控制工业机器人按照预先规划的轨迹运动；工业机器人记录UWB标签的运动轨迹，得到UWB标签的真实位置信息；同时通过UWB***监测所述UWB标签，得到UWB标签的观测位置信息；
3)将上述UWB标签的真实位置信息和UWB标签的观测位置信息的坐标进行统一；
4)在统一坐标系下，比较UWB标签的真实位置信息和UWB标签的观测位置信息的差异；
5)根据所述差异计算UWB***的动态运动误差，完成UWB***的动态精度标定。
2.根据权利要求1所述的UWB***的动态精度标定方法，其特征在于，所述步骤3)中通过转换矩阵进行坐标统一，所述转换矩阵通过控制工业机器人使UWB标签运动到不同静态位置，根据UWB标签在工业机器人坐标系和UWB***坐标系下的不同坐标，采用公共点转换的方法得到。
3.根据权利要求1所述的UWB***的动态精度标定方法，其特征在于，所述UWB***的动态运动误差为：
ei＝||ΔPi||2；
其中，ei为UWB***的第i个位置信息的动态运动误差；ΔP为第i个真实位置信息和观测位置信息的差异。
4.根据权利要求1所述的UWB***的动态精度标定方法，其特征在于，所述步骤2)中，控制工业机器人按照预先设定的姿态、速度、路线进行运动。
5.根据权利要求4所述的UWB***的动态精度标定方法，其特征在于，所述路线包括直线路线和曲线路线。
CN202011564384.1A 2020-12-25 2020-12-25 一种uwb***的动态精度标定方法 Pending CN113154989A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011564384.1A CN113154989A (zh) 2020-12-25 2020-12-25 一种uwb***的动态精度标定方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011564384.1A CN113154989A (zh) 2020-12-25 2020-12-25 一种uwb***的动态精度标定方法

Publications (1)

Publication Number Publication Date
CN113154989A true CN113154989A (zh) 2021-07-23

Family

ID=76878046

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011564384.1A Pending CN113154989A (zh) 2020-12-25 2020-12-25 一种uwb***的动态精度标定方法

Country Status (1)

Country Link
CN (1) CN113154989A (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103033183A (zh) * 2012-12-14 2013-04-10 中国航空工业集团公司北京长城航空测控技术研究所 工业机器人室内精确定位***及方法
WO2013054442A1 (ja) * 2011-10-14 2013-04-18 中国電力株式会社 位置標定方法、及び位置標定システム
CN103228040A (zh) * 2012-01-31 2013-07-31 国际商业机器公司 室内电子地图生成方法与***及室内目标定位方法与***
CN104612682A (zh) * 2014-12-09 2015-05-13 中国矿业大学 一种基于uwb采煤机绝对位置精确校准方法及装置
CN104714209A (zh) * 2015-03-27 2015-06-17 中国矿业大学 一种基于uwb与激光测距组合的动态定位方法及装置
CN108174442A (zh) * 2017-12-26 2018-06-15 河海大学常州校区 一种水下构筑物裂缝修复机器人传感网定位检测方法
CN108474859A (zh) * 2017-08-15 2018-08-31 深圳市大疆创新科技有限公司 定位***及其搭建方法
CN109829952A (zh) * 2019-02-11 2019-05-31 广东工业大学 一种定位***的外参标定方法、装置及相关设备
CN110243376A (zh) * 2019-06-28 2019-09-17 湖南三一快而居住宅工业有限公司 一种室内定位方法以及室内定位***
CN110290463A (zh) * 2019-08-05 2019-09-27 杭州智鹍科技有限公司 基于最优化理论的uwb基站坐标自动标定方法和***

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2013054442A1 (ja) * 2011-10-14 2013-04-18 中国電力株式会社 位置標定方法、及び位置標定システム
CN103228040A (zh) * 2012-01-31 2013-07-31 国际商业机器公司 室内电子地图生成方法与***及室内目标定位方法与***
CN103033183A (zh) * 2012-12-14 2013-04-10 中国航空工业集团公司北京长城航空测控技术研究所 工业机器人室内精确定位***及方法
CN104612682A (zh) * 2014-12-09 2015-05-13 中国矿业大学 一种基于uwb采煤机绝对位置精确校准方法及装置
CN104714209A (zh) * 2015-03-27 2015-06-17 中国矿业大学 一种基于uwb与激光测距组合的动态定位方法及装置
CN108474859A (zh) * 2017-08-15 2018-08-31 深圳市大疆创新科技有限公司 定位***及其搭建方法
CN108174442A (zh) * 2017-12-26 2018-06-15 河海大学常州校区 一种水下构筑物裂缝修复机器人传感网定位检测方法
CN109829952A (zh) * 2019-02-11 2019-05-31 广东工业大学 一种定位***的外参标定方法、装置及相关设备
CN110243376A (zh) * 2019-06-28 2019-09-17 湖南三一快而居住宅工业有限公司 一种室内定位方法以及室内定位***
CN110290463A (zh) * 2019-08-05 2019-09-27 杭州智鹍科技有限公司 基于最优化理论的uwb基站坐标自动标定方法和***

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
***: "《2020室内定位***》", 16 July 2020 *
刘智伟等: "基于运动捕捉***的UWB室内定位精度标定方法", 《测绘科学技术学报》 *
杨洲等: "超宽带室内高精度定位技术研究", 《导航定位学报》 *
隋心等: "基于UWB TDOA测距的井下动态定位方法", 《导航定位学报》 *

Similar Documents

Publication Publication Date Title
CN111536967B (zh) 一种基于ekf的多传感器融合温室巡检机器人跟踪方法
US9182435B2 (en) Method and software for spatial pattern analysis
CN109990701A (zh) 一种大型复杂曲面三维形貌机器人移动测量***及方法
WO2019136714A1 (zh) 一种基于3d激光的地图构建方法及***
CN109375158A (zh) 基于UGO Fusion的移动机器人定位方法
CN106443578B (zh) 一种室内定位基站坐标标定方法
CN102062576A (zh) 基于激光跟踪测量的附加外轴机器人自动标定装置及方法
CN102494657A (zh) 一种曲面轮廓测量及检测的测头半径补偿方法
CN109732600A (zh) 一种全自动顺序多站式测量***及测量方法
CN110026993B (zh) 一种基于uwb及热释电红外传感器的人体跟随机器人
CN108489382A (zh) 一种基于空间多点约束的agv动态位姿测量方法
CN110531391A (zh) 基于动态载波相位差分技术的田间导航方法及***
CN114013427B (zh) 用于自动泊车测试的泊车数据处理方法
CN111024059A (zh) 用于厂区内三维空间的高精度人员定位***及方法
CN114739400A (zh) 一种基于uwb和imu信息融合的室内定位方法
CN105928512A (zh) 一种基于地磁场的室内定位方法
CN107631727A (zh) 一种室内css/ins组合导航***
CN115188098A (zh) 数字钥匙自动化标定及测试的方法及其***
CN110542418A (zh) 一种综合二维码和惯性传感器的室内管道定位方法
Jiménez et al. Precise localisation of archaeological findings with a new ultrasonic 3D positioning sensor
Ciężkowski et al. Apparent beacon position estimation for accuracy improvement in lateration positioning system
CN109142999A (zh) 变电站局部放电巡检定位设备的位置检测装置及方法
CN113154989A (zh) 一种uwb***的动态精度标定方法
CN112556695A (zh) 室内定位与三维建模方法、***、电子设备及存储介质
CN114740798B (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: 20210723