平码五不中公式规律
  • / 14
  • 下载费用:30 金币  

一种室内运动标签定位和测速方法.pdf

关 键 ?#21097;?/dt>
一种 室内 运动 标签 定位 测速 方法
  专利查询网所有资源均是用户自行上传分享,仅供网友学习交流,未经上传用户书面授权,请勿作他用。
摘要
申请专利号:

CN201610812129.1

申请日:

2016.09.09

公开号:

CN106483495A

公开日:

2017.03.08

当前法律状态:

实审

有效性:

审中

法?#19978;?#24773;: 实质审查的生效IPC(主分类):G01S 5/00申请日:20160909|||公开
IPC分类号: G01S5/00; G01S5/06; G01S11/02(2010.01)I 主分类号: G01S5/00
申请人: 电子科技大学
发明人: 陈祝明; 张吉伟; 张晨曦; ?#21028;?#26106;; 徐聪; 王林翰
地址: 611731 四川省成都市高新区(西区)西源大道2006号
优?#28909;ǎ?/td>
专利代理机构: 成都众恒智合专利代理事务所(普通合伙) 51239 代理人: 罗言刚
PDF完整版下载: PDF下载
法律状态
申请(专利)号:

CN201610812129.1

授权公告号:

|||

法律状态公告日:

2017.04.05|||2017.03.08

法律状态类型:

实质审查的生效|||公开

摘要

一种室内运动标签定位和测速方法,具体包括如下步骤:步骤1:待测标签与基站同步产生线性调频连续波信号,对各基站得到的数?#31181;?#39057;信号按正、负扫频分别做FFT处理;步骤2:对FFT处理结果做CFAR判决,得到正负扫频对应的正中频频率f+和负中频频率f?步骤3:解算出待测标签相对各基站的伪距R,以及待测标签相对各基站的速度分量vi;步骤4:计算出标签的位置;步骤5:计算出标签相对于各基站的角度;步骤6:解算出标签的速度大小和方向。本发明的有益之处在于只利用定位信道实现室内运动标签的位置和速度解算,具有高精度和实时性的特点,可以直接应用于运动标签的导航。

权利要求书

1.一种室内运动标签定位和测速方法,其特征在于,具体包括如下步骤:
步骤1:待测标签与基站同步产生线性调频连续波信号;所述线性调频连续波信号的调
制方式为三角波,对各基站得到的数?#31181;?#39057;信号按正、负扫频分别做FFT处理;
步骤2:对FFT处理结果做CFAR判决,得到正负扫频对应的正中频频率f+和负中频频率
f-
步骤3:利用步骤2得到的正中频频率f+和负中频频率f-解算出待测标签相对各基站的
伪距R,以及待测标签相对各基站的速度分量vi;下标表示不同基站;
步骤4?#33322;?#27493;骤3得到的伪距两两作差得到基站间真实距离差,计算出标签的位置;
步骤5?#33322;?#27493;骤4得到的标签位置计算出标签相对于各基站的角度;
步骤6:利用步骤3计算出的速度分量和步骤5得出的角度解算出标签的速度大小和方
向。
2.如权利要求1所述室内运动标签定位和测速方法,其特征在于,
所述步骤2中解算标签相对于各基站的速度分量:
vi= c(f+ + f- - 2fIF)/2f0
其中f0为该基站的载波起始频率,fIF为该基站和标签调频连续波信号的起始频率差。
3.如权利要求1所述室内运动标签定位和测速方法,其特征在于,所述步骤3中伪距
R= c(f+ - f-)/2μ
其中c为光速,μ为连续波的调频斜率。
4.如权利要求1所述室内运动标签定位和测速方法,其特征在于,所述步骤5标签相对
于各基站的角度计算方法如下:
建立XY二维坐标系,以x轴正方向为参考,其中基站坐标为(x0,y0),由所述步骤4得到的
标签的坐标为(x,y),标签相对于基站与x轴正方向的夹角为α0
α0=arctan((y-y0)/(x-x0))
5.如权利要求1所述室内运动标签定位和测速方法,其特征在于,所述步骤6中解算标
签运动速度和方向的具体方法如下:
任选所述步骤3中的得到的两个速度分量va、vb,计算出vavb的夹角α,选出速度较大
的速度分量,这里设,标签与vb的夹角记作θ,偏向速度va为正方向;
标签的运动角度θ为:

标签速度:
v=vb/cos(θ) 。
6.如权利要求5所述室内运动标签定位和测速方法,其特征在于,所述夹角α的计算方
法为:
va>0vax轴正方向的夹角αa1va<=0vax轴正方向的夹角αa1
vb>0vbx轴正方向的夹角αb2vb<=0vbx轴正方向的夹角αb2
α=αba
α1α2分别为vavb对应的基站与x轴正方向的夹角。
7.如权利要求1所述室内运动标签定位和测速方法,其特征在于,所述步骤4中得到基
站间真实距离差后,利用双曲定位原理计算出标签的位置信息。
8.如权利要求1所述室内运动标签定位和测速方法,其特征在于,所述步骤1中基站得
到数?#31181;?#39057;信号为基站将线性调频连续波经过混频、滤波、放大后得到。

?#24471;?#20070;

一种室内运动标签定位和测速方法

技术领域

本发明属于电子通信领域,涉及一种室内运动标签定位和测速方法。主分类号为
G01S5/06。

背景技术

随着智能技术的发展,目前越来越多的移动式机器人应用于餐厅服务、流配送等
领域。机器人的导航技术是智能机器人领域的一个重要研究方向,而位置和速度信息又是
导航的基本要素。

因为速度是一个矢量信息,目前主流的室内动标签的测速方法主要为在标签上加
入额外的速度或者加速度传感器来计算目标速度,加入额外的电子罗盘或方向传感器来确
定方向,比如专利申请号201610321161.X《室内导航方法及装置》利用陀螺仪和方向传感器
进行实时卡尔曼滤波获取融合导航信息;专利申请号201521043024.X《一种基于UWB技术的
室内机器人自主定位系统》,利用UWB坐标终端通过?#28304;?#30340;电子罗盘计算出当前机器人的航
向角;专利申请号201510121270.2《一种腰带式可穿戴室内移动定位终端》利用惯性导航模
块的加速度计和角速度计各自感知加速度和角速度分别进行积分速度和角度信息。这种方
式测速方式,增加了标签的成本,增大了标签体积和复杂度。另一种对室内运动标签的定位
方法为利用定位系统得到的航迹信息做航迹预测处理,比如专利申请号201310469003.5
《一种室内移动机器人定位方法》利用超声波定位获得不同时刻的绝对距离信息和航迹推
算得到相对距离信息实现对运动机器人的定位;这种方法由于定位精度不高导致距离信息
误差大,得到的航迹信息误差也比较大,另外这并不是一个实时测速方法,获取的速度信息
也是不准确的。

目前,室内标签定位一般都采用专门的高精度室内定位系统,其中线性调频连续
波是一种常用的信号形式,目前主要相关技术文献有:文献1,《基于线性调频信号的无线定
位系统设计与实现》(郑州大学,武霄泳,硕士论文);文献2,专利《一种基于线性调频连续波
技术精确定位及设备》(专利申请号201310538331.6);文献3,专利《室内定位装置及方法》
(专利申请号:201410416423.1)。前两个文献采用的是线性调频连续波信号体制,但他们都
是距离测量系统,标签需要分时与各个基站距离测量,另外在测距时基站和标签(文献2,设
备A与设备B)也需要分时双向测距,这些非实时性都给运动标签带来了定位和测速误差。文
献3是一个距离差系统,定位精度和实时性都要优于前两种,但是对于运动标签,单一的正
扫频或者下扫频无法解决速度距离耦合现象从而造成定位误差。

发明内容

针对现有室内定位系统中对运动目标定位和测速精度不足,需要附件额外的速度
或加速度以及方向传感器的问题,本发明提出了一种室内运动标签的定位与测速方法。

本发明公开了一种室内运动标签的定位与测速方法一种室内运动标签定位和测
速方法,具体包括如下步骤:

步骤1:待测标签与基站同步产生线性调频连续波信号;所述线性调频连续波信号的调
制方式为三角波,对各基站得到的数?#31181;?#39057;信号按正、负扫频分别做FFT处理;

步骤2:对FFT处理结果做CFAR判决,得到正负扫频对应的正中频频率f+和负中频频率
f-

步骤3:利用步骤2得到的正中频频率f+和负中频频率f-解算出待测标签相对各基站的
伪距R,以及待测标签相对各基站的速度分量vi;下标表示不同基站;

步骤4?#33322;?#27493;骤3得到的伪距两两作差得到基站间真实距离差,计算出标签的位置;

步骤5?#33322;?#27493;骤4得到的标签位置计算出标签相对于各基站的角度;

步骤6:利用步骤3计算出的速度分量和步骤5得出的角度解算出标签的速度大小和方
向。

具体的,所述步骤2中解算标签相对于各基站的速度分量:

vi= c(f+ + f- - 2fIF)/2f0

其中f0为该基站的载波起始频率,fIF为该基站和标签调频连续波信号的起始频率差。

具体的,所述步骤3中伪距

R= c(f+ - f-)/2μ

其中c为光速,μ为连续波的调频斜率。

具体的,所述步骤5标签相对于各基站的角度计算方法如下:

建立XY二维坐标系,以x轴正方向为参考,其中基站坐标为(x0,y0),由所述步骤4得到
的标签的坐标为(x,y),标签相对于基站与x轴正方向的夹角为α0

α0=arctan((y-y0)/(x-x0))

具体的,所述步骤6中解算标签运动速度和方向的具体方法如下:

任选所述步骤3中的得到的两个速度分量va、vb,计算出vavb的夹角α,选出速度较大
的速度分量,这里设,标签与vb的夹角记作θ,偏向速度va为正方向;

标签的运动角度θ为:


标签速度:

v=vb/cos(θ)

进一步的,所述夹角α的计算方法为:

va>0vax轴正方向的夹角αa1va<=0vax轴正方向的夹角αa1

vb>0vbx轴正方向的夹角αb2vb<=0vbx轴正方向的夹角αb2

α=αba

α1α2分别为vavb对应的基站与x轴正方向的夹角。

具体的,所述步骤4中得到基站间真实距离差后,利用双曲定位原理计算出标签的
位置信息。

优选的,所述步骤1中基站得到数?#31181;?#39057;信号为基站将线性调频连续波经过混频、
滤波、放大后得到。

本发明的有益之处在于只利用定位信道实现室内运动标签的位置和速度解算,具
有高精度和实时性的特点,可以直接应用于运动标签的导航。

附图?#24471;?br />

图1是能够实现本发明所述方法的一种硬件系统的具体实施方式示意图;

图2是图1中的标签、基站、控制器的一种具体实施方式结构示意图;

图3是本发明的一个完整工作流程具体实施方式示意图;

图4是本发明所述速度解算方法示意图;

图5是实施例1中定位区域、定位装置分布示意图;

图6是实施例1中标签位置解算结果示意图。

具体实施方式

下面结合附图,对本发明的具体实施方式作进一步的详细?#24471;鰲?br />

本发明采用现有的测距硬件系统实现,特别是在中国专利《室内定位装置及方法》
(专利申请号:201410416423.1)中已公开的室内定位装置。

如图1至3所示,给出了本发明所述室内运动标签的定位和测速方法所适用的室内
定位装置的具体实施方式。

图1为本发明所适用的一室内定位装置结构示意图,所述定位系统装置由控制器、
至少三个?#36824;?#32447;的基站和若干定位标签组成。所述控制器和标签设置通信模块,所述控制
器具有数字信号处理功能,所述控制器与各基站通过有线或无线方式控制同步信号。

图2为图1中控制器、基站和标签的具体结构图。所述控制器包含同步控制模块,
ZigBee模块、和信号处理模块,控制器的同步控制模块通过有线连接各基站的MCU;所述基
站由天线、放大器、混频器、线性调频发生器、滤波放大器、ADC,基站ADC采集到的数据通过
有线传?#36879;?#25968;字信号处理器,所述基站接收到标签发射的线性调频信号流向为天线、放大
器、混频器、滤波放大器、ADC;所述标签由天线、线性调频发生器,标签MCU和ZigBee模块组
成,所述标签MCU通过ZigBee模块与控制器同步后,控制线性调频发生器产生线性调频信
号,经过天线发送出去。

图2的具体实施方式中,以MCU控制通信信号的同步;以上控制器中的ZigBee模块
为控制器通信模块,标签中的ZigBee模块为标签通信模块,ZigBee是基于IEEE802.15.4标
准的低功耗局域网协议,是一种短距离、低功耗的无线通信技术,为本领域技术人员公知。

如图3所示给出本发明的一个完整实施方式流程示意图,具体流程如下所述:

待测标签与基站同步产生线性调频连续波信号。所述线性调频连续波信号的调制方式
为三角波,带宽为B,调频周期为T,同步误差为τ0

所述各基站的本振信号如下:

(6)

其中,t表示以时间为变量,Tup表示正程扫频阶段时间,Tdown表示负程扫频阶段时间;A0
表示本振信号幅度;其中fS为该基站的载波起始频率;fH=fS+B;发射信号的调频斜率为μ=
2B/T

待测标签发射的信号如下:

(7)

其中,Tup表示正程扫频阶段,Tdown表示负程扫频阶段,标签载波起始频率为f0,标签载
波终止频率为f1=f0+B, A0表示发射信号幅度,发射信号的调频斜率为μ=2B/T

各基站经过混频、滤波、放大后得到中频信号为:

(8)

和表示中频信号的固定相位部分,记作:

(9)

以系统中有A、B、C三个基站为例,若为A基站,fIF=fA- f0,Δτ=τa-τ0fd=fdaτxa;其
中,τa=Ra/c表示待测标签信号到达基站A的传播时延,fda为待测标签相对于A基站产生的多
普勒频率,γ=γa表示待测标签接收到A基站信号的衰减系数。若为B基站fIF=fB- f0,Δτ=
τb-τ0fd=fdbτxb;其中,τb=Rb/c表示标签信号到基站B的传播时延, fdb为待测标签相对于
B基站产生的多普勒频率,γ=γb表示标签接收到B基站信号的衰减系数。若为C基站fIF=fC-
f0,Δτ=τc-τ0fd=fdcτxc;其中,τc=Rc/c表示标签信号到基站C的传播时延,fdc为待测标签
相对于C基站产生的多普勒频率,γ=γc表示标签接收到C基站信号的衰减系数。所述c为光
速,RaRbRc分别为标签到基站A、B、C的距离。

步骤1中对各基站得到的数?#31181;?#39057;信号按正、负扫频分别做FFT((Fast Fourier
Transformation,即快速付利叶变换)处理后,进入步骤2。

步骤2:对FFT处理结果做CFAR判决,得到正负扫频对应的中频频率f+f-

(10)

其中μ为线性调频连续波的调频斜率,fIF为基站和标签调频连续波信号的起始频率
差,fd为待测标签相对于基站产生的多普勒频率。CFAR即Constant False-Alarm Rate,恒
虚警率检测是?#29366;?#30446;标检测的常用判定方法。

步骤3:利用步骤2得到f+f-解算出待测标签相对各基站的伪距,以及待测标签相
对各个基站的速度分量,计算公式为

R= c(f+ - f-)/2μ (11)

v= c(f+ + f- - 2fIF)/2f0 (12)

步骤3中解算出的速度分量包含正负符号,其中正号代表标签相对于基站速度分量的
方向朝向基站的方向,负号代表标签相对于基站速度分量的方

向朝向基站的反方向。

步骤4?#33322;?#27493;骤3得到的伪距两两作差得到基站间真实距离差,计算出标签的位置
信息。可以利用双曲定位原理进行计算,利用双曲定位原理计算前应先对定位系统建立坐
标系,对于二维平面的定位,首先选取定位区域里的一点作为坐标原点,在选取x轴和y轴建
立二维平面坐标系,解算出标签的坐标为(x,y)。

步骤4中基站间的真实距离差包含正负符号,利用距离差的正负来筛选双曲线交
点。

步骤5?#33322;?#27493;骤4得到的标签位置计算出标签相对于各基站的角度。根据标签位置,
结合各个基站的位置,容易得到该待测标签相对于各个基站的角度。例如以下给出一个具
体算法:

x轴正方向为参考,其中基站的坐标为(x0,y0),步骤4中得到的待测标签坐标为(x,
y),则标签相对于基站与x轴正方向的夹角:

α1=arctan((y-y0)/(x-x0))。 (13)

步骤6:利用步骤3计算出的速度分量和步骤5得出的角度信息解算出标签的速度大小
和方向。

下面给出步骤6中计算标签速度大小和方向的一种具体实施方式:

任选步骤3中的得到的待测标签相对A,B两个基站的速度分量va、vb,下标分别表示基
站A和B,根据步骤5得到待测标签相对于各基站的角度计算出vavb的夹角α。选出速度较大
的速度分量,假设,标签与vb的夹角记作θ,速度vb为参考,偏向于va的方向为正方向。
图4中分别给出了两种θ与速度分量va、vb的空间关系示意图,其中a部分表示θ>0的一个示
例,b部分表示θ<0的一个示例。

则标签的角度信息θ为:

(14)

标签速度大小为:

v=vb/cos(θ) (15)

本发明所述夹角α的计算方法为?#21495;?#26029;vavb的正负,

va>0vax轴正方向的夹角αa1va<=0vax轴正方向的夹角αa1

vb>0vbx轴正方向的夹角αb2vb<=0vbx轴正方向的夹角αb2

α=αba

其中α1α2分别为步骤5中得到的该待测标签相对基站的角度。

最后可以由图2所示的控制器将解算得到的待测标签位置和速度信息通过通信链
路发送。

以下给出本发明的一个具体实施例

本实施例中,采用如图2所示结构的室内定位装置,包括待测标签、基站、控制器。所述
标签、基站、控制器结构功能图如图5所示。标签与控制器通信采用ZigBee模块,同?#22791;?#36890;信
信道也是粗同步信道,其中控制器中的同步控制模块采用直接产生本振信号通过等长传输
线传输至各基站的方式来进行基站同步。所述标签具有线性调频连续波发射功能,可以控
制线性调频连续波的发射时刻、起始频率和调频斜率。所述基站包括基站天线、基站放大
器、线性调频产生器、混频器、滤波放大器、ADC;控制器结构包括同步控制模块、ZigBee模块
和信号处理模块。

本实施例中是在一个边长为100米的正方形房间,设置3个基站,位置分布如图5中
基站A、基站B、基站C所示,以A基站为坐标原点,以房间两条边为x、y轴建立直角坐标系。待
测标签在位置坐标为(40m,75m),速度大小为3.8m/s,速度方向延x轴正向夹角为103度。

待测标签和控制器粗同步之后,控制器通过有线方式控制三个基站完全同步,基
站,控制器约定标签和各个基站在同一时刻控制线性调频连续波产生器产生线性调频连续
波。标签线性调频连续波调制周期T=5ms,标签载波起始频率f0=5.2GHz,调频带宽B=
500MHz。

各基站本振信号的线性调频连续波调制周期T=5ms,载波起始频率fs=5.201GHz,
fA= fB= fC=5.201GHz,调频带宽B=500MHz,其中,fIF=1MHz,中频信号采样率fc=4MHz,FFT
点数通过补零增加为N=218,信噪比10dB。

各个基站经过混频、滤波、放大、ADC采样得到数?#31181;?#39057;信号,各基站将得到的数字
中频信号传?#36879;?#25511;制器,控制器的数字信号处理器?#36816;?#36848;数?#31181;?#39057;信号解算得到位置和速
度信息。

由步骤4解算得到的距离差结果如下:

标签到基站B与标签到基站A的距离差为-37.83(?#31069;?br />

标签到基站C与标签到基站B的距离差为17.83(?#31069;?br />

标签到基站C与标签到基站A的距离差为-20.00(?#31069;?br />

由步骤4得到标签的坐标为(39.94,75.07),定位误差为0.088(?#31069;?#23450;位结果如图6所
示。图6中横,纵坐标分别为X、Y坐标,三条不同轨迹的交点为最终得到的标签坐标。

由步骤3解算得到标签相对于各个基站的速度分量如下:

待测标签相对于A基站的速度分量为:-2.87m/s

待测标签相对于B基站的速度分量为:2.67m/s

待测标签相对于C基站的速度分量为:0.64m/s

由步骤5解算标签到各个基站与x轴正方向的夹角为:A基站241.91度、B基站148.02度、
C基站22.62度。

由步骤6解算到标签的速度大小为3.79m/s,与x轴夹角为102.74度,速度误差为
0.01m/s,角度误差为0.26度。

前文所述的为本发明的各个优选实施例,各个优选实施例中的优选实施方式如果
不是明显自相矛盾或以某一优选实施方式为前提,各个优选实施方式都可以?#25105;?#21472;加组合
使用,所述实施例以及实施例中的具体参数仅是为了清楚表述发明人的发明验证过程,并
非用以限制本发明的专利保护?#27573;В?#26412;发明的专利保护?#27573;?#20173;然以其权利要求书为?#36857;?#20961;
是运用本发明的?#24471;?#20070;及附图内容所作的等同结构变化,同理均应包含在本发明的保护范
围内。

关于本文
本文标题:一种室内运动标签定位和测速方法.pdf
链接地址:http://www.pqiex.tw/p-5994784.html
关于我们 - 网站声明 - 网站地图 - 资源地图 - 友情链接 - 网站客服 - 联系我们

[email protected] 2017-2018 zhuanlichaxun.net网站版权所有
经营许可证编号:粤ICP备17046363号-1 
 


收起
展开
平码五不中公式规律 上海时时乐今天开奖结果 双色球第17140期历史同期 贵州十一选五怎么玩 北京十一选五任五玩法 澳洲幸运10免费计划软件下载 彩票开奖直播 kk棋牌游戏是黑平台吗 股票涨跌幅计算软件 重庆百变王牌游戏平台 pc蛋蛋加拿大开奖官网