基于局域和全域能量最优的重载成形机器人轨迹规划方法

摘要: 本发明涉及成形装备,更具体地说,涉及一种基于局域和全域能量最优的重载成形机器人轨迹规划方法。背景技术:1、薄壁高筋构件是航空航天装备中的主承力构件。为实现薄壁高...
基于局域和全域能量最优的重载成形机器人轨迹规划方法

本发明涉及成形装备,更具体地说,涉及一种基于局域和全域能量最优的重载成形机器人轨迹规划方法。

背景技术:

1、薄壁高筋构件是航空航天装备中的主承力构件。为实现薄壁高筋构件的高性能、高效率制造,采用由六组大功率伺服电机驱动的重载成形机器人进行成形加工。由于成形过程中的驱动系统受力较大,伺服电机的运动轨迹对装备能量消耗具有较大影响。

2、重载成形机器人的机构构型较复杂,运动关系与力学关系相互耦合,采用传统轨迹规划方法时存在能耗较高和运动误差较大的问题。同时,不同局域速度曲线所对应的能耗、冲击及动平台运动误差存在差异,需要在能量消耗与工作平顺性之间进行协调。

技术实现思路

1、本发明要解决的技术问题在于,提供一种基于局域和全域能量最优的重载成形机器人轨迹规划方法,通过结合全域能量规划与局域能量—冲击优化,在满足运动约束及动平台误差约束的条件下降低成形运动能耗,并兼顾工作平顺性。

2、本发明解决其技术问题所采用的技术方案是:构造一种基于局域和全域能量最优的重载成形机器人轨迹规划方法,所述重载成形机器人采用六台伺服电机分别通过滚珠丝杠驱动六个滑块、由所述滑块经连杆带动动平台进行空间成形运动,轨迹规划方法包括以下步骤:

3、s1、根据所述重载成形机器人的机构几何关系建立运动学模型,并根据滑块、连杆和动平台的受力关系建立动力学模型,获得各滑块的位移、速度、加速度和驱动力;

4、s2、将六个滑块的运动曲线划分为运动规划插值点,建立以各滑块的驱动力与速度乘积的绝对值对时间积分并求和得到的全域能量消耗目标;根据所述运动学模型和动力学模型得到六台伺服电机的总功率曲线,将单周期总功率曲线分为两段,分别进行多次傅里叶拟合和多次三角函数逼近,得到功率曲线的近似拟合函数表达式,并将所述功率曲线的近似拟合函数作为优化条件,在速度、加速度、驱动力和动平台误差约束下进行全域轨迹规划;

5、s3、在所述全域轨迹规划的基础上,对相邻运动规划插值点之间的局域轨迹建立局域能量—冲击模型,所述局域能量—冲击模型以能量消耗和各滑块位移对时间的三阶导数的绝对值对时间积分并求和得到的冲击指数作为优化目标,以三次多项式曲线、五次多项式曲线和s型样条曲线分别形成的轨迹作为优化初始解,根据能量消耗与冲击的权衡系数,在运动学约束和动力学约束下对局域轨迹进行优化;

6、s4、由上位机计算优化后的轨迹,将所述优化后的轨迹作为六台伺服电机的输入轨迹,通过多轴控制系统驱动所述动平台进行成形运动。

7、按上述方案,步骤s1中,在静平台外接圆圆心处建立固定坐标系,在动平台外接圆圆心处建立动坐标系,利用所述固定坐标系与动坐标系之间的齐次坐标变换,以及上球铰点、下球铰点与连杆之间的杆长不变关系,求得六个滑块的位移,并根据所述位移获得对应的速度和加速度。

8、按上述方案,步骤s1中,分别根据滑块、连杆和动平台所受的约束反力、外部载荷及重力建立牛顿欧拉方程,联立所述牛顿欧拉方程,根据滑块、连杆和动平台之间的内力与力矩关系消除内力,求得各滑块的驱动力。

9、按上述方案,步骤s2中,将运动规划插值点的数量记为n,第k个运动规划插值点对应的时刻记为tk,运动总时间记为t,所述全域能量消耗目标为使下式表示的能量消耗最小:

10、

