CN110703188B - 一种基于rfid的六自由度姿态估计系统 - Google Patents
一种基于rfid的六自由度姿态估计系统 Download PDFInfo
- Publication number
- CN110703188B CN110703188B CN201910855141.4A CN201910855141A CN110703188B CN 110703188 B CN110703188 B CN 110703188B CN 201910855141 A CN201910855141 A CN 201910855141A CN 110703188 B CN110703188 B CN 110703188B
- Authority
- CN
- China
- Prior art keywords
- axis
- rotation
- displacement
- rcs
- rfid
- 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.)
- Active
Links
Images
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
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Radar Systems Or Details Thereof (AREA)
Abstract
本发明涉及一种基于RFID的六自由度姿态估计系统,包括:首先定义全局坐标系GCS:O‑XYZ,它表示物体和附加标签的实际位置,以及旋转坐标系RCS:C‑UVW,用于表示物体的位移和旋转,通过定位RCS的原点,即物体的旋转中心,计算物体沿x轴,y轴和z轴的位移,RCS与对象具有相同的位移,但它不会旋转,围绕RCS坐标轴的物体的旋转角度被称为物体的姿态角,令物体围绕u轴,v轴和w轴的旋转角度分别为α,β和γ,设γ=0,给出坐标变换,设两个线性独立的矢量n1和n2由三个标签的位置确定;计算出三个姿态角;从中获得物体的三维位置。
Description
技术领域
本发明属于RFID定位技术领域。
背景技术
随着移动互联网和智能手机的普及,基于位置的服务(Location Based Service,LBS)得到了广泛的关注,带动了各种现代导航定位技术的发展。众所周知的室外定位技术GPS由于建筑物的遮挡等原因GPS系统不能够应用于室内定位。近年来出现了很多基于无线网络的室内定位技术,如WiFi定位、蓝牙定位、ZigBee定位和RFID定位等。而物联网技术的飞速发展使得RFID技术开始广泛应用于生产、物流及药品等的定位、追踪与回溯。在室内定位方面,RFID相比于其他定位方法除了具有低成本、定位精度高、识别速度快和抗干扰强等特点,还有非接触、非视距以及可以对多目标同时进行识别跟踪的优点,这使其逐渐成为室内定位的首选。
RFID的无线定位技术主要分为两种:一种是基于非测距方法,通常不需要确定的信号传播模型,在定位区域中预先布置大量参考标签,经过某种运算后筛选出位置相近的参考标签,用它们去确定最终定位坐标;另一种是基于测距的方法,根据信号传播模型确定人与多个无线点装置之间的距离,通过几何关系变换确定人员位置。基于测距的方法主要包括:AOA(Angle of Arrival)信号到达角度法、TOA(Time of Arrival)信号到达时间法、TDOA(Time Difference of Arrival)信号到达时间差法和RSSI(Received SignalStrength Indication)接收信号强度法。RSSI定位法通过信号强度与距离建立传播模型来估计接收的标签,这种方法功率低,成本低,无需额外的设备功能支持,然而信号能量信息在传播过程中除了距离因素还受非视距、多径等其他多种因素影响,导致其定位精度受限。TOA和TDOA定位法主要通过测量电磁波的传播时间来计算距离,这种方法对于硬件设施的时钟同步有要求或者需要精确的参考时间。AOA定位法主要通过阅读器的天线阵列来测量标签信号的到达方向,这种方法需要功能特殊的天线阵列,准确度受限于设备性能,成本也相对较高。
而在标签与阅读器存在相对移动的场景中,合成孔径技术可以利用天线与目标之间的相对移动形成虚拟天线阵列,通过多个采样相位值的相干叠加来确定目标位置,从而具有良好的抗噪声和多径干扰的能力,能够提高定位精度。并且适用于手持式设备等独特的动态应用场景,也不需要额外布置参考标签和费时的校准阶段。同时成本相对较低,仅用商用设备就可以实现定位。
发明内容
本发明的目的在于提供一种基于RFID的六自由度姿态估计系统。本发明的技术方案如下:
一种基于RFID的六自由度姿态估计系统,包括:
1)首先定义全局坐标系GCS:O-XYZ,它表示物体和附加标签的实际位置,以及旋转坐标系RCS:C-UVW,用于表示物体的位移和旋转,通过定位RCS的原点,即物体的旋转中心,计算物体沿x轴,y轴和z轴的位移,RCS与对象具有相同的位移,但它不会旋转。围绕RCS坐标轴的物体的旋转角度被称为物体的姿态角。设RCS中的u轴,v轴和w轴分别与GCS中的x轴,y轴和z轴平行,将目标的起始位置c=[xc,yc,zc]表示为
其中I3是单位矩阵,经过位移dt=[Δx,Δy,Δz]后的新位置为:
此等式可以写作:
Cd=Trans(dt)×C
将Trans称为位移函数。
2)令物体围绕u轴,v轴和w轴的旋转角度分别为α,β和γ,设γ=0,坐标变换表示为:
其中
类似地,得到:
因此,平移和旋转后的坐标变换可以表示为:
其中R(α,β,γ)=Rot(w,γ)×Rot(v,β)×Rot(u,α),被称为旋转矩阵。
3)设两个线性独立的矢量n1和n2由三个标签的位置确定,计算出第三个向量n3=n1×n2,通过定位获得的GCS中的坐标,可以获得两个矩阵Ng=[n1,n2,n3]和Nr=[r1,r2,r3],坐标变换表示为:
Nr=R(α,β,γ)×Ng
之后得到旋转矩阵
将R(α,β,γ)写为:
然后可以计算出三个姿态角:
进一步可以得到位移矩阵
从中获得物体的三维位置。
附图说明
图1为系统模型示意图。
具体实施方式
下面结合附图对本发明的一种基于RFID的六自由度姿态估计系统。
步骤如下:
1)为了介绍我们的六自由度物体定位和姿态估计系统,我们首先定义全局坐标系(GCS)O-XYZ,它表示物体和附加标签的实际位置,以及旋转坐标系(RCS)C-UVW,用于表示物体的位移和旋转。通过定位RCS的原点,即物体的旋转中心,我们可以计算物体沿x轴,y轴和z轴的位移。请注意,RCS与对象具有相同的位移,但它不会旋转。围绕RCS坐标轴的物体的旋转角度被称为物体的姿态角。设RCS中的u轴,v轴和w轴分别与GCS中的x轴,y轴和z轴平行。将目标的起始位置c=[xc,yc,zc]表示为
其中I3是单位矩阵。k是一个表示周期数的整数。经过位移dt=[Δx,Δy,Δz]
后的新位置为:
此等式可以写作:
Cd=Trans(dt)×C
我们将Trans称为位移函数。
2)令物体围绕u轴,v轴和w轴的旋转角度分别为α,β和γ。设γ=0,可以证明坐标变换可以表示为:
其中
类似地,我们可以得到:
因此,平移和旋转后的坐标变换可以表示为:
其中R(α,β,γ)=Rot(ω,γ)×Rot(v,β)×Rot(u,α),被称为旋转矩阵。
3)为了通过将三个标签的坐标代入其中来求解方程,有必要引入标签之间的位置关系作为约束,并且求解过程很复杂。为了简化求解过程,两个线性独立的矢量n1和n2可以由三个标签的位置确定。然后我们可以计算出第三个向量n3=n1×n2。通过使用通过定位获得的GCS中的坐标,可以获得两个矩阵Ng=[n1,n2,n3]和Nr=[r1,r2,r3]。于是坐标变换可以表示为Nr=R(α,β,γ)×Ng
之后可以得到旋转矩阵
将R(α,β,γ)写为:
然后可以计算出三个姿态角:
进一步可以得到位移矩阵
从中我们可以获得物体的三维位置。
Claims (1)
1.一种基于RFID的六自由度姿态估计系统,包括:
1)首先定义全局坐标系GCS:O-XYZ,它表示物体和附加标签的实际位置,以及旋转坐标系RCS:C-UVW,用于表示物体的位移和旋转,通过定位RCS的原点,即物体的旋转中心,计算物体沿x轴,y轴和z轴的位移,RCS与物体具有相同的位移,但它不会旋转;围绕RCS坐标轴的物体的旋转角度被称为物体的姿态角;设RCS中的u轴,v轴和w轴分别与GCS中的x轴,y轴和z轴平行,将物体的起始位置c=[xc,yc,zc]表示为
其中I3是单位矩阵,cT为物体的起始位置c三维坐标构成的向量的转置,经过位移dt=[Δx,Δy,Δz]后的新位置为:
此等式记为:
Cd=Trans(dt)×C
将Trans称为位移函数;
2)令物体围绕u轴,v轴和w轴的旋转角度分别为α,β和γ,设γ=0,
坐标变换表示为:
其中
类似地,得到:
因此,平移和旋转后的坐标变换可以表示为:
其中R(α,β,γ)=Rot(w,γ)×Rot(υ,β)×Rot(u,α),被称为旋转矩阵;
3)设两个线性独立的矢量n1和n2由三个标签的位置确定,计算出第三个向量n3=n1×n2,通过定位获得的GCS中的标签坐标,可以获得两个矩阵Ng=[n1,n2,n3]和Nr=[r1,r2,r3],坐标变换表示为:
Nr=R(α,β,γ)×Ng
之后得到旋转矩阵
将R(α,β,γ)写为:
然后可以计算出三个姿态角:
进一步可以得到位移矩阵
从中获得物体的三维位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910855141.4A CN110703188B (zh) | 2019-09-10 | 2019-09-10 | 一种基于rfid的六自由度姿态估计系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910855141.4A CN110703188B (zh) | 2019-09-10 | 2019-09-10 | 一种基于rfid的六自由度姿态估计系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110703188A CN110703188A (zh) | 2020-01-17 |
CN110703188B true CN110703188B (zh) | 2022-03-25 |
Family
ID=69195291
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910855141.4A Active CN110703188B (zh) | 2019-09-10 | 2019-09-10 | 一种基于rfid的六自由度姿态估计系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110703188B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114444629B (zh) * | 2022-01-11 | 2023-12-05 | 重庆邮电大学 | 一种基于rfid标签阵列的测角定位系统及方法 |
Family Cites Families (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2013045974A1 (en) * | 2011-09-27 | 2013-04-04 | Nokia Corporation | Using measured angular coordinates of an object relative to a directional transceiver |
US20200057778A1 (en) * | 2017-04-11 | 2020-02-20 | Siemens Mobility GmbH | Depth image pose search with a bootstrapped-created database |
US10627475B2 (en) * | 2017-05-05 | 2020-04-21 | The Boeing Company | Pose estimation using radio frequency identification (RFID) tags |
CN107797094A (zh) * | 2017-11-10 | 2018-03-13 | 南阳师范学院 | 一种基于rfid的移动机器人位姿估计方法 |
CN109345588B (zh) * | 2018-09-20 | 2021-10-15 | 浙江工业大学 | 一种基于Tag的六自由度姿态估计方法 |
CN109900301B (zh) * | 2019-04-02 | 2022-10-25 | 哈尔滨工程大学 | 一种动态环境下双目立体定位角度补偿方法 |
-
2019
- 2019-09-10 CN CN201910855141.4A patent/CN110703188B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110703188A (zh) | 2020-01-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105547305B (zh) | 一种基于无线定位和激光地图匹配的位姿解算方法 | |
CN110187333B (zh) | 一种基于合成孔径雷达技术的rfid标签定位方法 | |
Ni et al. | UWB indoor positioning application based on Kalman filter and 3-D TOA localization algorithm | |
Khalaf-Allah | Time of arrival (TOA)-based direct location method | |
CN104698437B (zh) | 一种基于超宽带的井下车辆定位方法 | |
Kang et al. | A high-accuracy TOA-based localization method without time synchronization in a three-dimensional space | |
CN106352869A (zh) | 移动机器人室内定位系统及其计算方法 | |
CN109613584B (zh) | 基于uwb的无人集卡的定位定向方法 | |
CN104010361A (zh) | 定位系统和方法 | |
Ren et al. | A study of indoor positioning based on UWB base-station configurations | |
Feng et al. | GDOP index in UWB indoor location system experiment | |
CN105929364B (zh) | 利用无线电定位的相对位置测量方法及测量装置 | |
CN111757256A (zh) | 室内定位方法及装置 | |
CN110888108B (zh) | 一种基于rfid与相位校准的定位方法 | |
Bernardini et al. | Particle swarm optimization in multi-antenna SAR-based localization for UHF-RFID tags | |
Hsu et al. | An accelerometer based approach for indoor localization | |
CN110703188B (zh) | 一种基于rfid的六自由度姿态估计系统 | |
CN105548962A (zh) | 非同步基站系统下的无线测距定位方法及系统 | |
CN110850401B (zh) | 一种基于运动模型与合成孔径的rfid标签定位方法 | |
CN111132013B (zh) | 室内定位方法、装置、存储介质及计算机设备 | |
CN102082998A (zh) | 一种支持tdoa、toa和rssi三种模式的实时定位方法 | |
CN110781698A (zh) | 一种低计算量的sar rfid定位方法 | |
CN108225321A (zh) | 一种基于移动节点辅助下的室内定位方法 | |
CN110471025B (zh) | 一种单站三维定位与测速方法 | |
CN112444777A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |