【技术实现步骤摘要】
一种油管搬运机器人关节轨迹规划方法
[0001]本专利技术属于油管搬运机器人关节轨迹规划
,尤其涉及一种油管搬运机器人关节轨迹规划方法。
技术介绍
[0002]石油油管搬运机器人被广泛地应用于油田油管加工、修复、喷漆、检测等工序中。但由于油管长度长、重量大,且搬运机器人连杆机构的关节较多,因此对油管搬运机器人关节轨迹的规划将直接影响到工序任务的完成质量及完成效率。此外,冗余的关节轨迹也会无端增加机器人运行能耗,降低搬运机器人的使用效果。
[0003]进一步研究后发现,由于轨迹规划和关节运动具有直接的重要关系,受各种几何误差和非几何误差的影响,关节之间的空间相关性是高度动态的,因此,有必要建立一种可靠、合理的关节轨迹规划方法,从而提高搬运机器人在各工序中的运行效率,降低搬运机器人的运行能耗。
技术实现思路
[0004]本专利技术提供了一种油管搬运机器人关节轨迹规划方法,该种油管搬运机器人关节轨迹规划方法按照任务要求,可实时求解各关节运动的位移、速度和加速度,从而为生成关节轨迹提供帮助。利用该方法进行关节轨迹的实时规划,可有效提高机器人关节的运动效率,降低运动能耗,最终可按照各种需求优化机器人的关节轨迹。
[0005]为解决上述技术问题,本专利技术采用了如下技术方案:一种油管搬运机器人关节轨迹规划方法,包括有如下步骤:步骤1:规划油管搬运机器人关节轨迹的空间路径,计算油管搬运机器人关节轨迹的空间路径插值;步骤2:设定油管搬运机器人关节轨迹的目标函数与约束函数;步骤3:构建用于调整油管 ...
【技术保护点】
【技术特征摘要】
1.一种油管搬运机器人关节轨迹规划方法,其特征在于,包括有如下步骤:步骤1:规划油管搬运机器人关节轨迹的空间路径,计算油管搬运机器人关节轨迹的空间路径插值;步骤2:设定油管搬运机器人关节轨迹的目标函数与约束函数;步骤3:构建用于调整油管搬运机器人关节轨迹规划的融合算法;步骤4:基于步骤3所得的融合算法,计算得到油管搬运机器人关节轨迹的最优解,完成油管搬运机器人关节轨迹的规划。2.根据权利要求1所述的一种油管搬运机器人关节轨迹规划方法,其特征在于,所述步骤1具体可描述为:采用三次均匀B样条曲线,实现对油管搬运机器人关节轨迹的空间路径的插值计算;其中,插值计算的数学表达式为:其式(1)中,θ
i
(u)为样条曲线对应于参数u的第i段点的矢量值,u∈[0,1];V
i+j
‑1为样条曲线的控制点;B
j,3
(u)为多项式,具体可描述为:将式(2)改写为矩阵形式,得到:为了保证B样条轨迹的连续性,令前一段轨迹的末端矢量与后一段轨迹的首端矢量相等,可得:其中,P
i
为轨迹上的型值点;由n个型值点确定n个方程,并添加边界条件,求出所有未知数;其中,添加的边界条件,满足:
基于式(5)中的V
i
‑1,V
i
,V
i+1
,V
i+2
,得到B样条曲线,满足:假设B样条曲线上控制点为V
i
(t
i
,q
i
),则B样条曲线上第i段轨迹的油管搬运机器人关节角度变化q(u)及时间变化t(u)分别满足:3.根据权利要求1所述的一种油管搬运机器人关节轨迹规划方法,其特征在于,所述步骤2具体可描述为:以油管搬运机器人关节运动时间最短为目标函数,对油管搬运机器人关节轨迹的路径进行优化;目标函数的数学模型可以表示为:其中,h
i
为每段油管搬运机器人关节轨迹的运行时间;T为整段油管搬运机器人关节轨迹的总时间;对油管搬运机器人关节轨迹的速度做如下约束:对B样条曲线求导,得到油管搬运机器人关节的速度表达式得到油管搬运机器人关节的速度表达式其式(9)也可以表达为:对油管搬运机器人关节轨迹的加速度做如下约束:对式(9)所示的油管搬运机器人关节的速度表达式求导,得到油管搬运机器人关
节的加速度表达式节的加速度表达式其式(11)也可以表达为:综合油管搬运机器人关节的速度表达式油管搬运机器人关节的加速度表达式得到的约束函数可以表达为:4.根据权利要求1所述的一种油管搬运机器人关节轨迹规划方法,其特征在于,所述步骤3具体可描述为:依托WOA算法的捕食机制,结合SMA算法中的参数以及表征每个黏菌个体的适应度权重,构建形成用于调整油管搬运机器人关节轨迹规划的融合算法;其中,WOA算法的捕食机制包括有包围猎物、动...
【专利技术属性】
技术研发人员:谭帅,李鑫宁,崔树芹,吴虎,张永辉,杨先海,
申请(专利权)人:山东高原油气装备有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。