考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法
本发明涉及成形装备,更具体地说,涉及一种考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法。
背景技术:
1、薄壁高筋构件广泛应用于航空航天等领域,其成形过程通常要求成形模具按照预定的多自由度轨迹运动。采用并联式重载成形机器人驱动包络模具,能够兼顾较大的成形载荷和空间运动能力。现有机器人动力学模型多将滑块、连杆和动平台视为刚体,或者仅考虑单一构件的柔性变形;在重载、偏心载荷和周期载荷作用下,滑块、连杆及动平台均会产生平移变形和转动变形,并通过支链接头和内部作用力相互传递。若忽略上述变形及耦合关系,所得驱动力、约束力、构件变形和末端位姿误差与实际状态之间容易产生偏差。另一方面,直接采用高自由度有限元模型虽可细化描述结构变形,但模型规模大、参数组织和求解复杂,不利于机器人设计迭代、在线误差预测及控制应用。因此,需要建立一种计算规模可控且能够同时反映滑块、连杆和动平台变形的刚柔耦合动力学模型。
技术实现思路
1、本发明要解决的技术问题在于,提供一种考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,可以解决现有重载成形机器人动力学模型难以同时描述滑块、连杆和动平台在重载作用下的多方向变形、构件间内力传递和末端模具位姿误差,导致模型精度与求解效率难以兼顾的问题。
2、本发明解决其技术问题所采用的技术方案是:构造一种考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,所述重载成形机器人包括上底座、动平台、设置于所述动平台的成形模具以及并联连接于所述上底座和所述动平台之间的六条支链,每条所述支链包括滑块以及两端分别与所述滑块和所述动平台连接的连杆,其特征在于,建模方法包括以下步骤:
3、s1、根据所述上底座、动平台、六条支链和成形模具之间的几何关系建立机器人运动学模型,获得所述成形模具的理论运动以及各滑块的理论位移;
4、s2、将每个所述滑块和每个所述连杆分别离散为由等效弹性单元和等效阻尼单元连接的两个质量部分,并将所述动平台离散为一个中心质量部分和六个侧质量部分,所述中心质量部分与各侧质量部分之间以及相邻侧质量部分之间分别设置等效弹性单元和等效阻尼单元;
5、s3、分别构建所述滑块、连杆和动平台各质量部分的质量矩阵、刚度矩阵和阻尼矩阵,以有限位移旋量表征各质量部分之间的平移变形和转动变形,并建立各质量部分的动力学方程;
6、s4、根据驱动器与滑块之间、滑块与连杆之间以及连杆与动平台之间的内力传递关系,将所述动力学方程与边界条件、接头约束条件和动平台变形协调条件组合,得到总体刚柔耦合动力学模型,并求解机器人运动状态、变形状态、约束力、驱动力和载荷中的待求变量;
7、s5、根据所述成形模具的理论运动与由所述总体刚柔耦合动力学模型求得的实际运动之间的偏差,获得所述成形模具的位置误差和角度误差。
8、按上述方案,每条所述支链还包括依次传动连接的伺服电机、减速器和滚珠丝杠,所述滚珠丝杠用于驱动所述滑块沿所述上底座的导向方向平移;所述连杆的两端分别通过s型接头与所述滑块和所述动平台连接,所述伺服电机和减速器固定于所述上底座。
9、按上述方案,步骤s1包括:分别建立上底座坐标系、动平台坐标系、坯料坐标系、成形模具辅助坐标系和成形模具坐标系;采用变换矩阵表示相邻坐标系之间的位姿变换,并采用六维运动旋量表示所述成形模具、滑块和连杆的运动;根据各支链上、下接头中心的位置向量以及连杆长度约束求取各滑块的理论位移。
10、按上述方案,所述滑块的两个质量部分均等效为圆柱形质量部分,所述两个质量部分之间的相对变形采用包含三个线位移分量和三个角位移分量的有限位移旋量表示;所述滑块的等效刚度矩阵的六个对角元素分别对应三个方向的线刚度和三个方向的角刚度。
11、按上述方案,所述连杆的两个质量部分均等效为集中质量部分,所述两个质量部分之间的相对变形采用包含三个线位移分量和三个角位移分量的有限位移旋量表示;所述连杆的等效刚度矩阵根据连杆材料的杨氏模量、泊松比、截面尺寸和等效长度确定。
12、按上述方案,所述动平台的中心质量部分包含成形模具质量和动平台的至少部分质量,所述侧质量部分包含与相应连杆连接的接头座质量;中心质量部分与侧质量部分之间的等效刚度根据动平台半径、厚度以及相邻侧质量部分之间的弦长确定,相邻侧质量部分之间的等效刚度根据相邻侧质量部分之间连接区域的长度、宽度和厚度确定。
13、按上述方案,所述阻尼矩阵采用瑞利阻尼形式d=χm+λk,其中,m为对应质量部分的质量矩阵,k为对应连接区域的刚度矩阵,χ和λ为线性阻尼系数。
14、按上述方案,步骤s3中,对于相连接的两个质量部分,根据所述有限位移旋量和其时间导数分别计算弹性力旋量和阻尼力旋量,并通过李代数伴随变换将不同局部坐标系中的运动旋量和力旋量变换至统一参考坐标系,以建立各质量部分质心处的动力学平衡方程。
15、按上述方案,步骤s4中,所述动平台变形协调条件包括各侧质量部分经相应接头与连杆连接处的位姿连续条件,以及相邻侧质量部分之间的相对变形协调条件;所述总体刚柔耦合动力学模型通过驱动器-滑块内力、滑块-连杆内力和连杆-动平台内力将各构件动力学方程耦合。
16、按上述方案,步骤s5中,将所述成形模具的理论运动旋量与所述动平台中心质量部分的实际运动旋量之差定义为运动误差旋量,将所述运动误差旋量的平移部分分解为沿三个坐标轴的位置误差,并根据理论成形模具坐标系与实际成形模具坐标系对应坐标轴之间的夹角获得绕三个坐标轴的角度误差。
17、实施本发明的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,具有以下有益效果:
18、1、通过对滑块、连杆和动平台进行面向力传递路径的集中参数离散,可在较低模型规模下同时描述关键承载构件的线性变形和角变形,避免仅将连杆柔性化或将整机完全刚体化所带来的误差。
19、2、通过有限位移旋量、坐标变换和构件内力将各质量部分的运动方程耦合起来,可统一求解运动、变形、约束力、驱动力和载荷,便于开展正向动力学和逆向动力学分析。
20、3、动平台采用中心质量部分与六个侧质量部分的等效结构,并设置中心-侧部及相邻侧部的变形协调关系,能够反映偏心重载导致的动平台弯曲、扭转和压缩变形。
21、4、依据理论运动与实际运动的旋量偏差直接计算包络模具六自由度运动误差,可为机器人结构参数优化、误差预测、轨迹修正和成形精度控制提供模型基础。
1.一种考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,所述重载成形机器人包括上底座、动平台、设置于所述动平台的成形模具以及并联连接于所述上底座和所述动平台之间的六条支链,每条所述支链包括滑块以及两端分别与所述滑块和所述动平台连接的连杆,其特征在于,建模方法包括以下步骤:
2.根据权利要求1所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,每条所述支链还包括依次传动连接的伺服电机、减速器和滚珠丝杠,所述滚珠丝杠用于驱动所述滑块沿所述上底座的导向方向平移;所述连杆的两端分别通过s型接头与所述滑块和所述动平台连接,所述伺服电机和减速器固定于所述上底座。
3.根据权利要求2所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,步骤s1包括:分别建立上底座坐标系、动平台坐标系、坯料坐标系、成形模具辅助坐标系和成形模具坐标系;采用变换矩阵表示相邻坐标系之间的位姿变换,并采用六维运动旋量表示所述成形模具、滑块和连杆的运动;根据各支链上、下接头中心的位置向量以及连杆长度约束求取各滑块的理论位移。
4.根据权利要求1所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,所述滑块的两个质量部分均等效为圆柱形质量部分,所述两个质量部分之间的相对变形采用包含三个线位移分量和三个角位移分量的有限位移旋量表示;所述滑块的等效刚度矩阵的六个对角元素分别对应三个方向的线刚度和三个方向的角刚度。
5.根据权利要求4所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,所述连杆的两个质量部分均等效为集中质量部分,所述两个质量部分之间的相对变形采用包含三个线位移分量和三个角位移分量的有限位移旋量表示;所述连杆的等效刚度矩阵根据连杆材料的杨氏模量、泊松比、截面尺寸和等效长度确定。
6.根据权利要求5所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,所述动平台的中心质量部分包含成形模具质量和动平台的至少部分质量,所述侧质量部分包含与相应连杆连接的接头座质量;中心质量部分与侧质量部分之间的等效刚度根据动平台半径、厚度以及相邻侧质量部分之间的弦长确定,相邻侧质量部分之间的等效刚度根据相邻侧质量部分之间连接区域的长度、宽度和厚度确定。
7.根据权利要求4-6任意一项所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,所述阻尼矩阵采用瑞利阻尼形式d=χm+λk,其中,m为对应质量部分的质量矩阵,k为对应连接区域的刚度矩阵,χ和λ为线性阻尼系数。
8.根据权利要求7所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,步骤s3中,对于相连接的两个质量部分,根据所述有限位移旋量和其时间导数分别计算弹性力旋量和阻尼力旋量,并通过李代数伴随变换将不同局部坐标系中的运动旋量和力旋量变换至统一参考坐标系,以建立各质量部分质心处的动力学平衡方程。
9.根据权利要求8所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,步骤s4中,所述动平台变形协调条件包括各侧质量部分经相应接头与连杆连接处的位姿连续条件,以及相邻侧质量部分之间的相对变形协调条件;所述总体刚柔耦合动力学模型通过驱动器-滑块内力、滑块-连杆内力和连杆-动平台内力将各构件动力学方程耦合。
10.根据权利要求9所述的考虑滑块、连杆和动平台变形的重载成形机器人刚柔耦合建模方法,其特征在于,步骤s5中,将所述成形模具的理论运动旋量与所述动平台中心质量部分的实际运动旋量之差定义为运动误差旋量,将所述运动误差旋量的平移部分分解为沿三个坐标轴的位置误差,并根据理论成形模具坐标系与实际成形模具坐标系对应坐标轴之间的夹角获得绕三个坐标轴的角度误差。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com