CN106341887A - 一种室内机器人定位方法及装置 - Google Patents

Abstract

本发明提供了一种室内机器人定位方法及装置，该方法包括：根据机器人接收的无线局域网的信号强度指示值确定机器人与无线局域网基站之间的距离；根据上述距离和无线局域网基站的位置坐标，确定机器人的位置坐标；获取机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；计算机器人接收的无线局域网的信号强度指示值与分布图上不同参考位置接收的无线局域网的信号强度指示值的匹配概率，根据匹配概率确定机器人的辅助定位位置坐标；根据机器人的位置坐标和辅助定位位置坐标确定机器人的实际位置坐标。本发明中，不仅能定位出机器人在室内的位置坐标，而且定位比较准确。

Description

一种室内机器人定位方法及装置

技术领域

本发明涉及机器人及定位技术领域，具体而言，涉及一种室内机器人定位方法及装置。

背景技术

随着机器人学的不断发展，室内机器人得到了越来越多的应用，比如说扫地机器人等等，在室内机器人应用中，能否准确的定位室内机器人的位置对于室内机器人的路径规划非常重要，因此，室内机器人定位是实现机器人自主导航的关键，对于提高机器人的自动化水平具有重要的意义。

现有的定位技术，有全球定位系统(Global Positioning System，GPS)、惯性导航系统(Inertial Navigation System，INS)等，GPS系统虽然能够提供稳定的导航信息，但是，当处于室内环境、楼宇密集、矿井及隧道等环境下时，GPS信号会衰减，导致无法检索到GPS信号，从而不能实现室内机器人的定位，而INS系统，随着使用时间的增加，误差会不断的积累，当长时间使用而不校准时，定位将产生极大的偏差，导致不能准确的定位出室内机器人的位置。

发明内容

有鉴于此，本发明实施例的目的在于提供一种室内机器人定位方法及装置，以解决现有技术中不能准确定位出机器人在室内的位置的问题。

第一方面，本发明实施例提供了一种室内机器人定位方法，其中，所述方法包括：

根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离；

根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标；

获取所述机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；

计算所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，根据所述匹配概率确定所述机器人的辅助定位位置坐标；

根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标。

结合第一方面，本发明实施例提供了上述第一方面的第一种可能的实现方式，其中，所述计算所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，包括：

确定所述机器人接收的无线局域网的信号强度指示值的平均值；

根据所述机器人接收的无线局域网的信号强度指示值及所述平均值，对所述机器人接收的信号强度指示值进行计数，得到所述机器人接收的无线局域网的信号强度指示值的计数值；

计算所述计数值与所述分布图上每个参考位置的匹配概率。

结合第一方面，本发明实施例提供了上述第一方面的第二种可能的实现方式，其中，所述根据所述匹配概率确定所述机器人的辅助定位位置坐标，包括：

确定每个所述参考位置对应的匹配概率与1的差值，选取所述差值的绝对值最小的匹配概率；

将所述差值的绝对值最小的匹配概率对应的参考位置的位置坐标确定为所述机器人的辅助定位位置坐标。

结合第一方面，本发明实施例提供了上述第一方面的第三种可能的实现方式，其中，所述根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离之前，还包括：

对机器人接收的无线局域网的信号强度指示值进行修正。

结合第一方面，本发明实施例提供了上述第一方面的第四种可能的实现方式，其中，所述根据所述机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离，包括：

计算距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值和所述机器人接收的无线局域网的信号强度值之间的差值；

根据所述机器人与所述无线局域网基站之间的距离的对数和所述差值之间的比例关系，确定所述机器人和所述无线局域网基站之间的距离。

结合第一方面，本发明实施例提供了上述第一方面的第五种可能的实现方式，其中，所述根据所述机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离，包括：

根据距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值和所述机器人接收的无线局域网的信号强度指示值，通过公式(1)计算所述机器人与所述无线局域网基站之间的距离；

$d={10}^{\frac{p\left(d_0\right)-p\left(d\right)}{10\·a}}---\left(1\right)$

其中，在公式(1)中，d为所述机器人与所述无线局域网基站之间的距离，d₀为所述预设距离，a为衰减常量，p(d₀)为距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值，p(d)为所述机器人接收的无线局域网的信号强度指示值。

结合第一方面，本发明实施例提供了上述第一方面的第六种可能的实现方式，其中，所述根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标，包括：

根据所述距离和所述无线局域网基站的位置坐标，通过公式(2)计算所述机器人的位置坐标；

(x-x_i)²+(y-y_i)²＝d_i ² (2)

其中，在公式(2)中，(x，y)为所述机器人的位置坐标，(x_i，y_i)为第i个所述无线局域网基站的位置坐标，d_i为所述机器人与所述第i个无线局域网基站之间的距离。

结合第一方面，本发明实施例提供了上述第一方面的第七种可能的实现方式，其中，所述根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标，包括：

计算所述机器人的位置坐标和所述机器人的辅助定位位置坐标的平均坐标；

将所述平均坐标确定为所述机器人的实际位置坐标。

第二方面，本发明实施例提供了一种室内机器人定位装置，其中，所述装置包括：

第一确定模块，用于根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离；

第二确定模块，用于根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标；

获取模块，用于获取所述机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；

匹配模块，用于将所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，根据所述匹配概确定所述机器人的辅助定位位置坐标；

第三确定模块，用于根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标。

结合第二方面，本发明实施例提供了上述第二方面的第一种可能的实现方式，其中，所述匹配模块包括：

选取单元，用于确定每个所述参考位置对应的匹配概率与1的差值，选取所述差值的绝对值最小的匹配概率；

第一确定单元，用于将所述差值的绝对值最小的匹配概率对应的参考位置的位置坐标确定为所述机器人的辅助定位位置坐标。

本发明实施例提供的室内机器人定位方法及装置，通过无线局域网(WirelessLocal Area Networks，WLAN)定位机器人在室内的位置，不仅能够定位出机器人在室内的位置，而且定位比较准确。

为使本发明的上述目的、特征和优点能更明显易懂，下文特举较佳实施例，并配合所附附图，作详细说明如下。

附图说明

为了更清楚地说明本发明实施例的技术方案，下面将对实施例中所需要使用的附图作简单地介绍，应当理解，以下附图仅示出了本发明的某些实施例，因此不应被看作是对范围的限定，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他相关的附图。

图1示出了本发明实施例1所提供的室内机器人定位方法的流程图；

图2示出了本发明实施例2所提供的室内机器人定位装置的结构示意图。

具体实施方式

为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。通常在此处附图中描述和示出的本发明实施例的组件可以以各种不同的配置来布置和设计。因此，以下对在附图中提供的本发明的实施例的详细描述并非旨在限制要求保护的本发明的范围，而是仅仅表示本发明的选定实施例。基于本发明的实施例，本领域技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例，都属于本发明保护的范围。

考虑到现有的定位技术有GPS定位、INS定位，虽然GPS系统虽然能够提供稳定的导航信息，但是当处于室内环境、楼宇密集、矿井和隧道等环境下时，GPS信号会衰减，导致无法检测到GPS信号，进而不能实现机器人的定位，而INS定位，随着时间的累加，误差会不断的积累，当长时间使用而不进行校准时，定位将产生很大的偏差，导致不能准确的定位出机器人在室内的位置。基于此，本发明实施例提供了一种室内机器人定位方法及装置，下面通过实施例进行描述。

实施例1

本发明实施例提供了一种室内机器人定位方法，该方法通过WLAN实现机器人在室内的定位，不仅能够定位出机器人在室内的位置，而且定位比较准确。

采用本发明实施例提供的方法定位机器人在室内的位置之前，需要在室内设置多个WLAN无线局域网基站，该WLAN无线局域网基站可以是路由器、中继器、无线接入点或者无线保真(Wireless-Fidelity，WIFI)模块等等。

本发明实施例中，在房间内设置有多个无线局域网基站，机器人移动到任意位置时，均可以接收到不止一个无线局域网基站发射的信号，在设置无线局域网基站时，需要确定无线局域网基站的位置坐标，以房间内的某一个角落作为坐标原点，确定出每个无线局域网基站的位置坐标，在本发明实施例中出现的所有的位置坐标均是以同一个角落作为坐标原点。

比如说，在某个实施例中，室内的面积为10平方米，将室内划分为0.1m×0.1m的网格单元，无线局域网基站可以设置三台，以房间内的某个角落作为坐标原点，三个无线局域网基站的坐标分别是(1.2,3.6)、(7.8,6.3)和(2.5,8.4)，此处，只是举例说明一种室内无线局域网基站的设置数量及位置，并没有限定室内的面积、无线局域网基站的数量及坐标，无线局域网基站的数量和坐标可以根据实际应用场景进行设置。

采用本发明实施例提供的方法定位机器人在室内的位置时，包括步骤S110-S150，具体如下。

在本发明实施例中，如果机器人所在的室内存在一些障碍物，比如说，存在一些玻璃、桌椅、墙壁等障碍物时，会影响无线局域网信号的传输，这时，需要对机器人接收的无线局域网的信号强度指示值进行修正，具体可以通过公式进行修正，其中，在该公式中，为机器人所在位置接收的无线局域网的信号强度指示值的平均路径损耗，为距离无线局域网基站d₀距离处接收的无线局域网的信号强度指示值的平均路径损耗，F为衰减因子，n_SF为常数，d₀为参考距离，即与无线局域网基站之间的距离，该距离为预设的，可以为1m、10m等等，d为机器人所在位置与无线局域网基站之间的距离，该距离可以通过机器人底座上的电机尾部的编码器的读数得到。

当上述障碍物不同时，衰减因子F取不同的值。

当计算出机器人所在位置接收的无线局域网的信号强度指示值的平均路径损耗后，将与机器人接收到的无线局域网的信号强度指示值相乘，得到修正后的信号强度指示值，即机器人实际接收的无线局域网的信号强度指示值。

在本发明实施例中，下文出现的机器人接收到的无线局域网的信号强度指示值，均指的是修正后的信号强度指示值，即机器人实际接收的无线局域网的信号强度指示值。

S110，根据机器人接收的无线局域网的信号强度指示值确定机器人与无线局域网基站之间的距离。

由于室内设置有多个无线局域网基站，机器人在室内移动到任意位置均可以接收到不止一个无线局域网基站发射的信号强度指示值，根据信号强度指示值确定机器人和无线局域网基站之间的距离，具体包括：

计算距离无线局域网基站预设距离时机器人接收的无线局域网的信号强度指示值和机器人接收的无线局域网的信号强度指示值之间的差值；根据机器人与无线局域网基站之间的距离的对数和上述差值之间的比例关系，确定机器人和无线局域网基站之间的距离。

机器人与无线局域网基站之间的距离的对数和上述差值之间存在一定的比例关系，因此，可以通过上述比例关系确定出机器人和信号与无线局域网基站之间的距离，具体过程为：

根据距离无线局域网基站预设距离时机器人接收的无线局域网的信号强度指示值和机器人接收的无线局域网的信号强度指示值，通过公式(1)计算机器人与无线局域网基站之间的距离；

$d={10}^{\frac{p\left(d_0\right)-p\left(d\right)}{10\·a}}---\left(1\right)$

其中，在公式(1)中，d为机器人与无线局域网基站之间的距离，d₀为预设距离，a为衰减常量，p(d₀)为距离无线局域网基站预设距离时机器人接收的无线局域网的信号强度指示值，p(d)为机器人接收的无线局域网的信号强度指示值。

上述预设距离为预先设置的一个距离值，可以为1m、2m等，该数值可以根据实际应用场景进行设置，本发明实施例并不限定上述预设距离的具体数值。

在本发明实施例中，首先获取距离无线局域网基站预设距离的位置接收的无线局域网的信号强度指示值p(d₀)，将p(d₀)作为一个参考值，当机器人在移动过程中，不断获取机器人接收的无线局域网的信号强度指示值p(d)，根据公式(1)计算出机器人和无线局域网基站之间的距离。

机器人在移动过程中接收不止一个无线局域网基站发射的网络信号，因此，通过上述方法可以计算出机器人和每个无线局域网基站之间的距离。

S120，根据上述距离和无线局域网基站的位置坐标，确定机器人的位置坐标。

当计算出机器人和无线局域网基站之间的距离后，根据计算出的距离和无线局域网基站的位置坐标，确定机器人的位置坐标，具体包括：

根据上述距离和无线局域网基站的位置坐标，通过公式(2)计算机器人的位置坐标；

(x-x_i)²+(y-y_i)2＝d_i ² (2)

在公式(2)中，(x，y)为机器人的位置坐标，(x_i，y_i)为第i个无线局域网基站的位置坐标，d_i为机器人与第i个无线局域网基站之间的距离。

机器人在移动过程中能够接收到不止一个无线局域网基站发射的网络信号，可以接收3个无线局域网基站发射的网络信号，也可以接收4个无线局域网基站发射的网络信号，当然还可以接收其它数量个无线局域网基站发射的网络信号，能够接收的无线局域网基站的个数可以根据具体应用场景确定，本发明实施例并不限定上述无线局域网基站的具体数目。

下面将以三个无线局域网基站为例，详细介绍根据上述距离和无线局域网基站的位置坐标确定机器人的位置坐标的具体过程：

当上述无线局域网基站的数目为三个时，将三个无线局域网基站分别记为第一个无线局域网基站、第二个无线局域网基站和第三个无线局域网基站，通过公式(1)可以分别计算出机器人与第一个无线局域网基站之间的距离d₁，机器人与第二个无线局域网基站之间的距离d₂，机器人与第三个无线局域网基站之间的距离d₃，且将第一个无线局域网基站的位置坐标记为(x₁，y₁)，将第二个无线局域网基站的位置坐标记为(x₂，y₂)，将第三个无线局域网基站的位置坐标记为(x₃，y₃)，将机器人的位置坐标记为(x，y)，根据第一个无线局域网基站的位置坐标及第一个无线局域网基站和机器人之间的距离，通过公式(2)可以列出方程式根据第二个无线局域网基站的位置坐标及第二个无线局域网基站和机器人之间的距离，通过公式(2)可以得出方程式根据第三个无线局域网基站的位置坐标及第三个无线局域网基站和机器人之间的距离，通过公式(2)可以得出方程式将上述得出的三个方程式联立，可以计算出机器人的位置坐标，该三个方程式计算出的机器人的位置坐标为

$\left[\begin{array}{c}x\\ y\end{array}\right]=\left[\begin{array}{c}\left(y_2-y_3\right)\frac{x_2^2-x_3^2+y_2^2-y_3^2+d_3^2-d_2^2}{2\left(x_1-x_3\right)\left(y_2-y_3\right)-2\left(x_2-x_3\right)\left(y_1-y_3\right)}+\left(y_3-y_1\right)\frac{x_1^2-x_3^2+y_1^2-y_3^2+d_3^2-d_1^2}{2\left(x_1-x_3\right)\left(y_2-y_3\right)-2\left(x_2-x_3\right)\left(y_1-y_3\right)}\\ \left(x_3-x_2\right)\frac{x_2^2-x_3^2+y_2^2-y_3^2+d_3^2-d_2^2}{2\left(x_1-x_3\right)\left(y_2-y_3\right)-2\left(x_2-x_3\right)\left(y_1-y_3\right)}+\left(x_1-x_3\right)\frac{x_1^2-x_3^2+y_1^2-y_3^2+d_3^2-d_1^2}{2\left(x_1-x_3\right)\left(y_2-y_3\right)-2\left(x_2-x_3\right)\left(y_1-y_3\right)}\end{array}\right]$

将通过该方法计算得出的机器人的位置坐标记为机器人的位置坐标。

有时通过上述三个方程可能无法得出机器人的位置坐标，这时可以采用如下方法计算机器人的位置坐标，通过上述三个方程，求解A圆和B圆的交点坐标，记为(X_ab1，Y_ab1),(X_ab2，Y_ab2),圆A与圆C的交点坐标，记为(X_ac1，Y_ac1)，(X_ac2，Y_ac2).圆B和圆C的交点坐标，记为(X_bc1，Y_bc1)，(X_bc2，Y_bc2),其中，A圆指的是包含第一个ZigBee节点(x₁，y₁)在内的圆，但是，第一个ZigBee节点(x₁，y₁)并不是A圆的圆心，B圆指的是包含第二个ZigBee节点(x₂，y₂)在内的圆，但是第二个ZigBee节点(x₂，y₂)并不是B圆的圆心，C圆指的是包含第三个ZigBee节点(x₃，y₃)在内的圆，但是第三个ZigBee节点(x₃，y₃)并不是该圆的圆心，将圆A与圆C的交点坐标带入公式中，可以确定出距离B圆圆心较近的点的坐标，记为(X_ac，Y_ac)，同理可以确定出距离A圆圆心较近的点的坐标，记为(X_bc，Y_bc),距离C圆圆心较近的点的坐标，记为(X_ab，Y_ab)，根据上述三个点的坐标，可以得出机器人的位置坐标为其中，(x，y)为机器人的位置坐标。

S130，获取机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图。

在采用本发明实施例提供的方法定位机器人在室内的位置时，需要预先建立室内不同参考位置接收的无线局域网的信号强度指示值的分布图，具体过程包括：

首先获取机器人所在室内的地图，根据选取的无线局域网基站的功率将上述室内的地图划分成多个正方形网格，每个正方形网格的大小是一样的，确每个正方形网格的初始计数值为0，将每个正方形网格确定为一个参考位置，每个正方形网格均可以接收不止一个无线局域网基站发射的信号，计算每个正方形网格接收的多个无线局域网基站发射的信号强度指示值的平均值，将该平均值确定为信号阈值，将该正方形网格接收到的某个无线局域网基站的信号强度指示值与该信号阈值进行比较，当信号强度指示值大于该信号阈值时，将该正方形网格的计数值加1，当信号强度指示值小于该信号阈值时，将该正方形网格的计数值减1，当信号强度指示值等于信号阈值时，该正方形网格的计数值不发生变化，通过上述方法可以得到每个正方形网格的信号强度指示值的计数值，根据每个正方形网格的位置坐标及该位置坐标对应的计数值，建立机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图。

除此之外，还可以对机器人接收的无线局域网的信号强度指示值进行计数，用计数值表示机器人在每个参考位置接收的无线局域网的信号强度指示值。

具体过程包括：首先将机器人所在区域划分为多个正方形网格，且将每个正方形网格的初始计数值设置为0，每个正方形网格表示一个参考位置，该正方形网格的大小可以与无线局域网基站的功率有关系，可以根据具体应用时选取的无线局域网基站的功率进行设置，本发明实施例并不限定上述正方形网格的具体大小；采集每个正方形网格接收的无线局域网的信号强度指示值，每个正方形网格处均可以接收到不止一个无线局域网基站发射的信号，计算正方形网格接收到的信号强度指示值的平均值，将该平均值作为阈值，并将该正方形网格出接收到的每个无线局域网基站发射的信号强度指示值与该阈值进行比较，当该指示值大于阈值时，将该正方形网格的计数值加1，当该指示值等于阈值时，该正方形网格的计数值不发生变化，当该指示值小于阈值时，将该正方形网格的计数值减1，由此得到每个正方形网格计数值，得到上述分布图。

S140，计算机器人接收的无线局域网的信号强度指示值与上述分布图上不同参考位置的匹配概率，根据匹配概率确定机器人的辅助定位位置坐标。

机器人在移动过程中，移动到室内任何位置时，均可以接收到不止一个无线局域网基站发射的信号，计算机器人接收的无线局域网的信号强度指示值与上述分布图上不同参考位置的匹配概率，具体包括：确定机器人接收的无线局域网的信号强度指示值的平均值；根据机器人接收的无线局域网的信号强度指示值及上述平均值，对机器人接收的无线局域网的信号强度指示值进行计数，得到机器人接收的无线局域网的信号强度指示值的计数值；计算上述计数值与分布图上每个参考位置的匹配概率。

