伺服电动机控制装置制造方法及图纸

本发明专利技术提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。伺服电动机控制装置具备：伺服电动机；被驱动体，其由伺服电动机进行驱动，作用于驱动轴的负荷根据被驱动体的位置而发生变动；位置检测部，其检测被驱动体的位置(FB)；速度检测部，其检测被驱动体的速度(FB)；以及电动机控制部，其控制伺服电动，电动机控制部具有：位置控制部，其根据被驱动体的位置指令与位置(FB)之间的位置偏差来生成速度指令；速度控制部，其将速度增益乘以速度指令与速度(FB)之间的速度偏差，和/或加上转矩补偿并生成转矩指令；以及变更部，其根据被驱动体的位置来变更速度增益与转矩补偿中的至少一个。

Servo Motor Control Device

The present invention provides a servo motor control device for suppressing the decrease of responsiveness caused by the change of load acting on the drive shaft of the driven body. Servo motor control device has: servo motor; driven body, which is driven by servo motor, the load acting on the driving shaft changes according to the position of the driven body; position detection unit, which detects the position of the driven body (FB); speed detection unit, which detects the speed of the driven body (FB); and motor control unit, which controls servo motor, motor. The control unit has: a position control unit, which generates speed instructions according to the position deviation between the position instruction and the position (FB) of the driven body; a speed control unit, which multiplies the speed gain by the velocity deviation between the speed instruction and the speed (FB), and/or adds a torque compensation and generates a torque instruction; and a change unit, which changes the speed gain and the torque according to the position of the driven body. At least one of the compensations.

【技术实现步骤摘要】
伺服电动机控制装置
本专利技术涉及一种控制用于驱动被驱动体的伺服电动机的伺服电动机控制装置。
技术介绍
例如在机床中，会使用进给机构使包括用于驱动工具的主轴用电动机的主轴单元进行移动。已知一种伺服电动机控制装置(例如参照专利文献1～3)，控制用于驱动这种进给机构(被驱动体)的伺服电动机。专利文献1：日本特开2002-178237号公报专利文献2：日本特开平06-155217号公报专利文献3：国际公开第2016/135958号
技术实现思路
在上述机床中，通过重力、旋转而作用于进给机构的驱动轴上的负荷(负载)会根据进给机构(被驱动体)的位置(即主轴单元的位置)而发生变化。例如，如果作用于驱动轴的负荷增加，则进给机构到达目标位置的时间变迟。即，伺服电动机控制装置的响应性下降。本专利技术的目的为提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。(1)本专利技术的伺服电动机控制装置(例如后述的伺服电动机控制装置1)具备：伺服电动机(例如后述的伺服电动机400)；被驱动体(例如后述的倾斜机构500)，其由上述伺服电动机进行驱动，作用于驱动轴(例如后述的倾斜轴X)的负荷根据上述被驱动体的位置而发生变动；位置检测部(例如后述的编码器300)，其检测上述被驱动体的位置；速度检测部(例如后述的编码器300)，其检测上述被驱动体的速度；以及电动机控制部(例如后述的电动机控制部100)，其控制上述伺服电动机，上述电动机控制部具有：位置控制部(例如后述的位置控制部20)，其根据上述被驱动体的位置指令与通过上述位置检测部检测出的位置反馈之间的位置偏差来生成速度指令；速度控制部(例如后述的速度控制部30)，其将速度增益乘以通过上述位置控制部生成的速度指令与通过上述速度检测部检测出的速度反馈之间的速度偏差，和/或加上转矩补偿来生成转矩指令；以及变更部(例如后述的变更部60)，其根据上述被驱动体的位置来变更上述速度增益与上述转矩补偿中的至少一个。(2)在(1)记载的伺服电动机控制装置中，上述变更部可以使用通过上述位置检测部检测出的位置反馈作为上述被驱动体的位置。(3)在(1)记载的伺服电动机控制装置中，上述变更部可以使用上述被驱动体的位置指令作为上述被驱动体的位置。(4)在(1)～(3)中任意一项记载的伺服电动机控制装置中，上述被驱动体由上述伺服电动机进行旋转驱动，上述变更部可以使用上述被驱动体的旋转角度作为上述被驱动体的位置。(5)在(1)～(4)中任意一项记载的伺服电动机控制装置中，上述被驱动体可以包括主轴单元(例如后述的主轴单元510)，该主轴单元包括用于驱动机床的工具的主轴用电动机。根据本专利技术，能够提供一种抑制由于作用于被驱动体的驱动轴上的负荷的变动引起的响应性的下降的伺服电动机控制装置。附图说明图1表示本实施方式的伺服电动机控制装置的结构。图2表示图1所示的电动机控制部的结构。图3表示存储在存储部中的函数(数据表)的一例。附图标记的说明1：伺服电动机控制装置、10：位置指令部、20：位置控制部、21：减法器、22：位置控制部、30：速度控制部、31：减法器、32：速度控制器、33：加法器、40：电流控制部、41：减法器、42：电流控制器、50：存储部、60：变更部、100：电动机控制部、200：电流检测器(电流检测部)、300：编码器(位置检测部、速度检测部)、400：伺服电动机、500：倾斜机构(被驱动体)、510：主轴单元、501：基材、502：臂。具体实施方式以下，根据附图说明本专利技术的实施方式的一例。另外，在各个附图中对相同或相当的部分标注相同的符号。(第一实施方式)图1表示本实施方式的伺服电动机控制装置的结构。图1所示的伺服电动机控制装置1具备电动机控制部100、电流检测器200、编码器(位置检测部、速度检测部)300、伺服电动机400以及倾斜机构500。电动机控制部100控制用于驱动倾斜机构(被驱动体)500的伺服电动机400，该倾斜机构500包括机床的主轴单元510。后面详细描述电动机控制部100。电流检测器200例如是电流互感器。电流检测器200检测伺服电动机400的驱动电流。检测出的电流用作电流反馈(电流FB)。编码器300设置在伺服电动机400上，检测伺服电动机400的旋转位置。伺服电动机400的旋转位置与倾斜机构500的位置对应，所以编码器300检测倾斜机构500的位置(机器坐标，换言之是倾斜角度(旋转角度))。检测出的位置用作位置反馈(位置FB)。另外，编码器300检测伺服电动机400的转速。伺服电动机400的转速与倾斜结构500的速度对应，所以编码器300检测倾斜机构500的速度。检测出的速度用作速度反馈(速度FB)。倾斜结构500由伺服电动机400进行旋转驱动，使包括用于驱动机床的工具的主轴用电动机的主轴单元510倾斜。倾斜结构500例如由安装了机床的主轴单元510的基材501、在一端侧支撑基材501且在另一端侧具有倾斜轴(旋转轴)X的臂502构成。这样，倾斜结构500具有相对于倾斜轴X非对称的结构。接着，参照图2说明电动机控制部100。图2表示图1所示的电动机控制部100的结构。电动机控制部100具备位置指令部10、位置控制部20、速度控制部30、电流控制部40、存储部50以及变更部60。位置指令部10根据从未图示的上位控制装置、外部输入装置等输入的程序、命令来生成伺服电动机400的位置指令，即倾斜机构500的位置指令。位置控制部20根据通过位置指令部10生成的位置指令和通过编码器300检测出的位置FB来生成速度指令。位置控制部20具备减法器21和位置控制器22。减法器21求出通过位置指令部10生成的位置指令和通过编码器300检测出的位置FB之间的位置偏差。位置控制器22将位置增益与通过减法器21求出的位置偏差相乘来生成速度指令。速度控制部30根据通过位置控制部20生成的速度指令、通过编码器300检测出的速度FB、来自变更部60的速度增益以及转矩补偿来生成转矩指令。速度控制部30具备减法器31、速度控制器32、加法器33。减法器31求出通过位置控制部20生成的速度指令与通过编码器300检测出的速度FB之间的速度偏差。速度控制器32将变更部60的速度增益与通过减法器31求出的速度偏差相乘。加法器33将来自变更部60的转矩补偿与通过速度控制器32进行乘法运算而得的值相加，生成转矩指令。另外，速度控制部30可以不具备加法器33，而根据速度指令、速度FB以及速度增益来生成转矩指令。电流控制部40根据通过速度控制部30生成的转矩指令和通过电流检测器200检测出的电流FB来生成伺服电动机400的驱动电流。电流控制部40具备减法器41和电流控制器42。减法器41生成通过速度控制部30生成的转矩指令和通过电流检测器200检测出的电流FB之间的转矩偏差。电流控制器42将转矩增益与通过减法器41求出的转矩偏差相乘，生成驱动电流。所生成的驱动电流被提供给伺服电动机400。存储部50存储预定的速度增益(固定值)以及预定的转矩补偿(固定值)。另外，存储部50存储用于变更预定的速度增益的倍率(Override)。具体地说，如图3所示，存储部50存储将位置FB(倾斜机构500的位置)作本文档来自技高网...

【技术保护点】
1.一种伺服电动机控制装置，其特征在于，该伺服电动机控制装置具备：伺服电动机；被驱动体，其由上述伺服电动机进行驱动，作用于驱动轴的负荷根据上述被驱动体的位置而发生变动；位置检测部，其检测上述被驱动体的位置；速度检测部，其检测上述被驱动体的速度；以及电动机控制部，其控制上述伺服电动机，上述电动机控制部具有：位置控制部，其根据上述被驱动体的位置指令与通过上述位置检测部检测出的位置反馈之间的位置偏差来生成速度指令；速度控制部，其将速度增益乘以通过上述位置控制部生成的速度指令与通过上述速度检测部检测出的速度反馈之间的速度偏差，和/或加上转矩补偿来生成转矩指令；以及变更部，其根据上述被驱动体的位置来变更上述速度增益与上述转矩补偿中的至少一个。

【技术特征摘要】
2017.07.19 JP 2017-1398111.一种伺服电动机控制装置，其特征在于，该伺服电动机控制装置具备：伺服电动机；被驱动体，其由上述伺服电动机进行驱动，作用于驱动轴的负荷根据上述被驱动体的位置而发生变动；位置检测部，其检测上述被驱动体的位置；速度检测部，其检测上述被驱动体的速度；以及电动机控制部，其控制上述伺服电动机，上述电动机控制部具有：位置控制部，其根据上述被驱动体的位置指令与通过上述位置检测部检测出的位置反馈之间的位置偏差来生成速度指令；速度控制部，其将速度增益乘以通过上述位置控制部生成的速度指令与通过上述速度检测部检测出的速度反馈之间的速度偏差，和/或加上转矩补偿来生成转...

【专利技术属性】
技术研发人员：熊本裕树，猪饲聪史，
申请(专利权)人：发那科株式会社，
类型：发明
国别省市：日本,JP