发明名称 基于多点RFID结合超声波的室内机器人定位方法
摘要 本发明提出了一种基于RFID和超声波结合的室内机器人定位方法,用于解决现有现有RFID结合超声波的机器人室内定位方法中存在的针对不同的实际需求灵活性较差,数据处理过程复杂,实现步骤为:利用机器人上的RFID传感器测量其与RFID标签之间的距离;求取机器人当前位置的N‑1个待定坐标值;利用赋权值比例算法,对机器人当前位置的N‑1个待定坐标值进行加权求和,得到机器人当前待定位置的横向坐标;利用机器人上的超声波传感器,测量与其平行的室内墙面之间的距离,得到机器人当前待定位置的纵向坐标;将得到机器人当前待定位置的横向坐标和得到的纵向坐标结合,得到机器人当前待定位置的最终坐标。
申请公布号 CN106249198A 申请公布日期 2016.12.21
申请号 CN201610561414.0 申请日期 2016.07.15
申请人 西安电子科技大学 发明人 李颖;赵予玮;郭旭东;鲁瑞颖
分类号 G01S5/02(2010.01)I;G01S5/10(2006.01)I;G01S15/02(2006.01)I;G01S15/06(2006.01)I 主分类号 G01S5/02(2010.01)I
代理机构 陕西电子工业专利中心 61205 代理人 韦全生;王品华
主权项 一种基于多点RFID结合超声波的室内机器人定位方法,包括如下步骤:1)利用机器人上的RFID传感器测量其与RFID标签之间的距离,实现步骤为:1a)机器人上的RFID传感器对室内墙壁上水平均匀设置的N个RFID标签进行信号强度值测量,得到N个信号强度值p(d<sub>m</sub>),其中m表示N个RFID标签中第m个RFID标签,d表示RFID标签和RFID传感器之间的距离,p(d)表示RFID传感器接收到的信号强度;1b)从得到的N个信号强度值p(d<sub>m</sub>)中,任意选取两个RFID标签对应的信号强度值p(d<sub>a</sub>)和p(d<sub>b</sub>),其中a表示N个RFID标签中第a个RFID标签;b表示N个RFID标签中第b个RFID标签;1c)将两个信号强度值p(d<sub>a</sub>)和p(d<sub>b</sub>),代入对数—常态分布传播损耗模型,得到当前室内环境的信号传播常量n:n=(p(d<sub>a</sub>)‑p(d<sub>b</sub>))/10lg(d<sub>b</sub>/d<sub>a</sub>)其中,p(d<sub>a</sub>)为RFID传感器接收到距离为d<sub>a</sub>的标签对应的信号强度;p(d<sub>b</sub>)为RFID传感器接收到距离为d<sub>b</sub>的标签对应的信号强度;1d)将得到的信号传播常量n,再次代入对数—常态分布传播损耗模型,得到当前室内环境下机器人上的RFID传感器与RFID标签之间的距离:<maths num="0001"><math><![CDATA[<mrow><mi>d</mi><mo>=</mo><msub><mi>d</mi><mi>a</mi></msub><msup><mn>10</mn><mrow><mo>&lsqb;</mo><mi>P</mi><mrow><mo>(</mo><msub><mi>d</mi><mi>a</mi></msub><mo>)</mo></mrow><mo>-</mo><mi>P</mi><mrow><mo>(</mo><mi>d</mi><mo>)</mo></mrow><mo>&rsqb;</mo><mo>/</mo><mn>10</mn><mi>n</mi></mrow></msup></mrow>]]></math><img file="FDA0001051199800000011.GIF" wi="582" he="79" /></maths>2)利用机器人上的RFID传感器到多点RFID标签之间距离最短的一个RFID标签坐标(x<sub>min</sub>,y<sub>min</sub>),和剩余的N‑1个RFID标签坐标(x<sub>i</sub>,y<sub>i</sub>),求取机器人当前位置的N‑1个待定坐标值,其中,i表示N‑1个RFID标签坐标中第i个的RFID标签坐标;3)利用赋权值比例算法,对机器人当前位置的N‑1个待定坐标值进行加权求和,得到机器人当前待定位置的横向坐标;4)利用机器人上的超声波传感器,测量与其平行的室内墙面之间的距离,得到机器人当前待定位置的纵向坐标;5)将步骤3)得到机器人当前待定位置的横向坐标和步骤4)得到机器人当前待定位置的纵向坐标结合,得到机器人当前待定位置的最终坐标。
地址 710071 陕西省西安市太白南路2号