专利名称：一种面向智能空间中服务机器人的精确无线定位方法
技术领域：
本发明属于无线定位技术领域，涉及一种面向智能空间中服务机器人的精确无线定位方法。
背景技术：
随着物联网应用的不断扩大和深入，位置感知计算、基于位置的服务显得越来越重要，尤其在智能空间中，对位置的精确定位要求越来越高。目前，室内定位技术大多采用基于接收信号强度指示RSSI(RSSIjReceivedsingalstrength index)的定位方式，即利用已知发射信号强度,接收节点根据收到的信号强度，计算信号在传播过程中的损耗，使用理论或经验的信号传播模型将传播损耗转化为距离。在无线传感器网络中，理论上通过4个不在同一平面上节点的RSSI信息就可以确定一个未知节点的空间位置，但是对于复杂的室内空间环境(如桌椅比较多)很难确定补偿的大�。佣苟ㄎ痪群艿停荒艽锏�2-3米左右的精度。还有一些类似的装置，比如通过RSSI和电子罗盘定位、通过三轴加速度传感器从而得到物体运动轨�：蚏SSI数据融合定位等以及通过超声波定位等方式。以上定位方法普遍存在的问题是定位精确度不高，尤其是在一些对定位精确度要求很高的场合，这些定位方法的局限性就显得非常突出，比如在需要对智能空间中的服务机器人实现精确定位的时候，如果定位精确度达不到要求则不能很好地控制机器人完成相应操作，此时，如果通过RSSI定位方式则达不到厘米级别的要求精确度，从而无法实现对机器人的控制。再者，由于室内环境一般比较复杂，同时由于超声波不能穿过物体和超声波的多径传播效应，所以超声波定位方法也不能很好地应用到复杂室内环境的定位中。因此，目前需要一种能够实现在智能空间中的精确无线定位的方法，从而实现诸如控制服务机器人之类的基于位置的传感服务。
发明内容
有鉴于此，本发明的目的在于提供一种面向智能空间中服务机器人的精确无线定位方法，采用该无线定位方法可以实现在复杂室内环境中厘米级别的定位精度，从而家庭服务机器人可以根据高精确度的位置信息提供更多更准确的服务。为达到上述目的，本发明提供如下技术方案一种面向智能空间中服务机器人的精确无线定位方法，包括以下步骤步骤一设置信标节点；步骤二 采集先验数据，建立先验数据库并进行模型拟合；步骤三判断待定位目标与信标节点的视距关系；步骤四对待定位目标进行初步定位；步骤五利用超声波进行精确定位。进一步，步骤一中所述信标节点包括一个信号接收系统，该信号接收系统包括射频芯片、超声波传感器和单片机控制器；射频芯片用于采集待定位目标的射频信号；超声波传感器用于采集待定位目标超声波传感器发送的超声波信号；单片机控制器用于控制信号接收系统；信标节点的数量根据室内空间的大小合理确定，以使信标节点能够均匀布置在室内空间中。进一步，所述待定位目标超声波传感器采用360 °发射超声波的传感器US40KT-01，信标节点上的超声波传感器采用55°至65°接收超声波的传感器TCT40-16R。进一步，步骤二采用的方式为:当房间中无任何物品时，分别测量距离待定位目标
0.1m-1Om内的信标节点接收到的射频信号数据，然后在待定位目标和信标节点之间放置阻挡物，再在有阻挡物的情况下分别测量距离待定位目标0.1m-1Om内的信标节点接收到的射频信号数据，根据上述数据建立先验数据库，并对其进行分析得到信标节点接收射频信号强度与定位位置之间的关系，根据信号能量的对数值与距离的对数值呈线性关系，通过对数据进行线性拟合，得到该房间中信号能量与距离在视距下和非视距下的关系。进一步，所述阻挡物采用3cm的木板。进一步，步骤三中判断待定位目标与信标节点的视距关系采用以下方式:将信标节点固定在室内地面角落或墙面上，每平方米取10个点作为待定位测量点，多次测量各个待定位测量点相对于各个信标节点的射频信号到达时间τ，得到各个待定位测量点相对于各个信标节点的射频信号到达时间τ的均值和方差，取各个待定位测量点相对于各个信标节点的射频信号到达时间τ的方差最大值σ_ω作为门限值，σ_⑴为第i个信标节点相对于各个待定位测量点的射频信号到达时间τ的方差最大值，在之后的测量中，若多次测量某点相对于第i个信标节点的射频信号到达时间τ的方差Oi大于σ_ω则视为非视距传播，而小于0_(1)视为视距传播。进一步，步骤四中对待定位目标进行初步定位采用以下方式:首先由待定位目标发射射频信号，各信标节点分别采集射频信号的RSSI数值和到达时间τ，计算τ的方差σ，通过将各个信标节点的方差oJP omax(i)相比较，从而确定各个信标节点选择视距下的传播模型或是非视距下的传播模型，选择模型后，通过RSSI测量值可以得到各个信标节点和待定位目标节点的大致距离。进一步，步骤五中利用超声波进行精确定位采用以下步骤:a.确定经步骤四中选出的与待定位目标有视距的信标节点接收超声波信号能量大小的门限值，其过程为:通过步骤四得到待定位目标和信标节点的大致距离，从而根据此距离的大小确定信标节点中超声波传感器的增益，进而确定接收超声波信号能量大小的门限值；b.忽略小于门限值的超声波信号，减少由于超声波多径传播而产生的误差；c.基于TDOA算法实现定位，其过程为:视距下的信标节点接收到待定位目标发送的射频信号后，启动单片机的定时器，待接收到超声波信号后停止定时器，此定时时间t即为超声波的传播时间，而信标节点与定位目标的距离L=340*t，将距离数据存储到单片机中，待所有视距下的信标节点均测距完成后，可将这些信标节点单片机中存储的距离数据通过无线发送至PC机中进行精确位置计算。本发明的有益效果在于:本发明所述的无线定位方法能够实现复杂室内环境的精确定位，其精度能够达到厘米级别，从而家庭服务机器人可以根据高精确度的位置信息提供更多更准确的服务。
为了使本发明的目的、技术方案和有益效果更加清楚，本发明提供如下附图进行说明:图1为本发明所述无线定位方法的流程图。
具体实施例方式下面将结合附图，对本发明的优选实施例进行详细的描述。本发明所述的面向智能空间中服务机器人的精确无线定位方法采用RSSI数据作为辅助分析，用超声波进行精确定位，通过测量信标节点中RSSI数值大小，初步估计待定位目标位置，找出与待定位目标视距下的信标节点，同时根据初步定位位置确定信标节点中超声波接收�？榈姆糯笃髟鲆妫檬泳嘞滦疟杲诘阒械某？榻芯范ㄎ�。图1为本发明所述的无线定位方法的流程图，该无线定位方法包括五个步骤:步骤一:设置信标节点；步骤二:采集先验数据，建立先验数据库并进行模型拟合；步骤三:判断待定位目标与信标节点的视距关系；步骤四:对待定位目标进行初步定位；步骤五:利用超声波进行精确定位。步骤一中所述的信标节点包括一个信号接收系统，该信号接收系统包括射频芯片、超声波传感器和单片机控制器；射频芯片用于采集待定位目标的射频信号；超声波传感器用于采集待定位目标超声波传感器发送的超声波信号；单片机控制器用于控制信号接收系统；信标节点的数量根据室内空间的大小合理确定，以使信标节点能够均匀布置在室内空间中。在本实施例中，待定位目标超声波传感器采用360°发射超声波的传感器US40KT-01，信标节点上的超声波传感器采用55°至65°接收超声波的传感器TCT40-16R。在本实施例中，步骤二采用的具体方式为:当房间中无任何物品时，分别测量距离待定位目标0.1m-1Om内的信标节点接收到的射频信号数据；同时，由于一般在室内空间中，书桌、电脑桌等家具的各个面的厚度通常在3厘米左右，因此在本实施例中，在待定位目标和信标节点之间放置3厘米厚的木板，然后再分别测量距离待定位目标0.1m-1Om内的信标节点接收到的射频信号数据，根据上述数据建立先验数据库，并对其进行分析得到信标节点接收射频信号强度与定位位置之间的关系，根据信号能量的对数值与距离的对数值呈线性关系，通过对数据进行线性拟合，得到该房间中信号能量与距离在视距下和非视距下的关系。步骤三中判断待定位目标与信标节点的视距关系采用以下方式:将信标节点固定在室内地面角落或墙面上，每平方米取10个点作为待定位测量点，多次测量各个待定位测量点相对于各个信标节点的射频信号到达时间τ，得到各个待定位测量点相对于各个信标节点的射频信号到达时间τ的均值和方差，取各个待定位测量点相对于各个信标节点的射频信号到达时间τ的方差最大值σ_ω作为门限值，σ_⑴为第i个信标节点相对于各个待定位测量点的射频信号到达时间τ的方差最大值，在之后的测量中，若多次测量某点相对于第i个信标节点的射频信号到达时间τ的方差Oi大于0_(1)则视为非视距传播，而小于0_(1)视为视距传播。步骤四中对待定位目标进行初步定位采用以下方式:首先由待定位目标发射射频信号，各信标节点分别采集射频信号的RSSI数值和到达时间τ，计算τ的方差σ，通过将各个信标节点的方差^和σ_ω相比较，从而确定各个信标节点选择视距下的传播模型或是非视距下的传播模型，选择模型后，通过RSSI测量值可以得到各个信标节点和待定位目标节点的大致距离。本发明所述无线定位方法的步骤五是利用超声波实现精确定位，由于超声波具有反射性，所以信标节点中的超声波接收�？榭赡芙邮盏讲煌肪兜某ㄐ藕牛宋ǖ亩嗑洞ノ侍�。因为超声波在介质中传播时，随着传播距离的增加，能量逐渐衰减，所以通过信标节点中RSSI数值大�。醪焦兰颇勘晡恢煤罂梢缘玫侥勘旰托疟杲诘愕拇笾戮嗬耄佣荽司嗬氲拇笮∪范ㄐ疟杲诘阒谐ń邮漳？榉糯笃鞯脑鲆妫范ń邮粘ㄐ藕拍芰看笮〉拿畔拗担雎孕∮诖嗣畔拗档某ㄐ藕牛庋梢源蟠蠹跎儆捎诔ǘ嗑洞ザ奈蟛睿佣锏骄范ㄎ坏哪康�。在本实施例中，步骤五中利用超声波进行精确定位采用以下步骤:a.确定经步骤四中选出的与待定位目标有视距的信标节点接收超声波信号能量大小的门限值，其过程为:通过步骤四得到待定位目标和信标节点的大致距离，从而根据此距离的大小确定信标节点中超声波传感器的增益，进而确定接收超声波信号能量大小的门限值；b.忽略小于门限值的超声波信号，减少由于超声波多径传播而产生的误差；c.基于TDOA算法实现定位，其过程为:视距下的信标节点接收到待定位目标发送的射频信号后，启动单片机的定时器，待接收到超声波信号后停止定时器，此定时时间t即为超声波的传播时间，而信标节点与定位目标的距离L=340*t，将距离数据存储到单片机中，待所有视距下的信标节点均测距完成后，可将这些信标节点单片机中存储的距离数据通过无线发送至PC机中进行精确位置计算。
通过以上五个步骤，能够实现智能空间中的精确定位，从而为无线传感服务提供精确的位置信息。最后说明的是，以上优选实施例仅用以说明本发明的技术方案而非限制，尽管通过上述优选实施例已经对本发明进行了详细的描述，但本领域技术人员应当理解，可以在形式上和细节上对其作出各种各样的改变，而不偏离本发明权利要求书所限定的范围。
权利要求
1.一种面向智能空间中服务机器人的精确无线定位方法，其特征在于:包括以下步骤: 步骤一:设置信标节点； 步骤二:采集先验数据，建立先验数据库并进行模型拟合； 步骤三:判断待定位目标与信标节点的视距关系； 步骤四:对待定位目标进行初步定位； 步骤五:利用超声波进行精确定位。
2.根据权利要求1所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:步骤一中所述信标节点包括一个信号接收系统，该信号接收系统包括射频芯片、超声波传感器和单片机控制器；射频芯片用于采集待定位目标的射频信号；超声波传感器用于采集待定位目标超声波传感器发送的超声波信号；单片机控制器用于控制信号接收系统；信标节点的数量根据室内空间的大小合理确定，以使信标节点能够均匀布置在室内空间中。
3.根据权利要求2所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:所述待定位目标超声波传感器采用360°发射超声波的传感器US40KT-01，信标节点上的超声波传感器采用55°至65°接收超声波的传感器TCT40-16R。
4.根据权利要求1所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:步骤二采用以下方式:当房间中无任何物品时，分别测量距离待定位目标0.1m-1Om内的信标节点接收到的射频信号数据，然后在待定位目标和信标节点之间放置阻挡物，再在有阻挡物的情况下分别测量距离待定位目标0.1m-1Om内的信标节点接收到的射频信号数据，根据上述数据建立先验数据库，并对其进行分析得到信标节点接收射频信号强度与定位位置之间的关系，根据信号能量的对数值与距离的对数值呈线性关系，通过对数据进行线性拟合，得到该房间中信号能量与距离在视距下和非视距下的关系。
5.根据权利要求4所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:所述阻挡物采用3cm的木板。
6.根据权利要求1所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:步骤三中判断待定位目标与信标节点的视距关系采用以下方式:将信标节点固定在室内地面角落或墙面上，每平方米取10个点作为待定位测量点，多次测量各个待定位测量点相对于各个信标节点的射频信号到达时间τ，得到各个待定位测量点相对于各个信标节点的射频信号到达时间τ的均值和方差，取各个待定位测量点相对于各个信标节点的射频信号到达时间τ的方差最大值σ_ω作为门限值，σ_⑴为第i个信标节点相对于各个待定位测量点的射频信号到达时间τ的方差最大值，在之后的测量中，若多次测量某点相对于第i个信标节点的射频信号到达时间τ的方差Oi大于σ_ω则视为非视距传播，而小于σ max(i)视为视距传播。
7.根据权利要求6所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:步骤四中对待定位目标进行初步定位采用以下方式:首先由待定位目标发射射频信号，各信标节点分别采集射频信号的RSSI数值和到达时间τ，计算τ的方差σ，通过将各个信标节点的方差01和omax(i)相比较，从而确定各个信标节点选择视距下的传播模型或是非视距下的传播模型，选择模 型后，通过RSSI测量值可以得到各个信标节点和待定位目标节点的大致距离。
8.根据权利要求1至7中任一项所述的面向智能空间中服务机器人的精确无线定位方法，其特征在于:步骤五中利用超声波进行精确定位采用以下步骤: a.确定经步骤四中选出的与待定位目标有视距的信标节点接收超声波信号能量大小的门限值，其过程为:通过步骤四得到待定位目标和信标节点的大致距离，从而根据此距离的大小确定信标节点中超声波传感器的增益，进而确定接收超声波信号能量大小的门限值； b.忽略小于门限值的超声波信号,减少由于超声波多径传播而产生的误差； c.基于TDOA算法实现定位，其过程为:视距下的信标节点接收到待定位目标发送的射频信号后，启动单片机的定时器，待接收到超声波信号后停止定时器，此定时时间t即为超声波的传播时间，而信标节点与定位目标的距离L=340*t，将距离数据存储到单片机中，待所有视距下的信标节点均测距完成后，可将这些信标节点单片机中存储的距离数据通过无线发送至PC机中进行精确位置计算。
全文摘要
本发明公开了一种面向智能空间中服务机器人的精确无线定位方法，属于无线定位技术领域；本发明所述的无线定位方法包括以下步骤步骤一设置信标节点；步骤二采集先验数据，建立先验数据库并进行模型拟合；步骤三判断待定位目标与信标节点的视距关系；步骤四对待定位目标进行初步定位；步骤五利用超声波进行精确定位；采用本发明所述的无线定位方法能够实现在复杂室内环境中厘米级别的定位精度，从而家庭服务机器人可以根据高精确度的位置信息提供更多更准确的服务，此外，该无线定位方法也可以应用于一些需要厘米级定位精度的场合，满足高精度定位的需要。
文档编号G01S5/18GK103076592SQ20121058075
公开日2013年5月1日 申请日期2012年12月27日 优先权日2012年12月27日
发明者尹宏鹏, 柴毅, 姚聪 申请人:重庆大学
专业数控铣床产品供应商
20年生产经验，实力工厂，精工品质，质量有保障
