CN102545733A - 硅片传输机械手双电机同步控制装置及其方法 - Google Patents
硅片传输机械手双电机同步控制装置及其方法 Download PDFInfo
- Publication number
- CN102545733A CN102545733A CN2010106142262A CN201010614226A CN102545733A CN 102545733 A CN102545733 A CN 102545733A CN 2010106142262 A CN2010106142262 A CN 2010106142262A CN 201010614226 A CN201010614226 A CN 201010614226A CN 102545733 A CN102545733 A CN 102545733A
- Authority
- CN
- China
- Prior art keywords
- motor
- cross
- output shafts
- dsp
- control amount
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Landscapes
- Control Of Multiple Motors (AREA)
Abstract
本发明涉及一种硅片传输机械手双电机同步控制装置及其方法,步骤为:主计算机通过轨迹规划计算,得到两个电机输出轴的期望位置;通过编码器接口电路读取两个电机输出轴的实际位置;进行PID计算得到单轴位置闭环控制量输出给电机驱动器;通过两个电机输出轴的实际位置计算得到两个电机输出轴的实际速度;根据两个电机输出轴的实际速度分别求两个电机输出轴的速度差和位置差;将上述速度差和位置差输入交叉耦合控制器进行处理,得到交叉耦合控制量;将交叉耦合控制量与单轴位置闭环控制量相加或减,然后输出给电机驱动器,实现两轴的交叉耦合同步控制。本发明能够在机械手运行过程中提高手臂同步性,避免硅片损坏,能够对机械手不同步性进行补偿,提高同步性。
Description
技术领域
本发明涉及硅片传输机械手控制技术,具体地说为一种硅片传输机械手双电机同步控制装置及其方法。
背景技术
硅片传输机械手是一种在集成电路制造业中,用于硅片在生产线上不同的工艺加工模块之间进行高效的传输和定位的专用机器人。集成电路制造业的特点是超精密化、超洁净环境和细微化,硅片传输过程中的轻微震动都可能对硅片造成损坏,这就对硅片传输机械手在运行过程中的平稳性提出了较高要求。
当前应用较广的frog-leg型真空机械手,其由两个电机配合驱动两个手臂的运行。由于机械摩擦、机构设计、使用材料等因素的影响,两个手臂的机械特性不可能完全相同。当同时对两个电机施加相同的控制作用时,两个手臂的运行将会出现不同步性,这种不同步性将导致手臂末端托盘出现抖动现象,甚至会滑落损坏硅片。如何减小手臂运行过程中的不同步性、减小机械手抖动成为硅片传输机械手研制的关键问题。
发明内容
针对现有技术中硅片传输机械手存在的不同步性等不足之处,本发明要解决的技术问题是提供一种能够根据两手臂的运行情况对两电机的控制进行补偿,实现机械手臂的同步控制的硅片传输机械手双电机同步控制装置及其方法。
为解决上述技术问题,本发明采用的技术方案是:
本发明硅片传输机械手双电机同步控制装置包括:主计算机、DSP电机同步控制卡、电机驱动器以及电机,其中主计算机作为主机,DSP电机同步控制卡作为从机,二者进行通信连接,DSP电机同步控制卡的两输出端分别与两个电机驱动器相连,每个电机驱动器的控制输出端接至电机,电机转速信息通过电机驱动器送至DSP电机同步控制卡。
所述DSP电机同步控制卡具有DSP数字信号处理器,通过CAN接口电路与主计算机进行通信,通过存储器保存程序运行过程中的数据,通过模拟量输出电路与电机驱动器相连,通过编码器接口电路接收电机驱动器返回的码盘数据。
本发明硅片传输机械手双电机同步控制方法包括以下步骤:
主计算机通过轨迹规划计算,得到两个电机输出轴的期望位置;
通过编码器接口电路读取两个电机输出轴的实际位置;
通过期望位置与实际位置求差值进行PID计算得到单轴位置闭环控制量输出给电机驱动器,实现单轴位置闭环控制;
通过两个电机输出轴的实际位置计算得到两个电机输出轴的实际速度;
根据两个电机输出轴的实际速度分别求两个电机输出轴的速度差和位置差;
将上述速度差和位置差输入交叉耦合控制器进行处理,得到交叉耦合控制量;
将交叉耦合控制量与单轴位置闭环控制量相加或减,然后输出给电机驱动器,实现两轴的交叉耦合同步控制。
所述交叉耦合控制器对速度差和位置差相加,再通过比例计算得到交叉耦合控制量。
本发明具有以下有益效果及优点:
1.本发明提供一种硅片传输机械手同步控制方法和装置,能够在机械手运行过程中提高手臂同步性,避免硅片损坏。
2.本发明提供一种速度差和位置差求和后比例计算的交叉耦合控制算法,能够对机械手不同步性进行补偿,提高同步性。
附图说明
图1为硅片传输机械手双电机同步控制装置总体结构图;
图2为DSP电机同步控制卡示意框图;
图3为本发明方法流程图;
图4为交叉耦合控制算法结构图。
具体实施方式
如图1所示,本发明包括主计算机、DSP电机同步控制卡、电机驱动器以及电机,其中主计算机作为主机,DSP电机同步控制卡作为从机,二者进行通信连接,DSP电机同步控制卡的两输出端分别与两个电机驱动器相连,每个电机驱动器的控制输出端接至电机,电机转速信息通过电机驱动器送至DSP电机同步控制卡。
本实施例中,主计算机采用PC104,主计算机和DSP电机同步控制卡通过CAN总线实现通信,DSP电机同步控制卡作为从机。主计算机每个控制周期将轨迹规划的位置点通过CAN总线发送给DSP电机同步控制卡。DSP电机同步控制卡通过模拟量输出线与电机驱动器连接,电机驱动器又通过码盘线将码盘值返回给DSP电机同步控制卡。DSP电机同步控制卡根据主计算机发送来的位置值和电机驱动器返回的码盘值计算控制量,然后将控制量通过模拟量输出线输出给电机驱动器。电机驱动器与电机直接通过驱动器连线连接,实现对电机的伺服控制。
如图2所示,DSP电机同步控制卡具有DSP数字信号处理器,通过CAN接口电路与主计算机进行通信,通过存储器保存程序运行过程中的数据,通过模拟量输出电路与电机驱动器相连,通过编码器接口电路接收电机驱动器返回的码盘数据。
DSP数字信号处理器运行电机控制程序,CAN接口电路实现DSP数字信号处理器与主计算机的通信,存储器用于保存程序运行过程中的数据,模拟量输出电路将DSP数字信号处理器的计算结果输出给电机驱动器,编码器接口电路用于接收电机驱动器返回的码盘信息。
如图3所示,本发明硅片传输机械手双电机同步控制方法包括以下步骤:
主计算机通过轨迹规划计算,得到两个电机输出轴的期望位置;
通过编码器接口电路读取两个电机输出轴的实际位置;
通过期望位置与实际位置求差值进行PID计算得到单轴位置闭环控制量输出给电机驱动器,实现单轴位置闭环控制;
通过两个电机输出轴的实际位置计算得到两个电机输出轴的实际速度;
根据两个电机输出轴的实际速度分别求两个电机输出轴的速度差和位置差;
将上述速度差和位置差输入交叉耦合控制器进行处理,得到交叉耦合控制量;
将交叉耦合控制量与单轴位置闭环控制量相加或减,然后输出给电机驱动器,实现两轴的交叉耦合同步控制。
如图4所示,所述交叉耦合控制器对速度差和位置差相加,再通过比例计算得到交叉耦合控制量。
一轴、二轴位置控制器在DSP电机同步控制卡中通过软件实现,用于位置环控制。一轴、二轴驱动单元对应两个电机驱动器,实现速度环和电流环的控制。交叉耦合控制器为DSP电机同步控制卡中软件的一部分,实现交叉耦合控制算法。位置反馈由电机驱动器、码盘线和DSP电机同步控制卡实现。电机驱动器通过码盘线将码盘值返回给DSP电机同步控制卡,DSP电机同步控制卡通过编码器接口电路实现对码盘值的接收。交叉耦合控制算法结构图中,一轴、二轴分别对位置P通过位置环进行闭环跟踪,一轴实际位置为P1,二轴实际位置为P2。对两轴的位置P1、P2求微分得到两轴速度V1和V2。分别求两轴的速度差和位置差作为交叉耦合控制器的输入,在交叉耦合控制器内部,通过交叉耦合控制算法得到控制量的补偿值,该补偿值加入到速度环的输入,实现两轴的交叉耦合同步控制。
Claims (4)
1.一种硅片传输机械手双电机同步控制装置,其特征在于包括:主计算机、DSP电机同步控制卡、电机驱动器以及电机,其中主计算机作为主机,DSP电机同步控制卡作为从机,二者进行通信连接,DSP电机同步控制卡的两输出端分别与两个电机驱动器相连,每个电机驱动器的控制输出端接至电机,电机转速信息通过电机驱动器送至DSP电机同步控制卡。
2.按权利要求1所述的硅片传输机械手双电机同步控制装置,其特征在于:所述DSP电机同步控制卡具有DSP数字信号处理器,通过CAN接口电路与主计算机进行通信,通过存储器保存程序运行过程中的数据,通过模拟量输出电路与电机驱动器相连,通过编码器接口电路接收电机驱动器返回的码盘数据。
3.一种硅片传输机械手双电机同步控制方法,其特征在于包括以下步骤:
主计算机通过轨迹规划计算,得到两个电机输出轴的期望位置;
通过编码器接口电路读取两个电机输出轴的实际位置;
通过期望位置与实际位置求差值进行PID计算得到单轴位置闭环控制量输出给电机驱动器,实现单轴位置闭环控制;
通过两个电机输出轴的实际位置计算得到两个电机输出轴的实际速度;
根据两个电机输出轴的实际速度分别求两个电机输出轴的速度差和位置差;
将上述速度差和位置差输入交叉耦合控制器进行处理,得到交叉耦合控制量;
将交叉耦合控制量与单轴位置闭环控制量相加或减,然后输出给电机驱动器,实现两轴的交叉耦合同步控制。
4.按权利要求3所述的片传输机械手双电机同步控制方法,其特征在于:所述交叉耦合控制器对速度差和位置差相加,再通过比例计算得到交叉耦合控制量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010614226.2A CN102545733B (zh) | 2010-12-30 | 2010-12-30 | 硅片传输机械手双电机同步控制装置及其方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201010614226.2A CN102545733B (zh) | 2010-12-30 | 2010-12-30 | 硅片传输机械手双电机同步控制装置及其方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102545733A true CN102545733A (zh) | 2012-07-04 |
CN102545733B CN102545733B (zh) | 2014-11-26 |
Family
ID=46351841
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201010614226.2A Active CN102545733B (zh) | 2010-12-30 | 2010-12-30 | 硅片传输机械手双电机同步控制装置及其方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102545733B (zh) |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103269187A (zh) * | 2013-05-31 | 2013-08-28 | 南京工程学院 | 一种双电机同步控制系统及其控制方法 |
CN103490678A (zh) * | 2013-10-17 | 2014-01-01 | 双峰格雷斯海姆医药玻璃(丹阳)有限公司 | 主从机同步控制方法及系统 |
WO2014071858A1 (zh) * | 2012-11-08 | 2014-05-15 | 沈阳新松机器人自动化股份有限公司 | 一种搬运天车控制系统 |
CN104635654A (zh) * | 2013-11-13 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 一种loadport控制系统 |
CN104935218A (zh) * | 2015-07-11 | 2015-09-23 | 哈尔滨工业大学 | 一种双旋转电机系统的主从控制方法 |
CN105356792A (zh) * | 2015-10-26 | 2016-02-24 | 江苏科技大学 | 一种基于pid的多电机同步控制系统 |
CN105717843A (zh) * | 2016-03-23 | 2016-06-29 | 苏州市正步机器制造有限公司 | 一种双伺服同步控制方法以及系统 |
CN106301092A (zh) * | 2015-05-15 | 2017-01-04 | 北新集团建材股份有限公司 | 一种多轴同步控制系统 |
CN106877747A (zh) * | 2017-02-07 | 2017-06-20 | 上海仙知机器人科技有限公司 | 一种驱动器及驱动方法 |
CN108227537A (zh) * | 2016-12-14 | 2018-06-29 | 中国航空工业集团公司西安航空计算技术研究所 | 一种基于rvdt位置反馈的飞机步进电机伺服控制系统及方法 |
CN108923693A (zh) * | 2018-07-09 | 2018-11-30 | 天津工业大学 | 两永磁电机二自由度交叉耦合控制方法 |
CN109699070A (zh) * | 2018-12-28 | 2019-04-30 | 湖南深拓智能设备股份有限公司 | 主、从机旋转设备及其同步控制方法 |
CN109960290A (zh) * | 2017-12-14 | 2019-07-02 | 深圳市优必选科技有限公司 | 舵机输出控制方法、系统及装置 |
CN110901416A (zh) * | 2019-12-25 | 2020-03-24 | 傲基科技股份有限公司 | 一种基于双电机转速差的补偿系统及补偿方法 |
CN112265863A (zh) * | 2020-09-02 | 2021-01-26 | 浙江力创自动化科技有限公司 | 一种可实现同步控制的可编程控制器及配置方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0425689A1 (en) * | 1989-04-26 | 1991-05-08 | Fanuc Ltd. | Method of controlling main shaft rotation |
CN101116969A (zh) * | 2007-09-04 | 2008-02-06 | 杭州电子科技大学 | 一种移动机器人运动高精度控制方法 |
CN101422959A (zh) * | 2008-11-14 | 2009-05-06 | 宁波弘讯科技有限公司 | 一种挤出机牵引装置的同步控制系统 |
CN101442283A (zh) * | 2007-11-23 | 2009-05-27 | 沈阳新松机器人自动化股份有限公司 | 一种基于dsp的双电机同步伺服驱动装置 |
CN101807872A (zh) * | 2009-12-08 | 2010-08-18 | 北京华盛源通科技有限公司 | 基于dsp的电机控制器 |
CN202034930U (zh) * | 2010-12-30 | 2011-11-09 | 沈阳新松机器人自动化股份有限公司 | 硅片传输机械手双电机同步控制装置 |
-
2010
- 2010-12-30 CN CN201010614226.2A patent/CN102545733B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0425689A1 (en) * | 1989-04-26 | 1991-05-08 | Fanuc Ltd. | Method of controlling main shaft rotation |
CN101116969A (zh) * | 2007-09-04 | 2008-02-06 | 杭州电子科技大学 | 一种移动机器人运动高精度控制方法 |
CN101442283A (zh) * | 2007-11-23 | 2009-05-27 | 沈阳新松机器人自动化股份有限公司 | 一种基于dsp的双电机同步伺服驱动装置 |
CN101422959A (zh) * | 2008-11-14 | 2009-05-06 | 宁波弘讯科技有限公司 | 一种挤出机牵引装置的同步控制系统 |
CN101807872A (zh) * | 2009-12-08 | 2010-08-18 | 北京华盛源通科技有限公司 | 基于dsp的电机控制器 |
CN202034930U (zh) * | 2010-12-30 | 2011-11-09 | 沈阳新松机器人自动化股份有限公司 | 硅片传输机械手双电机同步控制装置 |
Non-Patent Citations (1)
Title |
---|
李萌萌: "龙门移动式镗铣床双直线电机交叉耦合同步控制", 《中国优秀硕士论文电子期刊网》 * |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2014071858A1 (zh) * | 2012-11-08 | 2014-05-15 | 沈阳新松机器人自动化股份有限公司 | 一种搬运天车控制系统 |
CN103809501A (zh) * | 2012-11-08 | 2014-05-21 | 沈阳新松机器人自动化股份有限公司 | 一种搬运天车控制系统 |
CN103269187B (zh) * | 2013-05-31 | 2015-08-12 | 南京工程学院 | 一种双电机同步控制系统及其控制方法 |
CN103269187A (zh) * | 2013-05-31 | 2013-08-28 | 南京工程学院 | 一种双电机同步控制系统及其控制方法 |
CN103490678B (zh) * | 2013-10-17 | 2016-06-22 | 双峰格雷斯海姆医药玻璃(丹阳)有限公司 | 主从机同步控制方法及系统 |
CN103490678A (zh) * | 2013-10-17 | 2014-01-01 | 双峰格雷斯海姆医药玻璃(丹阳)有限公司 | 主从机同步控制方法及系统 |
CN104635654A (zh) * | 2013-11-13 | 2015-05-20 | 沈阳新松机器人自动化股份有限公司 | 一种loadport控制系统 |
CN106301092A (zh) * | 2015-05-15 | 2017-01-04 | 北新集团建材股份有限公司 | 一种多轴同步控制系统 |
CN104935218A (zh) * | 2015-07-11 | 2015-09-23 | 哈尔滨工业大学 | 一种双旋转电机系统的主从控制方法 |
CN105356792B (zh) * | 2015-10-26 | 2018-10-23 | 江苏科技大学 | 一种基于pid的多电机同步控制系统 |
CN105356792A (zh) * | 2015-10-26 | 2016-02-24 | 江苏科技大学 | 一种基于pid的多电机同步控制系统 |
CN105717843A (zh) * | 2016-03-23 | 2016-06-29 | 苏州市正步机器制造有限公司 | 一种双伺服同步控制方法以及系统 |
CN108227537A (zh) * | 2016-12-14 | 2018-06-29 | 中国航空工业集团公司西安航空计算技术研究所 | 一种基于rvdt位置反馈的飞机步进电机伺服控制系统及方法 |
CN106877747A (zh) * | 2017-02-07 | 2017-06-20 | 上海仙知机器人科技有限公司 | 一种驱动器及驱动方法 |
CN109960290A (zh) * | 2017-12-14 | 2019-07-02 | 深圳市优必选科技有限公司 | 舵机输出控制方法、系统及装置 |
CN108923693A (zh) * | 2018-07-09 | 2018-11-30 | 天津工业大学 | 两永磁电机二自由度交叉耦合控制方法 |
CN109699070A (zh) * | 2018-12-28 | 2019-04-30 | 湖南深拓智能设备股份有限公司 | 主、从机旋转设备及其同步控制方法 |
CN109699070B (zh) * | 2018-12-28 | 2021-01-01 | 湖南深拓智能设备股份有限公司 | 主、从机旋转设备及其同步控制方法 |
CN110901416A (zh) * | 2019-12-25 | 2020-03-24 | 傲基科技股份有限公司 | 一种基于双电机转速差的补偿系统及补偿方法 |
CN112265863A (zh) * | 2020-09-02 | 2021-01-26 | 浙江力创自动化科技有限公司 | 一种可实现同步控制的可编程控制器及配置方法 |
CN112265863B (zh) * | 2020-09-02 | 2022-09-27 | 浙江力创自动化科技有限公司 | 一种可实现同步控制的可编程控制器及配置方法 |
Also Published As
Publication number | Publication date |
---|---|
CN102545733B (zh) | 2014-11-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102545733B (zh) | 硅片传输机械手双电机同步控制装置及其方法 | |
CN202034930U (zh) | 硅片传输机械手双电机同步控制装置 | |
CN107505882A (zh) | 一种多轴运动控制器及控制方法 | |
CN103984275B (zh) | 一种基于fpga的通用工业运动控制系统及基于该运动控制系统的控制方法 | |
CN103676653B (zh) | 应用于龙门机构的伺服同步控制方法及系统 | |
CN104820403B (zh) | 一种基于EtherCAT总线的8轴机器人控制系统 | |
CN204076264U (zh) | 一种运动控制卡及机器人 | |
CN201426109Y (zh) | 一种pci总线型多轴脉冲式运动控制卡 | |
CN104552311A (zh) | 基于EtherCAT的智能工业机器人总线模块及其操作方法 | |
CN105163510A (zh) | 一种基于EtherCAT总线的贴片机控制系统 | |
CN107783501A (zh) | 一种PCIe控制的数控插补系统 | |
WO2017179452A1 (ja) | アクチュエータ制御システム、アクチュエータ制御方法、情報処理プログラム、および記録媒体 | |
CN102445924A (zh) | 一种一体化数控系统及一体化数控机床 | |
CN206710827U (zh) | 一种模块化的运动控制器 | |
CN103552711B (zh) | 多轴控制装置、循圆方法以及包装机 | |
CN116009404B (zh) | 伺服设备的调试方法、装置、设备和可读存储介质 | |
JP7453268B2 (ja) | 多軸サーボ制御システム | |
CN104155909B (zh) | 基于pc+fpga的带速度观测器的有限时间稳定性控制系统 | |
CN105682864A (zh) | 一种控制卡及机器人 | |
CN105223868A (zh) | 一种Delta机器人分布式控制系统及控制方法 | |
CN103935771B (zh) | 一种码垛工业机器人的电控系统 | |
CN110442019A (zh) | 前馈伺服控制方法、交流伺服系统和可读存储介质 | |
CN206075117U (zh) | 一种多轴运动控制器 | |
CN102627000B (zh) | 全自动粘箱机的集成控制方法 | |
CN202548601U (zh) | 一种一体化数控系统及一体化数控机床 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |