欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 202010301450X
申请人: 苏州大学
专利类型:发明专利
专利状态:未下证
专利领域: 测量;测试
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种人机共融环境中的移动型机器人路径规划采样方法,其特征在于,包括如下步骤:

步骤S1:计算地图中的点到最近障碍物的距离,同时,对环境中的行人进行检测,并标记环境中行人的位置;

步骤S2:选择起点位置作为根节点,初始化搜索树;

步骤S3:在可行区域随机选取候选节点,计算搜索树上节点到所述候选节点的累计成本,选取成本最小的点作为生长点,所述可行区域是指在最近障碍物距离地图上取值大于零的区域,计算搜索树上节点到所述候选节点的累计成本的方法为:采用公式其中,nnew为候选节点;ni为搜索树上T的节点,ni∈T;cost(ni)表示从根节点到ni的累计成本;dist(.)表示两个点之间的欧氏距离;angle(.)表示两条连线之间的夹角,一条是nnew与ni之间的连线,另一条是ni与ni父节点之间的连线;dmin表示ni到最近障碍物的距离;Sp表示nnew与ni之间的连线上行人所占据的可行区域的面积;和ε是常数,取最大线速度的倒数,ε取最大角速度的倒数;

步骤S4:对所述生长点和所述候选节点之间的连线作碰撞检测,判断碰撞检测是否通过,若通过,则进入步骤S5,否则,返回步骤S3;

步骤S5:将所述候选节点连接到所述生长点上,判断所述候选节点是否为终点,若是,则进入步骤S6,否则返回步骤S3;

步骤S6:从所述搜索树上获取从根节点到终点之间的节点连线集合,形成最终路径。

2.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:所述步骤S1中地图中的点到最近障碍物的距离通过线下计算完成,对于同一幅地图,计算结果在不同的路径规划中多次复用。

3.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:对环境中的行人进行检测的方法为:步骤S11:通过环境中的分布式摄像机网络拍摄环境图片;

步骤S12:应用行人检测算法对行人进行检测,输出行人在像素坐标系下的位置;

步骤S13:根据摄像机标定结果,通过坐标变换,输出行人在全局坐标系下的位置。

4.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:所述步骤S2中搜索树的节点包含:节点位置、节点连接和节点成本,在搜索树初始化过程中,根节点位置设置为起点,节点连接为空,节点成本为零。

5.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:所述生长点通过如下公式计算:

6.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:对所述生长点和所述候选节点之间的连线作碰撞检测的方法为:步骤S41:取生长点和候选节点之间的连线上的点的集合C;

步骤S42:判断是否所有集合C中的点对应的最近障碍物距离地图上的值都大于零,如果是,则无碰撞发生,碰撞检测通过;否则,发生碰撞,碰撞检测不通过。

7.根据权利要求5所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:所述步骤S5中将所述候选节点连接到所述生长点的方法为:步骤S51:记录候选节点nnew的位置,计算候选节点的成本cost(nnew,ngrowth);

步骤S52:将nnew的父节点设为ngrowth,将nnew包含进ngrowth的子节点列表中,建立起候选节点与随机树之间的联系。

8.根据权利要求1所述的人机共融环境中的移动型机器人路径规划采样方法,其特征在于:所述步骤S6中从搜索树上获取从根节点到终点之间的节点连线集合的方法为:步骤S61:确定终点所在的节点ngoal,设为当前节点ncurrent;

步骤S62:在所述搜索树上,获取ncurrent的父节点nparent,将nparent添加到路径上;

步骤S63:判断nparent是否为根节点,如果不是,则令ncurrent=nparent,返回步骤S62;如果是,则输出路径,结束搜索。

9.一种人机共融环境中的移动型机器人路径规划采样系统,其特征在于,包括:障碍物确定模块,用于计算地图中的点到最近障碍物的距离,同时,对环境中的行人进行检测,并标记环境中行人的位置;

初始化模块,用于选择起点位置作为根节点,初始化搜索树;

选取模块,用于在可行区域随机选取候选节点,计算搜索树上节点到所述候选节点的累计成本,选取成本最小的点作为生长点,所述可行区域是指在最近障碍物距离地图上取值大于零的区域,计算搜索树上节点到所述候选节点的累计成本的方法为:采用公式其中,nnew为候选节点;ni为搜索树上T的节点,ni∈T;cost(ni)表示从根节点到ni的累计成本;dist(.)表示两个点之间的欧氏距离;angle(.)表示两条连线之间的夹角,一条是nnew与ni之间的连线,另一条是ni与ni父节点之间的连线;dmin表示ni到最近障碍物的距离;Sp表示nnew与ni之间的连线上行人所占据的可行区域的面积;和ε是常数,取最大线速度的倒数,ε取最大角速度的倒数;

碰撞检测模块,用于对所述生长点和所述候选节点之间的连线作碰撞检测,判断碰撞检测是否通过;

判断模块,用于将所述候选节点连接到所述生长点上,判断所述候选节点是否为终点;

集合模块,用于从所述搜索树上获取从根节点到终点之间的节点连线集合,形成最终路径。