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

摘要:

权利要求书:

1.一种机器人时间‑能量最优平滑轨迹规划方法,其特征是按如下步骤:步骤S1、基于Delaunay三角剖分的地图环境构建:包括确定任务空间中障碍物的边及顶点的坐标值、基于Delaunay三角剖分、将处于障碍物内部的剖分三角形去除,并将障碍物的边界纳入,形成新的剖分三角组网;包含设计:(a)转角法判断某点在多边形障碍物外部的标准;

(b)判断三角组网中三角形整体或某一部分处于障碍物内部的标准;

定义地图中三角组网自由边的中点为后续路径搜索的可选路径点;可选路径的边集合则为相邻三角形两自由边的中点连线、以及起终点与邻近自由边中点连线的集合;

步骤S2、初始折线路径规划:以路径曲率变化率的平方和构造能量函数,并将其与路径长度加权求和一起构成代价函数,同时将路径曲率峰值及安全距离纳入约束条件,构建初始路径优化模型,搜索总代价最小的初始无碰撞折线路径;

步骤S3、初始路径再优化:将初始折线路径的总代价作为初始值,对初始路径进一步通过删除锐角顶点、路径替换及去除冗余路径点再优化;

步骤S4、路径的三次NURBS拟合及宽度实现:首先输入最优折线路径点为型值点,通过公式反算控制点,选取合适的权因子,确定NURBS路径,再以此NURBS路径线为中线,以2倍安全距离为宽度,获得拥有宽度的NURBS路径;

步骤S5、首先,根据机器人的具体结构、特征及工作条件,确定其速度、加速度、跃度取值限制;接着,基于三次NURBS路径的几何形状、总长度及机器人运动策略,确定各分段轨迹长度及运行时间,将整条路径分成五段,分别对应运动控制的加加速段、减加速段、匀速段、加减速段和减减速段;最后,具体设计各段轨迹的速度、加速度、跃度控制策略。

2.根据权利要求1所述的一种机器人时间‑能量最优平滑轨迹规划方法,其特征是步骤S1中所述的(a)转角法判断某点在多边形障碍物外部的标准:设障碍物在二维地面的投影均为封闭的多边形,Vi,i=1,2,…k为多边形的顶点,从任意点P点到Vi,i=1,2,…k分别做连线,αi,i=1,2,…,k‑1为连线PVi向连线PVi+1旋转而转过的角度,逆时针为正,反之为负,αk为连线PVk转回到初始连线PV1的角度;根据转角法判断点P在多边形障碍物外部的具体要求是:该式表示由初始连线PV1出发,依次向其它连线PV2,PV3,…,PVk旋转,最后由PVk转回到初始连线PV1,若所有转角之和相消为0,则点P位于多边形障碍物的外部;

所述的(b)判断三角组网中三角形整体或某一部分处于障碍物内部的标准:由于不允许在障碍物内部寻找路径,因此三角剖分后,需将处于障碍物内部的剖分三角形去除,若剖分三角形的某一部分处于障碍物内部,则去除处于障碍物内部的那部分线段,并将障碍物的边界及其与该三角形的交点纳入并形成新的剖分三角组网;新的三角组网中的所有自由三角形共同构成自由空间;

设环境中共有n个障碍物,barrierξ为第ξ个障碍物,ξ=1,2,…,n,三角组网中共有m个三角形, 为第 个三角形, 则 的整体或某一部分处于障碍物barrierξ内部的判断标准为

式中, 为三角形 与障碍物barrierξ交集的面积。

3.根据权利要求1所述的一种机器人时间‑能量最优平滑轨迹规划方法,其特征是步骤S2中所述的初始路径优化模型步骤如下:(a)构造能量函数

对一条连续曲线路径进行离散,以曲率变化率的平方和构造能量函数,表达式为:表达式中,P1,P2,…,Pm为离散点序列,m为离散点总数,P1、Pm分别为路径的起终点,κi是离散点Pi点的曲率,Δli是相邻离散点之间的距离,Δli=|Pi+1‑Pi|;

Pi处的离散曲率κi的计算公式为:

计算公式中,Pi‑1、Pi、Pi+1表示路径轨迹中的三个相邻的节点; 表示带符号的三角形ΔPi‑1PiPi+1面积,当Pi‑1、Pi、Pi+1逆时针运行时被定义为正,反之为负;

(b)构建代价函数

代价是对能量函数及长度指标值的加权求和,以实现路径的时间‑能量最优;表达式如下:表达式中,λκ和λL分别表示每个网格节点的离散曲率指标、长度指标的权重系数;X表示待评估的完整路径;m表示从起点P1到目标点Pm的节点数;

(c)构建初始路径的优化模型

初始路径的优化模型为:

优化模型中,κlim为移动机器人系统要求的轨迹曲率峰值限制值;优化模型要求0≤λκ≤

