《同步控制装置.pdf》由会员分享,可在线阅读,更多相关《同步控制装置.pdf(39页珍藏版)》请在专利查询网上搜索。
1、(10)申请公布号 CN 103123478 A (43)申请公布日 2013.05.29 CN 103123478 A *CN103123478A* (21)申请号 201310003771.1 (22)申请日 2011.01.12 2010-004380 2010.01.12 JP 2010-167089 2010.07.26 JP 201110020670.6 2011.01.12 G05B 19/414(2006.01) (71)申请人 株式会社安川电机 地址 日本福冈县 (72)发明人 吉浦泰史 加来靖彦 (74)专利代理机构 北京信慧永光知识产权代理 有限责任公司 11290 代理。
2、人 陈桂香 褚海英 (54) 发明名称 同步控制装置 (57) 摘要 本发明提供一种同步控制装置, 对于通过多 个马达沿同一方向的坐标轴进行驱动的机械, 使 用通用的机电器件来抑制相互施加在各轴间的无 效反作用力, 同时高精度地进行针对作业位置的 同步控制。具体为, 具备 : 指令装置 (2) , 具有生成 位置指令 (121) 的位置指令生成部 (21) 和根据 2 台的马达的位置信息 (131) 、(141) 运算 XY 轴坐标 系的作业位置 (122) 并根据位置指令 (121) 与作 业位置的一个轴的坐标系位置 (122) 的差运算新 的位置指令 (125) 的第 1 位置控制系统 ;。
3、 及 2 台马 达控制装置 (3) 、(4) , 分别具有根据新的位置指 令 (125) 与位置信息 (131) 、(141) 的差对驱动马 达的指令进行运算的第 2 位置控制系统。 (30)优先权数据 (62)分案原申请数据 (51)Int.Cl. 权利要求书 1 页 说明书 12 页 附图 25 页 (19)中华人民共和国国家知识产权局 (12)发明专利申请 权利要求书1页 说明书12页 附图25页 (10)申请公布号 CN 103123478 A CN 103123478 A *CN103123478A* 1/1 页 2 1. 一种同步控制装置, 是具有对具备多台马达、 分别检测出所述多。
4、台马达的位置信息 的多台位置检测器、 使所述多台马达的可动轴彼此连结的机械结合部的控制对象进行驱动 的第 1 轴、 对具备单台马达、 检测出所述单台马达的位置信息的单台位置检测器、 连结所述 单台马达的可动轴的机械连结部的其它控制对象进行驱动的第 2 轴、 根据位置指令使所述 第 1 轴和所述第 2 轴进行 XY 轴坐标系的圆弧插补动作的指令装置的同步控制装置, 其特征 在于, 所述第 1 轴构成位置积分比例速度比例控制系统, 所述第 2 轴构成位置比例速度 积分比例控制系统, 将所述第 1 轴的位置比例增益设定为与所述第 2 轴的速度积分时间的倒数一致, 同时将所述第 1 轴的位置积分时间设。
5、定为与所述第 2 轴的位置比例增益的倒数一致。 2. 根据权利要求 1 所述的同步控制装置, 其特征在于, 所述第 1 轴构成位置比例积分速度比例控制系统来代替位置积分比例速度比例控 制系统, 所述第 2 轴构成位置比例速度比例积分控制系统来代替位置比例速度积分比 例控制系统, 在设定为使所述第 1 轴的位置比例增益与所述第 2 轴的速度积分时间的倒数的 1/2 及 所述第 2 轴的位置比例增益的 1/2 的和一致的同时, 设定为使所述第 1 轴的位置积分时间与所述第 2 轴的位置比例增益的倒数的 1/2 及所 述第 2 轴的速度积分时间的 1/2 的和一致, 而且, 设定为使所述第2轴的速度。
6、积分时间与所述第2轴的位置比例增益的倒数一致。 3. 根据权利要求 1 或 2 所述的同步控制装置, 其特征在于, 所述指令装置具有 : 位置信息运算部, 输入所述多台位置检测器分别检测出的检测位置信息以运算并输出 作业位置信息 ; 位置观测器, 输入所述作业位置信息和位置偏差以运算并输出新的作业位置信息 ; 及减法器, 从所述位置指令减去所述新的作业位置信息并输出所述位置偏差, 根据所述位置偏差, 使所述第 1 轴和所述第 2 轴进行 XY 轴坐标系的圆弧插补动作。 权 利 要 求 书 CN 103123478 A 2 1/12 页 3 同步控制装置 0001 本申请是申请日为 2011 年。
7、 1 月 12 日、 发明名称为 “同步控制装置”的第 201110020670.6 号专利申请的分案申请。 技术领域 0002 本发明涉及一种同步控制装置, 对机械地结合的多个马达进行同步驱动。 背景技术 0003 第 1 现有技术例如在日本公开公报特开 2007-042068 号公报中记载有, 具备补偿 数据计算单元, 其根据同步误差计算出对进给侧马达的位置偏差进行补偿的补偿数据, 进 行如下控制, 将补偿数据加在进给侧马达的位置偏差上, 使同步误差接近零, 该同步误差是 来自上位控制装置对主轴马达的指令和从设置在主轴马达上的检测器所反馈的主轴马达 的检测值的差即位置偏差与来自进给侧马达的。
8、上位控制装置的指令和从设置在进给侧马 达上的检测器所反馈的进给侧马达的检测值的差即位置偏差的差分。 0004 第2现有技术例如在日本公开公报特开2004-288164号公报中记载有一种控制装 置, 其通过位置控制部和速度控制部来驱动控制伺服马达, 该位置控制部根据位置指令与 来自位置检测器的位置反馈的位置偏差而在每个规定周期输出速度指令, 该速度控制部根 据速度指令与来自速度检测器的速度反馈而在每个规定周期输出转矩指令, 其中, 具备同 步补偿处理部, 对驱动同一控制对象的2个伺服马达进行同步控制, 根据作用在该2个伺服 马达之间的力使作用在 2 个伺服马达之间的力减少。 0005 第 3 现。
9、有技术例如在日本公开公报特开 2003-131712 号公报中记载有, 分别检测 出主轴及从轴的现在位置, 根据所检测出的主轴位置, 按从轴计算出对应于主轴位置的理 论位置, 对于各从轴, 计算出所计算的理论位置和所检测出的实际位置的同步误差, 根据所 计算的同步误差改变从轴的增益。 发明内容 0006 根据本发明的一个方案, 同步控制装置是对于具备多台马达、 分别检测出多台马 达的位置信息的多台位置检测器、 使多台马达的可动轴彼此连结的机械结合部的控制对 象, 同步控制多台马达的同步控制装置, 其特征在于, 具备 : 指令装置, 具有根据多个位置 信息运算作业位置, 且根据位置指令与作业位置。
10、的差运算新的位置指令的第 1 位置控制系 统 ; 及多个马达控制装置, 分别具有根据新的位置指令与位置信息的差对驱动马达的指令 进行运算的第 2 位置控制系统。 0007 根据本发明的另一个方案, 同步控制装置是对于具备2台马达、 分别检测出2台马 达的位置信息的 2 台位置检测器、 使马达的可动轴彼此连结的机械结合部的龙门机构即控 制对象, 同步控制2台马达的同步控制装置, 其特征在于, 具备 : 位置计测装置, 计测XY轴坐 标系的作业位置 ; 指令装置, 具有根据位置指令与作业位置的一个轴的坐标系位置的差运 算新的位置指令的第1位置控制系统 ; 第1及第2马达控制装置, 具有根据新的位置。
11、指令与 说 明 书 CN 103123478 A 3 2/12 页 4 位置信息的差对驱动马达的指令进行运算的第2位置控制系统 ; 及第3马达控制装置, 在具 有与第 1 或第 2 马达控制装置相同的功能的同时, 输入作业位置的一个轴的坐标系位置并 输出至指令装置。 0008 根据本发明的另一个方案, 同步控制装置是具有对具备多台马达、 分别检测出多 台马达的位置信息的多台位置检测器、 使多台马达的可动轴彼此连结的机械结合部的控制 对象进行驱动的第 1 轴、 对具备单台马达、 检测出单台马达的位置信息的单台位置检测器、 连结单台马达的可动轴的机械连结部的其它控制对象进行驱动的第 2 轴、 根据。
12、位置指令使 第 1 轴和第 2 轴进行 XY 轴坐标系的圆弧插补动作的指令装置的同步控制装置, 其特征在 于, 第 1 轴构成位置积分比例速度比例控制系统, 第 2 轴构成位置比例速度积分比例控 制系统, 将第 1 轴的位置比例增益 (Kp1) 设定为与第 2 轴的速度积分时间 (Ti) 的倒数一致, 同时将第 1 轴的位置积分时间 (Tir) 设定为与第 2 轴的位置比例增益 (Kp) 的倒数一致。 附图说明 0009 在结合附图参照以下详细说明更好地理解之后, 可以更容易获得对本发明及其许 多附带优点的更加全面的理解。 0010 图 1 是本发明第 1 实施方式所涉及的同步控制装置的框图。。
13、 0011 图 2 是表示第 1 实施方式中的速度及转矩的模拟波形的图。 0012 图 3 是本发明第 2 实施方式所涉及的同步控制装置的框图。 0013 图 4 是本发明第 3 实施方式所涉及的同步控制装置的框图。 0014 图 5 是表示第 2 实施方式中的速度及转矩的模拟波形的图。 0015 图 6 是表示同步控制装置驱动的第 1 同步机构 (龙门结构) 的图。 0016 图 7 是表示同步控制装置驱动的第 2 同步机构 (其它的龙门结构) 的图。 0017 图 8 是表示同步控制装置驱动的第 3 同步机构) 的图。 0018 图 9 是本发明第 4 实施方式所涉及的同步控制装置中的速度。
14、控制部 (比例 + 不完 全积分) 的框图。 0019 图 10 是第 1 现有技术的同步控制装置的框图。 0020 图 11 是表示第 1 现有技术的同步控制装置中的速度及转矩的模拟波形的图。 0021 图 12 是第 2 现有技术的同步控制装置的框图。 0022 图 13 是表示第 2 现有技术的同步控制装置中的速度及转矩的模拟波形的图。 0023 图 14 是第 3 现有技术的同步控制装置的框图。 0024 图 15 是表示第 3 现有技术的同步控制装置中的速度及转矩的模拟波形的图。 0025 图 16 是模式化表示图 6 中的第 1 同步机构 (龙门结构) 的图。 0026 图 17 。
15、是本发明第 5 实施方式中的通常增益设定时的圆弧插补动作波形图。 0027 图 18 是本发明第 5 实施方式所涉及的增益设定时的圆弧插补动作波形图。 0028 图 19 是本发明第 6 实施方式中的通常增益设定时的圆弧插补动作波形图。 0029 图 20 是本发明第 6 实施方式所涉及的增益设定时的圆弧插补动作波形图。 0030 图 21 是延迟较大时的本发明第 5 实施方式所涉及的增益设定时的圆弧插补动作 波形图。 0031 图 22 是本发明第 7 实施方式所涉及的增益设定时的圆弧插补动作波形图。 说 明 书 CN 103123478 A 4 3/12 页 5 0032 图 23 是本发。
16、明第 7 实施方式所涉及的同步控制装置的框图。 0033 图 24 是本发明第 7 实施方式所涉及的位置观测器的控制框图。 0034 图 25 是本发明第 7 实施方式所涉及的位置观测器的其它的控制框图。 具体实施方式 0035 参照附图说明实施例, 其中在各附图中相同附图标记指明相似或相同要素。 0036 首先, 利用第 1 至第 3 现有技术的同步控制装置驱动的同步机构说明其课题。图 6 是表示同步控制装置驱动的第 1 同步机构 (龙门结构) 的图。该第 1 同步机构 (龙门结构) 是用于例如在基板上安装半导体器件的安装机、 在基板上对半导体器件进行软钎焊的焊接 机、 涂布装置等工业用机械。
17、、 半导体或液晶制造装置的构成。 0037 第 1 至第 3 现有技术的同步控制装置在驱动这种第 1 同步机构 (龙门结构) 时, 对 于相同的位置控制构成的伺服放大器 15、 16, 从指令器 14 经由位置信息传输路径 126 发送 相同的位置指令并同步控制 2 个轴 (X1 轴、 X2 轴) 。 0038 但是, 在通过机械结合部 9 连结彼此的轴这样的第 1 同步机构 (龙门结构) 中, 该机 械结合部 9 的刚性越高, 则从一个轴向另一个轴、 从另一个轴向一个轴相互施加的扭转反 作用力 (以下称为无效反作用力) 越大。该无效反作用力起因于例如线性光栅尺 12 的制造 偏差或对机构的安。
18、装误差、 机构自身的组装精度等, 作为对伺服放大器 15、 16 的干扰而对 双方的位置控制系统产生影响。 0039 即, 该无效反作用力成为相对于伺服放大器 15、 16 的推力指令值符号相反的推 力, 伺服放大器 15、 16 为了消除该无效反作用力, 需要进一步增加推力指令值 (为了增加负 荷率) , 因此存在能效显著恶化的问题。 0040 而且, 还存在如下问题, 该无效反作用力较大时, 有可能会超过伺服放大器 15、 16 能够输出的推力上限值, 而超过时连正常的位置控制动作及同步控制都无法实现。 0041 而且, 第1至第3现有技术的同步控制装置如后所述, 在伺服放大器轴间需要位置。
19、 信息传输路径以外的传输路径。即, 第 1 现有技术的同步控制装置在伺服放大器轴间需要 位置偏差传输路径, 第 2、 3 现有技术的同步控制装置在伺服放大器轴间需要转矩指令传输 路径。 由于这些新的传输路径通常不存在于伺服放大器的通用产品中, 因此第1至第3现有 技术的同步控制装置不得不由专用器件来构成, 还存在成本方面或维护性、 交货期等问题。 0042 而且, 在 N 轴同步控制 (N 为轴数, 是 N1 的自然数) 中, 存在使 1 个检测位置为主 位置, 而剩余的 (N-1) 个轴的位置为从位置的情况。例如, 在图 6 中, X1 轴的检测位置为主 位置, X2 轴的检测位置为从位置。。
20、在如图 6 的同步机构 (龙门结构) 的情况下, 大多存在与 X1 及 X2 轴正交的 Y 轴, 在这些 XY 轴坐标系上存在作业位置 (作业中心) 。由于 Y 轴坐标是 在X1轴和X2轴的轴间移动的坐标, 因此还存在如下问题, 作业位置并不一定存在于主轴位 置上 (X1 轴上) , 从而无法进行针对作业位置的同步控制。 0043 本发明是鉴于上述问题而进行的, 提供一种同步控制装置, 对于通过多个马达沿 同一方向的坐标轴进行驱动的机械, 使用通用的机电器件 (马达、 伺服放大器、 指令器等) 来 抑制相互施加在各轴间的无效反作用力, 同时高精度地进行针对作业位置的同步控制。 0044 参照附。
21、图对本发明的第 1 实施方式进行说明。图 1 是本发明第 1 实施方式所涉及 的同步控制装置的框图。图中, 同步控制装置 1 具备指令器 2、 伺服放大器 3、 4。 说 明 书 CN 103123478 A 5 4/12 页 6 0045 指令器 2 具备位置指令生成部 21、 位置控制部 22、 位置信息运算部 23。 0046 位置指令生成部 21 生成用于驱动马达 5、 6 的内部位置指令 121 并输出至位置控 制部 22。位置信息运算部 23 从伺服放大器 3、 4 经由位置信息传输路径 126 输入由编码器 7、 8 检测出的检测位置信息 131、 141, 通过后述的运算输出作。
22、业位置信息 122。位置控制部 22 输入内部位置指令 121 与作业位置信息 122 的偏差并进行比例积分控制运算, 经由位置 信息传输路径 126 向伺服放大器 3、 4 输出新的位置指令信号 125。另外, 位置信息传输路 径 126 只要是例如高速串行通信路径等即可, 能够针对各伺服放大器 3、 4 进行同步并以双 方向对位置信息进行通信。 0047 而且, 作业位置信息 122 是例如当同步控制装置 1 驱动的机构系为 XY 轴坐标系, 内部位置指令 121 为 XY 轴坐标系中的位置指令时, 存在于该 XY 轴坐标系上的作业位置 (作 业中心) 的坐标。 0048 伺服放大器 3 。
23、具备位置控制部 31、 速度控制部 32、 速度运算部 33、 电流控制部 34, 伺服放大器 4 也具备相同构成 (位置控制部 41、 速度控制部 42、 速度运算部 43、 电流控制部 44) 。 0049 位置控制部 31、 41 输入新的位置指令信号 125 与检测位置信息 131、 141 的偏差进 行比例控制运算, 输出速度指令。速度运算部 33、 43 输入检测位置信息 131、 141 进行微分 运算, 输出速度反馈信号。速度控制部 32、 42 输入速度指令与速度反馈信号的偏差进行比 例控制运算, 输出驱动马达的指令。 0050 在此, 由于该驱动马达的指令通过在马达绕组上外。
24、加电压并流过电流而驱动马 达, 因此是电压或电流指令。电流控制部 34、 44 控制运算与电流指令相当的电流并供给至 马达 5、 6。马达 5、 6 产生与所被供给的电流成比例的力。例如, 如果是同步旋转型马达则产 生转矩, 如果是线性马达则产生推力。 0051 另外, 马达 5、 6、 编码器 7、 8、 机械结合部 9 的构成简单地表示图 6 中说明的第 1 同 步机构 (龙门结构) 的构成。而且, 干扰转矩 (反作用力) 191 意味着无效反作用力, 该无效反 作用力例如相对于伺服放大器 3 相当于负推力, 相对于伺服放大器 4 相当于正推力。而且, 图 6 中的指令器 14、 伺服放大。
25、器 15、 16 相当于图 1 中的指令器 2、 伺服放大器 3、 4。 0052 如此, 本发明第 1 实施方式所涉及的同步控制装置除在伺服放大器 3、 4 内构成的 位置控制系统外, 还在指令器 2 中具备其它的位置控制系统。由于指令器 2 内的位置控制 部 22 包含积分运算, 因此作业位置信息 122 能够相对于位置指令生成部 21 输出的内部位 置指令 121 没有位置偏差地进行跟踪或进行定位动作。 0053 另外, 位置控制部 22 即使仅通过积分控制也能够进行同样的动作。 0054 下面, 说明位置信息运算部 23 根据检测位置信息 131、 141 运算作业位置信息 122 的。
26、方法。 0055 位置信息运算部 23 通过式 (1)运算作业位置信息 122 的 X 坐标。另外, m 为 0 m 1, 是根据预先任意指定的作业位置而确定的 (m 的计算方法如后所述) 。 0056 (作业位置信息 122 的 X 坐标) 0057 =m(检测位置信息 131) +(1-m) (检测位置信息 141)(1) 0058 在图 6 (图 1 同样) 所示的第 1 同步机构 (龙门结构) 的构成中, 作业位置位于 X1 轴 和 X2 轴的轴间任意位置时, 作为 X 坐标能够通过式 (1) 计算出 X1 轴的位置 (检测位置信息 说 明 书 CN 103123478 A 6 5/1。
27、2 页 7 131) 和 X2 轴的位置 (检测位置信息 141) 之间的任意位置的作业位置信息 122, 能够针对位 置指令跟踪或定位未安装编码器的位置。 0059 例如, 如果式 (1) 中的 m 为 0.5, 则作为作业位置信息 122 的 X 坐标能够计算出 X1 轴和 X2 轴的轴间中央位置。如此, 使 X1 轴和 X2 轴的轴间距离为 L 时, 能够计算出 mL 的 X 轴方向的作业位置信息。 0060 而且, 在图 6(图 1 同样) 所示的第 1 同步机构 (龙门结构) 的构成的情况下, 大多 是构成与 X1 轴和 X2 轴正交的 Y 轴, 在由 X1 轴、 X2 轴、 Y 轴。
28、的各坐标所确定的位置, 即作业 位置上进行物品加工等的作业的工业用机械、 半导体或液晶制造装置。 0061 另外, Y 轴也与 X1 轴和 X2 轴一样具备其它的 (Y 轴用的) 伺服放大器并构成位置 控制系统, 构成为根据来自指令器 2 的其它的 (Y 轴用的) 位置指令, 驱动其它的 (Y 轴用的) 马达。此时, 如后所述, 对于 X1 轴、 X2 轴的坐标, 能够根据与它们正交的 Y 轴的坐标计算 m 的值。即, Y 轴的位置为作业位置信息 122 的 Y 坐标, 由使用 m 的 (1) 式计算的位置为作业 位置信息 122 的 X 坐标。 0062 下面, 说明 m 的计算式。图 16。
29、 是模式化表示图 6 中的第 1 同步机构 (龙门结构) 的 图。图中, X1 轴和 X2 轴都是线性光栅尺的位置, 线性光栅尺头部位于检测位置 131 和 141。 Y 轴是行程 Ly。使 Y 轴的行程末端至 X1 轴编码器头部的偏移距离为 dY1, 使 Y 轴的原点 (0 位置) 至 X2 轴的偏移距离为 dY2。将 Y 轴的原点 (0 位置) 取为 Y 坐标 (作业坐标) 的原点 (0 位置) , 将 X1 轴、 X2 轴的原点 (0 位置) 取为 X 坐标 (作业坐标) 的原点 (0 位置) , 使作业位置 为 (Px、 Py) 。 0063 此时, 能够通过式 (2) 计算出 m。 。
30、0064 m=(Py+dY2) /(dY1+Ly+dY2)(2) 0065 另外, 在图 16 中夸大记载了 Y 轴的斜度, 但是在实际的机械中, 对于 1m 左右的 Y 轴行程, 检测位置 131 和检测位置 141 的差为几十 m 左右, 因此, Y 轴的斜度是极小的量。 由于即使考虑Y轴方向与Y坐标 (作业坐标) 大致平行在计算上也没有问题, 因此能够将 (2) 式的 m 应用于上述 (1) 式并计算检测位置 122 的 X 坐标 (Px) 。 0066 如此, 能够根据 Y 轴的位置计算出 X 轴方向的作业位置信息。而且, 在图 6 所示的 机械结合部 9 上安装有沿 Y 轴移动的作业。
31、用头部 13 时, 存在如下问题, 在 X1 轴和 X2 轴间 的机械结合部 9 存在歪斜时, 根据 Y 轴的作业用头部 13 的位置, 作业用头部 13 的 X 坐标位 置相对于位置指令会产生机械误差, 但是根据前述的位置信息运算部 23 的运算, 即使 Y 轴 移动也能够按照位置指令对作业用头部 13 的 X 轴方向位置进行定位。 0067 图 2 是表示第 1 实施方式中的速度及转矩的模拟波形的图。图中, 图 1 中的作业 位置信息 122= 检测位置信息 131 时, 上段是速度波形, 下段是转矩波形, 纵轴是各振幅, 横 轴是时间轴。此时, 与定位动作后的停止时 (时间轴 16 之后。
32、) 的无效反作用力相当的推力为 约 0.05p-p 左右, 是加减速时 (时间轴 0 至 3) 的最大推力振幅 (0.5 左右) 的约 10% 左右。 0068 在此, 对第 1 至第 3 现有技术的同步控制装置中的无效反作用力进行说明。图 10 是第 1 现有技术的同步控制装置的框图, 图 12 是第 2 现有技术的同步控制装置的框图, 图 14 是第 3 现有技术的同步控制装置的框图。而且, 图 11 是表示第 1 现有技术的同步控制装 置中的速度及转矩的模拟波形的图, 图13是表示第2现有技术的同步控制装置中的速度及 转矩的模拟波形的图, 图15是表示第3现有技术的同步控制装置中的速度及。
33、转矩的模拟波 说 明 书 CN 103123478 A 7 6/12 页 8 形的图。在图 11、 13、 15 中, 图模拟条件与图 2 相同, 上段是速度波形, 下段是转矩波形, 纵 轴是各振幅, 横轴是时间轴。 0069 与各自定位动作后的停止时 (时间轴 16 之后)的无效反作用力相当的推力为, 第 1 现有技术的同步控制装置为约 0.1p-p(图 11) , 第 2 现有技术的同步控制装置为约 0.15p-p(图 13) , 第 3 现有技术的同步控制装置为约 0.3p-p(图 15) 。它们相当于加 减速时 (时间轴 0 至 3) 的最大推力振幅 (0.5 左右) 的约 20%、 。
34、约 30%、 约 60%。 0070 如此, 第 1 至第 3 现有技术的同步控制装置为, 虽然对于相同的位置指令, 各伺服 放大器试图使检测位置完全跟踪于位置指令, 但是由于编码器自身的误差、 安装误差、 机械 误差 (轴间的偏移) , 尤其在定位停止后对各伺服放大器产生无效反作用力。虽然根据位置 偏差、 转矩指令等检测出该轴间的偏移并在轴间进行补偿处理, 但是与本发明的实施方式 相比没有达到使无效反作用力降低。 0071 本发明的实施方式 (第 1 实施方式及后述的第 2、 3、 4 实施方式) 所涉及的同步控制 装置在 N 轴同步控制 (N 为轴数, 是 N1 的自然数) 中着眼于 : 。
35、轴数份的编码器位置与实际的 同步机构的机械位置没有严密地一致 ; 由于使轴数份的马达可动轴彼此连结的结合构件的 刚性而产生无效反作用力 ; 轴数份的编码器位置在轴间的偏移与无效反作用力反向。 0072 即, 本发明的实施方式 (第 1 实施方式及后述的第 2、 3、 4 实施方式) 所涉及的同步 控制装置是在 N 轴同步控制 (N 为轴数, 是 N1 的自然数) 中基于如下条件而构成的, 与位置 指令一致的检测位置不是多个而是限定于 1 个, 以及在具备各伺服放大器中的位置控制系 统的同时需要对于位置指令使用 1 个检测位置的位置控制系统。 0073 本申请的典型的发明在 N 轴同步控制 (N。
36、 为轴数, 是 N1 的自然数) 中为如下构成 : 根据多个编码器位置计算出作业位置并使该作业位置跟踪于位置指令的构成 ; 去掉各伺服 放大器内的积分运算的构成 (由于积分运算在动作越是低频时则增益越大, 因此在定位完 成的停止时刻无效反作用力增大。通过去掉该积分运算来抑制无效反作用力的增加。 ) ; 在 伺服放大器的更外侧追加 1 个新的位置控制系统并仅在该位置控制系统中具备积分运算 的构成。 0074 如此, 本申请的典型的发明还综合、 本质地探讨了控制对象的机械精度等。而且, 对于通过多个马达沿同一方向的坐标轴进行驱动的机械, 能够使用通用的机电器件 (马达、 伺服放大器、 指令器等) 。
37、来抑制相互施加在各轴间的无效反作用力, 同时高精度地进行针对 作业位置的同步控制。 0075 即, 应同步的多个马达的推力 (转矩) 能够为大致相同的程度, 能够仅通过进行位 置数据交接的位置信息传输路径 (利用通用的串行通信等) , 实现定位动作时或定位完成后 的无效反作用力较少的同步动作。 而且, 能够减小机械结合部的刚性、 粘性摩擦的影响所引 起的偏移, 能够使指令器内的作业位置信息在定位完成时刻与位置指令严密地一致。 0076 另外, 检测位置信息相当于各技术方案所记载的位置信息, 内部位置指令相当于 位置指令, 作业位置信息相当于作业位置, 指令器相当于指令装置, 伺服放大器相当于马。
38、达 控制装置。 0077 下面, 对于各种同步机构, 依次说明本发明实施方式所涉及的同步控制装置的应 用例。 0078 下面, 参照附图对本发明的第 2 实施方式进行说明。图 7 是表示同步控制装置驱 说 明 书 CN 103123478 A 8 7/12 页 9 动的第 2 同步机构 (其它的龙门结构) 的图。图中, 为了准确地计测作业位置附近的 X 方向 位置, 安装有使用了激光干涉仪 101 的位置计测装置。 0079 激光干涉仪 101 是将反射镜设置在机械结合部 9 上, 通过来自激光干涉仪的激光 束的干涉而非接触地计测位置。因此, 在无法设置线性光栅尺 12 的场所, 能够在 X 。
39、轴方向 上直接计测机械结合部 9 的作业位置。 0080 图 3 是本发明第 2 实施方式所涉及的同步控制装置的框图。图中, 同步控制装置 10 具备指令器 2、 伺服放大器 3、 4、 17。 0081 第 2 实施方式与第 1 实施方式的不同之处在于 : 同步控制装置 10 将激光干涉仪 101的检测位置信息输入伺服放大器17, 作为检测位置信息171经由位置信息传输路径126 输入指令器 2 内的位置信息运算部 23 ; 位置信息运算部 23 仅使用激光干涉仪 101 的检测 位置信息 171, 而不使用来自伺服放大器 3、 4 的检测位置信息 131 和检测位置信息 141。 0082。
40、 因此, 同步控制装置 10 不在伺服放大器 17 上连接马达, 作为仅将激光干涉仪 101 的检测位置信息171传输至位置信息传输路径126的数据转换器而使用伺服放大器17。 通 过如此构成, 能够仅由通用产品来构成。 0083 另外, 编码器 (线性光栅尺) 7 和编码器 8 的检测分辨率 (每 1 个脉冲的长度 : 例如 0.1m/1 个脉冲等) 和激光干涉仪 101 的检测位置分辨率不同时, 在位置信息运算部 23 内 进行电子齿轮运算, 使分辨率一致即可。 0084 在第2实施方式中, 通过激光干涉仪101检测出作业位置附近的位置, 作为指令器 2 内的作业位置信息 122 对指令器。
41、 2 内的位置控制系统进行反馈, 因此, 能够使 X 方向的作 业位置比第 1 实施方式更准确地跟踪于指令位置。 0085 另外, 激光干涉仪相当于各技术方案记载的位置计测装置。 0086 下面, 参照附图对本发明的第 3 实施方式进行说明。图 8 是表示同步控制装置驱 动的第 3 同步机构 (圆弧线性结构) 的图。图 4 是本发明第 3 实施方式所涉及的同步控制装 置的框图。图 4 中, 同步控制装置 11 具备指令器 2、 伺服放大器 3、 4、 17。另外, 由于伺服放 大器 4、 17 的控制构成与伺服放大器 3 相同, 因此省略详细的记载。 0087 本发明第 3 实施方式所涉及的同。
42、步控制装置向图 8 中的圆弧形线性马达 5、 6、 18 供电并同步控制多个线性马达动子 (例如线性马达动子53) 。 在各线性马达动子上安装有线 性光栅尺的位置读取头部, 能够通过使用带式线性光栅尺等以圆弧状粘贴光栅尺, 也可以 通过 3 个头部对 1 根线性光栅尺进行位置检测或者针对各头部分别安装线性光栅尺。 0088 第 3 实施方式与第 1 实施方式的不同之处在于, 同步控制装置 11 同步控制由 3 个 轴构成的同步机构 (例如图8) 。 另外, 标注与第1实施方式的代表图即图1相同的符号的构 成要素由于其作用效果相同, 因此省略详细的说明。 0089 图 4 中的马达 5、 6、 。
43、18、 编码器 7、 8、 19、 机械结合部 9、 105、 106 的构成简单地表示 图 8 中说明的第 3 同步机构 (圆弧线性结构) 的构成。另外, 由于马达 5、 6、 18 通过转台 (9、 105、 106) 而被机械地结合, 因此图 8 中的转台 (9、 105、 106) 在图 4 中是以机械结合部 9、 105、 106 来标明的。而且, 与第 1 实施例一样, 由于各轴通过机械结合部 9、 105、 106 而被机 械地结合, 因此无效反作用力 (干扰转矩 191) 施加在各轴上。 0090 指令器 2 中的位置信息运算部 23 根据来自伺服放大器 3、 4、 17 的检。
44、测位置信息 131、 141、 171 计算出作业位置信息 122。例如, 将第 1 实施例中说明的使用式 (1) 的 2 个轴 说 明 书 CN 103123478 A 9 8/12 页 10 的计算方法展开为 3 个轴即可 (参照式 (3) 、(4) ) 。 0091 而且, 在图 8 中, 存在如下情况, 因线性光栅尺的安装误差而在旋转 1 周时产生 N 个周期的误差 (N为自然数) 。 例如在图8中, 虽然在薄厚度的圆筒形构件上贴上了线性光栅 尺, 但是在直径达 2m 左右的大型圆弧形转台的情况下, 存在如下情况, 圆筒形构件因加工 误差、 安装时的误差而在直径方向上歪斜。此时, 在机。
45、械结合部即转台旋转 1 周时产生 N 个 周期的误差 (N 为自然数) 。由于转台旋转 1 周时返回原位, 因此该误差为 N 个周期的误差。 0092 例如, 在1根线性光栅尺上安装3个线性光栅尺头部并检测位置时, 使经由伺服放 大器 3 从线性光栅尺检测出的检测位置信息 X1 的真值为 rad, 使相当于误差的微小值 为 , 而线性光栅尺上出现 1 个周期的误差时, X1=+sin() 。 0093 而且, 如果在该线性光栅尺圆周上每隔 120 度 (2/3) 分别配置线性光栅尺头部, 则伺服放大器 4 的检测位置信息 X2、 伺服放大器 17 的检测位置信息 X3 为 X2=+sin (-。
46、2/3) 、 X3=+sin (-4/3) 。在此, 虽然 3 个线性光栅尺头部每隔 120 度错开配 置, 但是如果在 3 个马达中使原点位置为共通的 1 个, 则由于真值 的值能够相同, 因此 1 个周期的误差依赖于物理位置, 是从 错开 120 度、 240 度的值。 0094 本发明第3实施方式所涉及的同步控制装置中的位置信息运算部23通过式 (3) 对 作业位置信息 122 进行平均化运算。 0095 (作业位置信息 122) 0096 =( (检测位置信息 131) +(检测位置信息 141) +(检测位置信息 171) ) /3(3) 0097 而且, 式 (3) 由式 (4) 。
47、来表示。 0098 (作业位置信息 122) 0099 =+(sin() +sin(-2/3) +sin(-4/3) )(4) 0100 在此, 由于 sin() +sin(-2/3) +sin(-4/3) =0, 因此 (作业位置信息 122) =, 作业位置信息 122 作为没有误差的真值而被求出。圆弧形线性马达的个数为 m 个 时, 每隔 360/m 度 =2/m 配置线性光栅尺头部即可, 在位置信息运算部 23 中进行 m 个的平 均化运算即可。 0101 如此, 本发明第3实施方式所涉及的同步控制装置除在伺服放大器3、 4、 17内构成 的位置控制系统外, 还在指令器 2 中具备其它。
48、的位置控制系统。由于指令器 2 内的位置控 制部 22 包含积分运算, 因此作业位置信息 122 能够相对于位置指令生成部 21 输出的内部 位置指令 121 没有位置偏差地进行跟踪或进行定位动作。而且, 通过位置信息运算部 23 的 平均化运算, 能够降低因线性光栅尺的安装误差所产生的旋转1周时N个周期 (N为自然数) 的误差。 0102 图 5 是表示第 3 实施方式中的速度及转矩的模拟波形的图。图中, 上段是速度波 形, 下段是转矩波形, 纵轴是各振幅, 横轴是时间轴。此时, 与定位动作后的停止时 (时间轴 16 之后) 的无效反作用力相当的推力为约 0.1p-p 左右, 是加减速时 (。
49、时间轴 0 至 3) 的最 大推力振幅 (0.5 左右) 的约 20% 左右。可知即使在 3 个轴的情况下无效反作用力也较少。 0103 如此, 根据第 3 实施方式, 能够容易地增加进行同步控制的轴, 还能够将各轴的无 效反作用力抑制为较少。在第 1 至第 3 现有的同步控制装置中, 随着进行同步控制的轴数 增加, 轴间的控制构成变得复杂, 控制增益等的调节也较为复杂。另一方面, 根据第 3 实施 方式, 构成针对 N 个轴 (N 为 N1 的自然数) 的同步控制系统时, 只要准备 N 轴份的相同控制 说 明 书 CN 103123478 A 10 9/12 页 11 系统的伺服放大器 (例如通用的伺服放大器) 即可。 0104 同步控制 N 个。