[发明专利]一种基于三维地图的路径规划方法及设备

权利要求书

1.一种基于三维地图的路径规划方法，其特征在于，所述方法包括：

获取机器人在栅格坐标地图中的坐标位置信息，以及所述栅格坐标地图的特征参数；

其中，所述获取机器人在栅格坐标地图中的坐标位置信息，以及所述栅格坐标地图的特征参数，包括，

获取对所述机器人周围环境的建模，并将模型放置到所述三维地图的对应位置；

获取机器人激光导航绘制的所述栅格坐标地图，将所述栅格坐标地图放置到三维地图中；其中，所述栅格坐标地图内的坐标位置与所述三维地图中的模型的坐标位置相对应；

在所述三维地图中，对所述栅格坐标地图对应的最小经纬度坐标，与最大经纬度坐标，分别进行标记；

获取所述机器人在所述栅格坐标地图中的横坐标位置与纵坐标位置，以及，获取所述栅格坐标地图的宽度与高度；

根据所述坐标位置信息，以及所述栅格坐标地图的特征参数，实时得到所述机器人在三维地图中的坐标点信息；其中，所述三维地图对应的坐标系为大地坐标系；

其中，所述根据所述坐标位置信息，以及所述栅格坐标地图的特征参数，实时得到所述机器人在三维地图中的坐标点信息，包括，

确定出所述三维地图中标记的最大经度值与最小经度值之间的第一差值，并根据所述最小经度值、所述第一差值、所述机器人对应的横坐标值以及所述栅格坐标地图的宽度，得到所述机器人在所述大地坐标系对应的经度位置；以及

确定出所述栅格坐标地图对应的最大纬度值与最小纬度值之间的第二差值，并根据所述最小纬度值、所述第二差值、所述机器人对应的纵坐标值以及所述栅格坐标地图的高度，得到所述机器人在所述大地坐标系对应的纬度位置；

获取所述机器人对应的目标坐标点信息，确定出所述机器人在当前坐标点到达所述目标坐标点的多条预定路径，并确定所述多条预定路径分别对应的多个路段，以及各路段对应的坡度值；

在所述路段的坡度值大于预设坡度值，且所述路段存在障碍物的情况下，获取所述障碍物的坐标，并根据所述障碍物的坐标、所述路段的起点坐标，重新规划所述路段对应的避障路线，以使所述机器人根据预设坡度夹角前进至所述路段的终点；

其中，所述获取所述障碍物的坐标，并根据所述障碍物的坐标、所述路段的起点坐标，重新规划所述路段对应的避障路线，以使所述机器人根据预设坡度夹角前进至所述路段的终点，包括，

获取所述障碍物的坐标，以及所述障碍物周围可通行通道的宽度；

在所述通行路径的宽度，大于所述机器人对应的最小通行宽度的情况下，转变所述机器人的前进方向，以使所述机器人的爬坡角度调整为所述预设坡度夹角；

在所述机器人与所述障碍物的距离或者与可通行通道的墙壁的距离，小于第一预设距离的情况下，改变所述机器人的前进方向，以使所述机器人继续按照所述预设坡度夹角，躲避所述障碍物或者所述墙壁，直到所述机器人到达所述路段的终点；

根据所述避障路线对应的水平距离，以及所述预设坡度夹角，得到所述避障路线的长度；

根据所述避障路线的长度，确定出所述机器人的通行路径，并基于所述通行路径，指引所述机器人前往所述目标坐标点。

2.根据权利要求1所述的一种基于三维地图的路径规划方法，其特征在于，所述在所述通行路径的宽度，大于所述机器人对应的最小通行宽度的情况下，转变所述机器人的前进方向，以使所述机器人的爬坡角度调整为所述预设坡度夹角，具体包括：

以所述机器人的本体中心为圆心，以所述机器人的本体的边缘距离所述圆心最远的距离为半径，获取所述机器人的最小通行宽度；

在所述通行路径的宽度大于所述最小通行宽度的情况下，以所述机器人的当前坐标为起点，向所述路段绘制射线，并确定出各所述射线与水平面的夹角角度；

将夹角角度为所述预设坡度夹角的射线所对应的方向，作为所述机器人的前进方向。