CN103219930A - 用于双电机驱动轴回原点的方法 - Google Patents
用于双电机驱动轴回原点的方法 Download PDFInfo
- Publication number
- CN103219930A CN103219930A CN2012100165838A CN201210016583A CN103219930A CN 103219930 A CN103219930 A CN 103219930A CN 2012100165838 A CN2012100165838 A CN 2012100165838A CN 201210016583 A CN201210016583 A CN 201210016583A CN 103219930 A CN103219930 A CN 103219930A
- Authority
- CN
- China
- Prior art keywords
- motor
- encoder
- ind
- counter
- dual
- 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.)
- Pending
Links
Landscapes
- Control Of Position Or Direction (AREA)
Abstract
本发明涉及一种用于双电机驱动轴(Gantry轴)回原点的方法，主要解决现有技术中双电机驱动轴回原点重复性与准确性差的问题，本发明所采用的双电机驱动轴回原点的方法包括如下几个步骤：Gantry轴上电并复位左右两编码器计数值；对左右两个电机施加相同运动指令进行反方向运动控制，触发负限位后停止两电机的运动；复位左右两个编码器index点的捕获值，对左右两个电机施加相同运动指令进行正方向运动控制，直至捕获左右两个index点后停止运动，记录IND_left与IND_right值(图1中2、3)；将左右两电机配置为编码器交叉耦合的Gantry轴控制模式；重新设置左右两电机编码器值；寻原点结束。本发明较好地解决了Gantry轴归零重复性与准确性差问题，可用于gantry结构同步控制领域。
Description
技术领域
本发明涉及一种用于双电机驱动轴(Gantry轴)回原点的方法，涉及双直线电机驱动轴(gantry结构)同步控制领域。
背景技术
双电机同步驱动(Gantry)结构由于能平衡负载、获得高加速度等优点被广泛应用于高精密设备，采用gantry结构的***位置精度的不断变化是影响Gantry结构功能的一大因素，gantry结构由于上电时横梁的姿态不同影响归零的重复性和准确性，进而不断影响***的位置精度。
中国专利CN202017118U 公开了花样机原点控制机构，包括：X向原点感应机构和Y向原点感应机构；所述的X向原点感应机构包括：一个固定在机器上的X向原点磁感应器，一个X向安装槽座固定安装在X向直线导轨上；所述的X向直线导轨固定在机器上；所述的Y向原点感应机构包括：一个固定在Y向步进电机座上的Y向原点磁感应器，一个与步进电机连接的Y向驱动轴；所述的Y向步进电机座固定在机器上；本实用新型的有益效果是：由于原点感应器为磁性感应器，当金属物接近感应器时，感应器将产生信号；再由于原点感应器本身有螺纹，与感应器架连接时可自由调整与感应物之间的间隙，使其感应迅速、灵敏，不易受工作环境的影响。该发明并未公开双电机驱动轴返回原点的方法。
本发明介绍了一种gantry结构中左右两电机同时采用增量式光栅尺作为反馈元件的gantry轴归零方式，提高了归零的重复性与准确性，实验验证归零重复与准确性均在10um以内。
发明内容
本发明所要解决的技术问题是现有技术中，双电机同步驱动轴归零的重复性和准确性差的问题。提供一种新的用于双电机驱动轴回原点的方法，该方法具有双电机同步驱动轴归零的重复性和准确高的优点。
为解决上述技术问题，本发明采用的技术方案如下：一种用于双电机驱动轴回原点的方法，包括如下几个步骤：
a) Gantry轴电机上电使能并对编码器计数值进行复位：FB_left = 0； FB_right= 0；依据下面公式记录左右两电机反馈值与原始反馈偏移值：
FB_left_offset = FB_left–FB_left_counter
FB_right_offset = FB_ right– FB_ right _counter
其中FB_left_counter，FB_ right _counter为机台上电时左右两编码器的起始计数值；
b) 对左右两个电机施加相同运动指令同时进行反方向运动控制直至触发负限位（图1中1位置），停止两个轴的运动；
c) 复位左右两个index点的捕获值，并施加相同运动指令驱动左右两个电机正方向运动直至捕获左右两个index点后停止，记录IND_left与IND_right的值（图1中2、3位置）；
d) 将左右两电机配置为两编码器交叉耦合Gantry控制模式；
e) 设置左右两电机编码器值：
FB_left=FB_left-(IND_left+IND_right)/2+(FB_right_counter-FB_left_counter)/2；
FB_ right= FB_ right-( IND_right- IND_left)- FB_left_counter；
f) 寻原点结束。
Gantry结构配置可以为双电机单编码器与双电机双编码器反馈，由于双电机单编码器在运动过程中横梁姿态不能进行实时调整，所以高精度gantry结构一般采用双电机双编码器形式；如果反馈元件选用增量式反馈，归零的重复性依赖于每次上电横梁的姿态，本专利所提出的归零方法仅使用gantry轴左右两个光尺反馈的INDEX点信号进行归零，通过捕获左右两个INDEX点反馈数值进行相应计算，自动校正横梁姿态，提高归零重复性与准确性。
本发明中的gantry结构中，左右两电机同时采用增量式光栅尺作为反馈元件的gantry轴归零方式，提高了归零的重复性与准确性，实验验证归零重复与准确性均在10um以内。电机同步驱动轴归零的重复性和准确性比现有技术显著提高，取得了较好的技术效果。
附图说明
图1为Gantry轴寻原点方式的原理示意图。
下面通过具体实施例对本发明作进一步的阐述，但不仅限于本实施例。
具体实施例
【实施例1】
一种用于双电机驱动轴回原点的方法，原理示意图如图1所示，包括如下几个步骤：
a) Gantry轴电机上电使能并对编码器计数值进行复位：FB_left = 0； FB_right= 0；依据下面公式记录左右两电机反馈值与原始反馈偏移值：
FB_left_offset = FB_left–FB_left_counter
FB_right_offset = FB_ right– FB_ right _counter
其中FB_left_counter，FB_ right _counter为机台上电时左右两编码器的起始计数值；
b) 对左右两个电机施加相同运动指令同时进行反方向运动控制直至触发负限位（图1中1位置），停止两个轴的运动；
c) 复位左右两个index点的捕获值，并施加相同运动指令驱动左右两个电机正方向运动直至捕获左右两个index点后停止，记录IND_left与IND_right的值（图1中2、3位置）；
d) 将左右两电机配置为两编码器交叉耦合Gantry控制模式；
e) 设置左右两电机编码器值：
FB_left=FB_left-(IND_left+IND_right)/2+(FB_right_counter-FB_left_counter)/2；
FB_ right= FB_ right-( IND_right- IND_left)- FB_left_counter；
f) 寻原点结束。
Claims (1)
1.一种用于双电机驱动轴回原点的方法，包括如下几个步骤：
Gantry轴电机上电使能并对编码器计数值进行复位：FB_left = 0； FB_right= 0；依据下面公式记录左右两电机反馈值与原始反馈偏移值：
FB_left_offset = FB_left–FB_left_counter
FB_right_offset = FB_ right– FB_ right _counter
其中FB_left_counter，FB_ right _counter为机台上电时左右两编码器的起始计数值；
对左右两个电机施加相同运动指令同时进行反方向运动控制直至触发负限位（图1中1位置），停止两个轴的运动；
复位左右两个index点的捕获值，并施加相同运动指令驱动左右两个电机正方向运动直至捕获左右两个index点后停止，记录IND_left与IND_right的值（图1中2、3位置）；
将左右两电机配置为两编码器交叉耦合Gantry控制模式；
设置左右两电机编码器值：
FB_left=FB_left-(IND_left+IND_right)/2+(FB_right_counter-FB_left_counter)/2；
FB_ right= FB_ right-( IND_right- IND_left)- FB_left_counter；
寻原点结束。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2012100165838A CN103219930A (zh) | 2012-01-19 | 2012-01-19 | 用于双电机驱动轴回原点的方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2012100165838A CN103219930A (zh) | 2012-01-19 | 2012-01-19 | 用于双电机驱动轴回原点的方法 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN103219930A true CN103219930A (zh) | 2013-07-24 |
Family
ID=48817487
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN2012100165838A Pending CN103219930A (zh) | 2012-01-19 | 2012-01-19 | 用于双电机驱动轴回原点的方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN103219930A (zh) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0347705A1 (de) * | 1988-06-23 | 1989-12-27 | Siemens Aktiengesellschaft | Antriebsanordnung für einen Portallaufwagen |
| US6163116A (en) * | 1997-03-10 | 2000-12-19 | Convolve, Inc. | Method and apparatus for the control of gantry machines |
| CN1778031A (zh) * | 2003-04-22 | 2006-05-24 | 株式会社安川电机 | 成对同步控制方法 |
| JP2007018439A (ja) * | 2005-07-11 | 2007-01-25 | Juki Corp | ガントリ型ｘｙ位置決め装置 |
| CN201418055Y (zh) * | 2009-04-01 | 2010-03-03 | 公安部交通管理科学研究所 | 库架双电机同步驱动定位控制机构 |
| JP2010088193A (ja) * | 2008-09-30 | 2010-04-15 | Juki Corp | ガントリ型ｘｙ位置決め装置の同期防振制御装置 |
-
2012
- 2012-01-19 CN CN2012100165838A patent/CN103219930A/zh active Pending
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP0347705A1 (de) * | 1988-06-23 | 1989-12-27 | Siemens Aktiengesellschaft | Antriebsanordnung für einen Portallaufwagen |
| US6163116A (en) * | 1997-03-10 | 2000-12-19 | Convolve, Inc. | Method and apparatus for the control of gantry machines |
| CN1778031A (zh) * | 2003-04-22 | 2006-05-24 | 株式会社安川电机 | 成对同步控制方法 |
| JP2007018439A (ja) * | 2005-07-11 | 2007-01-25 | Juki Corp | ガントリ型ｘｙ位置決め装置 |
| JP2010088193A (ja) * | 2008-09-30 | 2010-04-15 | Juki Corp | ガントリ型ｘｙ位置決め装置の同期防振制御装置 |
| CN201418055Y (zh) * | 2009-04-01 | 2010-03-03 | 公安部交通管理科学研究所 | 库架双电机同步驱动定位控制机构 |
Non-Patent Citations (1)
| Title |
|---|
| 袁博等: "基于Gantry 驱动的双直线电动机高速动态同步误差性能测试研究", 《制造技术与机床》 * |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN102629122B (zh) | 一种大行程高速双重驱动纳米定位*** | |
| CN202964020U (zh) | 一种xyz空间定位装置 | |
| CN106054806A (zh) | 一种基于二维编码器的平面并联机构末端跟踪控制***与方法 | |
| CN203780024U (zh) | 一种对位平台 | |
| CN102694454B (zh) | 直驱式开关磁阻平面电机动子位移控制方式 | |
| CN103522742B (zh) | 一种工作台伺服定位控制***及定位控制方法 | |
| CN103219930A (zh) | 用于双电机驱动轴回原点的方法 | |
| CN202199929U (zh) | 搅拌摩擦焊设备的集成控制器 | |
| CN202818219U (zh) | 永磁同步直线电机改进的迭代学习控制*** | |
| CN203033673U (zh) | 一种起重机的精确定位装置 | |
| CN103684184B (zh) | 一种直线电机初始相位确定方法 | |
| CN203979792U (zh) | 工字形二维移动平台 | |
| CN110376885A (zh) | 运动控制的数据补偿方法及装置 | |
| CN2906795Y (zh) | 基于多轴运动控制卡的教学用多轴混合控制*** | |
| CN205498137U (zh) | 一种板料数控冲孔机闭环检测装置 | |
| CN103523744A (zh) | 高速精密运动平台的两级光栅定位方法 | |
| CN202815509U (zh) | 利用误差修正闭环回路消除齿隙误差的精密定位装置 | |
| CN105334610A (zh) | 永磁同步直线电机驱动的自动控制显微镜载物平台 | |
| CN203759483U (zh) | 基于plc的翅片座运动控制*** | |
| CN204286678U (zh) | 超大型扭矩标准机平衡机构同步移动控制*** | |
| CN103302538A (zh) | 直线电机重心驱动高频超高加减速微切削运动控制机构 | |
| CN205983170U (zh) | 一种基于二维编码器的平面并联机构末端跟踪控制*** | |
| CN203281485U (zh) | 一种适用于led封装设备固晶机的点胶臂结构 | |
| CN105353502A (zh) | 混合电机驱动的自动控制显微镜载物平台 | |
| CN104647747A (zh) | 一种新型彩色3d打印机机头x轴运动结构 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20130724 |
|
| WD01 | Invention patent application deemed withdrawn after publication |