本发明实施例涉及机器人图像信息处理技术，尤其涉及一种机器人定位方法、装置、设备及存储介质。
背景技术：
在移动机器人领域中，二维栅格地图是机器人进行定位和导航的重要依据和前提。它使得机器人实现空间定位，进行路劲规划，避障和导航。
但是，目前使用的二维栅格地图表示的环境信息是单一和不完备的，它只能在二维方向上显示空间信息，无法表达实际环境中每个物体的语义信息。
因此，亟需一种方法能够准确定位移动机器人的位置，以实现从不同维度为移动机器人提供环境信息，进一步提高移动机器人的定位准确度。
技术实现要素：
本发明提供一种机器人定位方法、装置、设备及存储介质，以实现从不同维度为移动机器人提供环境信息，进一步提高移动机器人的定位准确度。
第一方面，本发明实施例提供了一种机器人定位方法，包括：
通过机器人上搭载的图像采集器采集环境图像；
将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
根据所述目标标志物的空间位置
第二方面，本发明实施例还提供了一种机器人定位装置，包括：
图像采集装置，用于通过机器人上搭载的图像采集器采集环境图像；
目标标志物匹配装置，用于将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
机器人空间位置确定装置，用于根据所述目标标志物的空间位置
第三方面，本发明实施例还提供了一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现如本发明实施例中任一所述的机器人定位方法。
第四方面，本发明实施例还提供了一种计算机可读存储介质，其上存储有计算机程序，该程序被处理器执行时实现如本发明实施例中任一所述的机器人定位方法。
本发明实施例通过机器人上搭载的图像采集器采集环境图像；将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；根据所述目标标志物的空间位置
附图说明
图1是本发明实施例一中提供的一种机器人定位方法的流程示意图；
图2是本发明实施例二中提供的一种机器人定位方法的流程示意图；
图3是本发明实施例三中提供的一种机器人定位装置的结构示意图；
图4是本发明实施例四中提供的一种设备的结构示意图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是，此处所描述的具体实施例仅仅用于解释本发明，而非对本发明的限定。另外还需要说明的是，为了便于描述，附图中仅示出了与本发明相关的部分而非全部结构。
在更加详细地讨论示例性实施例之前应当提到的是，一些示例性实施例被描述成作为流程图描绘的处理或方法。虽然流程图将各步骤描述成顺序的处理，但是其中的许多步骤可以被并行地、并发地或者同时实施。此外，各步骤的顺序可以被重新安排。当其操作完成时所述处理可以被终止，但是还可以具有未包括在附图中的附加步骤。所述处理可以对应于方法、函数、规程、子例程、子程序等等。
实施例一
图1是本发明实施例一提供的一种机器人定位方法的流程示意图，本实施例可适用于在复杂的环境中定位移动机器人的位置以便移动机器人进行路径规划的情况，该方法可以由机器人定位装置来执行，该装置可以采用软件和/或硬件的方式实现，并可集成于电子设备中，具体包括如下步骤：
步骤110、通过机器人上搭载的图像采集器采集环境图像。
本实施例中，机器人可以是扫地机器人或者是适用在复杂环境中的移动机器人，其上搭载的图像采集器可以是照相机、摄像机或者具有拍照功能的电子设备。通过图像采集器拍摄环境中的图像。示例性的，如在博物馆内拍摄室内建筑的分布情况。
步骤120、将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物。
候选标志物是指在机器人存储的数据库中的标志物，示例性的，当环境图像中包含有桌子，则将拍摄到的桌子与机器人存储的该环境下的数据库中的物体进行匹配，当匹配到环境图像中的桌子时，则说明该桌子是目标标志物。如果在该场景下，并没有匹配到环境图像中的桌子，则通过机器人搭载的图像采集器重新采集环境图像。
步骤130、根据所述目标标志物的空间位置
本实施例中，在目标标志物的空间位置
可选的，所述根据所述目标标志物的空间位置
根据如下公式，确定所述机器人的空间位置：
其中，δdi是所述机器人在xj观测到
本实施例中，目标标志物的数量可以是两个以上，示例性的，当目标标志物的数量为两个，则将其中一个目标标志物的空间位置记为
本发明实施例通过机器人上搭载的图像采集器采集环境图像；将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；根据所述目标标志物的空间位置
实施例二
图2是本发明实施例二提供的一种机器人定位方法的流程示意图，本实施例可适用于移动机器人在行进中躲避障碍物的情况，该方法可以由机器人定位装置来执行，该装置可以采用软件和/或硬件的方式实现，并可集成于电子设备中，具体包括如下步骤：
步骤210、通过机器人上搭载的图像采集器采集环境图像。
步骤220、将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物。
可选的，将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物，包括：
根据所述环境图像中物体在图像坐标系中的三维空间位置，确定所述物体的特征向量和协方差矩阵；
根据所述物体的特征向量和所述物体的协方差矩阵，以及候选标志物的特征向量和协方差矩阵，确定物体与候选标志物的位置偏差；
若物体与任一候选标志物的位置偏差小于偏差阈值，则将该标志物作为目标标志物。
本实施例中，由物体在环境图像中的位置和图像采集器内置的参数矩阵得到物体在图像坐标系中的三维空间位置，具体通过如下公式计算得到：
其中，
其中，
步骤230、根据所述目标标志物的空间位置
步骤240、根据所述目标标志物的空间位置，确定所述目标标志物在所述机器人坐标系下的空间位置。
本实施例中，在步骤220中确定物体在图像坐标系中的三维空间位置后，通过公式
进一步地，将机器人坐标系下的物体的空间位置映射在二维栅格地图中，以便于机器人进行路径规划。通过如下公式进行转化：
其中，s(x,y)为物体在二维栅格地图中机器人坐标系下的坐标。
可选的，所述根据所述目标标志物的空间位置，确定所述目标标志物在所述机器人坐标系下的空间位置，还包括：
根据如下公式，
其中，
进一步地，若物体是动态的，则在s(x,y)添加一个障碍物消退函数f(t)，这样设置的好处是可以使机器人在路径规划时，避开物体。
其中，
a为预设的时间值，根据s(x,y)和当前机器人的距离调节机器人的移动速度，机器人的移动速度随着障碍物距离的接近而缩小，以给出足够的时间进行避障。
本发明实施例通过机器人上搭载的图像采集器采集环境图像；将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；根据所述目标标志物的空间位置
实施例三
图3为本发明实施例三提供的一种机器人定位装置的结构示意图。本发明实施例所提供的一种机器人定位装置可执行本发明任意实施例所提供的机器人定位方法，具备执行方法相应的功能模块和有益效果。如图3所示，该装置包括：
图像采集装置301，用于通过机器人上搭载的图像采集器采集环境图像；
目标标志物匹配装置302，用于将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
机器人空间位置确定装置303，用于根据所述目标标志物的空间位置
所述目标标志物匹配装置302，具体用于：
根据所述环境图像中物体在图像坐标系中的三维空间位置，确定所述物体的特征向量和协方差矩阵；
根据所述物体的特征向量和所述物体的协方差矩阵，以及候选标志物的特征向量和协方差矩阵，确定物体与候选标志物的位置偏差；
若物体与任一候选标志物的位置偏差小于偏差阈值，则将该标志物作为目标标志物。
所述机器人空间位置确定装置303，具体用于：
根据如下公式，确定所述机器人的空间位置：
其中，δdi是所述机器人在xj观测到
所述装置，还包括：
确定目标标志物机器人坐标系下的空间位置模块，用于根据所述目标标志物的空间位置，确定所述目标标志物在所述机器人坐标系下的空间位置。
所述确定目标标志物机器人坐标系下的空间位置模块，还用于：
根据如下公式，
其中，
所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述装置的具体工作过程，可以参考前述方法实施例中的对应过程，在此不再赘述。
实施例四
图4为本发明实施例四提供的一种设备的结构示意图，图4示出了适于用来实现本发明实施例实施方式的示例性设备的结构示意图。图4显示的设备12仅仅是一个示例，不应对本发明实施例的功能和使用范围带来任何限制。
如图4所示，设备12以通用计算设备的形式表现。设备12的组件可以包括但不限于：一个或者多个处理器或者处理单元16，系统存储器28，连接不同系统组件(包括系统存储器28和处理单元16)的总线18。
总线18表示几类总线结构中的一种或多种，包括存储器总线或者存储器控制器，外围总线，图形加速端口，处理器或者使用多种总线结构中的任意总线结构的局域总线。举例来说，这些体系结构包括但不限于工业标准体系结构(isa)总线，微通道体系结构(mac)总线，增强型isa总线、视频电子标准协会(vesa)局域总线以及外围组件互连(pci)总线。
设备12典型地包括多种计算机系统可读介质。这些介质可以是任何能够被设备12访问的可用介质，包括易失性和非易失性介质，可移动的和不可移动的介质。
系统存储器28可以包括易失性存储器形式的计算机系统可读介质，例如随机存取存储器(ram)30和/或高速缓存存储器32。设备12可以进一步包括其它可移动/不可移动的、易失性/非易失性计算机系统存储介质。仅作为举例，存储系统34可以用于读写不可移动的、非易失性磁介质(图4未显示，通常称为“硬盘驱动器”)。尽管图4中未示出，可以提供用于对可移动非易失性磁盘(例如“软盘”)读写的磁盘驱动器，以及对可移动非易失性光盘(例如cd-rom,dvd-rom或者其它光介质)读写的光盘驱动器。在这些情况下，每个驱动器可以通过一个或者多个数据介质接口与总线18相连。系统存储器28可以包括至少一个程序产品，该程序产品具有一组(例如至少一个)程序模块，这些程序模块被配置以执行本发明实施例各实施例的功能。
具有一组(至少一个)程序模块42的程序/实用工具40，可以存储在例如系统存储器28中，这样的程序模块42包括但不限于操作系统、一个或者多个应用程序、其它程序模块以及程序数据，这些示例中的每一个或某种组合中可能包括网络环境的实现。程序模块42通常执行本发明实施例所描述的实施例中的功能和/或方法。
设备12也可以与一个或多个外部设备14(例如键盘、指向设备、显示器24等)通信，还可与一个或者多个使得用户能与该设备12交互的设备通信，和/或与使得该设备12能与一个或多个其它计算设备进行通信的任何设备(例如网卡，调制解调器等等)通信。这种通信可以通过输入/输出(i/o)接口22进行。并且，设备12还可以通过网络适配器20与一个或者多个网络(例如局域网(lan)，广域网(wan)和/或公共网络，例如因特网)通信。如图4所示，网络适配器20通过总线18与设备12的其它模块通信。应当明白，尽管图中未示出，可以结合设备12使用其它硬件和/或软件模块，包括但不限于：微代码、设备驱动器、冗余处理单元、外部磁盘驱动阵列、raid系统、磁带驱动器以及数据备份存储系统等。
处理单元16通过运行存储在系统存储器28中的程序，从而执行各种功能应用以及数据处理，例如实现本发明实施例所提供的一种机器人定位方法，包括：
通过机器人上搭载的图像采集器采集环境图像；
将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
根据所述目标标志物的空间位置
实施例五
本发明实施例五还提供一种计算机可读存储介质，其上存储有计算机程序(或称为计算机可执行指令)，该程序被处理器执行时可实现上述任意实施例所述的一种机器人定位方法，包括：
通过机器人上搭载的图像采集器采集环境图像；
将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
根据所述目标标志物的空间位置
本发明实施例的计算机存储介质，可以采用一个或多个计算机可读的介质的任意组合。计算机可读介质可以是计算机可读信号介质或者计算机可读存储介质。计算机可读存储介质例如可以是——但不限于——电、磁、光、电磁、红外线、或半导体的系统、装置或器件，或者任意以上的组合。计算机可读存储介质的更具体的例子(非穷举的列表)包括：具有一个或多个导线的电连接、便携式计算机磁盘、硬盘、随机存取存储器(ram)、只读存储器(rom)、可擦式可编程只读存储器(eprom或闪存)、光纤、便携式紧凑磁盘只读存储器(cd-rom)、光存储器件、磁存储器件、或者上述的任意合适的组合。在本文件中，计算机可读存储介质可以是任何包含或存储程序的有形介质，该程序可以被指令执行系统、装置或者器件使用或者与其结合使用。
计算机可读的信号介质可以包括在基带中或者作为载波一部分传播的数据信号，其中承载了计算机可读的程序代码。这种传播的数据信号可以采用多种形式，包括但不限于电磁信号、光信号或上述的任意合适的组合。计算机可读的信号介质还可以是计算机可读存储介质以外的任何计算机可读介质，该计算机可读介质可以发送、传播或者传输用于由指令执行系统、装置或者器件使用或者与其结合使用的程序。
计算机可读介质上包含的程序代码可以用任何适当的介质传输，包括——但不限于无线、电线、光缆、rf等等，或者上述的任意合适的组合。
可以以一种或多种程序设计语言或其组合来编写用于执行本发明实施例操作的计算机程序代码，所述程序设计语言包括面向对象的程序设计语言—诸如java、smalltalk、c++，还包括常规的过程式程序设计语言—诸如”c”语言或类似的程序设计语言。程序代码可以完全地在用户计算机上执行、部分地在用户计算机上执行、作为一个独立的软件包执行、部分在用户计算机上部分在远程计算机上执行、或者完全在远程计算机或服务器上执行。在涉及远程计算机的情形中，远程计算机可以通过任意种类的网络——包括局域网(lan)或广域网(wan)—连接到用户计算机，或者，可以连接到外部计算机(例如利用因特网服务提供商来通过因特网连接)。
注意，上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解，本发明不限于这里所述的特定实施例，对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此，虽然通过以上实施例对本发明进行了较为详细的说明，但是本发明不仅仅限于以上实施例，在不脱离本发明构思的情况下，还可以包括更多其他等效实施例，而本发明的范围由所附的权利要求范围决定。
技术特征：
1.一种机器人定位方法，其特征在于，包括：
通过机器人上搭载的图像采集器采集环境图像；
将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
根据所述目标标志物的空间位置
2.根据权利要求1所述的方法，其特征在于，将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物，包括：
根据所述环境图像中物体在图像坐标系中的三维空间位置，确定所述物体的特征向量和协方差矩阵；
根据所述物体的特征向量和所述物体的协方差矩阵，以及候选标志物的特征向量和协方差矩阵，确定物体与候选标志物的位置偏差；
若物体与任一候选标志物的位置偏差小于偏差阈值，则将该标志物作为目标标志物。
3.根据权利要求1所述的方法，其特征在于，所述根据所述目标标志物的空间位置
根据如下公式，确定所述机器人的空间位置：
其中，δdi是所述机器人在xj观测到
4.根据权利要求1所述的方法，其特征在于，所述根据所述目标标志物的空间位置
根据所述目标标志物的空间位置，确定所述目标标志物在所述机器人坐标系下的空间位置。
5.根据权利要求4所述的方法，其特征在于，所述根据所述目标标志物的空间位置，确定所述目标标志物在所述机器人坐标系下的空间位置，还包括：
根据如下公式，
其中，
6.一种机器人定位装置，其特征在于，包括：
图像采集装置，用于通过机器人上搭载的图像采集器采集环境图像；
目标标志物匹配装置，用于将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；
机器人空间位置确定装置，用于根据所述目标标志物的空间位置
7.根据权利要求6所述的装置，其特征在于，所述目标标志物匹配装置，具体用于：
根据所述环境图像中物体在图像坐标系中的三维空间位置，确定所述物体的特征向量和协方差矩阵；
根据所述物体的特征向量和所述物体的协方差矩阵，以及候选标志物的特征向量和协方差矩阵，确定物体与候选标志物的位置偏差；
若物体与任一候选标志物的位置偏差小于偏差阈值，则将该标志物作为目标标志物。
8.根据权利要求6所述的装置，其特征在于，所述机器人空间位置确定装置，具体用于：
根据如下公式，确定所述机器人的空间位置：
其中，δdi是所述机器人在xj观测到
9.一种计算机设备，包括存储器、处理器及存储在存储器上并可在处理器上运行的计算机程序，其特征在于，所述处理器执行所述程序时实现如权利要求1-5中任一所述的机器人定位方法。
10.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现如权利要求1-5中任一所述的机器人定位方法。
技术总结
本发明实施例公开了一种机器人定位方法、装置、设备及存储介质。通过机器人上搭载的图像采集器采集环境图像；将所述环境图像中的物体与候选标志物进行匹配，得到匹配的目标标志物；根据所述目标标志物的空间位置和所述机器人在Xj所观测到与之间的距离值，确定所述机器人的空间位置，其中，Xj是在所述目标标志物的空间位置观测到的所述机器人的空间位置。以实现从不同维度为移动机器人提供环境信息，进一步提高移动机器人的定位准确度。
技术研发人员：周孙春;白静;程伟;陈士凯
受保护的技术使用者：上海思岚科技有限公司
技术研发日：.11.15
技术公布日：.02.28