1,0≤λL≤1,λκ+λL=1;其目标函数,表示路径的能量与长度加权求和最小;第一个约束为路径的曲率;第二个为考虑到移动机器人因自身存在非完整约束,在转折点处无法连续运动而做出的轨迹曲率峰值限制;第三个约束是路径中的任何节点与障碍物的距离D(Pi,barrierξ)均不小于安全距离Dsafe,以保证轨迹的无碰撞与安全性;第四、五个约束分别表示路径以Pstart为起点,以Pgoal为终点;第六个约束是路径轨迹中的边均属于边集合A,Apath为路径选中的边集合;

(d)搜索总代价最小的初始无碰撞折线路径

依据初始路径的优化模型,基于步骤S1中利用Delaunay三角剖分构建的地图环境,以地图中三角组网自由边的中点为后续搜索的可选路径点,以相邻三角形两自由边的中点连线、以及起终点与邻近自由边中点连线的集合为可选路径的边集合A,从起点向目标点搜索总代价最小的初始无碰撞折线路径。

4.根据权利要求1所述的一种机器人时间‑能量最优平滑轨迹规划方法,其特征是步骤S3所述的初始折线路径再优化,包括以下步骤:(a)删除锐角顶点;

当路径中存在锐角,依次尝试删除锐角顶点,将其前后路径点直接连线,如新路径代价能够降低且满足曲率峰值限制及安全距离等约束,则接受;否则,保留原路径;

(b)路径替换;

从起始点开始,依次搜索该路径点直接连接路径上的终点、倒数第二点、倒数第三点、……、该路径点的下下点,判断直接连线的新路径的代价是否能够降低且满足曲率峰值限制及安全距离等约束,如满足,则以该两点间的直接连线进行替代两点间的原路径,否则,保持原路径;反复迭代直至路径的第一点、第二点、第三点、……至……、倒数第三点、倒数第二点、终点间的路径替换全部完成;

(c)除冗余路径点;

当存在相邻路径共线时,则去除中间冗余点,将最端部的两路径点直接连线;

经以上三步骤的反复迭代,最终获得再优化的无碰撞最优折线路径。

5.根据权利要求1所述的一种机器人时间‑能量最优平滑轨迹规划方法,其特征是步骤S5包括以下步骤:(a)根据机器人的具体结构、特征及工作条件,确定机器人的速度、加速度、跃度取值限制;

(b)确定各分段轨迹长度及运行时间;

五段S型加减速段分别是加加速段、减加速段、匀速段、加减速段和减减速段;沿轨迹切向的速度、加速度连续,跃度为Bang‑Bang‑Singular直线阶跃形式;

设五段分运动所花费的时长分别是τ1、τ2、τ3、τ4、τ5,运动结束的时刻分别为t1、t2、t3、t4、t5,每段轨迹对应的长度分别为s1、s2、s3、s4、s5;则五段式S型加减速运动控制曲线的速度、加速度和跃度与时间的关系式分别如下:速度规划需满足初始、末端的状态要求,具体为:

s(Pstart)=0

s(Pgoal)=stotal

设五段运动所花费的总时长为ttotal,考虑到曲线对称,可得:设vlim、alim、Jlim分别为速度、加速度和跃度取值的限制值;为获得运动的平稳性,要求移动机器人的运动满足速度、加速度及跃度约束:v≤vlim

a≤alim

J≤Jlim

根据第一段的终点加速度,有:

Jt1≤alim

因t1=τ1=τ,即有:

根据第二段的终点或第三段起点的速度,有:

因t2=τ1+τ2=2*t1=2τ,即有:

再考虑轨迹长度约束;设轨迹的总长度为s,对轨迹速度时间关系式进行积分与求解,得出在第一、二、四、五速度段期间,机器人分段走过的轨迹长度s1、s2、s4、s5分别为:故第三段匀速运动期间,机器人走过的轨迹长度s3为:3

s3=s‑2Jτ

3

根据s3≥0,可以得到s≥2Jτ,即有:

综合考虑加速度、跃度、轨迹长度约束,时间τ的极值为:由速度时间关系式,可得第三段匀速运动期间机器人沿轨迹切向运行的速度v3为:2

v3=Jτ

3

结合s3=s‑2Jτ,第三段匀速运动期间所花费的时间t3为:结合 可得五段运动所花费的总时长ttotal为:由此,便可确定各分段轨迹长度及运行时间;

(c)将整条路径分成五段:基于各分段轨迹长度及运行时间,将整条路径分成五段,分别对应运动控制的加加速段、减加速段、匀速段、加减速段和减减速段;

(d)具体设计各段轨迹的速度、加速度、跃度控制策略;

根据时间τ的极值为 即在 三者中取最小,确

定了这三者哪个最小之后,判断出为了使总运动时间最短,轨迹长度、速度、加速度及跃度中哪一个参数的取值受到了限制,将该参数的最大值取限制值,再通过五段式S型加减速运动控制曲线的速度、加速度和跃度与时间的关系式推算出各段轨迹具体的速度、加速度、跃度;τ分别在 三者中,取得不同最小值情形下,实现总时长ttotal最小的方法:

① 情形

若此情形下的s、vlim为定值,则J=Jlim时,总时长ttotal最小,其值为:② 情形

若此情形下的s、alim为定值,则 时,总时长ttotal最小,其值为:③ 情形

此情形下的s为定值,则J=Jlim时,总时长ttotal最小,其值为: