一种栅格地图通行成本的计算方法技术

本发明专利技术提供了一种栅格地图通行成本的计算方法，所述方法包括：获取激光传感器数据并对其数据进行预处理；对有效数据进行栅格化，生成初始栅格地图；对初始栅格地图进行膨胀处理；根据机器人平台尺寸重新计算每个小栅格的通行成本；通过该方法减少了路径搜索的搜索面积，在保证获得路径可通过的同时，提高了搜索效率。

【技术实现步骤摘要】
一种栅格地图通行成本的计算方法
本专利技术涉及一种计算方法，具体涉及一种栅格地图通行成本的计算方法。
技术介绍
环境认知及建模是实现机器人平台自主导航的基本前提。机器人平台在运动过程中依靠传感器获取对环境的感知信息，同时创建环境地图。一个合理的环境地图有益于减少用于路径搜索的环境区域面积，提高路径搜索的效率。一种表示环境的模型栅格地图将环境分解成一系列离散的栅格，通常采用0、1值定义栅格的通行(0)和不通行(1)两种属性。采用这种方法生成的栅格通行成本地图，在定义栅格通行成本时并未考虑机器人平台的尺寸信息，导致在进行路径搜索时需要根据机器人平台尺寸确定栅格的通过性，同时搜索环境区域增大，搜索效率低。申请号为200810194812.9的中国专利公开了一种基于栅格数据的空间成本距离计算方法，该方法主要用于计算空间内任意位置到达另一空间位置所需要的最小空间成本距离值，而对栅格单元的数值没有给出明确的计算方法。申请号为200810143537.8的中国专利公开了一种实时数据融合的移动机器人平台栅格地图创建方法，该方法将栅格定义为空闲、被占用和不确定三种状态，仅计算栅格置信度，完成栅格地图创建，在地图创建过程中并未考虑栅格通行成本值的具体计算方法。
技术实现思路
本专利技术的目的是提供一种栅格地图通行成本的计算方法，该方法根据机器人平台尺寸计算每个栅格的通行成本，以数值化表示，能适用于为各种规则、不规则机器人平台建立栅格地图，栅格通行成本分配合理，计算过程简单。本专利技术的目的是采用下述技术方案实现的：一种栅格地图通行成本的计算方法，所述方法包括：获取激光传感器数据并对其数据进行预处理；对有效数据进行栅格化，生成初始栅格地图；对初始栅格地图进行膨胀处理；根据机器人平台尺寸重新计算每个小栅格的通行成本。优选的，所述激光传感器数据包括，以激光传感器的重心为极坐标原点建立极坐标系，探测前方10m且角度在-45°～225°以内的物体与极坐标原点之间弧长和角度值；其中，所述激光传感器为安装在机器人平台前方的单线激光传感器。优选的，所述预处理包括：通过以太网将所述激光传感器数据发送至工控机，所述工控机根据激光传感器和机器人平台之间的坐标转换将激光传感器数据投影到机器人平台。进一步地，所述坐标转换包括：以表示任一激光传感器数据点在极坐标系下的坐标，根据激光传感器直角坐标系和极坐标系之间的坐标转换关系计算该激光传感器数据点在直角坐标系下的坐标(xi，yi)；以(lx(t)，ly(t))表示激光传感器坐标系和大地坐标系之间的坐标转换关系，利用将激光传感器数据点在直角坐标系下的坐标(xi，yi)转换为大地坐标系下的坐标(xgi，ygi)。优选的，所述有效数据包括，随着机器人平台移动，不断对激光传感器数据点进行坐标转换，生成大地坐标系下的坐标集合。优选的，所述对有效数据进行栅格化包括：将占据栅格通行成本设定为254，自由栅格通行成本设定为0，存储在工控机内；在每个小栅格(xsi，ysi，costsi)中，xsi为行数，ysi为列数，costsi为通行成本；所述占据栅格为存在激光传感器数据点的栅格；所述自由栅格为不存在激光传感器数据点的栅格。优选的，所述对初始栅格地图进行膨胀处理包括，设定机器人平台外形的内切圆半径为r，外接圆半径为R，初始栅格地图中任一自由栅格为Gsi(xsi,ysi,0)；在栅格膨胀区域半径P的范围内，遍历Gsi到占据栅格点的欧几里得距离，计算Gsi到占据栅格的最小距离dmin。进一步地，根据dmin(Gsi)与机器人平台外形的内切圆半径r和外接圆半径R之间的大小关系，重新计算该栅格点的栅格通行成本costsi，生成栅格地图式中，f为控制栅格通行成本衰减的比例因子，f越大，栅格通行成本衰减越快。与现有技术相比，本专利技术提供的方法达到以下有益效果：本专利技术采用激光传感器数据获取初始栅格地图，依据机器人尺寸信息对初始栅格地图进行膨胀处理，计算自由栅格的通行成本；利用该方法建立的栅格地图进行路径搜索时，可以减少搜索区域的面积，提高搜索效率，保证获得路径的可通过性。附图说明图1是本专利技术一种栅格地图通行成本的计算方法的流程图图2是本专利技术的机器人系统结构示意图其中，1.机器人平台2.激光传感器3.网线4.工控机图3是本专利技术建立的初始栅格地图示意图图4是本专利技术的机器人平台外形尺寸及内切圆、外接圆示意图；图5是本专利技术建立的栅格地图示意图具体实施方式下面结合附图和具体实施例对本专利技术作进一步的详细说明。如图1所示，一种栅格地图通行成本的计算方法，所述方法包括：获取激光传感器数据并对其数据进行预处理；所述激光传感器数据包括，以激光传感器的重心为极坐标原点建立极坐标系，探测前方10m且角度在-45°～225°以内的物体与极坐标原点之间弧长和角度值；其中，如图2所示，所述激光传感器为安装在机器人平台前方的单线激光传感器。所述机器人平台为任一规则、不规则形状的机器人。所述预处理包括：通过以太网将所述激光传感器数据发送至工控机，所述工控机根据激光传感器和机器人平台之间的坐标转换将激光传感器数据投影到机器人平台。所述工控机用于遥控机器人运动，在运动过程中采集激光传感器数据和轮速码盘数据。所述坐标转换包括：以表示任一激光传感器数据点在极坐标系下的坐标，根据激光传感器直角坐标系和极坐标系之间的坐标转换关系计算该激光传感器数据点在直角坐标系下的坐标(xi，yi)；激光传感器坐标系和机器人坐标系之间的坐标转换关系是固定的，而机器人坐标系和大地坐标系之间的坐标转换关系随机器人平台姿态变化调整，这可通过GPS或航迹推算方法获得，因此激光传感器坐标系和大地坐标系之间的坐标转换关系是动态变化的：以(lx(t)，ly(t))表示激光传感器坐标系和大地坐标系之间的坐标转换关系，利用将激光传感器数据点在直角坐标系下的坐标(xi，yi)转换为大地坐标系下的坐标(xgi，ygi)。对有效数据进行栅格化，如图3所示，生成初始栅格地图；所述有效数据包括，随着机器人平台移动，不断对激光传感器数据点进行坐标转换，生成大地坐标系下的坐标集合。所述对有效数据进行栅格化包括：将占据栅格通行成本设定为254，自由栅格通行成本设定为0，存储在工控机内；在每个小栅格(xsi，ysi，costsi)中，xsi为行数，即xsi按照地图栅格分辨率的圆整数，ysi为列数，即ysi按照地图栅格分辨率的圆整数，costsi为通行成本；，所述占据栅格为存在激光传感器数据点的栅格；所述自由栅格为不存在激光传感器数据点的栅格。对初始栅格地图进行膨胀处理；所述对初始栅格地图进行膨胀处理包括，设定机器人平台外形的内切圆半径为r，外接圆半径为R，初始栅格地图中任一自由栅格为Gsi(xsi,ysi,0)；在栅格膨胀区域半径P的范围内，遍历Gsi到占据栅格点的欧几里得距离，计算Gsi到占据栅格的最小距离dmin。根据机器人平台尺寸重新计算每个小栅格的通行成本。如图4所示，根据dmin(Gsi)与机器人平台外形的内切圆半径r和外接圆半径R之间的大小关系，重新计算该栅格点的栅格通行成本costsi，生成栅格地图；式中，f为控制栅格通行成本衰减的比例因子，f越大，栅格通行成本衰减越快。实施例：选取参数P为0.55m，f为10，按本文档来自技高网...

