一种UWB系统的动态精度标定方法

本发明涉及一种uwb系统的动态精度标定方法，属于精度标定技术领域。

背景技术：

随着人们对室内环境下lbs(locationbasedservice)的需求愈加强烈，室内定位技术受到学者的广泛研究和关注。超声波、红外线、wifi、蓝牙、rfid、如图1所示的uwb超宽带等多种室内定位技术的发展，使人们在商场购物、地下停车和展厅参观时能快速地进行自身定位和目的地导航。

其中，uwb(ultrawideband)超宽带室内定位技术作为一种新兴的一种室内定位技术，具有穿透能力强、系统结构简单和定位精度高的优点，在生产车间、博物馆和展厅等场所应用广泛。研究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-lineofsight)误差对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。

根据坐标系转换公式建立如下方程组：

令：

得到：a·x＝b，根据最小二乘迭代得到两套坐标系的转换矩阵x＝(a^ta)^-1a^tb。

基于所得到的转换矩阵，将步骤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：

其中，n为位置信息的总数。

上述实施例中，设定工业机器人3的运动路线为矩形和圆形，作为其他实施方式，运动路线也可以为三角形，梯形等其他形状的路线，同时关于姿态和速度的控制也可以根据人为进行设定，本发明对此不做限制。

关于转换矩阵的确定方式，上述实施例中，为了提高转换矩阵的精度，采用工业机器人3的不同静态点得到，当然作为其他实施方式，也可以采用动态线路得到转换矩阵。

本发明提出的标定方法只需要将uwb标签2固定在工业机器人3末端，首先通过多个静态点得到基坐标系和uwb局部坐标系间的转换矩阵；其次控制机器人按事先运动规划的轨迹运动，进行uwb系统的动态精度标定，标定方法操作过程简单；工业机器人3的动态运动精度在1mm左右，而uwb系统的动态定位精度在分米级，利用工业机器人3进行uwb系统的标定精度较高；同时，由于工业机器人3的运动姿态、运动速度和运动路线可以人为自主规划，因此可以探究uwb标签2在不同姿态、不同速度、和不同运动路线的情况下的uwb系统的动态定位精度，标定结果更可靠、具有说服力。由于用户能够通过离线编程规划工业机器人的运动轨迹，使工业机器人按照事先规划好的程序自动运行，减少了人为因素对标定过程的干扰，同时降低了工作人员的劳动强度，提高了标定效率。

本发明提出的标定方法不仅可以用于uwb系统的动态精度标定，而且可以用于蓝牙、超声波等其他室内导航定位系统的动态定位精度标定。