洁净大气机器人及控制方法与流程

摘要: 本发明涉及机器人,尤其涉及一种洁净大气机器人及控制方法。背景技术:1、在洁净大气环境使用的半导体晶圆搬运机器人,简称洁净大气机器人,一般在设备前端模块、晶圆传片...
洁净大气机器人及控制方法与流程

本发明涉及机器人,尤其涉及一种洁净大气机器人及控制方法。

背景技术:

1、在洁净大气环境使用的半导体晶圆搬运机器人,简称洁净大气机器人,一般在设备前端模块、晶圆传片设备中使用。洁净大气机器人经常与预对准器、晶圆盒和工艺模块之间以较高节拍完成精密取放晶圆。其设计同时受到安装空间、槽位间距、晶圆易碎性、洁净度、重复定位精度和长期稳定性及维护性的约束。

2、传统洁净大气机器人通常采用步进电机或伺服电机带动谐波减速器配合同步带、带轮、张紧机构等实现关节传动。该类传动方式成本较低、结构成熟,但在半导体洁净环境中,同步带和带轮的啮合、弯折、摩擦及张力变化容易带来颗粒释放、维护调节和精度稳定性等问题。同时由于传动环节较多,传动效率将会降低、同时会带来噪音和共振,为晶圆传送带来诸多影响。

技术实现思路

1、本发明提供一种洁净大气机器人及控制方法,用以解决现有技术中现有的传动方式易带来颗粒释放、传动效率低的缺陷。

2、本发明提供一种洁净大气机器人,包括:基座;驱动机构,设置于所述基座内;第一电机,与所述驱动机构连接,所述驱动机构用于带动所述第一电机沿第一方向升降;机械臂组件,与所述第一电机的输出轴连接,所述第一电机用于带动所述机械臂组件转动;第二电机,与所述机械臂组件连接;端拾器,与所述第二电机的输出轴连接,所述第二电机用于带动所述端拾器转动。

3、根据本发明提供的一种洁净大气机器人,所述机械臂组件包括:第一机械臂,所述第一机械臂的第一端与所述第一电机的输出轴连接;第三电机,所述第三电机的固定端与所述第一机械臂连接;第二机械臂,所述第二机械臂的第一端与所述第三电机的输出轴连接,所述第二电机的固定端与所述第二机械臂连接。

4、根据本发明提供的一种洁净大气机器人,所述第一机械臂的内部设有:第一安装腔,用于容置所述第三电机的固定端;第一通道,用于布设线缆和管道;多个第一加强筋,设置于所述第一机械臂的内壁与所述第一通道的壁面之间。

5、根据本发明提供的一种洁净大气机器人,所述第二机械臂的内部设有:第二安装腔,用于容置所述第二电机的固定端;第二通道,与所述第一通道连通;多个第二加强筋,设置于所述第二机械臂的内壁与所述第二通道的壁面之间。

6、根据本发明提供的一种洁净大气机器人,所述第二电机的输出轴沿其长度方向设有多个通孔,多个所述通孔与所述第一通道连通,多个所述通孔用于布设线缆和管道。

7、根据本发明提供的一种洁净大气机器人,所述驱动机构包括:第四电机,设于所述基座内;丝杠,与所述第四电机的输出轴连接;滑块,与所述丝杠螺纹连接,所述第一电机与所述滑块连接。

8、根据本发明提供的一种洁净大气机器人,还包括:多个编码器,多个所述编码器分别设置于所述第一电机、所述第二电机、所述第三电机和第四电机,所述编码器用于检测所述第一电机、所述第二电机、所述第三电机和所述第四电机的旋转角度信号或位移信号;控制器,与所述第一电机、所述第二电机、所述第三电机、所述第四电机以及多个编码器电性连接,所述控制器用于对所述洁净大气机器人的末端动作进行解耦,所述控制器还用于基于所述旋转角度信号或所述位移信号对所述第一电机、所述第二电机、所述第三电机和所述第四电机的输出电压进行闭环控制。

9、本发明还提供一种基于如上所述的洁净大气机器人的控制方法,包括:建立基座坐标系下洁净大气机器人末端的位姿;基于正运动学建立关节空间与任务空间的映射关系;基于末端的目标位姿,通过逆运动学求解所述第一电机、所述第二电机以及所述第三电机的目标旋转角度,其中,驱动机构在所述基座坐标系下的升降位移与目标位移相等;针对所述第二电机的旋转动角度进行前馈补偿;基于解耦后的目标旋转角度控制所述第一电机、所述第二电机和所述第三电机的转动角度,基于所述目标位移控制所述驱动机构的升降位移。

10、根据本发明提供的一种洁净大气机器人的控制方法,所述基于正运动学建立关节空间与任务空间的映射关系的步骤包括:所述映射关系通过雅可比矩阵描述,所述雅可比矩阵呈块对角结构,使得末端速度与关节速度之间的映射关系解耦为平面运动子块、姿态子块及第一方向运动子块。

11、根据本发明提供的一种洁净大气机器人的控制方法,还包括:实时采集各输出轴的旋转角度信号或位移信号,并将所述旋转角度信号或所述位移信号分别作为对应输出轴的位置反馈信号,通过对所述位置反馈信号进行差分运算得到各输出轴的速度反馈;针对每个所述输出轴,构建位置环—速度环—电流环的三环级联闭环控制架构:在所述位置环中,计算目标位置与实际位置反馈的位置误差,并将所述位置误差转化为速度指令输出至速度环;在所述速度环中,计算所述速度指令与实际速度反馈的速度误差,并将所述速度误差转化为电流指令输出至电流环;在所述电流环中,计算所述电流指令与实际电流的电流误差,并基于所述电流误差输出电压指令,经功率逆变后驱动对应的电机;监测各输出轴的位置误差,当所有输出轴的位置误差均收敛至预设阈值以内时,判定运动到位。

12、本发明实施例提供的洁净大气机器人,通过将各传动机构设置为电机直驱,不需要设置同步带、带轮和张紧机构,避免了由皮带磨损、啮合摩擦及张紧调节带来的颗粒污染问题,保证了工作环境的洁净度;同时,传动链短、传动效率高、背隙小,尤为适用于高速启停和高重复定位精度的晶圆传输场景。

1.一种洁净大气机器人,其特征在于,包括:

2.根据权利要求1所述的洁净大气机器人,其特征在于,所述机械臂组件包括:

3.根据权利要求2所述的洁净大气机器人,其特征在于,所述第一机械臂的内部设有:

4.根据权利要求3所述的洁净大气机器人,其特征在于,所述第二机械臂的内部设有:

5.根据权利要求3或4所述的洁净大气机器人,其特征在于,所述第二电机的输出轴沿其长度方向设有多个通孔,多个所述通孔与所述第一通道连通,多个所述通孔用于布设线缆和管道。

6.根据权利要求3所述的洁净大气机器人,其特征在于,所述驱动机构包括:

7.根据权利要求6所述的洁净大气机器人,其特征在于,还包括:

8.一种基于权利要求2-7中任一项所述的洁净大气机器人的控制方法,其特征在于,包括:

9.根据权利要求8所述的洁净大气机器人的控制方法,其特征在于,所述基于正运动学建立关节空间与任务空间的映射关系的步骤包括:

10.根据权利要求8所述的洁净大气机器人的控制方法,其特征在于,还包括: