[发明专利]一种机器人路径规划方法及装置

摘要

本发明公开了一种机器人路径规划方法及装置，通过对运动目标的追踪进行人体识别，获得运动目标相对于机器人的位置和运动速度，从而根据获得的运动目标相对于机器人的位置和运动速度，预测运动目标下一步的位置；并根据运动目标相对于机器人的位置和运动速度、下一步的位置以及第一高斯函数得到运动目标的运动成本地图；将获得的运动目标的静态成本地图、运动成本地图和已获得的障碍物的成本地图进行融合得到主成本地图；依据所述主成本地图和预设的规则，对机器人的路径进行规划。因此，这样不但可以预测运动目标下一步的位置，而且可以根据运动目标的运动轨迹对机器人的路径进行规划，从而使得机器人可以在不影响人活动的前提下进行活动。

主权项

1.一种机器人路径规划方法，其特征在于，所述方法包括：对运动目标的身体和腿部进行追踪，分别将追踪得到的身体数据和腿部数据输入到预设的机器学习模型中，得到身体的第一位置和腿部的第二位置；所述机器学习模型是已基于人体站立和走路的数据进行了训练；将得到的身体的第一位置和腿部的第二位置进行融合得到运动目标的位置；所述运动运动目标的位置是运动目标相对于机器人的位置；依据所述运动目标的位置和通过对身体追踪获得的运动目标的运动速度预测运动目标下一步的位置；依据所述运动目标的位置、运动速度、下一步的位置以及第一高斯函数，生成运动目标的运动成本地图；所述第一高斯函数为移动方向上峰值递增的函数；依据对运动目标追踪时得到的运动目标静止时的数据以及第二高斯函数生成运动目标的静态成本地图；所述第二高斯函数为圆形的高斯函数；将所述运动目标的静态成本地图、运动成本地图和已获得的障碍物的成本地图进行融合得到主成本地图；依据所述主成本地图和预设的规则，对机器人的路径进行规划。