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之间的连线上行人所占据的可行区域的面积;和ε是常数,取最大线速度的倒数,ε取最大角速度的倒数;
碰撞检测模块,用于对所述生长点和所述候选节点之间的连线作碰撞检测,判断碰撞检测是否通过;
判断模块,用于将所述候选节点连接到所述生长点上,判断所述候选节点是否为终点;
集合模块,用于从所述搜索树上获取从根节点到终点之间的节点连线集合,形成最终路径。