在本发明实施例中，将机器人移动到任何位置时接收到的无线局域网的信号强度指示值的计数值的初始值设置为0，当机器人在移动过程中，确定出机器人在当前位置接收到的无线局域网的信号强度指示值的平均值，将机器人接收到的多个无线局域网基站发射的信号强度指示值与该平均值进行比较，当信号强度指示值大于平均值时，将当前位置对应的计数值加1，当信号强度指示值等于平均值时，当前位置对应的计数值不发生变化，当信号强度指示值小于平均值时，将当前位置对应的计数值减1，得到当前位置的对应最终计数值，将该最终计数值分别与每个正方形网格的计数值进行匹配，即计算上述最终计数值与每个正方形网格的计数值的比值，将该比值确定为匹配概率。

确定每个参考位置对应的匹配概率与1的差值，选取差值的绝对值最小的匹配概率；将上述差值的绝对值最小的匹配概率对应的参考位置的位置坐标确定为机器人的辅助的行为位置坐标。

当上述计算出的机器人接收的无线局域网的信号强度指示值的计数值与分布图上不同正方形网格处的计数值越接近，两者的比值越接近1，这时两者的匹配程度越高。

S150，根据上述机器人的位置坐标和机器人的辅助定位位置坐标确定机器人的实际位置坐标。

当通过上述两种方法分别计算出机器人的位置坐标和机器人的辅助定位位置坐标后，根据机器人的位置坐标和辅助定位位置坐标确定机器人的实际位置坐标，具体包括：

计算机器人的实际位置坐标和机器人的辅助定位位置坐标的平均坐标；将上述平均坐标确定为机器人的实际位置坐标。

上述计算出的机器人的辅助定位位置坐标可能有多个，当定位出多个辅助定位位置坐标时，将机器人的多个辅助定位位置坐标与机器人的位置坐标进行比较，选取与机器人的位置坐标最接近的机器人辅助定位位置坐标，计算该最接近的机器人的辅助定位位置坐标与机器人的位置坐标的平均值，将该平均值确定为机器人的实际位置坐标。

上述将两种方法确定的位置坐标求平均，得到的定位出的机器人的位置更准确，减少了误差。

除此之外，还可以通过如下匹配的方法，确定出机器人的辅助定位位置坐标，首先需要建立机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图，具体过程为：

首先在室内选取多个参考位置，该参考位置的数目和在室内所处的位置坐标可以根据实际应用场景进行选取，本发明实施例并不限定上述参考位置的数据和在室内的具体位置坐标。

当选取了参考位置后，在每个参考位置均可以接收到不止一个无线局域网基站传输的网络信号，且接收的信号强度指示值符合正太分布，因此，可以得出在某个参考位置接收的无线局域网的信号强度指示值的似然函数，在该公式中，μ为在该参考位置接收到的无线局域网的信号强度指示值的期望，σ为在该参考位置接收的无线局域网的信号强度指示值的标准差，且μ和σ均为未知参数，x_i为上述参考位置接收的第i个无线局域网基站的信号强度指示值，n为接收的无线局域网基站的个数，求取上述似然函数的对数函数将该对数函数对期望和偏差求偏微分，可以得到该对数函数的极大死燃气函数，根据该极大似然函数，求取出概率密度最大时对应的期望和方差，将该期望确定为该参考位置接收为无线局域网的信号强度指示值，通过上述方法计算出每个参考位置接收的无线局域网的信号强度指示值，根据每个参考位置的位置坐标、接收的无线局域网的信号强度指示值及方差建立室内分布图。

在对机器人进行定位时，则直接获取机器人所在室内的分布图。

当上述分布图中每个参考位置处接收的信号强度指示值是通过期望和方差表征时，可以通过如下方法计算匹配概率，具体包括：机器人移动到任意位置时，均可以接收到多个无线局域网基站发射的信号强度指示值，首先计算接收到的其中一个无线局域网基站在分布图上每个参考位置的概率，通过如下公式计算，在该公式中，m为分布图上参考位置的个数，μ_m为第m个参考位置接收的无线局域网的信号强度指示值，σ_m为第m个参考位置接收的无线局域网的信号强度指示值的方差，RSSI_t为机器人接收的第t个无线局域网基站发射的信号强度指示值，t为机器人可接收信号的无线局域网基站的个数，p_m(x，y)为在第m个参考位置的概率，通过上述公式计算接收的第t个无线局域网基站在分布图上每个参考位置的概率，采用同样的方法计算出接收的t各无线局域网基站在分布图上每个参考位置的概率，将每个参考位置的t各概率值相乘，得到每个参考位置对应的匹配概率。

将每个参考位置对应的匹配概率进行比较，选取最大的匹配概率，将最大的匹配概率对应的参考位置确定为机器人的辅助定位位置坐标，计算机器人的位置坐标和机器人的辅助定位位置坐标之间的平均值，将该平均值确定为机器人的实际位置坐标。

本发明实施例提供的室内机器人定位方法，不仅能够定位出机器人在室内的位置，而且定位的比较准确。

实施例2

本发明实施例提供了一种室内机器人定位装置，如图2所示，该装置包括第一确定模块210、第二确定模块220、获取模块230、匹配模块240及第三确定模块250；

上述第一确定模块210，用于根据机器人接收的无线局域网的信号强度指示值确定机器人与无线局域网基站之间的距离；

上述第二确定模块220，用于根据上述距离和无线局域网基站的位置坐标，确定机器人的位置坐标；

上述获取模块230，用于获取机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；

上述匹配模块240，用于计算机器人接收的无线局域网的信号强度指示值与上述分布图上不同参考位置的匹配概率，根据匹配概率确定机器人的辅助定位位置坐标；

上述第三确定模块250，用于根据机器人的位置坐标和机器人的辅助定位位置坐标确定机器人的实际位置坐标。

其中，上述匹配模块240根据匹配概率确定机器人的辅助定位位置坐标，是通过比较单元和第一确定单元实现的，具体包括：

上述选取单元，用于确定每个参考位置对应的匹配概率与1的差值，选取该差值的绝对值最小的匹配概率；上述第一确定单元，用于将上述差值的绝对值最小匹配概率对应的参考位置的位置坐标确定为机器人的辅助定位位置坐标。

本发明实施例提供的室内机器人定位装置，不仅能够定位出机器人在室内的位置，而且定位比较准确。

本发明实施例所提供的室内机器人定位装置可以为设备上的特定硬件或者安装于设备上的软件或固件等。本发明实施例所提供的装置，其实现原理及产生的技术效果和前述方法实施例相同，为简要描述，装置实施例部分未提及之处，可参考前述方法实施例中相应内容。所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，前述描述的系统、装置和单元的具体工作过程，均可以参考上述方法实施例中的对应过程，在此不再赘述。

在本发明所提供的实施例中，应该理解到，所揭露装置和方法，可以通过其它的方式实现。以上所描述的装置实施例仅仅是示意性的，例如，所述单元的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，又例如，多个单元或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些通信接口，装置或单元的间接耦合或通信连接，可以是电性，机械或其它的形式。

所述作为分离部件说明的单元可以是或者也可以不是物理上分开的，作为单元显示的部件可以是或者也可以不是物理单元，即可以位于一个地方，或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。

另外，在本发明提供的实施例中的各功能单元可以集成在一个处理单元中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个单元中。

所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时，可以存储在一个计算机可读取存储介质中。基于这样的理解，本发明的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来，该计算机软件产品存储在一个存储介质中，包括若干指令用以使得一台计算机设备(可以是个人计算机，服务器，或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(ROM，Read-Only Memory)、随机存取存储器(RAM，Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。

应注意到：相似的标号和字母在下面的附图中表示类似项，因此，一旦某一项在一个附图中被定义，则在随后的附图中不需要对其进行进一步定义和解释，此外，术语“第一”、“第二”、“第三”等仅用于区分描述，而不能理解为指示或暗示相对重要性。

最后应说明的是：以上所述实施例，仅为本发明的具体实施方式，用以说明本发明的技术方案，而非对其限制，本发明的保护范围并不局限于此，尽管参照前述实施例对本发明进行了详细的说明，本领域的普通技术人员应当理解：任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，其依然可以对前述实施例所记载的技术方案进行修改或可轻易想到变化，或者对其中部分技术特征进行等同替换；而这些修改、变化或者替换，并不使相应技术方案的本质脱离本发明实施例技术方案的精神和范围。都应涵盖在本发明的保护范围之内。因此，本发明的保护范围应以所述权利要求的保护范围为准。

Claims (10)

1.一种室内机器人定位方法，其特征在于，所述方法包括：

根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离；

根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标；

获取所述机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；

计算所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，根据所述匹配概率确定所述机器人的辅助定位位置坐标；

根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标。

2.根据权利要求1所述的方法，其特征在于，所述计算所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，包括：

确定所述机器人接收的无线局域网的信号强度指示值的平均值；

根据所述机器人接收的无线局域网的信号强度指示值及所述平均值，对所述机器人接收的无线局域网的信号强度指示值进行计数，得到所述机器人接收的无线局域网的信号强度指示值的计数值；

计算所述计数值与所述分布图上每个参考位置的匹配概率。

3.根据权利要求1所述的方法，其特征在于，所述根据所述匹配概率确定所述机器人的辅助定位位置坐标，包括：

确定每个所述参考位置对应的匹配概率与1的差值，选取所述差值的绝对值最小的匹配概率；

将所述差值的绝对值最小的匹配概率对应的参考位置的位置坐标确定为所述机器人的辅助定位位置坐标。

4.根据权利要求1所述的方法，其特征在于，所述根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离之前，还包括：

对机器人接收的无线局域网的信号强度指示值进行修正。

5.根据权利要求1所述的方法，其特征在于，所述根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离，包括：

计算距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值和所述机器人接收的无线局域网的信号强度值之间的差值；

根据所述机器人与所述无线局域网基站之间的距离的对数和所述差值之间的比例关系，确定所述机器人和所述无线局域网基站之间的距离。

6.根据权利要求1所述的方法，其特征在于，所述根据所述机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离，包括：

根据距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值和所述机器人接收的无线局域网的信号强度指示值，通过公式(1)计算所述机器人与所述无线局域网基站之间的距离；

$d={10}^{\frac{p\left(d_0\right)-p\left(d\right)}{10\·a}}---\left(1\right)$

其中，在公式(1)中，d为所述机器人与所述无线局域网基站之间的距离，d₀为所述预设距离，a为衰减常量，p(d₀)为距离所述无线局域网基站预设距离时所述机器人接收的无线局域网的信号强度指示值，p(d)为所述机器人接收的无线局域网的信号强度指示值。

7.根据权利要求1所述的方法，其特征在于，所述根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标，包括：

根据所述距离和所述无线局域网基站的位置坐标，通过公式(2)计算所述机器人的位置坐标；

(x-x_i)²+(y-y_i)²＝d_i ² (2)

其中，在公式(2)中，(x，y)为所述机器人的位置坐标，(x_i，y_i)为第i个所述无线局域网基站的位置坐标，d_i为所述机器人与所述第i个无线局域网基站之间的距离。

8.根据权利要求1所述的方法，其特征在于，所述根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标，包括：

计算所述机器人的位置坐标和所述机器人的辅助定位位置坐标的平均坐标；

将所述平均坐标确定为所述机器人的实际位置坐标。

9.一种室内机器人定位装置，其特征在于，所述装置包括：

第一确定模块，用于根据机器人接收的无线局域网的信号强度指示值确定所述机器人与无线局域网基站之间的距离；

第二确定模块，用于根据所述距离和所述无线局域网基站的位置坐标，确定所述机器人的位置坐标；

获取模块，用于获取所述机器人所在区域不同参考位置接收的无线局域网的信号强度指示值的分布图；

匹配模块，计算所述机器人接收的无线局域网的信号强度指示值与所述分布图上不同参考位置的匹配概率，根据所述匹配概率确定所述机器人的辅助定位位置坐标；

第三确定模块，用于根据所述机器人的位置坐标和所述机器人的辅助定位位置坐标确定所述机器人的实际位置坐标。

10.根据权利要求9所述的装置，其特征在于，所述匹配模块包括：

比较单元，用于确定每个所述参考位置对应的匹配概率与1的差值，选取所述差值的绝对值最小的匹配概率；

第一确定单元，用于将所述差值的绝对值最小的匹配概率对应的参考位置的位置坐标确定为所述机器人的辅助定位位置坐标。