一种机械臂末端振动抑制方法及装置制造方法及图纸

技术编号:42236090 阅读:21 留言:0更新日期:2024-08-02 13:49
本申请公开一种机械臂末端振动抑制方法及装置,所述方法包括:基于机械臂尺寸参数,构建机械臂运动学模型;根据机械臂运动学模型,构建机械臂动力学模型;基于机械臂关节电机运动参数,构建电机传递函数模型;基于电机传递函数模型,构建机械臂关节响应模型;输入所述机械臂关节响应模型至机械臂动力学模型,计算机械臂末端振动响应参数;采用输入整形器,抑制机械臂末端振动响应参数。通过本发明专利技术提供的机械臂末端振动抑制方法,代替了以往单电机振动的抑制,从整体上基于机械臂的运动学和动力学并结合电机时域频域响应来抑制机械臂振动,较高效地实现机械臂振动抑制。此外,整体上对机械臂的非线性误差进行降低,以实现机械臂更好的振动抑制。

【技术实现步骤摘要】

本申请涉及精密控制,尤其涉及一种机械臂末端振动抑制方法及装置


技术介绍

1、芯片制造过程中晶圆机械手用于对芯片进行搬运,晶圆机械手通过若干电机驱动机械手的末端执行器实现操控。该控制过程中若干电机会发生振动,当然也可认为是机械手末端产生的振动。为了抑制该振动,通常采用输入整形器抵消绝大多数的振动,如输入整形器zvd。当然也可通过提高结构或传动系统的刚性来达到减震的目的,然而环境、成本等特殊要求造成的结构构型、材料等方面的限制,常常使得的结构或传动刚性无法满足要求。

2、在实现现有技术的过程中,专利技术人发现:

3、现有采用输入整形器进行振动抑制对象的一般为单电机,需增加额外的传感器,增加了搭建成本,且对于由若干电机组成的晶圆机械手而言,分别对若干电机采用输入整形器进行振动抑制的效果差,未有考虑到其系统性地输入整形进行振动抑制的技术方案。此外,机械手除电机的振动外,机械手加工制造过程中还存在由于误差和间隙等原因导致的机械臂结构参数和设计差异等参数,进而导致机械手模型不准确,机械臂末端的振动不能简单地转换为时域的信号,也无法对该信号进行本文档来自技高网...

【技术保护点】

1.一种机械臂末端振动抑制方法,其特征在于,包括:

2.如权利要求1所述方法,其特征在于,所述基于机械臂尺寸参数,构建机械臂运动学模型,具体包括:

3.如权利要求2述方法,其特征在于,基于机械臂尺寸参数,获取机械臂连杆传递矩阵,具体包括:

4.如权利要求3方法,其特征在于,对所述连杆传递矩阵进行函数运算,生成机器人相应关节位姿信息,具体包括:

5.权利要求4方法,其特征在于,对所述辨识处理后的机器人相应关节位姿信息进行标定处理,具体包括:

6.如权利要求1所述方法,其特征在于,根据机械臂运动学模型,构建机械臂动力学模型,具体包括...

【技术特征摘要】

1.一种机械臂末端振动抑制方法,其特征在于,包括:

2.如权利要求1所述方法,其特征在于,所述基于机械臂尺寸参数,构建机械臂运动学模型,具体包括:

3.如权利要求2述方法,其特征在于,基于机械臂尺寸参数,获取机械臂连杆传递矩阵,具体包括:

4.如权利要求3方法,其特征在于,对所述连杆传递矩阵进行函数运算,生成机器人相应关节位姿信息,具体包括:

5.权利要求4方法,其特征在于,对所述辨识处理后的机器人相应关节位姿信息进行标定处理,具体包括:

6.如权利要求1所述方法,其特征在于...

【专利技术属性】
技术研发人员:向星灿闫金书
申请(专利权)人:苏州纳道精运半导体科技有限公司
类型:发明
国别省市:

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1