【技术保护点】
一种栅格地图通行成本的计算方法，其特征在于，所述方法包括：获取激光传感器数据并对其数据进行预处理；对有效数据进行栅格化，生成初始栅格地图；对初始栅格地图进行膨胀处理；根据机器人平台尺寸重新计算每个小栅格的通行成本。

【技术特征摘要】
1.一种栅格地图通行成本的计算方法，其特征在于，所述方法包括：获取激光传感器数据并对其数据进行预处理；对有效数据进行栅格化，生成初始栅格地图；对初始栅格地图进行膨胀处理；根据机器人平台尺寸重新计算每个小栅格的通行成本。2.如权利要求1所述的一种栅格地图通行成本的计算方法，其特征在于，所述激光传感器数据包括，以激光传感器的重心为极坐标原点建立极坐标系，探测前方10m且角度在-45°～225°以内的物体与极坐标原点之间弧长和角度值；其中，所述激光传感器为安装在机器人平台前方的单线激光传感器。3.如权利要求1所述的一种栅格地图通行成本的计算方法，其特征在于，所述预处理包括：通过以太网将所述激光传感器数据发送至工控机，所述工控机根据激光传感器和机器人平台之间的坐标转换将激光传感器数据投影到机器人平台。4.如权利要求3所述的一种栅格地图通行成本的计算方法，其特征在于，所述坐标转换包括：以表示任一激光传感器数据点在极坐标系下的坐标，根据激光传感器直角坐标系和极坐标系之间的坐标转换关系计算该激光传感器数据点在直角坐标系下的坐标(xi，yi)；以(lx(t)，ly(t))表示激光传感器直角坐标系和大地坐标系之间的坐标转换关系，利用将激光传感器数据点在直角坐标系下的坐标(xi，yi)转换为大地坐标系下的坐标(xgi，ygi)。5.如权利要求1所述的一种栅格地图通行成本的计算方法，其特征在于，所述有效数据包括，随着机器人平台移动，不断对激光传感器数据点进...

【专利技术属性】
技术研发人员：张浩杰，苏波，宋海平，蓝伟，熊巍，
申请(专利权)人：中国北方车辆研究所，
类型：发明
国别省市：北京;11