一种基于虚拟路网的服务机器人导航方法及系统技术方案

本发明专利技术公开了一种基于虚拟路网的服务机器人导航方法及系统，所述方法包括：创建机器人工作环境的自由空间地图和虚拟路网模型；根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列；根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹；引导机器人按照所述参考轨迹移动。本发明专利技术提供服务机器人导航方法及系统能够考虑环境影响，实现全局导航规划。

【技术实现步骤摘要】
一种基于虚拟路网的服务机器人导航方法及系统
本专利技术涉及机器人
，尤其涉及一种服务机器人导航方法及系统。
技术介绍
服务机器人实现导航任务，需要在已知环境中规划一条可行的移动轨迹。目前大多数的导航轨迹规划方法大多根据给定的起始和目标点，在一个已知的自由空间(FreeSpace)地图中，采用A-Star算法、AD-Star算法、人工势场、快速随机搜索树(RRT)等在线搜索方法获得符合机器人动力学规则的移动轨迹。然而这类方法仅仅基于自由空间的导航地图，很难嵌入环境的动态信息，或者一些规则性的信息，如某些区域的临时禁行、可移除障碍物等，因此受环境的不确定性影响较大，往往只能得到局部最优路径，甚至有时陷入局部规划陷阱，使机器人无法完成导航任务。
技术实现思路
针对现有技术中的缺陷，本专利技术提供一种基于虚拟路网的服务机器人导航方法及系统，能够考虑环境影响，实现全局导航规划。第一方面，本专利技术提供了一种基于虚拟路网的服务机器人导航方法，所述方法包括：创建机器人工作环境的自由空间地图和虚拟路网模型；根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列；根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹；引导机器人按照所述参考轨迹移动。进一步地，所述创建机器人工作环境的虚拟路网模型，具体包括：在所述自由空间地图中，根据机器人的导航任务设计虚拟路网模型；将工作环境中的规则信息和动态信息添加到设计好的虚拟路网模型中。进一步地，所述规则信息包括交通管控规则；所述动态信息包括工作环境的动态变化。进一步地，所述在所述虚拟路网模型中规划虚拟道路序列，具体包括：在所述虚拟路网模型中选择起点和终点；计算从起点到终点的虚拟道路序列。进一步地，所述计算从起点到终点的虚拟道路序列，具体包括：根据虚拟道路连接情况，计算出从起点到终点最优的虚拟道路序列。进一步地，所述根据虚拟道路连接情况，计算出从起点到终点最优的虚拟道路序列，具体包括：根据虚拟道路连接情况，以换道次数最少为选择依据，计算出最优的虚拟道路序列。进一步地，所述根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹，具体包括：计算所述虚拟道路序列中每条虚拟道路的中心线；将多条所述中心线连接起来，形成参考轨迹。进一步地，所述中心线的计算公式为：其中，pi为所述虚拟道路序列中几何基准线上的第i个点，vi为垂直于向量pipi+1的单位向量，为第j条虚拟道路在处的宽度，i≧0，j≧1。第二方面，本专利技术还提供了基于虚拟路网的服务机器人导航系统，所述系统包括：模型建立模块，道路规划模块，轨迹计算模块，引导模块；所述模型建立模块，用于创建机器人工作环境的自由空间地图和虚拟路网模型；所述道路规划模块，用于根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列；所述轨迹计算模块，用于根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹；所述引导模块，用于引导机器人按照所述参考轨迹移动。进一步地，所述模型建立模块，具体用于：在所述自由空间地图中，根据机器人的导航任务设计虚拟路网模型；将工作环境中的规则信息和动态信息添加到设计好的虚拟路网模型中。由上述技术方案可知，本专利技术提供一种基于虚拟路网的服务机器人导航方法及系统，通过在自由空间地图中建立虚拟路网模型，在上述虚拟路网模型中可添加规则信息和动态信息，实现对环境因素的综合考虑，从而能更准确地计算出最优的虚拟道路序列，实现服务机器人的全局导航规划。附图说明图1为本专利技术提供的基于虚拟路网的服务机器人导航方法的流程示意图。图2为本专利技术提供的基于虚拟路网的服务机器人导航方法中中心线的计算示意图。图3为本专利技术提供的基于虚拟路网的服务机器人导航系统的结构示意图。具体实施方式下面将结合附图对本专利技术技术方案的实施例进行详细的描述。以下实施例仅用于更加清楚地说明本专利技术的技术方案，因此只是作为示例，而不能以此来限制本专利技术的保护范围。实施例一图1示出了本专利技术实施例一提供的基于虚拟路网的服务机器人导航方法的流程示意图。如图1所示，一种基于虚拟路网的服务机器人导航方法，包括：步骤S1，创建机器人工作环境的自由空间地图和虚拟路网模型。优选地，创建机器人工作环境的虚拟路网模型，具体包括：首先，在所述自由空间地图中，根据机器人的导航任务设计虚拟路网模型；其次，将工作环境中的规则信息和动态信息添加到设计好的虚拟路网模型中。其中，虚拟路网模型是根据机器人的主要任务，人为地离线生成的，该虚拟路网模型中包含道路网络中涉及的多种信息，如虚拟车道、虚拟交叉路口、虚拟站点信息等。进一步优选地，所述规则信息包括交通管控规则，如道路划分规则、限行规则、速度规则、红绿灯的设置等；所述动态信息包括工作环境的动态变化，如某一路段的临时限行、可移除障碍物等，除此以外，还可以根据实际情况添加其它额外道路属性。对于多机器人协作时，可利用现有的交通管控规则实现多机器人的最优协同作业。将环境中的规则信息和动态信息加入模型，可以在导航过程中更好地考虑环境因素，使虚拟路网模型与环境更匹配。步骤S2，根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列。优选地，在所述虚拟路网模型中规划虚拟道路序列，具体包括：在所述虚拟路网模型中选择起点和终点；计算从起点到终点的虚拟道路序列。进一步优选地，计算从起点到终点的虚拟道路序列，具体包括：根据虚拟道路连接情况，计算出从起点到终点最优的虚拟道路序列。具体地，根据从起点到终点的虚拟道路连接情况，以换道次数最少为选择依据，在虚拟路网模型的道路树中计算和选择从起点到终点最优的虚拟道路序列。在虚拟路网模型中，从起点到终点可选的路线可能不只一条，虚拟道路序列的选择相应地也可能有多种，但此处的虚拟道路序列指的是多种选择中最优的一种，即最佳路线。其选择的依据是换道次数最少，减少了机器人转换方向的次数。虚拟路网模型是人为实现设计的，因而具有全局最优性，且具备较高的确定性。步骤S3，根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹。在步骤S3中，虚拟路网模型中的连续道路中心线即为参考轨迹，确定参考轨迹的过程具体包括：首先，计算所述虚拟道路序列中每条虚拟道路的中心线；其次，将多条所述中心线连接起来，形成参考轨迹。其中，所述中心线的计算公式为：其中，pi为所述虚拟道路序列中几何基准线上的第i个基准点，vi为垂直于向量pipi+1的单位向量，为第j条虚拟道路在处的宽度，0≦i≦m，1≦j≦n，i、j、m、n均为自然数，其中m和n的具体值可根据实际情况设定，m表示几何基准线上的第m+1个基准点，n代表虚拟道路序列中的第n条道路。所述中心线是通过计算多个中心点得到的，如图2所示，虚拟道路序列中的每条道路都有一个几何基准线，在图2中用p0至pm所在的横线来表示该几何基准线，p0至pm表示该几何基准线上的多个基准点，该基准点是用于测量道路宽度的参考点。在图2中，第1条道路在p0处的宽度为通过上述计算公式能够得到第1个中心点，在p1处的宽度为通过上述计算公式能够得到第2个中心点，依此类推，能够得到第1条道路的第0至第m共m+1个中心点，将该m+1个中心点连接起来，能够得到第1条道路的中心线；依照同样的方法，也能够得到第2条道路至第n条本文档来自技高网...

【技术保护点】
一种基于虚拟路网的服务机器人导航方法，其特征在于，所述方法包括：创建机器人工作环境的自由空间地图和虚拟路网模型；根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列；根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹；引导机器人按照所述参考轨迹移动。

【技术特征摘要】
1.一种基于虚拟路网的服务机器人导航方法，其特征在于，所述方法包括：创建机器人工作环境的自由空间地图和虚拟路网模型；根据机器人的在线任务，在所述虚拟路网模型中规划虚拟道路序列；根据所述虚拟道路序列，确定机器人在所述自由空间地图中移动的参考轨迹；引导机器人按照所述参考轨迹移动。2.根据权利要求1所述的服务机器人导航方法，其特征在于，所述创建机器人工作环境的虚拟路网模型，具体包括：在所述自由空间地图中，根据机器人的导航任务设计虚拟路网模型；将工作环境中的规则信息和动态信息添加到设计好的虚拟路网模型中。3.根据权利要求2所述的服务机器人导航方法，其特征在于，所述规则信息包括交通管控规则；所述动态信息包括工作环境的动态变化。4.根据权利要求1所述的服务机器人导航方法，其特征在于，所述在所述虚拟路网模型中规划虚拟道路序列，具体包括：在所述虚拟路网模型中选择起点和终点；计算从起点到终点的虚拟道路序列。5.根据权利要求4所述的服务机器人导航方法，其特征在于，所述计算从起点到终点的虚拟道路序列，具体包括：根据虚拟道路连接情况，计算出从起点到终点最优的虚拟道路序列。6.根据权利要求5所述的服务机器人导航方法，其特征在于，所述根据虚拟道路连接情况，计算出从起点到终点最优的虚拟道路序列，具体包括：根据虚拟道路连接情况...

【专利技术属性】
技术研发人员：潘晶，苏至钒，刘亮，沈满，马夏怡，王海芸，董超，刘颖，刘伟，黄荣蓉，
申请(专利权)人：上海钛米机器人科技有限公司，
类型：发明
国别省市：上海,31