服务机器人物理禁区检测和全局重定位方法与流程

1.本公开涉及一种服务机器人物理禁区检测和全局重定位方法，属于智能控制技术领域。


背景技术：

2.目前服务机器人已经在商用场景中得到了广泛的应用，如商用促销机器人、商用清洁机器人、导购导览机器人和商超配送机器人等，主要实现用场景中服务于消费者的智能应用。随着技术的发展，服务机器人由于其智能性和性价比越来越高，且对于用户的品牌形象提升很高，也受到消费者的喜爱和欢迎，也越来越多地应用于各处商用场景。
3.商用场景中由于存在着台阶、扶梯、电梯以及各种娱乐设备，人比较多甚至是到处乱跑的孩子，环境往往比较复杂，有时会造成服务机器人可行驶的通道很窄，甚至无路可走。而服务机器人在商用场景中在执行各项设定好的服务任务时，首先要保证运行的安全性不发生安全事故，不能够主动碰撞行人，尤其是老人和孩子，不能够从台阶上跌落，不能够运行到自动扶梯上而导致跌落。尤其是针对商超中自动扶梯等设施，因为是不断运动的设备，台阶中有相对的高度差，服务机器人一般无法静止在自动扶梯上，传统的在服务机器人向下安装的防跌落传感器或悬崖传感器也不能有效预防。
4.而传统的通过软件设置禁区和禁线的方式，只有当服务机器人定位准确时才能发挥作用。当由于环境动态变化比较大时，服务机器人很容易定位丢失导致迷路，从而无法通过软件禁区和禁线的方法来限制服务机器人运行越过台阶和行至扶梯等危险禁止区域。
5.所以一种新的有效的能够防止服务机器人在复杂场景执行任务运行时进入危险区域保证作业安全，并同时帮助服务机器人恢复准确定位的方法，对于提高服务机器人运行的安全性、智能性以及环境适应性至关重要而且不可或缺。


技术实现要素：

6.为了解决上述技术问题之一，本公开提供了一种服务机器人物理禁区检测和全局重定位方法。
7.根据本公开的一个方面，提供了一种服务机器人物理禁区检测和全局重定位方法，其包括：
8.将人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘；
9.服务机器人运行中不断地检测工作场景中是否存在人工标识；
10.当在工作场景中存在人工标识信息时，识别人工标识，并确认服务机器人相对于人工标识的位置和航向角信息；
11.根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区；以及
12.根据人工标识在全局地图中的绝对位置，获得服务机器人在工作场景全局地图中可能的位置和航向角范围，应用全局定位算法实现服务机器人的准确的全局重定位。
13.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘，当所述服务机器人与所述人工标识的距离在预设范围内时，通过所述服务机器人的检测装置检测该人工标识。
14.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述人工标识包括：rfid标签、uwb标签、磁条、二维码或者颜色相间的特殊识别卡任意一种或者多种的组合；所述检测装置包括：rfid读卡器、uwb基站、霍尔传感器、摄像头和图像处理模组中的一种或多种；
15.其中，当所述人工标识包括rfid标签时，所述检测装置包括rfid读卡器；
16.当所述人工标识包括uwb标签时，所述检测装置包括uwb基站；
17.当所述人工标识包括磁条时，所述检测装置包括霍尔传感器；
18.当所述人工标识包括二维码或者颜色识别卡时，所述检测装置包括摄像头和图像处理模组。
19.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述rfid标签安装于物理禁区的边缘，并且该rfid标签存储有当前rfid标签在工作场景中的绝对全局位置信息；所述服务机器人的rfid读卡器距离该rfid标签一定范围时，获取该rfid标签所存储的当前rfid标签在工作场景中的绝对全局位置信息；并且根据当前rfid标签中的绝对全局位置信息确认服务机器人在工作场景全局地图中的可能位置和航向角范围。
20.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述uwb标签安装于工作场景中物理禁区的边缘，并且该uwb标签存储有当前uwb标签在工作场景中的绝对全局位置信息；所述服务机器人的uwb基站用于接收每个uwb标签以一定频率发送的uwb标签的id号以及与uwb基站的距离，所述uwb基站根据至少一个uwb标签与uwb基站的距离值，从而根据三角测量方法获得服务机器人在工作场景全局地图中的可能位置和航向角范围。
21.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述磁条安装于工作场景中物理禁区的地面边缘，所述服务机器人的霍尔传感器检测到地面设置有磁条时，控制所述服务机器人停止前行，并且控制服务机器人沿接近所述磁条的运动轨迹反向运动，以远离物理禁区，从而防止服务机器人进入危险区域。
22.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述磁条距离物理禁区的边缘存在预设安全有效距离，所述安全有效距离的大小根据服务机器人减速距离和检测装置的响应速度而决定。
23.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述二维码或者颜色识别卡设置于工作场景中物理禁区的地面边缘或者竖直面上，所述服务机器人的摄像头所采集的图像中包括二维码或者颜色相间的特殊识别卡时，所述服务机器人根据所述摄像头所采集的图像，图像处理模组提取二维码或者颜色相间特殊识别卡的图像坐标，由图像坐标系到服务机器人坐标系的转换矩阵进行转换，从而获得服务机器人在工作场景全局地图中的可能位置和航向角范围。
24.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，
根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区包括：
25.根据服务机器人相对于人工标识的相对位置和航向角信息，控制服务机器人的运动速度和方向，避免驶入工作场景中物理禁区发生危险事故。
26.根据本公开的至少一个实施方式的服务机器人物理禁区检测和全局重定位方法，所述服务机器人的准确的全局重定位包括：
27.s1、获取服务机器人的当前时间帧的导航传感器的数据，基于已经构建的全局地图和当前时间帧的导航传感器数据，应用蒙特卡罗定位算法获得当前时间帧的最佳位姿估计；
28.s2、根据当前时间帧k的最佳位姿估计p
k
＝[p
k q
k θ
k
]
t
，计算当前时间帧k全局定位得分ψ
k
；以及
[0029]
s3、当前时间帧的全局定位得分大于一定的阈值，表明服务机器人基于人工标识物理禁区的重定位准确，服务机器人从异常状态中得到恢复。
附图说明
[0030]
附图示出了本公开的示例性实施方式，并与其说明一起用于解释本公开的原理，其中包括了这些附图以提供对本公开的进一步理解，并且附图包括在本说明书中并构成本说明书的一部分。
[0031]
图1是根据本公开的一个实施方式的服务机器人物理禁区检测和全局重定位方法的流程图。
[0032]
图2是根据本公开的一个实施方式的服务机器人的示意图。
具体实施方式
[0033]
下面结合附图和实施方式对本公开作进一步的详细说明。可以理解的是，此处所描述的具体实施方式仅用于解释相关内容，而非对本公开的限定。另外还需要说明的是，为了便于描述，附图中仅示出了与本公开相关的部分。
[0034]
需要说明的是，在不冲突的情况下，本公开中的实施方式及实施方式中的特征可以相互组合。下面将参考附图并结合实施方式来详细说明本公开的技术方案。
[0035]
除非另有说明，否则示出的示例性实施方式/实施例将被理解为提供可以在实践中实施本公开的技术构思的一些方式的各种细节的示例性特征。因此，除非另有说明，否则在不脱离本公开的技术构思的情况下，各种实施方式/实施例的特征可以另外地组合、分离、互换和/或重新布置。
[0036]
在附图中使用交叉影线和/或阴影通常用于使相邻部件之间的边界变得清晰。如此，除非说明，否则交叉影线或阴影的存在与否均不传达或表示对部件的具体材料、材料性质、尺寸、比例、示出的部件之间的共性和/或部件的任何其它特性、属性、性质等的任何偏好或者要求。此外，在附图中，为了清楚和/或描述性的目的，可以夸大部件的尺寸和相对尺寸。当可以不同地实施示例性实施例时，可以以不同于所描述的顺序来执行具体的工艺顺序。例如，可以基本同时执行或者以与所描述的顺序相反的顺序执行两个连续描述的工艺。此外，同样的附图标记表示同样的部件。
[0037]
当一个部件被称作“在”另一部件“上”或“之上”、“连接到”或“结合到”另一部件时，该部件可以直接在所述另一部件上、直接连接到或直接结合到所述另一部件，或者可以存在中间部件。然而，当部件被称作“直接在”另一部件“上”、“直接连接到”或“直接结合到”另一部件时，不存在中间部件。为此，术语“连接”可以指物理连接、电气连接等，并且具有或不具有中间部件。
[0038]
为了描述性目的，本公开可使用诸如“在
……
之下”、“在
……
下方”、“在
……
下”、“下”、“在
……
上方”、“上”、“在
……
之上”、“较高的”和“侧(例如，如在“侧壁”中)”等的空间相对术语，从而来描述如附图中示出的一个部件与另一(其它)部件的关系。除了附图中描绘的方位之外，空间相对术语还意图包含设备在使用、操作和/或制造中的不同方位。例如，如果附图中的设备被翻转，则被描述为“在”其它部件或特征“下方”或“之下”的部件将随后被定位为“在”所述其它部件或特征“上方”。因此，示例性术语“在
……
下方”可以包含“上方”和“下方”两种方位。此外，设备可被另外定位(例如，旋转90度或者在其它方位处)，如此，相应地解释这里使用的空间相对描述语。
[0039]
这里使用的术语是为了描述具体实施例的目的，而不意图是限制性的。如这里所使用的，除非上下文另外清楚地指出，否则单数形式“一个(种、者)”和“所述(该)”也意图包括复数形式。此外，当在本说明书中使用术语“包含”和/或“包括”以及它们的变型时，说明存在所陈述的特征、整体、步骤、操作、部件、组件和/或它们的组，但不排除存在或附加一个或更多个其它特征、整体、步骤、操作、部件、组件和/或它们的组。还要注意的是，如这里使用的，术语“基本上”、“大约”和其它类似的术语被用作近似术语而不用作程度术语，如此，它们被用来解释本领域普通技术人员将认识到的测量值、计算值和/或提供的值的固有偏差。
[0040]
图1是根据本公开的一个实施方式的服务机器人物理禁区检测和全局重定位方法的流程图。
[0041]
如图1所示的服务机器人物理禁区检测和全局重定位方法，其包括：
[0042]
202、将人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘；
[0043]
204、服务机器人运行中不断地检测工作场景中是否存在人工标识；
[0044]
206、当在工作场景中存在人工标识信息时，识别人工标识，并确认服务机器人相对于人工标识的位置和航向角信息；
[0045]
208、根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区；以及
[0046]
210、根据人工标识在全局地图中的绝对位置，获得服务机器人在工作场景全局地图中可能的位置和航向角范围，应用全局定位算法实现服务机器人的准确的全局重定位。
[0047]
本公开中，服务机器人在场景中运行，由于存在着台阶、扶梯、电梯以及各种娱乐设备，针对这些固定的机器人不能进入的危险区域，一般可以通过在服务机器人全局地图编辑软件设置虚拟禁区或禁线的方式，禁止服务机器人进入这些危险区域，这种设置策略在家庭用的扫地机器人比较常用。
[0048]
而考虑到在商超和办公楼等公区区域中，人比较多，环境比较复杂且对于服务机器人的传感器经常受行走的客人等遮挡，而造成服务机器人全局定位不是很准确，有时甚至完全迷路，尤其是针对商超和办公楼内环境比较对称和相似，服务机器人更容易迷路。
[0049]
这种情况出现时，服务机器人地图中所设置的虚拟禁区或禁线就不会起作用，此时服务机器人就可能驶入台阶、扶梯和电梯等危险区域，发生安全事故。
[0050]
本公开通过实体的人工标识，能够将服务机器人的工作区域划分出物理禁区，并能够有效地防止服务机器人进入这些物理禁区，避免了安全事故的发生。
[0051]
尤其是，由于人工标识在全局地图中的绝对位置已知，可以进一步获得服务机器人在工作场景全局地图中可能的位置和航向角范围，从而应用全局定位算法，实现服务机器人的准确全局重定位。
[0052]
优选地，所述人工标识被预先设置在工作场景中服务机器人不能进入的危险区域边缘，如物理禁区的地面边缘或者竖直面上，当所述服务机器人与所述人工标识的距离在预设范围内时，即在服务机器人物理禁区检测装置的有效工作范围内时，通过所述服务机器人的检测装置检测该人工标识。
[0053]
所述人工标识包括：rfid标签、uwb标签、磁条、二维码或者颜色相间的特殊识别卡任意一种或者多种的组合；所述检测装置包括：rfid读卡器、uwb基站、霍尔传感器、摄像头和图像处理模组中的一种或多种；
[0054]
其中，当所述人工标识包括rfid标签时，所述检测装置包括rfid读卡器；
[0055]
当所述人工标识包括uwb标签时，所述检测装置包括uwb基站；
[0056]
当所述人工标识包括磁条时，所述检测装置包括霍尔传感器；
[0057]
当所述人工标识包括二维码或者颜色识别卡时，所述检测装置包括摄像头和图像处理模组。
[0058]
也就是说，当选择不同的人工标识，需要选择与该人工标识对应的检测装置。
[0059]
以下结合具体的人工标识说明：206、当在工作场景中存在人工标识信息时，识别人工标识，并确认服务机器人相对于人工标识的位置和航向角信息。
[0060]
本公开中，服务机器人相对于人工标识的可能位置和航向角信息表征为：
[0061]
ω
k
＝{[x
k y
k α
k
]
t
|x
k
∈[x
min x
max
] y
k
∈[y
min y
max
] α
k
∈[α
min α
max
]}
[0062]
其中[x
min x
max
]、[y
min y
max
]、[α
min α
max
]为通过人工标识检测装置所计算确定的对应的服务机器人前向、侧向等可能位置范围和航向角范围。
[0063]
作为一种实现形式，所述rfid标签安装于工作场景中物理禁区的边缘，并且该rfid标签存储有当前rfid标签在空间中的位置信息；所述服务机器人的rfid读卡器距离该rfid标签一定范围时，获取该rfid标签所存储的当前rfid标签在工作场景中的绝对位置信息；并且根据当前rfid标签中的位置信息获取服务机器人在工作场景全局地图中的位置和航向角范围。
[0064]
也就是说，所述rfid读卡器可以安装于服务机器人的端部，如前底部，其有效检测距离为几十厘米，响应时间在1s以内。
[0065]
当rfid标签在有效检测范围内，rfid读卡器检测到有rfid标签信息时，即意味着服务机器人马上要驶入物理禁区范围内。
[0066]
当然，可以通过调整rfid标签的位置和服务机器人rfid读卡器的安装位置和方向，来限制rfid标签信息的检测方向和作用范围。
[0067]
另一方面，所述uwb标签安装于工作场景中物理禁区的边缘，并且该uwb标签存储有当前uwb标签在工作场景中的绝对位置信息；所述服务机器人的uwb基站用于接收每个
uwb标签以一定频率发送的uwb标签的id号以及与uwb基站的距离，所述uwb基站根据至少一个uwb标签与uwb基站的距离值，从而根据三角测量等方法获得服务机器人在工作场景全局地图中可能的位置和航向角范围。
[0068]
也就是说，考虑到uwb标签需要供电，为了提高续航能力，一般将uwb标签设定工作在低功耗模式，例如设置数据发送频率为1hz。
[0069]
所述服务机器人的uwb基站，实时接收uwb标签所发送的数据，获得uwb标签相对于uwb基站，也就是服务机器人的相对距离和uwb标签的id号信息，服务机器人综合多个uwb标签所发送的数据，即从而根据三角测量等方法可判断服务机器人在工作场景全局地图中可能的位置和航向角范围；并且可以基于此可能的位置和航向角范围，使服务机器人执行全局定位算法，如蒙特卡罗全局定位算法等，实现服务机器人的准确全局重定位，使服务机器人从迷路等异常状态中恢复。
[0070]
另一方面，所述磁条安装于物理禁区的地面边缘，所述服务机器人的霍尔传感器检测到地面设置有磁条时，控制所述服务机器人禁止前行，并且控制服务机器人沿接近所述磁条的运动轨迹反向运动，以远离物理禁区。
[0071]
优选地，考虑到有效检测距离和响应时间，所述霍尔传感器一般安装于服务机器人前底部脚轮的前面位置，其距离脚轮的远近需要综合考虑服务机器人的紧急制动距离。
[0072]
优选地，所述磁条距离物理禁区的边缘存在预设距离，以保证服务机器人完全不驶入物理禁区。
[0073]
本公开中，所述二维码或者颜色相间特殊识别卡设置于工作场景中物理禁区的地面边缘或者竖直面上，所述服务机器人的摄像头所采集的图像中包括二维码或者颜色相间的特殊识别卡时，所述服务机器人根据所述摄像头所采集的图像，图像处理模组提取二维码或者颜色相间特殊识别卡的图像坐标，由图像坐标系到服务机器人坐标系的转换矩阵进行转换，从而获得服务机器人的可能位置和航向角范围，并且基于所述服务机器人的可能位置和航向角范围，应用全局定位算法，基于工作场景全局地图获得服务机器人的全局最佳位姿估计。
[0074]
优选地，根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区包括：
[0075]
根据服务机器人相对于人工标识的相对位置和航向角信息，控制服务机器人的运动速度和方向，避免驶入工作场景中物理禁区发生危险事故。
[0076]
根据本公开的另一方面，提供一种服务机器人，服务机器人主要在商超、办公楼等商用场景中执行促销、导购导览和清洁任务。所述服务机器人包括机器人本体100和检测装置101，检测装置101不限于安装在服务机器人本体的下部或前端，主要进行人工标识的检测、识别和相对服务机器人的定位。
[0077]
控制器102安装内服务机器人本体100内部，控制服务机器人本体的前后左右等相对运动，通过实时接收检测装置101的信息，根据其中的人工标识相对于服务机器人100的位置，控制服务机器人100做出相应的规避运动策略。
[0078]
服务机器人的控制器102可以基于检测装置101的信息，使服务机器人在迷路等状态后重新计算服务机器人的全局最佳位姿估计，找回自己的准确位姿。
[0079]
人工标识103表示物理禁区104的区域，不限于安装于所需设物理禁区104前的地
面或者旁边竖直面。物理禁区104主要用以表征服务机器人100绝对不能驶入的危险区域。
[0080]
本公开中，当获得服务机器人在工作场景全局地图中的位置和航向角范围后，基于服务机器人可能的位置和航向角范围，应用全局定位算法，如蒙特卡罗全局定位算法等，实现服务机器人的准确全局重定位，使服务机器人从迷路等异常状态中恢复。
[0081]
具体地，所述服务机器人的准确的全局重定位包括：
[0082]
s1、获取服务机器人的当前时间帧的导航传感器的数据，如激光数据，基于已经构建的全局地图和当前时间帧的激光数据，应用蒙特卡罗定位算法获得当前时间帧的最佳位姿估计；
[0083]
s2、根据当前时间帧k的最佳位姿估计p
k
＝[p
k q
k θ
k
]
t
，计算当前时间帧k全局定位得分ψ
k
；
[0084]
s3、当前时间帧的全局定位得分大于一定的阈值，即ψ
k
＞ψ
threshold
，表明服务机器人基于人工标识物理禁区的重定位准确，服务机器人从迷路等异常状态中得到恢复。
[0085]
由此，本公开的服务机器人能够实现服务机器人在检测装置检测到物理禁区边缘的人工标识后，获得服务机器人在场景全局地图的可能位置和航向解范围后，获得准确的全局定位，并进一步地能使服务机器人从迷路等异常状态中恢复。
[0086]
以下结合具体的示例，详细说明本公开的各个步骤。
[0087]
s1、获取服务机器人的当前时间帧的导航传感器的数据，如激光数据，基于已经构建的全局地图和当前时间帧的激光数据，应用蒙特卡罗定位算法获得当前时间帧的最佳位姿估计。
[0088]
通过服务机器人的导航2d激光传感器不断地扫描周围工作场景，获取每个时间帧的激光数据，其表征为{ld|{λ
k,n
,n},n＝1...n}，其中λ
k,n
为对应的激光点n极坐标距离，n为k时间帧激光点的序号，n为时间帧k激光点的总数，其每个离散点对应的角度为n
·
δδ，δδ为激光角分辨率，这些离散的激光数据点一般为2d扇面。
[0089]
而已经存储的场景全局地图中χ
u,v
表示场景2d全局地图中的栅格点[u,v]
t
的值，为二维地图栅格点集，考虑一般激光传感器所构建的是2d栅格地图，即把场景中的固定路标(障碍物区域)、可行驶区域(无障碍物区域)等离散成一定尺寸大小的栅格集，投射在激光扫描平面。通常用1表示有障碍物，0表示无障碍物，考虑到激光的有效扫描范围，对于未确定的区域用
‑
1来表征,其表达式为：
[0090][0091]
服务机器人在工作场景中通过物理禁区检测装置，不断地检测人工标识，计算服务机器人相对于人工标识的位置和航向角信息，并根据人工标识在工作场景中的全局绝对位置，获得服务机器人在全局地图中的可能位置和航向角。
[0092]
服务机器人依据当前时间帧的导航传感器的数据，如激光数据、已经构建的全局地图和在全局地图中的可能位置和航向角ω
k
＝{[x
k y
k α
k
]
t
|x
k
∈[x
min x
max
] y
k
∈[y
min y
max
] α
k
∈[α
min α
max
]}，应用蒙特卡罗定位算法确定相对于给定场景地图的服务机器人的当前时间帧全局最佳位姿估计，从而实现准确的全局定位，其表征为p
k
＝[p
k q
k θ
k
]
t
。其中
p
k
和q
k
表示时间帧k服务机器人在全局坐标系的坐标位置，θ
k
表示时间帧k服务机器人在全局坐标系的航向角。
[0093]
s2、根据当前时间帧k的最佳位姿估计p
k
＝[p
k q
k θ
k
]
t
，计算当前时间帧k全局定位得分ψ
k
。
[0094]
为了评估当前时间帧k的最佳位姿估计是否准确可信的，需要定义一个判断标准和方法。本公开依据是基于当前时间帧k的最佳位姿估计p
k
＝[p
k q
k θ
k
]
t
，对当前时间帧k的激光数据{ld|{λ
k,n
,n},n＝1...n}投影到已经构建的场景全局地图中，并计算与地图栅格点重合的激光数据点的个数。
[0095]
首先，将激光数据点基于当前时间帧的全局最佳位姿估计投影到全局坐标系，当前时间帧k激光数据的每个激光离散点对应的全局坐标系位置为：
[0096][0097]
其中δw为场景全局地图中栅格的物理宽度，δδ为激光角分辨率，λ
k,n
为对应的激光极坐标距离，p
k
＝[p
k q
k θ
k
]
t
为当前时间帧k全局最佳位姿估计。
[0098]
其次，统计与场景全局地图栅格点重合的激光数据点的个数：
[0099]
ifχ
u,v
＝1 i
u,v
＝1 else i
u,v
＝0
[0100]
理论上，对于绝对静态的场景，如果服务机器人全局定位准确，每个时间帧所获得的每个激光点应与地图中的某个栅格点会对应重合χ
u,v
＝1，即统计的全局定位得分ψ
k
＝n。但是考虑到两个方面的影响因素，一是服务机器人的全局定位并不绝对准确，二是工作场景并不是绝对静态的，例如有些动态的行人等，所以一般来说ψ
k
＜n。当然，ψ
k
越大说明时间帧k的最佳位姿估计越是准确可信的。
[0101]
s3、当前时间帧的全局定位得分大于一定的阈值，即ψ
k
＞ψ
threshold
，表明服务机器人基于人工标识物理禁区的重定位准确，服务机器人从迷路等异常状态中得到恢复。
[0102]
在通常情况下，服务机器人在工作场景中执行任务运行时，是实时执行全局定位的过程，也就是说服务机器人不断的实时获得当前时间帧的准确全局位姿估计p
k
＝[p
k q
k θ
k
]
t
，并实时计算当前时间帧k的全局定位得分ψ
k
。当ψ
k
＞ψ
threshold
时，可以判断服务机器人的全局定位是准确可信的，而通过软件在工作场景全局地图中所预先设置的禁区和禁线，也会限制服务机器人进入这些物理禁区。同时，考虑到服务机器人运动的连续性，其当前时间帧k的位姿估计p
k
＝[p
k q
k θ
k
]
t
可以为下一时间帧k 1提供相应的可能位置和航向角限制，从而不断地执行全局定位算法，获得不同时间帧的最佳位姿估计。但是当ψ
k
＜ψ
threshold
时，可以判断服务机器人处于异常如迷路等状态。在这种情况下，服务机器人当前时间帧k的位姿估计p
k
＝[p
k q
k θ
k
]
t
可能是不准确的，那么在地图中所预先设置的禁区和禁线也会失去限制和约束能力，这时服务机器人可能会试图驶入工作场景中的物理禁区。这种情况下，服务机器人可以通过其检测装置来检测人工标识的存在，从而判断是否在靠近物理禁区，以及相对物理禁区的可能的位置和航向角信息。又因为这些人工标识在工作场
景全局地图的绝对位置已知且不会发生改变，所以可以依据服务机器人可能的位置和航向角信息，再进一步基于已经构建的全局地图和当前时间帧的激光数据，应用蒙特卡罗定位算法获得当前时间帧的最佳位姿估计，并由此实现服务机器人的准确全局定位。
[0103]
在本说明书的描述中，参考术语“一个实施例/方式”、“一些实施例/方式”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例/方式或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例/方式或示例中。在本说明书中，对上述术语的示意性表述不必须针对的是相同的实施例/方式或示例。而且，描述的具体特征、结构、材料或者特点可以在任一个或多个实施例/方式或示例中以合适的方式结合。此外，在不相互矛盾的情况下，本领域的技术人员可以将本说明书中描述的不同实施例/方式或示例以及不同实施例/方式或示例的特征进行结合和组合。
[0104]
此外，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中，“多个”的含义是至少两个，例如两个，三个等，除非另有明确具体的限定。
[0105]
本领域的技术人员应当理解，上述实施方式仅仅是为了清楚地说明本公开，而并非是对本公开的范围进行限定。对于所属领域的技术人员而言，在上述公开的基础上还可以做出其它变化或变型，并且这些变化或变型仍处于本公开的范围内。

技术特征：
1.一种服务机器人物理禁区检测和全局重定位方法，其特征在于，包括：将人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘；服务机器人运行中不断地检测工作场景中是否存在人工标识；当在工作场景中存在人工标识信息时，识别人工标识，并确认服务机器人相对于人工标识的位置和航向角信息；根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区；以及根据人工标识在全局地图中的绝对位置，获得服务机器人在工作场景全局地图中可能的位置和航向角范围，应用全局定位算法实现服务机器人的准确的全局重定位。2.如权利要求1所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘，当所述服务机器人与所述人工标识的距离在预设范围内时，通过所述服务机器人的检测装置检测该人工标识。3.如权利要求2所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述人工标识包括：rfid标签、uwb标签、磁条、二维码或者颜色相间的特殊识别卡任意一种或者多种的组合；所述检测装置包括：rfid读卡器、uwb基站、霍尔传感器、摄像头和图像处理模组中的一种或多种；其中，当所述人工标识包括rfid标签时，所述检测装置包括rfid读卡器；当所述人工标识包括uwb标签时，所述检测装置包括uwb基站；当所述人工标识包括磁条时，所述检测装置包括霍尔传感器；当所述人工标识包括二维码或者颜色识别卡时，所述检测装置包括摄像头和图像处理模组。4.如权利要求3所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述rfid标签安装于物理禁区的边缘，并且该rfid标签存储有当前rfid标签在工作场景中的绝对全局位置信息；所述服务机器人的rfid读卡器距离该rfid标签一定范围时，获取该rfid标签所存储的当前rfid标签在工作场景中的绝对全局位置信息；并且根据当前rfid标签中的绝对全局位置信息确认服务机器人在工作场景全局地图中的可能位置和航向角范围。5.如权利要求3所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述uwb标签安装于工作场景中物理禁区的边缘，并且该uwb标签存储有当前uwb标签在工作场景中的绝对全局位置信息；所述服务机器人的uwb基站用于接收每个uwb标签以一定频率发送的uwb标签的id号以及与uwb基站的距离，所述uwb基站根据至少一个uwb标签与uwb基站的距离值，从而根据三角测量方法获得服务机器人在工作场景全局地图中的可能位置和航向角范围。6.如权利要求3所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述磁条安装于工作场景中物理禁区的地面边缘，所述服务机器人的霍尔传感器检测到地面设置有磁条时，控制所述服务机器人停止前行，并且控制服务机器人沿接近所述磁条的运动轨迹反向运动，以远离物理禁区，从而防止服务机器人进入危险区域。7.如权利要求6所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述磁条距离物理禁区的边缘存在预设安全有效距离，所述安全有效距离的大小根据服务机器
人减速距离和检测装置的响应速度而决定。8.如权利要求3所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述二维码或者颜色识别卡设置于工作场景中物理禁区的地面边缘或者竖直面上，所述服务机器人的摄像头所采集的图像中包括二维码或者颜色相间的特殊识别卡时，所述服务机器人根据所述摄像头所采集的图像，图像处理模组提取二维码或者颜色相间特殊识别卡的图像坐标，由图像坐标系到服务机器人坐标系的转换矩阵进行转换，从而获得服务机器人在工作场景全局地图中的可能位置和航向角范围。9.如权利要求1所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区包括：根据服务机器人相对于人工标识的相对位置和航向角信息，控制服务机器人的运动速度和方向，避免驶入工作场景中物理禁区发生危险事故。10.如权利要求4、5或8所述的服务机器人物理禁区检测和全局重定位方法，其特征在于，所述服务机器人的准确的全局重定位包括：s1、获取服务机器人的当前时间帧的导航传感器的数据，基于已经构建的全局地图和当前时间帧的导航传感器数据，应用蒙特卡罗定位算法获得当前时间帧的最佳位姿估计；s2、根据当前时间帧k的最佳位姿估计p
k
＝[p
k q
k θ
k
]
t
，计算当前时间帧k全局定位得分ψ
k
；以及s3、当前时间帧的全局定位得分大于一定的阈值，表明服务机器人基于人工标识物理禁区的重定位准确，服务机器人从异常状态中得到恢复。
技术总结
本公开提供一种服务机器人物理禁区检测和全局重定位方法，其包括：人工标识被预先设置在工作场景中服务机器人不能进入的物理禁区边缘；服务机器人运行中不断地检测工作场景中是否存在人工标识；当在工作场景中存在人工标识信息时，识别人工标识，并确认服务机器人相对于人工标识的位置和航向角信息；根据服务机器人相对于人工标识的位置和航向角信息，控制服务机器人的运动轨迹，禁止进入相应物理禁区；以及根据人工标识在全局地图中的绝对位置，获得服务机器人在工作场景全局地图中可能的位置和航向角范围，应用全局定位算法实现服务机器人的准确的全局重定位。务机器人的准确的全局重定位。务机器人的准确的全局重定位。


技术研发人员：林睿
受保护的技术使用者：苏州澜途科技有限公司
技术研发日：2021.03.01
技术公布日：2021/6/29