11、其中,fi(t)为第i个滑块的驱动力,qi(t)为第i个滑块的位移;所述全域轨迹规划满足首个插值点时刻为零、末个插值点时刻为t、相邻插值点的时间间隔不小于给定下限,以及各滑块的首末位置相同的约束。

12、按上述方案,步骤s2中得到的功率曲线的近似拟合函数表达式为:

13、。

14、按上述方案,步骤s3中,将包含始末路径点的任务路径划分为n个路径点以及n1个局域区间,第k个局域区间的时间间隔为相邻路径点对应时刻之差,并根据区间起始时刻和终止时刻所对应的位置、速度和加速度条件定义局域运动轨迹。

15、按上述方案,步骤s3中,所述冲击指数为:

16、

17、其中,qi(t)为第i个滑块的位移,t为运动总时间;所述局域轨迹优化同时满足滑块速度绝对值上限、加速度绝对值上限、位移对时间的三阶导数绝对值上限及驱动力上限的约束。

18、按上述方案,所述局域能量—冲击模型采用能量消耗与冲击指数的加权目标函数,优化目标为:

19、

20、其中,

ze为能量消耗,

zj为冲击指数,ξ为所述权衡系数,

kt为能量消耗的归一化系数,

kj为冲击指数的归一化系数。

21、按上述方案,针对能量消耗与冲击指数数量级不同的情况,采用标准化z分数对能量消耗与冲击指数进行无量纲化处理,利用无量纲化后的能量消耗与冲击指数进行加权优化。

22、按上述方案,所述权衡系数ξ取0.5或0.8,分别获得对应权衡系数下的优化轨迹。

23、实施本发明的基于局域和全域能量最优的重载成形机器人轨迹规划方法,具有以下有益效果:

24、本发明将六个驱动滑块的运动学、动力学关系与能量目标相结合,利用分段功率拟合建立全域规划条件,并通过局域能量—冲击模型对局域轨迹进行优化。与仅采用单一样条曲线的轨迹规划相比,能够根据能耗与冲击的权衡关系选择优化轨迹,降低成形过程中的能量消耗,并兼顾工作平顺性和运动精度。

1.一种基于局域和全域能量最优的重载成形机器人轨迹规划方法,所述重载成形机器人采用六台伺服电机分别通过滚珠丝杠驱动六个滑块、由所述滑块经连杆带动动平台进行空间成形运动,其特征在于,轨迹规划方法包括以下步骤:

2.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s1中,在静平台外接圆圆心处建立固定坐标系,在动平台外接圆圆心处建立动坐标系,利用所述固定坐标系与动坐标系之间的齐次坐标变换,以及上球铰点、下球铰点与连杆之间的杆长不变关系,求得六个滑块的位移,并根据所述位移获得对应的速度和加速度。

3.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s1中,分别根据滑块、连杆和动平台所受的约束反力、外部载荷及重力建立牛顿欧拉方程,联立所述牛顿欧拉方程,根据滑块、连杆和动平台之间的内力与力矩关系消除内力,求得各滑块的驱动力。

4.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s2中,将运动规划插值点的数量记为n,第k个运动规划插值点对应的时刻记为tk,运动总时间记为t,所述全域能量消耗目标为使下式表示的能量消耗最小:

5.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s2中得到的功率曲线的近似拟合函数表达式为:

6.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s3中,将包含始末路径点的任务路径划分为n个路径点以及n1个局域区间,第k个局域区间的时间间隔为相邻路径点对应时刻之差,并根据区间起始时刻和终止时刻所对应的位置、速度和加速度条件定义局域运动轨迹。

7.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,步骤s3中,所述冲击指数为:

8.根据权利要求7所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,所述局域能量—冲击模型采用能量消耗与冲击指数的加权目标函数,优化目标为:

9.根据权利要求1所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,针对能量消耗与冲击指数数量级不同的情况,采用标准化z分数对能量消耗与冲击指数进行无量纲化处理,利用无量纲化后的能量消耗与冲击指数进行加权优化。

10.根据权利要求8所述的基于局域和全域能量最优的重载成形机器人轨迹规划方法,其特征在于,所述权衡系数ξ取0.5或0.8,分别获得对应权衡系数下的优化轨迹。