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

摘要:

权利要求书:

1.一种拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述拱坝缆机实时避障轨迹平滑过渡规划方法包括以下步骤:

1)对拱坝缆机工作参数进行初始化;

2)构建二维栅格环境地图;

3)基于步骤2)构建得到的二维栅格环境地图进行最简几何避障路径规划,获取路径节点;

4)对步骤3)获取得到的最简几何避障路径规划进行优化,同时生成轨迹簇;所述步骤4)的具体实现方式:

4.1)以吊罐基准位置来进行缆机往返复合运动阶段的点到点的轨迹速度规划;所述吊罐基准位置是指吊罐形心的位置中心;将优化轨迹路径节点中每两个拐点之间用一个路径-速度平滑过渡曲线拟合,路径-速度平滑过渡曲线组合函数为:其中:

t为预期完成时间中每段完成运动时间期望值;

轨迹平滑过渡控制曲线组合函数中各系数分别为:

a10=s0

a11=vs

a12=as/2

a21=vm

a30=a20+a21h2

a31=vm

a32=0

其中:

si为第i段位移曲线;

aij为第i段位移曲线的第j个系数;

hi为第i段位移耗时;

s0和s、vs和ve、as和ae分别为整段曲线初、末时刻的位移、速度、加速度;

vm为设定的最大运行速度;

4.2)根据初始设置预期完成时间区间,根据最小期望时间单位,筛选出符合的避障轨迹簇;

所述步骤4.2)中筛选的具体实现方式是:首先对各段的吊运时间设定期望值,然后对各段的期望吊运时间进行离散化处理,并生成期望时间正交试验组合,逐一代入到参数化轨迹方程生成轨迹簇,最后根据轨迹约束和性能评价指标优选一条轨迹用于缆机执行;

5)筛选步骤4)所生成的轨迹簇,并形成优选轨迹;

6)执行步骤5)的优选轨迹,结合事中碰撞风险对步骤2)所得到的二维栅格环境地图进行更新;

7)结合步骤6)所更新得到的二维栅格环境地图,重复执行步骤3),构建实时避障轨迹平滑曲线。

2.根据权利要求1所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤1)中初始化参数包括起始点的位置和终止点的位置,初始速度和加速度,时间参数,约束条件,缆机水平和垂直最大吊运速度,缆机吊罐与边坡、坝体及附属设施的最小安全距离,缆机与塔机、仓面浇筑机械的最小安全距离,重罐提升终点和空罐落罐起点距离平台的高度距离,重罐对位起点高度,轨迹规划阈值σ和碰撞检测时间周期以及预测时间步长;

所述时间参数包括完成路程的期望时间最大值、期望时间最小值与期望完成时间区间最小单位;

所述约束条件包括小车的运行速度区间、缆绳升降的速度区间、小车运行加速度区间以及缆绳升降的加速度区间,小车与缆机缆绳升降最大运行速度;

所述σ是规划轨迹节点序列中,当前点与当前点前后相邻点连线所成角的最小角度阈值;所述是轨迹规划节点序列中,当前节点和前序规划路径所成夹角与后续节点和路径所成夹角之差的最小角度阈值。

3.根据权利要求2所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤2)具体是:所述二维栅格环境地图是将环境划分为平面的正方形区域或正方形栅格的地图,是缆机吊运混凝土的空间域;所述二维栅格环境地图包括可通行区域以及障碍区域;所述障碍区域是根据障碍物的运动状态来确定的,所述障碍区域包括固定障碍区域和非固定障碍区域;

所述二维栅格环境地图的具体构建方式是:通过正视拱坝方位,设置拱坝的边界位置坐标,建立平面正方形栅格地图;对障碍物区域用以栅格形式表达,精准确定障碍物区域边界位置尺寸;

所述拱坝的边界位置坐标是以主塔为原点,以缆机主塔向副塔的水平运输方向为X轴,以拱坝高程方向水平向上为Z轴,以顺河流方向为Y轴;障碍物区域边界的位置尺寸,即混凝土拱坝坝块的体积盒的尺寸,是将坝块用以体积盒来描述空间体积大小的尺寸参数,包括长、宽、高尺寸;每个栅格代表地图上的一个区域,每个栅格状态的状态分为占用、空闲或未知;每个栅格状态根据环境数据进行更新。

4.根据权利要求3所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述更新的具体方式是根据感知系统感知到环境在其对应二维栅格环境地图中的栅格是否存在障碍物,若存在障碍物则更新栅格状态。

5.根据权利要求3或4所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤3)中最简几何避障路径规划的具体实现方式是:通过正视拱坝方位,根据已构建二维栅格环境地图,在可通行区域内,避开二维栅格环境地图的障碍物区域,将缆机吊罐视为二维平面移动质点,规划最简几何避障路径,结果以二维栅格环境地图节点形式输出;所述障碍物区域,是在所处二维栅格环境地图的位置坐标区域外围,根据初始化设定的最小安全距离,继续在二维栅格环境地图的障碍物实体中扩展所形成的虚拟碰撞边界;

所述路径节点的获取方式是:a1)几何避障路径规划,获取轨迹节点;a2)优化轨迹路径节点。

6.根据权利要求5所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述a1)的具体实现方式:从二维栅格环境地图确定起始点出发,按照有向图构造规则,从初始节点起,衡量当前节点到与当前节点相邻16个方向的邻域节点的代价值F(n),来确定下一节点,直至期望终点,获取几何避障路径节点;

所述代价值的表达式是:F(n)=G(n)+H(n);

其中:

G(n)表示从起始节点到当前节点n的实际代价;

H(n)表示从当前节点n到目标点的代价估计值;

所述G(n)的表达式是:

所述H(n)的表达式是:

其中:

(xn,yn)、(xstart,ystart)以及(xgoal,ygoal)分别为起点、当前位置和目标点所在栅格的中心坐标。

7.根据权利要求5所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述a2)的具体实现方式:a2.1)从初步规划的轨迹中获得的路径节点判断冗余点;相邻的前后序列三个节点,若共线,则执行删除操作,删除三点中的中间节点;若前序节点与中间节点的连线和中间节点的连线所成的最小度数大于阈值σ小于180°,且前序节点和后续节点的连线与障碍区无交集,则判定当前点为冗余点,则执行删除操作,删除三点中的中间节点;每次执行以上操作后,重新遍历新节点,更新路径,直至移除所有冗余点;

a2.2)若当前节点和前序规划路径所成夹角与后续节点和路径所成夹角之差大于预设阈值则认定节点相对于路径偏离过大,需要进行修正,在两个节点位置的中点新增一个节点,并将新增节点沿路径法线方向,向着有利路径方向平移ω个栅格单位,即以减小角的方向平移ω个栅格单位,重新遍历新节点,确认路径与不可通行区域无交点后,更新路径;ω视与不可通行区域距离而机动变化。

8.根据权利要求6或7所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤5)的具体实现方式:

5.1)在生成的轨迹簇中,根据轨迹约束和建立评价轨迹性能的代价函数优选一条轨迹;

所述轨迹代价函数为:

其中:

m为轨迹段数序号;

hi为对应的时长;

di为缆机吊罐与障碍物的最小安全距离;

Dmin为轨迹点与障碍物的最小距离;

ω为权重系数,当di-Dmin≤0时,ω1+ω2=1,且ω1>0,ω2>0;当di-Dmin>0时,即规划的轨迹与障碍物的距离小于安全距离时,ω1=ω2;

5.2)将步骤5.1)获取得到的优选轨迹的运动参数转换成缆机牵引和起升机构的运动参数:

5.2.1)对吊罐基准位置的速度进行规划;

5.2.2)换算成缆机牵引和起升机构的运动参数;设小车、起升绳、吊罐的速度和加速度分别是vc、vl、vb和ac、al、ab为;缆机小车、起升绳与吊罐的运动参数的关系表示为:vl=vbx(1-tanβ)

其中:

β为小车运动升角,β∈[-α,α],α<<90°,当规划出的吊罐速度平滑过渡时,缆机牵引和起升机构的速度变化也是平滑过渡的;

5.2.3)将步骤5.2.2)所获取得到的缆机牵引和起升机构的运动参数作为优选轨迹的输出。

9.根据权利要求8所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤6)的具体实现方式:在规划好优选后的全局轨迹后,执行轨迹运行事件,事件中,以初始化设定检测周期时间进行碰撞检测,当检测评估存在碰撞风险时,立即以当前点重新规划路径,即在初始化设置预测时间步长内进行实时平滑过渡曲线的规划轨迹避障;在预测时间步长内,将识别到的障碍物加入二维栅格环境地图,并以预警此刻序列轨迹路径点作为起始点,重构路径-速度平滑过渡曲线函数;

所述碰撞检测是选取吊罐与施工实体之间发生碰撞时的空间坐标,通过拟合体之间的位置关系判断是否发生碰撞;

所述拟合的具体实现方式是:将坝块、停工的塔机用立方体包围盒拟合;将运行的塔机则用圆柱拟合;将吊罐以包围球拟合;检测包围盒与包围球是否碰撞,检查球心到包围盒的最近点距离是否小于等于球半径;包围盒在x、y、z轴上的最小值和最大值分别为(xmin,ymin,zmin)和(xmax,ymax,zmax),包围球圆心为C(xc,yc,zc),半径为r,计算球心到包围盒的最近点P(xP,yP,zP),xP=max(xmin,min(xc,xmax))yP=max(ymin,min(yc,ymax))zP=max(zmin,min(zc,zmax))计算球心到最近点的距离:如果d≤r,则包围球和包围盒碰撞;否则,不碰撞;包围球与包围圆柱体碰撞,计圆柱体轴线方向的单位向量u=(ux,uy,uz),轴线上的一点P0(x0,y0,z0),底面半径rcy1,计算球心到轴线的最近点P1,其中v=(xc-x0,yc-y0,zc-z0),计算球心到最近点的距离,d=‖C-P1‖,如果d≤r+rcy1,则包围球与包围圆柱体碰撞,否则,不发生碰撞。

10.根据权利要求9所述的拱坝缆机实时避障轨迹平滑过渡规划方法,其特征在于:所述步骤7)的具体实现方式:以碰撞检测后设定的起点,执行步骤3),获取规划轨迹的节点,两拐点之间,以单个多项式拟合,位移曲线方程公式是:S=b0+b1t+b2t2+b3t3+b4t4+b5t5其中:

t为预期完成时间中每段完成运动时间期望值;该多项式的系数为:上式中,当碰撞预警发生点与目标终点之间不存在中间节点,则进行上式中的单个多项式的实时避障轨迹平滑过渡规划;

若单个多项式不满足当前轨迹规划场景需求,即碰撞预警发生点与目标终点之间存在中间节点,则采用两段多项式,位移曲线方程组是:该多项式的系数为:

其中:

si为第i段位移曲线;

bij为第i段曲线的第j个系数;

hi为第i段位移耗时;

s0和s、vs和ve、as和ae分别为整段曲线初、末时刻的位移、速度、加速度;

vm为设定的最大运行速度;

若出现大于两段的情况,则其分解为多个1~2段多项式的组合;继续步骤3),执行事中实时避障,否则终止规划,继续执行原有规划轨迹。