摘要
本发明涉及晶圆技术领域,具体涉及一种多轨迹晶圆搬运机械手及控制方法,采用机械臂组件及末端执行器执行动作,其中机械臂组件包括三个依次转动连接的执行手臂;末端执行器安装于距离基座最远的执行手臂的末端位置,方法如下:S1:设定安全区域使多个执行手臂在运动中始终处于安全区域内;S2:在安全区域内从边界逐渐向中心迭代每个点的坐标,并生成安全链路;S3:在一个安全链路中,末端执行器始终朝向站点位置,并使末端执行器的中心沿安全链路移动,计算每个点的相邻执行手臂之间的角度a、b、c以及执行手臂与末端执行器之间的角度d;S4:对步骤S3中的距离C进行遍历优化,并找到最优的C值;S5:根据最优C值获得最优时间。
技术关键词
晶圆搬运机械手
末端执行器
机械臂组件
小臂
数值优化算法
安装件
伺服电机配置
轨迹
链路
障碍物
基座
坐标
减速器
传送带
锁紧件
加速度
站点
运动
多项式
系统为您推荐了相关专利信息
定位引导方法
定位点
图像分析
稳定特征点
噪声抑制
末端执行器
机械臂交互装置
多自由度机械臂
脑电信号采集模块
时间同步
多功能机械手
抓取机械手
装卸机器人
抓取机构
末端执行器
机器人控制方法
合规性
控制机器人运动
人机协作
末端执行器
柔性机械手
接触点
汽车冲压件
三维点云数据
装箱方法