[发明专利]一种基于超声阵列信息的室内场景定位方法与装置

摘要

本发明提出一种基于超声阵列信息的室内场景定位方法与装置，涉及定位技术领域。该方法包括1)采集作为训练样本的室内场景的超声阵列信息2)采集作为测试样本的超声阵列信息3)将超声训练样本和超声测试样本分别对齐；4)计算超声训练样本与测试样本的距离矩阵5)将所有超声测试样本通过最近邻算法得到每个测试样本的场景定位。本发明装置包括机器人本体，超声传感器和计算机。机器人本体与计算机通过U转串口线连接，把超声传感器实时采集到的超声阵列信息保存到计算机。本发明在机器学习的基础上实现一种基于超声阵列信息的室内场景定位方法与装置，提高了室内场景定位的鲁棒性和准确率。

主权项

一种基于超声阵列信息的室内场景定位方法，其特征在于，该方法包括以下步骤:1)采集作为训练样本的场景的超声阵列信息：为了有效地获取环境中的超声信息，超声传感器以环或阵列的形式安装在机器人本体上；室内场景的超声阵列信息被采集作为超声训练样本，设超声训练样本的个数为N，则得到超声训练样本数据集Str的表达式为：Str＝[Str1,Str2,···,StrN]  (1)其中Str1,Str2,···,StrN分别表示超声训练样本数据集Str中第一个超声训练样本、第二个超声训练样本、…第N个超声训练样本；第一个超声训练样本Str1的数据为由超声传感器采集的室内已知的第一组场景的超声阵列信息；2)对需要进行定位的测试样本场景进行采集超声阵列信息；设超声测试样本的个数为M，则得到超声测试样本数据集Ste的表达式为：Ste＝[Ste1,Ste2,···,SteM]  (2)其中Ste1,Ste2,···,SteM分别表示超声测试样本数据集Ste中第一个超声测试样本、第二个超声测试样本、…第M个超声测试样本；第一个超声测试样本Ste1的数据由超声传感器采集的来自需要定位的第一组室内场景的超声阵列信息；M和N分别为超声测试样本的个数和超声训练样本的个数，N≤M；3)设超声传感器放置的数量为l，则超声训练样本数据集中的任意的一个超声训练样本SI的长度为l，1≤I≤N，表达式为：SI＝[SI,1,SI,2,...,SI,l]，其中SI,1,SI,2,...,SI,l分别表示超声训练样本SI的第一个超声传感器的数据、第二个超声传感器的数据、…第l个超声传感器的数据；超声测试样本数据集中的任意的一个超声测试样本SJ的长度为l，1≤J≤M，表达式为：SJ＝[SJ,1,SJ,2,...,SJ,l]，其中SJ,1,SJ,2,...,SJ,l分别表示超声测试样本SJ的第一个超声传感器的数据、来自第二个超声传感器的数据、…第l个超声传感器的数据；对齐超声训练样本和超声测试样本：得到超声训练样本SI和超声测试样本SJ之后，将超声训练样本SI和超声测试样本SJ对齐，对齐就是分别找到超声训练样本SI和超声测试样本SJ的最小值和相应的下标，设超声训练样本SI的最小值为SI,minI，1≤minI≤l，则相应的下标为minI,超声测试样本SJ的最小值为SJ,minJ，1≤minJ≤l，则相应的下标为minJ,把超声训练样本SI和超声测试样本SJ的最小值SI,minI和SJ,minJ分别放到超声训练样本SI和超声测试样本SJ下标为1的位置上，超声训练样本SI和超声测试样本SJ剩下的数据按照原来的顺序，依次向后排列；4)超声训练样本SI和超声测试样本SJ对齐后得到新的超声训练样本SI′和超声测试样本SJ′，其中SI′＝[SI,1′,SI,2′,...,SI,l′]、SJ′＝[SJ,1′,SJ,2′,...,SJ,l′]，超声训练样本SI′和超声测试样本SJ′的距离被定义为：d(SI′,SJ′)＝||SI′‑SJ′||    (3)5)遍历超声训练样本数据集Str和超声测试样本数据集Ste，重复步骤3)，得到对齐后的超声训练样本数据集Str′和对齐后的超声测试样本数据集Ste′；对齐后超声测试样本数据集Ste′中任一超声测试样本SJ′与Str′之间的距离表达式为SJ′＝[SJ,1′,SJ,2′,...,SJ,l′]  (4)Str′＝[S1′,S2′,···,SN′]  (5)d(SJ′,Str′)＝[d(SJ′,S1′),d(SJ′,S2′),···,d(SJ′,SN′)]  (6)6)遍历超声测试样本数据集Ste′的每一个超声测试样本，重复公式(6)，计算Ste′与对齐后的超声训练样本数据集Str′的距离d(Ste′,Str′)，构建一个动态时间规整距离矩阵D：上述距离矩阵D中，D11是Ste′中第一个样本与Str′中第一个样本之间的距离，D1N是Ste′中第一个样本与Str′中第N个样本之间的距离，DM1是Ste′中第M个样本与Str′中第一个样本之间的距离，DMN是Ste′中第M个样本与Str′中第N个样本之间的距离；7)根据步骤6)得到的距离矩阵D，得到对齐后的超声测试样本数据集Ste′中第A个测试样本与对齐后的超声训练样本Str′的距离集合DA，DA的表达式为：DA＝[DA，1,DA，2,···,DA，N]  (8)其中1≤A≤M，求出距离集合DA表达式中的最小值DAo，其中第二个下标o范围为：1≤o≤N；根据最近邻算法，则距离集合DA中的第o个训练样本的场景位置即为第A个测试样本的场景定位；8)重复步骤7)，得到所有对齐后的超声测试样本的场景定位，完成由所有超声测试样本组成的目标场景类别的场景定位。