首页> 中国专利> 为了驱动一个被驱动体而控制两个电动机的电动机控制装置

为了驱动一个被驱动体而控制两个电动机的电动机控制装置

摘要

本发明的电动机控制装置中,速度控制部(24m)具备计算速度指令值(ωm)和转速(ωm’)之间的速度偏差(ωm-ωm’)的积分值(Sm)的积分器,根据速度偏差(ωm-ωm’)、预先决定的值、比例增益以及积分增益,生成转矩指令值(Tm)。速度控制部(24s)具备计算速度指令值(ωs)和转速(ωs’)之间的速度偏差(ωs-ωs’)的积分值(Ss)的积分器,根据速度偏差(ωs-ωs’)、预先决定的值、比例增益以及积分增益,生成转矩指令值(Ts)。积分值选择部(28)根据主电动机(6m)的驱动状态和子电动机(6s)的驱动状态,选择积分值(Sm)和积分值(Ss)中的任意一方作为预先决定的值。

著录项

  • 公开/公告号CN104298251A

    专利类型发明专利

  • 公开/公告日2015-01-21

    原文格式PDF

  • 申请/专利权人 发那科株式会社;

    申请/专利号CN201410344737.5

  • 发明设计人 前田和臣;

    申请日2014-07-18

  • 分类号G05D3/12(20060101);

  • 代理机构11243 北京银龙知识产权代理有限公司;

  • 代理人许静;李家浩

  • 地址 日本山梨县

  • 入库时间 2023-12-17 04:02:12

法律信息

  • 法律状态公告日

    法律状态信息

    法律状态

  • 2016-05-04

    授权

    授权

  • 2015-02-18

    实质审查的生效 IPC(主分类):G05D3/12 申请日:20140718

    实质审查的生效

  • 2015-01-21

    公开

    公开

说明书

技术领域

本发明涉及一种为了驱动一个被驱动体而控制两个电动机的电动机控制 装置。

背景技术

在机床等中,有时由于电动机的被驱动体是大型的,所以无法通过一个电 动机进行加减速。另外,也有时由于与电动机的驱动轴连接的传递机构的机械 要素和被驱动体之间的齿隙大,所以无法在稳定的状态下使被驱动体移动。在 这样的情况下,进行通过两个电动机驱动一个被驱动体的串联控制(例如日本 专利公开公报JP-A8-174481、JP-A-2003-79180、JP-A-2004-92859、 JP-A-2009-177881)。

在这样的串联控制中,两个电动机中的一个电动机作为具有驱动轴的主电 动机发挥功能,该驱动轴起到作为与传递机构连结的主轴的作用。另一个电动 机作为具有驱动轴的子电动机发挥功能,该驱动轴起到作为与传递机构连结的 从轴的作用。

另外,在进行串联控制时,必须抑制与电动机的驱动轴连接的传递机构的 机械要素和被驱动体之间的齿隙。为此,提出了以下的电动机控制装置,其生 成预先向转矩指令值附加的转矩值即预载荷转矩值,使得施加到主电动机的驱 动轴上的力的方向和施加到子电动机的驱动轴上的力的方向相互相反(例如日 本专利公开公报JP-A-8-16246、JP-A-2001-273037)。

另外,必须避免因串联控制中的主电动机的速度的检测的定时和子电动机 的速度的检测的定时之间的差等引起的对电动机的控制的坏影响以及电动机 的过热的产生。为此,提出了以下的电动机控制装置,其使用对主电动机的速 度指令值和主电动机的速度之间的速度偏差的积分值,生成对主电动机的转矩 指令值和对子电动机的转矩指令值(例如日本专利公开公报 JP-A-2003-189657)。

进而,提出了以下的电动机控制装置,其生成预载荷转矩值;使用对主电 动机的速度指令值和主电动机的速度之间的速度偏差的积分值生成对主电动 机的转矩指令值以及对子电动机的转矩指令值(例如日本专利公开公报 JP-A-2010-172054)。

有时使用对主电动机的速度指令值和主电动机的速度之间的速度偏差的 积分值,生成对主电动机的转矩指令值和对子电动机的转矩指令值。在这样的 情况下,主要驱动子电动机时、即主电动机的加速度是负值时对子电动机的位 置指令值和子电动机的位置之间的位置偏差变大,存在对电动机的控制产生坏 影响的问题。

本发明的目的在于:提供一种电动机控制装置,其在驱动两个电动机时无 论主要被驱动的电动机是哪一个电动机,都能够避免由于位置偏差增大而对电 动机的控制产生的坏影响。

发明内容

本发明的一个实施例的电动机控制装置是为了驱动一个被驱动体而控制 第一电动机和第二电动机的电动机控制装置,其特征在于,具备:第一位置控 制部,其为了控制第一电动机的位置,根据对第一电动机的位置指令值、与第 一电动机关联的位置信息以及第一位置控制增益,生成第一速度指令值;第二 位置控制部,其为了控制第二电动机的位置,根据对第二电动机的位置指令值、 与第二电动机关联的位置信息以及第二位置控制增益,生成第二速度指令值; 第一速度控制部,其具备计算第一速度指令值和第一电动机的速度之间的速度 偏差即第一速度偏差的积分值的第一积分器,为了控制第一电动机的速度,根 据第一速度偏差、预先决定的值、第一比例增益以及第一积分增益,生成第一 转矩指令值;第二速度控制部,其具备计算第二速度指令值和第二电动机的速 度之间的速度偏差即第二速度偏差的积分值的第二积分器,为了控制第二电动 机的速度,根据第二速度偏差、预先决定的值、第二比例增益以及第二积分增 益,生成第二转矩指令值;积分值选择部,其根据第一电动机的驱动状态和第 二电动机的驱动状态,选择第一速度偏差的积分值和第二速度偏差的积分值中 的任意一方作为预先决定的值;第一电动机驱动部,其根据第一转矩指令值驱 动第一电动机;第二电动机驱动部,其根据第二转矩指令值驱动第二电动机。

最好是积分值选择部在第一电动机的加速度相对于比零大的第一值大时, 选择第一速度偏差的积分值作为预先决定的值,在第一电动机的加速度相对于 比零小的第二值小时,选择第二速度偏差的积分值作为预先决定的值。

最好是本发明的其他实施例的电动机控制装置还具备:预载荷转矩值生成 部,其生成预先向第一转矩指令值附加的转矩值即第一预载荷转矩值、以及预 先向第二转矩指令值附加的转矩值即第二预载荷转矩值,使得施加到第一电动 机的驱动轴上的力的方向和施加到第二电动机的驱动轴上的力的方向相互相 反。

附图说明

通过参照以下的附图,能够更明确地理解本发明。

图1是具有本发明的实施方式的电动机控制装置的系统框图。

图2是详细地表示图1的积分值选择部和速度控制部的一个例子的图。

图3是图1所示的电动机控制装置的动作的流程图。

图4是表示由图1所示的电动机控制装置进行控制的电动机的加速度的时 间变化的一个例子的图。

图5A是用于说明本发明的电动机控制装置的效果的图。

图5B是用于说明本发明的电动机控制装置的效果的图。

图5C是用于说明本发明的电动机控制装置的效果的图。

图5D是用于说明本发明的电动机控制装置的效果的图。

图6是详细地表示图1的积分值选择部和速度控制部的其他例子的图。

具体实施方式

参照附图详细说明本发明的电动机控制装置的实施方式。在附图中,对相 同的结构要素附加相同的符号。

图1是具有本发明的实施方式的电动机控制装置的系统的框图。图1所示 的系统具备三相交流电源1、变换器2、平滑用电容器3、逆变器4m和4s、 电流检测器5m和5s、作为第一电动机的主电动机6m、作为第二电动机的子 电动机6s、传递机构7m和7s、被驱动体8、机械位置检测器9、电动机位置 检测器10m和10s、电动机速度检测部11m和11s、电动机控制装置12、上位 控制装置13。

三相交流电源1由商用交流电源构成。变换器2例如由多个(在三相交流 的情况下是6个)整流二极管以及分别与这些整流二极管逆并联连接的晶体管 构成,将从三相交流电源1供给的交流电力变换为直流电力。

平滑用电容器3为了对由变换器2的整流二极管进行整流后的电压进行平 滑化而与变换器2并联连接。逆变器4m、4s分别与平滑用电容器3并联连接, 例如由多个(在三相交流的情况下是6个)整流二极管以及分别与这些整流二 极管逆并联连接的晶体管构成。逆变器4m、4s分别根据后面说明的PWM信 号Vm、Vs进行晶体管的开关动作,由此将通过变换器2变换后的直流电力 变换为交流电力。

电流检测器5m为了检测流过主电动机6m的电流的值Im’而被设置在逆 变器4m的输出线上。电流检测器5s为了检测流过子电动机6s的电流值Is’ 而被设置在逆变器4s的输出线上。在本实施方式中,电流检测器5m、5s例如 由霍尔元件构成。

主电动机6m具有起到作为与传递机构7m连结的主轴的作用的驱动轴, 通过积蓄在平滑用电容器3中的电力而被驱动。子电动机6s具有起到作为与 传递机构7s连结的从轴的作用的驱动轴,通过积蓄在平滑用电容器3中的电 力被驱动。

在本实施方式中,主电动机6m和子电动机6s分别由在转子和定子的任 意一方设置有永磁铁的旋转型伺服电动机、在定子和滑动元件中的任意一方设 置有永磁铁的线性伺服电动机、在定子和振子中的任意一方设置有永磁铁的振 动型伺服电动机、不使用永磁铁的感应电动机等构成。

传递机构7m、7s为了使被驱动体8沿着传递机构7m、7s的轴线方向移 动而与被驱动体8连接。被驱动体8由机床的工作台、工业用机器人的臂等构 成。

机械位置检测器9由检测作为与第一电动机关联的位置信息和与第二电 动机关联的位置信息的包含传递机构7m、7s的未图示的机械的位置θx的比 例尺等构成。

电动机位置检测器10m由检测主电动机6m的旋转角度θm’的转子编码 器、霍尔元件、旋转变压器等构成。电动机位置检测器10s由检测子电动机 6s的旋转角度θs’的转子编码器、霍尔元件、旋转变压器等构成。

从电动机位置检测器10m向电动机速度检测部11m输入主电动机6m的 旋转角度θm’。电动机速度检测部11m通过用时间对旋转角度θm’进行一阶 微分而计算作为第一电动机的速度的主电动机6m的转速ωm’,将转速ωm’ 输出到电动机控制装置12。

从电动机位置检测器10s向电动机速度检测部11s输入子电动机6s的旋 转角度θs’。电动机速度检测部11s通过用时间对旋转角度θs’进行一阶微分 而计算作为第二电动机的速度的子电动机6s的转速ωs’,将转速ωs’输出到电 动机控制装置12。

电动机控制装置12为了降低传递机构7m、7s的机械要素和被驱动体8 之间的齿隙,并且抑制主电动机6m的驱动轴的扭曲以及子电动机6s的驱动 轴的扭曲,进行串联控制,即通过主电动机6m和子电动机6s驱动被驱动体8。 为此,电动机控制装置12具备减法器21m、减法器21s、作为第一位置控制 部的位置控制部22m、作为第二位置控制部的位置控制部22s、减法器23m、 减法器23s、作为第一速度控制部的速度控制部24m、作为第二速度控制部的 速度控制部24s、作为第一电动机驱动部的电动机驱动部25m、作为第二电动 机驱动部的电动机驱动部25s、预载荷转矩值生成部26、加速度计算部27、 积分值选择部28。

减法器21m具备从上位控制装置13输入作为对第一电动机即主电动机 6m的位置指令值的位置指令值θm的+输入端子、从机械位置检测器9输入 位置θx的-输入端子、向位置控制部22m输出这些位置偏差θm-θx的输出 端子。

减法器21s具备从上位控制装置13输入作为对第二电动机即子电动机6s 的位置指令值的位置指令值θs的+输入端子、从机械位置检测器9输入位置 θx的-输入端子、向位置控制部22s输出这些位置偏差θs-θx的输出端子。

位置控制部22m为了控制主电动机6m的位置,根据位置指令值θm、位 置θx以及作为第一位置控制增益的位置控制增益Kd,生成作为第一速度指 令值的对主电动机6m的速度指令值ωm。为此,位置控制部22m具备:位置 控制增益Kd的放大器(未图示),其从减法器21m输入位置偏差θm-θx, 放大位置偏差θm-θx。另外,位置控制部22m生成位置偏差θm-θx和位置 控制增益Kd的积即速度指令值ωm,向减法器23m输出所生成的速度指令值 ωm。

位置控制部22s为了控制子电动机6s的位置,根据位置指令值θs、位置 θx以及作为第二位置控制增益的位置控制增益Kd’,生成作为第二速度指令 值的对子电动机6s的速度指令值ωs。为此,位置控制部22s具备:位置控制 增益Kd’的放大器(未图示),其从减法器21s输入位置偏差θs-θx,放大位 置偏差θs-θx。另外,位置控制部22s生成位置偏差θs-θx和位置控制增益 Kd’的积即速度指令值ωs,向减法器23s输出所生成的速度指令值ωs。在此, 位置控制增益Kd和位置控制增益Kd’也可以是相同的值。

减法器23m具备从位置控制部22m输入速度指令值ωm的+输入端子、 从电动机速度检测部11m输入转速ωm’的-输入端子、向速度控制部24m输出 速度指令值ωm和转速ωm’之间的速度偏差即作为第一速度偏差的速度偏差 ωm-ωm’的输出端子。

减法器23s具备从位置控制部22s输入速度指令值ωs的+输入端子、从电 动机速度检测部11s输入转速ωs’的-输入端子、向速度控制部24s输出速度指 令值ωs和转速ωs’之间的速度偏差即作为第二速度偏差的速度偏差ωs-ωs’ 的输出端子。

速度控制部24m为了控制主电动机6m的速度,而根据速度偏差ωm-ω m’、后面说明的预先决定的值、作为第一比例增益的比例增益Kp以及作为第 一积分增益的积分增益Ki,生成作为第一转矩指令值的转矩指令值Tm。

为此,速度控制部24m具备:后面说明的第一积分器,其用于从减法器 23m输入速度偏差ωm-ωm’,计算速度偏差ωm-ωm’的积分值Sm;比例增益 Kp之后说明的放大器,其放大速度偏差ωm-ωm’;积分增益Ki之后说明的 放大器,其放大上述预先决定的值。

另外,速度控制部24m生成速度偏差ωm-ωm’和比例增益Kp的积以及 上述预先决定的值和积分增益Ki的积的和即转矩指令值Tm,将生成的转矩 指令值Tm输出到电动机驱动部25m。

速度控制部24s为了控制子电动机6s的速度,而根据速度偏差ωs-ωs’、 上述预先决定的值、作为第二比例增益的比例增益Kp’以及作为第二积分增益 的积分增益Ki’,生成作为第二转矩指令值的转矩指令值Ts。

为此,速度控制部24s具备:后面说明的第二积分器,其用于从减法器 23s输入速度偏差ωs-ωs’,计算速度偏差ωs-ωs’的积分值Ss;比例增益Kp’ 之后说明的放大器,其放大速度偏差ωs-ωs’;积分增益Ki’之后说明的放大器, 其放大上述预先决定的值。

另外,速度控制部24s生成速度偏差ωs-ωs’和比例增益Kp’的积、以及 上述预先决定的值和积分增益Ki’的积的和即转矩指令值Ts,将生成的转矩指 令值Ts输出到电动机驱动部25s。在此,比例增益Kp和比例增益Kp’也可以 是相同的值,积分增益Ki和积分增益Ki’也可以是相同的值。

电动机驱动部25m根据转矩指令值Tm和后面说明的预载荷转矩值+Pr来 驱动主电动机6m。为此,电动机驱动部25m具备加法器41m、减法器42m、 电流控制部43m。

加法器41m具备从速度控制部24m输入转矩指令值Tm的第一+输入端 子、从预载荷转矩值生成部26输入预载荷转矩值+Pr的第二+输入端子、输出 相当于转矩指令值Tm和预载荷转矩值+Pr的和的对主电动机6m的电流指令 值Im的输出端子。

减法器42m具备从加法器41m输入电流指令值Im的+输入端子、从电流 检测器5m输入电流的值Im’的-输入端子、向电流控制部43m输出电流指令值 Im和电流的值Im’之间的电流偏差Im-Im’的输出端子。

电流控制部43m从减法器42m输入电流偏差Im-Im’,根据输入的电流偏 差Im-Im’,生成与对主电动机6m的电压指令值对应的PWM信号Vm。另外, 电流控制部43m向逆变器4m输出所生成的PWM信号Vm。

电动机驱动部25s根据转矩指令值Ts和后面说明的预载荷转矩值-Pr来驱 动子电动机6s。为此,电动机驱动部25s具备加法器41s、减法器42s、电流 控制部43s。

加法器41s具备从速度控制部24s输入转矩指令值Ts的第一+输入端子、 从预载荷转矩值生成部26输入预载荷转矩值-Pr的第二+输入端子、输出相当 于转矩指令值Ts和预载荷转矩值-Pr的和的对子电动机6s的电流指令值Is的 输出端子。

减法器42s具备从加法器41s输入电流指令值Is的+输入端子、从电流检 测器5s输入电流的值Is’的-输入端子、向电流控制部43s输出电流指令值Is 和电流的值Is’之间的电流偏差Is-Is’的输出端子。

电流控制部43s从减法器42s输入电流偏差Is-Is’,根据输入的电流偏差 Is-Is’,生成与对子电动机6s的电压指令值对应的PWM信号Vs。另外,电流 控制部43s向逆变器4s输出所生成的PWM信号Vs。

预载荷转矩值生成部26与从上位控制装置13输出的励磁信号Se响应, 生成预先向转矩指令值Tm附加的转矩值即作为第一预载荷转矩值的预载荷 转矩值+Pr以及预先向转矩指令值Ts附加的转矩值即作为第二预载荷转矩值 的预载荷转矩值-Pr,使得施加到主电动机6m的驱动轴上的力的方向与施加到 子电动机6s的驱动轴上的力的方向相互相反。另外,预载荷转矩值生成部26 向加法器41m、41s分别输出所生成的预载荷转矩值+Pr、-Pr。

加速度计算部27从上位控制装置13输入位置指令值θm,用时间对所输 入的位置指令值θm进行二阶微分,由此计算作为第一电动机的加速度的加速 度a。另外,加速度计算部27将计算出的加速度a输出到积分值选择部28。

积分值选择部28根据主电动机6m的驱动状态和子电动机6s的驱动状态, 选择积分值Sm和积分值Ss中的任意一方作为上述预先决定的值。

图2是详细地表示图1的积分值选择部和速度控制部的一个例子的图。如 图2所示,速度控制部24m具备作为第一积分器的积分器31m、放大器32m、 放大器33m、加法器34m。

积分器31m计算积分值Sm。放大器32m是放大速度偏差ωm-ωm’的比 例增益Kp的放大器。放大器33m是放大上述预先决定的值的积分增益Ki的 放大器。

加法器34m具备从放大器32m输入速度偏差ωm-ωm’和比例增益Kp的 积的第一输入端子、从放大器33m输入上述预先决定的值和积分增益Ki的积 的第二输入端子、输出作为它们的积的和的转矩指令值Tm的输出端子。

另外,如图2所示,速度控制部24s具备作为第二积分器的积分器31s、 放大器32s、放大器33s、加法器34s。

积分器31s计算积分值Ss。放大器32s是放大速度偏差ωs-ωs’的比例增 益Kp’的放大器。放大器33s是放大上述预先决定的值的积分增益Ki’的放大 器。

加法器34s具备从放大器32s输入速度偏差ωs-ωs’和比例增益Kp’的积的 第一输入端子、从放大器33s输入上述预先决定的值和积分增益Ki’的积的第 二输入端子、输出作为它们的积的和的转矩指令值Ts的输出端子。

进而,如图2所示,积分值选择部28具备判定部28a、开关28b。判定部 28a从加速度计算部27输入加速度a。判定部28a根据加速度a判定电动机控 制装置12是主要驱动主电动机6m的状态、还是主要驱动子电动机6s的状态。 另外,判定部28a向开关28b发出与判定对应的指令。开关28b依照来自判定 部28a的指令,将积分器31m的输出部和积分器31s的输出部中的任意一方 与放大器33m的输入部和放大器33s的输入部连接。

更具体地说,在设定电动机控制装置12为主要驱动主电动机6m的状态 后、或加速度a变得比作为比零大的第一值的阈值Th(Th>0)大之后,在加 速度a是维持在比作为比零小的第二值的阈值Th’(Th`<0)大的值的状态时, 判定部28a判定电动机控制装置12是主要驱动主电动机6m的状态。与此相 对,在设定电动机控制装置12为主要驱动子电动机6s的状态后、或加速度a 变得比阈值Th’小后,在加速度a是维持在比阈值Th小的值的状态时,判定 部28a判定电动机控制装置12是主要驱动子电动机6s的状态。在此,可以将 阈值Th设为与阈值Th’的绝对值相同。另外,通过使用2个阈值Th、Th’,能 够防止触点抖动。

在判定电动机控制装置12是主要驱动主电动机6m的状态的情况下,判 定部28a控制开关28b使得将积分器31m的输出部与放大器33m的输入部和 放大器33s的输入部连接。因此,积分值选择部28选择积分值Sm作为上述 预先决定的值,因此速度控制部24m输出速度偏差ωm-ωm’和比例增益Kp 的积、以及积分值Sm和积分增益Ki的积的和即转矩指令值Tm,速度控制部 24s输出速度偏差ωs-ωs’和比例增益Kp’的积、以及积分值Sm和积分增益 Ki’的积的和即转矩指令值Ts。

与此相对,在判定电动机控制装置12是主要驱动子电动机6s的状态的情 况下,判定部28a控制开关28b使得将积分器31s的输出部与放大器33m的 输入部和放大器33s的输入部连接。因此,积分值选择部28选择积分值Ss作 为上述预先决定的值,因此速度控制部24m输出速度偏差ωm-ωm’和比例增 益Kp的积、以及积分值Ss和积分增益Ki的积的和即转矩指令值Tm,速度 控制部24s输出速度偏差ωs-ωs’和比例增益Kp’的积、以及积分值Ss和积分 增益Ki’的积的和即转矩指令值Ts。

上位控制装置13由CNC(数值控制装置)等构成,向减法器21m和加速 度计算部27输出位置指令值θm,向减法器21s输出位置指令值θs,向预载 荷转矩值生成部26输出用于生成预载荷转矩值+Pr、-Pr的励磁信号Se。

在本实施方式中,电动机控制装置12由具备输入输出端口、串行通信电 路、A/D变换器、比较器等的处理器来实现,依照存储在未图示的存储器中的 处理程序执行各种处理。

图3是图1所示的电动机控制装置的动作的流程图。首先,加速度计算部 27计算加速度a,向判定部28a输出计算出的加速度a(步骤S1)。然后,判 定部28a判断计算出的加速度a是否小于阈值Th’(步骤S2)。在加速度a小 于阈值Th’的情况下,判定部28a为了选择积分值Ss作为上述预先决定的值, 控制开关28b使得将积分器31s的输出部与放大器33m的输入部和放大器33s 的输入部连接(步骤S3),结束处理流程。

与此相对,在加速度a为阈值Th’以上的情况下,判定部28a判断计算出 的加速度a是否大于阈值Th(步骤S4)。在加速度a比阈值Th大的情况下, 判定部28a为了选择积分值Sm作为上述预先决定的值,控制开关28b使得将 积分器31m的输出部与放大器33m的输入部和放大器33s的输入部连接(步 骤S5),结束处理流程。与此相对,在加速度a为阈值Th以下的情况下,结 束处理流程。

图4是表示由图1所示的电动机控制装置进行控制的电动机的加速度的时 间变化的一个例子的图。在使用图4说明的动作中,判定部28a为了在作为动 作开始时的时间t0,设定电动机控制装置12为主要驱动主电动机6m的状态, 选择积分值Ss作为上述预先决定的值。

在图4中,从时间t0到时间t1为止的期间,加速度a线性地从零增加到 a1(a1>Th)。从时间t1到时间t2为止的期间,加速度a线性地从a1减少到 a2(a2<a1)。从时间t2到时间t3为止的期间,加速度a维持为a2(主电动机 6m的速度恒定)。从时间t3到时间t4为止的期间,加速度a线性地从a2减 少到阈值Th’。即,从时间t0到时间t4为止的期间是在设定电动机控制装置 12为主要驱动主电动机6m的状态后加速度a维持为比阈值Th’大的值的状态。 因此,判定部28a判定在从时间t0到时间t4为止的期间电动机控制装置12 为主要驱动主电动机6m的状态,选择积分值Ss作为上述预先决定的值。

另外,在图4中,从时间t4到时间t5为止的期间,加速度a线性地从阈 值Th’减少到a3(a3<Th’)。从时间t5到时间t6为止的期间,加速度从a3线 性地增加到零。即,从时间t4到时间t6为止的期间是在加速度a变得比阈值 Th’小后加速度a维持为比阈值Th小的值的状态。因此,判定部28判定在从 时间t4到时间t6为止的期间电动机控制装置1为2主要驱动子电动机6s的状 态,选择积分值Ss作为上述预先决定的值。

另外,在图4中,从时间t6到时间t7为止的期间,加速度a维持为零(主 电动机6m停止)。从时间t7到时间t8为止的期间,加速度a线性地从零减 少到a4(a4<a3)。从时间t8到时间t9为止的期间,加速度a线性地从a4增 加到a5(Th’<a5<0)。从时间t9到时间t10为止的期间,加速度a维持为a5 (主电动机6m的速度恒定)。从时间t10到时间t11为止的期间,加速度a 线性地从a5增加到阈值Th。即,从时间t6到时间t11为止的期间是在设定电 动机控制装置12为主要驱动子电动机6s的状态后加速度a维持为比阈值Th 小的值的状态。因此,判定部28a判定在从时间t6到时间t11为止的期间中电 动机控制装置12为主要驱动子电动机6s的状态,选择积分值Ss作为上述预 先决定的值。

进而,从时间t11到时间t12为止的期间,加速度a线性地从阈值Th增加 到a6(Th<a6<a1),从时间t12到时间t13为止的期间,加速度a线性地从a1 减少到零。即,从时间t11到时间t13为止的期间是在加速度a变得比阈值Th 大后维持为比阈值Th’大的值的状态。因此,判定部28a判定在从时间t11到 时间t13为止的期间电动机控制装置12为主要驱动主电动机6m的状态,选择 积分值Sm作为上述预先决定的值。

图5A~图5D是用于说明本发明的电动机控制装置的效果的图。在图5A 中,用实线α、β分别表示在生成了预载荷转矩值+Pr、-Pr的条件下,与电动 机控制装置12是主要驱动主电动机6m的状态、还是主要驱动子电动机6s的 状态无关而选择了积分值Sm的情况下所产生的电流指令值Im和电流指令值 Is的时间变化。另外,在图5B中,用实线γ表示与分别用实线α、β表示的 电流指令值Im和电流指令值Is对应的位置偏差θs-θm’。

在图5C中,用实线α’、β’分别表示在生成了预载荷转矩值+Pr、-Pr的 条件下,在电动机控制装置12为主要驱动主电动机6m的状态时选择积分值 Sm,并且在电动机控制装置12为主要驱动子电动机6s的状态时选择积分值 Ss的情况下产生的电流指令值Im和电流指令值Is的时间变化。另外,在图 5D中,用实线γ’表示与分别用实线α’、β’表示的电流指令值Im和电流指令 值Is对应的位置偏差θs-θm’。

与在生成了预载荷转矩值+Pr、-Pr的条件下,与电动机控制装置12是主 要驱动主电动机6m的状态、还是主要驱动子电动机6s的状态无关地选择了 积分值Sm的情况相比,如用实线γ、γ`所示那样,在生成了预载荷转矩值 +Pr、-Pr的条件下,在电动机控制装置12是主要驱动主电动机6m的状态时 选择积分值Sm,并且在电动机控制装置12是主要驱动子电动机6s的状态时 选择积分值Ss的情况下的位置偏差θs-θx的变动大幅减少。

因此,在生成了预载荷转矩值+Pr、-Pr的条件下,在电动机控制装置12 是主要驱动主电动机6m的状态时选择积分值Sm,并且在电动机控制装置12 是主要驱动子电动机6s的状态时选择积分值Ss的情况下,能够避免因位置偏 差θs-θx变大造成的对主电动机6m和子电动机6s的控制的坏影响。

根据本实施方式,积分值选择部28根据主电动机6m的驱动状态和子电 动机6s的驱动状态,选择积分值Sm和积分值Ss中的任意一方作为上述预先 决定的值。即,积分值选择部28在加速度a变得比阈值Th大时(主要驱动主 电动机6m的状态),选择积分值Sm作为上述预先决定的值,在加速度a变 得比阈值Th’小时(主要驱动子电动机6s的状态),选择积分值Ss作为上述 预先决定的值。通过这样选择积分值Sm和积分值Ss中的任意一方作为上述 预先决定的值,在驱动主电动机6m和子电动机6s时主要被驱动的电动机是 主电动机6m和子电动机6s的任意一个,都能够避免由于位置偏差θs-θx变 大造成的对主电动机6m和子电动机6s的控制的坏影响。

图6是详细地表示图1的积分值选择部和速度控制部的其他例子的图。如 图6所示,积分值选择部28具备判定部28a。判定部28a从加速度计算部27 输入加速度a,根据加速度a判定电动机控制装置12是主要驱动主电动机6m 的状态、还是主要驱动子电动机6s的状态。

在判定电动机控制装置12是主要驱动主电动机6m的状态的情况下,判 定部28a将由积分器31s计算出的积分值Ss改写为由积分器31m计算出的积 分值Sm。另外,代替积分值Ss,积分器31s向放大器33s输出积分值Sm。 因此,积分值选择部28选择积分值Sm作为上述预先决定的值,因此速度控 制部24m输出速度偏差ωm-ωm’和比例增益Kp的积、以及积分值Sm和积 分增益Ki的积的和即转矩指令值Tm,速度控制部24s输出速度偏差ωs-ωs’ 和比例增益Kp’的积、以及积分值Sm和积分增益Ki’的积的和即转矩指令值 Ts。

与此相对,在判定电动机控制装置12是主要驱动子电动机6s的状态的情 况下,判定部28a将由积分器31m计算出的积分值Sm改写为由积分器31s 计算出的积分值Ss。另外,代替积分值Sm,积分器31m向放大器33m输出 积分值Ss。因此,积分值选择部28选择积分值Ss作为上述预先决定的值, 因此速度控制部24m输出速度偏差ωm-ωm’和比例增益Kp的积、以及积分 值Ss和积分增益Ki的积的和即转矩指令值Tm,速度控制部24s输出速度偏 差ωs-ωs’和比例增益Kp’的积、以及积分值Ss和积分增益Ki’的积的和即转 矩指令值Ts。

本发明并不限于上述实施方式,能够进行若干变更和变形。例如,在上述 实施方式中,使用了机械的位置θx作为与第一电动机关联的位置信息和与第 二电动机关联的位置信息,但也可以使用主电动机6m的旋转角度θm’和子电 动机6s的旋转角度θs’作为与第一电动机关联的位置信息和与第二电动机关 联的位置信息。

另外,在上述实施方式中,说明了为了求出子电动机6s的位置偏差而使 用机械的位置θx的情况,但也可以为了求出子电动机6s的位置偏差而使用 子电动机6s的旋转角度θs’。

另外,在上述实施方式中,通过用时间对位置指令值θm进行二阶微分来 计算作为第一电动机的加速度的加速度a,但也可以通过用时间对旋转角度θ m’进行二阶微分来计算加速度a,通过用时间对旋转角度θs’进行二阶微分来 计算加速度a,或者将通过用时间对旋转角度θm’进行二阶微分计算出的值和 用时间对旋转角度θs’进行二阶微分计算出的值的和除以2来计算加速度a。

进而,在上述实施方式中,说明了设置预载荷转矩值生成部26的情况, 但也可以省略预载荷转矩值生成部26。

根据本发明,能够提供一种电动机控制装置,其在驱动2个电动机时主要 被驱动的电动机是哪一个电动机,都能够避免由于位置偏差增大而对电动机的 控制产生的坏影响。

去获取专利,查看全文>

相似文献

  • 专利
  • 中文文献
  • 外文文献
获取专利

客服邮箱:kefu@zhangqiaokeyan.com

京公网安备:11010802029741号 ICP备案号:京ICP备15016152号-6 六维联合信息科技 (北京) 有限公司©版权所有
  • 客服微信

  • 服务号