WO2012164740A1 - 多軸モータ駆動システム及び多軸モータ駆動装置 - Google Patents

多軸モータ駆動システム及び多軸モータ駆動装置 Download PDF

Info

Publication number
WO2012164740A1
WO2012164740A1 PCT/JP2011/062791 JP2011062791W WO2012164740A1 WO 2012164740 A1 WO2012164740 A1 WO 2012164740A1 JP 2011062791 W JP2011062791 W JP 2011062791W WO 2012164740 A1 WO2012164740 A1 WO 2012164740A1
Authority
WO
WIPO (PCT)
Prior art keywords
motor
detection position
axis motor
detector
axis
Prior art date
Application number
PCT/JP2011/062791
Other languages
English (en)
French (fr)
Inventor
勇 松村
Original Assignee
株式会社安川電機
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by 株式会社安川電機 filed Critical 株式会社安川電機
Priority to PCT/JP2011/062791 priority Critical patent/WO2012164740A1/ja
Priority to CN201180071279.7A priority patent/CN103563238B/zh
Priority to DE112011105306.1T priority patent/DE112011105306T5/de
Priority to JP2012554556A priority patent/JP5622125B2/ja
Publication of WO2012164740A1 publication Critical patent/WO2012164740A1/ja
Priority to US14/093,537 priority patent/US9069346B2/en

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B11/00—Automatic controllers
    • G05B11/01—Automatic controllers electric
    • G05B11/32—Automatic controllers electric with inputs from more than one sensing element; with outputs to more than one correcting element
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D3/00—Control of position or direction
    • G05D3/12—Control of position or direction using feedback
    • G05D3/20—Control of position or direction using feedback using a digital comparing device
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P23/00—Arrangements or methods for the control of AC motors characterised by a control method other than vector control
    • H02P23/18—Controlling the angular speed together with angular position or phase
    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P5/00—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors
    • H02P5/46—Arrangements specially adapted for regulating or controlling the speed or torque of two or more electric motors for speed regulation of two or more dynamo-electric motors in relation to one another

Definitions

  • Embodiments disclosed herein relate to a multi-axis motor drive system for driving a plurality of encoder-equipped motors and a multi-axis motor drive device provided therein.
  • Patent Document 1 describes a full closed loop position control servo driver capable of detecting a signal of a load side position detector and performing full closed loop control.
  • This fully closed loop position control servo driver includes a servomotor having at least a rotary encoder, a position control driver for controlling the servomotor, a controller and a linear scale, and position detection signals from the linear scale and speed detection from the rotary encoder A signal is fed back to the position control driver to perform positioning control, and after the positioning is completed, the position control driver outputs a positioning completion signal to the controller.
  • the present invention has been made in view of such problems, and an object of the present invention is to provide a multi-axis motor drive system and a multi-axis motor drive device capable of facilitating setup. is there.
  • a plurality of motors provided with at least a first detector for detecting a position, a host control device for outputting a motor control command, and the motor control command And a multi-axis motor drive device for driving the plurality of motors, and at least one second detector for detecting a position on the load side of the motor, wherein the multi-axis motor drive device controls the motor Based on a first drive shaft performing semi-closed control based on a command and a first detection position by the first detector, and based on the motor control command and the first detection position and a second detection position by the second detector A second drive shaft performing full-closed control is determined based on the amount of change in the first detection position or the second detection position when the motor in the second drive shaft is driven.
  • Multi-axis motor driving system having a control unit is applied.
  • setup can be facilitated.
  • FIG. 18 is a system configuration diagram conceptually showing a configuration of a multi-axis motor drive system in a modification in which the multi-axis motor drive system has a gantry axis. It is a flowchart showing the control content which an integrated control part performs at the time of setup in the modification which a multi-axis motor drive system has a gantry axis.
  • the multi-axis motor drive system 1 of this embodiment includes a plurality of (seven in this example, but only three are shown, and the rest is not shown) rotary motor 100 and motor control.
  • the host controller 200 outputs a command
  • the multi-axis motor drive device 300 drives each motor 100 based on a motor control command of the host controller 200.
  • Each motor 100 detects the brake 101 and the speed (angular velocity) or position (angle) of the rotating shaft, and outputs the detection signal as a feedback pulse to the multi-axis motor drive device 300 (first detector And. Note that the motor may not have the brake 101.
  • the detection position by the encoder 102 corresponds to an example of the first detection position described in the claims.
  • the multi-axis motor drive device 300 supports the power supply unit 301 to which alternating current power is input, the general control unit 302 that controls communication control with the host control device 200 and the entire multi-axis motor drive device 300, and each motor 100 And a plurality of (in this example, eight) drive units 303 that drive the motor 100 by supplying electric power to the motor 100, and axis control units 304 that control the plurality of drive units 303.
  • the overall control unit 302 corresponds to an example of a control unit described in the claims.
  • first to eighth driving units 303 are appropriately referred to as first to eighth driving units 303, and motors corresponding to the first to eighth driving units 303 are referred to as first to eighth motors 100.
  • first to eighth motors 100 motors corresponding to the first to eighth driving units 303 are referred to as first to eighth motors 100.
  • seven first to eighth motors 100 are provided corresponding to the seven driving units 303 other than the third driving unit 303.
  • the fourth to seventh motors 100 are not shown in FIG.
  • the multi-axis motor drive system 1 further includes a linear scale 400 (second detector) that detects the position on the load side of the motor 100.
  • a linear scale 400 (second detector) that detects the position on the load side of the motor 100.
  • one linear scale 400 for detecting the position of a load machine (for example, a stage moved by a ball screw) of the eighth motor 100 is provided.
  • the linear scale 400 outputs a position detection signal to the multi-axis motor drive device 300 as a feedback signal (for example, a pulse signal, an analog signal, etc.).
  • the detection position by the linear scale 400 corresponds to an example of the second detection position described in the claims.
  • the multi-axis motor drive device 300 has a relay unit 310 that relays the detection position by the encoder 102 and the linear scale 400 to the general control unit 302.
  • the relay portion 310 is configured of a substrate, a module or the like, and is integrally provided in the multi-axis motor drive device 300.
  • the relay unit 310 may be configured separately from the multi-axis motor drive device 300.
  • the relay unit 310 includes a plurality of (eight in this example) connectors 311 to which the wiring from the encoder 102 and the wiring from the linear scale 400 are connected, and correspond to the first to eighth driving units 303, respectively. doing.
  • the connectors 311 corresponding to the first to eighth driving units 303 will be referred to as first to eighth connectors 311, respectively.
  • the wiring from the encoder 102 and the wiring from the linear scale 400 may be directly connected to the general control unit 302 without the relay unit 310.
  • the wires from the encoders 102 of the first and second motors 100 are connected to the first and second connectors 311, respectively, and the wires from the encoders 102 of the fourth to eighth motors 100 are each fourth To the eighth connector 311.
  • the wiring from the linear scale 400 is connected to the third connector 311 corresponding to the third drive unit 303 in which the corresponding motor 100 is not provided.
  • relay unit 310 it is possible to arbitrarily set the connection connector position of the wiring from linear scale 400.
  • the wiring from the linear scale 400 is connected to the third connector 311 in the example shown in FIG. 1, when the connector position is changed to, for example, the seventh connector 311, seven drives other than the seventh driving unit 303
  • the seven first to eighth motors 100 (excluding the seventh motor 100) are connected to the section 303, and the wiring from the encoder 102 of these motors 100 is connected to the first to eighth connectors 311 (seventh connector 311).
  • the detection signal of each encoder 102 and the detection signal of the linear scale 400 are input to the general control unit 302 via the relay unit 310.
  • the overall control unit 302 performs full-closed control using position feedback from the linear scale 400 for the eighth motor 100 that detects the position on the load side with the linear scale 400 based on the detection signal from the relay unit 310.
  • semi-closed control using position feedback from the encoder 102 is performed.
  • the eighth motor 100 including the brake 101 and the encoder 102
  • the drive shaft of a load machine driven using the eighth motor 100, and the linear scale 400 are the second drive shaft according to the claims.
  • the drive shaft of the load machine driven using the motor 100 other than the eighth motor 100 and the motor 100 corresponds to an example of the first drive shaft.
  • An engineering tool 500 is connected to the multi-axis motor drive device 300.
  • the engineering tool 500 is configured of, for example, a portable handy controller or the like, and a worker can input various commands, data, and the like.
  • the general control unit 302 starts the flow shown in FIG. 2 when, for example, the multi-axis motor drive device 300 is powered on.
  • motor wiring for each motor 100 (wiring between each drive unit 303 and each motor 100), wiring for the brake 101, and wiring for the encoder 102 (wiring between the encoder 102 and the relay unit 310)
  • the wiring of the linear scale 400 (the wiring between the linear scale 400 and the relay unit 310) is assumed to be correctly made by the operator.
  • the engineering tool 500 is connected to the multi-axis motor drive device 300 in advance, and the power is assumed to be turned on.
  • step S20 in accordance with the selection signal from engineering tool 500, general control unit 302 selects motor 100 in the full-closed control target from among the plurality of motors 100 connected to multi-axis motor drive device 300. .
  • the motor performing the fully closed control is the eighth motor 100.
  • the selection signal is manually input by the operator via the engineering tool 500.
  • the rotation direction of the selected motor 100 may be set together with the motor control command (for example, the position command direction) of the host control device 200 as necessary.
  • the general control unit 302 releases the brakes 101 of each motor 100, and then energizes the motor 100 selected in the above step S20 via the axis control unit 304 and the drive unit 303 to perform servo-on. It will be in the state. Further, based on the detection signal from the relay unit 310 at this time, the detection positions of all the encoders 102 connected to the connector 311 of the relay unit 310 and the detection position of the linear scale 400 are predetermined storage units as initial positions ( Store in memory etc.) In the example shown in FIG. 1, since the motor performing the fully closed control is the eighth motor 100, the general control unit 302 energizes the eighth motor 100 to bring it into a servo-on state.
  • the servo-on state indicates the positioning control state where the drive amount is zero, that is, the motor 100 selected in step S20 is locked at the position at the start of energization.
  • the general control unit 302 outputs a position command of a predetermined drive amount to each axis control unit 304, and the motor 100 selected in step S20 through the drive unit 303 is set to a predetermined amount (for example, 1). / 4 rotation to 1 rotation) drive.
  • the general control unit 302 sets parameters for full closed control.
  • the overall control unit 302 is a relay unit in which the detection position has changed by a predetermined amount based on a detection signal from the relay unit 310 when the motor 100 in the full-closed control target is driven by a predetermined amount in step S40.
  • the position of the connector 310 is identified, and the connector 311 is determined to be a connector to which the wiring from the linear scale 400 is connected. That is, in the example shown in FIG. 1, the third connector 311 is determined to be a connector to which the wiring from the linear scale 400 is connected.
  • the general control unit 302 detects the position detected by the linear scale 400 when the motor 100 in the fully closed loop control target is driven by a predetermined amount in step S40 and the corresponding encoder 102 (eighth in the example shown in FIG. Based on the position detected by the encoder 102) of the motor 100, the correspondence between the rotational direction of the motor 100 (eighth motor 100 in the example shown in FIG. 1) and the moving direction of the load machine is set.
  • the general control unit 302 sets the movement amount LSP by the linear scale 400 and the movement amount EP by the encoder 102 when the motor 100 in the full-closed control target is driven by a predetermined amount in step S40 and the initial position stored in step S30.
  • the number of pulses LSPo of the linear scale 400 per unit drive amount (for example, one rotation) of the motor 100 is calculated using the movement amount LSP and the movement amount EP. Is set based on the following equation (1).
  • LSPo EPo ⁇ (LSP / EP) (Equation 1)
  • EPo Number of encoder pulses per motor unit drive amount (pulse / unit drive amount)
  • LSP Linear scale movement amount (pulse)
  • EP Encoder travel (pulse)
  • the EPo is stored in advance in a predetermined storage unit (such as a memory) or manually input via the engineering tool 500.
  • the general control unit 302 adds 1 to the variable i.
  • the general control unit 302 executes a procedure shown in the flowchart to drive a drive shaft (first drive shaft) using the motor 100 performing semi-closed control and a drive shaft using a motor 100 performing full-closed control (second Discrimination with the drive shaft).
  • “determination of the first drive shaft and the second drive shaft” refers to the output of each axis of the multi-axis motor drive device 300 (the output of each drive unit 303) and the connection to each motor 100, and each axis motor 100 And determining the consistency between the encoder output of the relay unit 310 and the connection to each connector 311 of the relay unit 310.
  • the general control unit 302 first selects the motor 100 in the full-closed control target in response to the selection signal from the engineering tool 500 (step S20), and performs connection to the motor 100 performing the full-closed control The connection of the output to the relay unit connector 311 is recognized. Thereafter, the motor 100 is driven by a predetermined amount (step S40), and it is determined to which connector 311 of the relay unit 310 the position detection signal of the linear scale 400 for detecting the load side position of the motor 100 is input. (Step S50). At this time, the relay unit that monitors the change amount of the position detection signal (first detection position or second detection position) input to the relay unit connector 311 and obtains the change amount according to the predetermined amount driving of the motor 100.
  • the position detection signal input to the connector 311 is set as the position detection signal (second detection position) of the linear scale 400, and the connector 311 to which the wiring from the linear scale 400 is connected is specified (step S50). Also, if there are a plurality of motors 100 that perform full-closed control, the above is repeated, and the other connector 311 to which the wiring from the other linear scale 400 is connected is specified. Thereby, the general control unit 302 completes the determination of the drive shaft (second drive shaft) using the motor 100 that performs full-closed control. Further, the general control unit 302 determines a drive shaft (first drive shaft) using the motor 100 performing semi-closed control, except for the drive shaft (second drive shaft) using the motor 100 performing full-closed control.
  • the drive shaft using the eighth motor 100 and the eighth connector 311 and the third connector 311 of the relay unit 310 is the drive shaft that performs full closed control, and the first to seventh motors It is determined that the drive shaft 100 (excluding the third motor 100) and the first to seventh connectors 311 (excluding the third connector 311) of the relay unit 310 are drive shafts performing the semi-closed control.
  • the general control unit 302 of the multi-axis motor drive device 300 performs the drive shaft using the motor 100 performing the semi-closed control and the motor 100 performing the fully closed control. Is automatically determined based on the amount of change in the detection position by the encoder 102 or the detection position by the linear scale 400 when the motor 100 performing full-closed control is driven. As a result, it is not necessary to set information such as which motor 100 is used for full closed control and which motor 100 is used for semi closed control at the time of setup. It can be easy.
  • the multi-axis motor drive device 300 having the relay portion 310 achieves the following effects. That is, at the time of setup of the multi-axis motor drive system 1, motor wiring for each motor 100 (wiring between each driving unit 303 and each motor 100), wiring of the brake 101 and encoder 102 (brake 101 and encoder 102, Wiring between the relay portions 310) and wiring of the linear scale 400 (wiring between the linear scale 400 and the relay portions 310) are performed. At this time, if it is assumed that the wiring of the linear scale 400 can be connected only to the specific connector 311 in the relay unit 310, it is necessary to check which connector the specific connector 311 is.
  • the connecting connector position of the wiring from the linear scale 400 can be arbitrarily set in the relay unit 310.
  • the confirmation work of the specific connector 311 as described above becomes unnecessary, and since the connection connector position can be flexibly changed according to the device arrangement and the like, the operation of changing the device arrangement and the like is also unnecessary. Thus, setup can be facilitated.
  • the motor 100 is not connected to the drive unit 303 corresponding to the connector 311 to which the wiring of the linear scale 400 is connected, and each motor 100 and the encoder 102 correspond to each other. It is necessary to check whether each connector 311 is connected.
  • the wire from the linear scale 400 is connected to an arbitrary connector 311 of the relay unit 310, it is necessary to specify the position of the connection connector.
  • the general control unit 302 of the multi-axis motor drive device 300 drives the motor 100 in the full-closed control target by a predetermined amount, and identifies the connector position where the detection position has changed by a predetermined amount. It can be automatically determined to which connector 311 of the part 310 the wiring from the linear scale 400 is connected (that is, which axis is the fully closed control axis). As a result, the correspondence between the semi-closed control axis and the fully-closed control axis can be easily checked, so that the working efficiency can be improved and the setup can be facilitated.
  • the rotational direction of the motor 100 is set during setup. It is necessary to set the parameters in association with the moving direction of the load machine. This is because, in the case of full-closed control, the target to be position controlled by the host controller 200 is a load machine, but the advancing direction of the linear scale 400 attached to the load machine depends on how the linear scale 400 is attached to the load machine Since this is different, by setting this parameter, the rotational direction of the motor 100 can be associated with the moving direction of the load machine (the advancing direction of the linear scale 400), and position control of the load machine from the host controller 200 can be performed.
  • the rotational direction and the load of the motor 100 are detected based on the detection position by the linear scale 400 when the motor 100 in the fully closed control target is driven by a predetermined amount and the detection position by the encoder 102 corresponding thereto. Since the correspondence with the moving direction of the machine can be set automatically, the parameter setting operation at the time of setup becomes easy, and the setup can be made easy.
  • a linear drive per unit drive amount (for example, one rotation) of the motor 100 is set as a parameter dedicated to full closed control at setup. It is necessary to set the number of pulses of the scale 400 separately.
  • This parameter is used as an internal conversion constant in each axis control unit 304 required when converting the drive amount (rotation amount) of the encoder 102 from the movement amount of the linear scale 400. For example, it is used when converting the velocity calculated from the movement amount of the linear scale 400 into the angular velocity of the motor 100 or the like.
  • the movement amount by the linear scale 400 is a position feedback signal to the position control loop in each axis control unit 304
  • the drive amount (rotation amount) by the encoder 102 is a speed feedback signal to the speed control loop in each axis control unit 304.
  • the internal conversion constant is used when calculating the speed command output from the position control loop in each axis control unit 304 and input to the speed control loop.
  • the linear scale per unit driving amount of the motor 100 is calculated using the moving amount by the linear scale 400 and the moving amount by the encoder 102 when the motor 100 in the fully closed control target is driven by a predetermined amount. Since the number of pulses of 400 can be set automatically, the parameter setting operation at the time of setup becomes easy, and the setup can be made easy.
  • the multi-axis motor drive system 1A of the present modification seven first to eighth motors 100 (sixth motors 100 corresponding to seven drive units 303 other than the sixth drive unit 303). ) are provided.
  • the third, fifth and seventh motors 100 are not shown.
  • a load machine in which the eighth motor 100 is set as a master shaft and the fourth motor 100 is set as a slave shaft and is driven by the synchronous operation of the eighth and fourth motors 100 (for example, a stage moved by a ball screw)
  • One linear scale 400 is provided to detect the position of the
  • the wires from the encoders 102 of the first to fifth motors 100 are respectively connected to the first to fifth connectors 311, and the wires from the encoders 102 of the seventh and eighth motors 100 are respectively seventh and fifth Eight connectors 311 are connected.
  • the wiring from the linear scale 400 is connected to the sixth connector 311 corresponding to the sixth driving unit 303 in which the corresponding motor 100 is not provided.
  • control contents executed by the general control unit 302 at the time of setup of the multi-axis motor drive system 1A will be described with reference to FIG.
  • parts different from FIG. 2 described above will be mainly described, and description of the same parts will be omitted.
  • Step S10 is the same as that of FIG.
  • general control unit 302 selects motor 100 in the fully closed control target from among the plurality of motors 100 connected to multi-axis motor drive device 300. .
  • there are two motors which perform full-closed control an eighth motor 100 as a master shaft and a fourth motor 100 as a slave shaft.
  • These selection signals are manually input by the operator via the engineering tool 500.
  • the rotation direction of the selected motor 100 may be set together as necessary.
  • the general control unit 302 releases the brakes 101 of the motors 100, and then energizes the two motors 100 selected in the step S20A through the axis control units 304 and the drive unit 303.
  • the servo is turned on.
  • the detection positions of all the encoders 102 connected to the connector 311 of the relay unit 310 and the detection position of the linear scale 400 are predetermined storage units as initial positions ( Store in memory etc.)
  • the general control unit 302 since there are two motors performing the fully closed control, the eighth motor 100 and the fourth motor 100, the general control unit 302 energizes these motors 100 to bring them into a servo-on state.
  • the general control unit 302 outputs a position command of a predetermined drive amount to each axis control unit 304, and the two motors 100 selected in step S20A through the drive unit 303 are set to a predetermined amount ( For example, it is driven (about 1/4 rotation to 1 rotation).
  • the general control unit 302 sets a parameter for full-crossed control to the eighth motor 100 which is a master axis.
  • the eighth and fourth motors 100 are synchronized by setting the position detected by the encoder 102 of the eighth motor 100 that is a master axis as a position command. It can be driven.
  • the remaining steps S60 and S70 are the same as in FIG.
  • the general control unit 302 performs the procedure shown in the above-described flowchart to drive shaft (first drive shaft) using the motor 100 that performs semi-closed control and the motor 100 that performs full-closed control.
  • drive shaft second drive shaft
  • the drive shaft using two of the fourth and eighth motors 100 is the drive shaft performing the full closed control, and the first to third, fifth and seventh motors 100 are used. It is determined that the drive shaft is a drive shaft that performs semi-closed control.
  • step S20 shown in FIG. 2 the general control unit 302 releases the brake 101 of each motor 100, and then outputs a position command of a predetermined drive amount to each axis control unit 304, and the driving unit 303
  • the plurality of motors 100 are sequentially and individually driven by a predetermined amount. Then, based on the detection signal from the relay unit 310 at this time, the motor 100 in which the detection position by the linear scale 400 has changed by a predetermined amount may be specified, and the drive shaft using the motor 100 may be selected as a full closed control target.
  • the multi-axis motor drive system includes the rotary motor 100
  • the motor does not have to be the rotary type, and for example, a linear motor may be used.
  • the control contents shown in FIG. 2 and the like are executed by the general control unit 302, they may be executed by each axis control unit 304.
  • the eight-axis drive multi-axis motor drive system has been described above as an example, the number of axes is not limited to this and may be changed as appropriate. Furthermore, although the case where only one linear scale 400 is provided has been described as an example, two or more may be provided.
  • multi-axis motor drive system 1A multi-axis motor drive system 100 motor 102 encoder (first detector) 200 host control device 300 multi-axis motor drive device 302 general control unit (control unit) 310 relay unit 311 connector 400 linear scale (second detector)

Abstract

【課題】セットアップを容易にできるようにする。 【解決手段】速度を検出するエンコーダ１０２を備えた複数のモータ１００と、モータ制御指令を出力する上位制御装置２００と、モータ制御指令に基づき、複数のモータ１００を駆動する多軸モータ駆動装置３００と、モータ１００の負荷側の位置を検出する少なくとも１つのリニアスケール４００と、を有し、多軸モータ駆動装置３００は、モータ制御指令及びエンコーダ１０２による検出位置に基づいてセミクローズド制御を行なうモータ１００を用いる駆動軸と、モータ制御指令並びにエンコーダ１０２及びリニアスケール４００による検出位置に基づいてフルクローズド制御を行なうモータ１００を用いる駆動軸とを、フルクローズド制御を行なうモータ１００を駆動させた際のエンコーダ１０２又はリニアスケール４００検出位置の変化量に基づいて判別する統括制御部３０２を有する。

Description

多軸モータ駆動システム及び多軸モータ駆動装置
　開示の実施形態は、複数のエンコーダ付きモータを駆動する多軸モータ駆動システム及びこれに備えられた多軸モータ駆動装置に関する。
　特許文献１には、負荷側の位置検出器の信号を検知しフルクローズドループ制御を行うことが可能なフルクローズドループ位置制御サーボドライバが記載されている。このフルクローズドループ位置制御サーボドライバは、少なくともロータリーエンコーダを備えたサーボモータと、サーボモータを制御する位置制御ドライバとコントローラとリニアスケールを備え、リニアスケールからの位置検出信号とロータリーエンコーダからの速度検出信号を位置制御ドライバにフィードバックして位置決め制御を行い、位置決め完了後に位置制御ドライバが位置決め完了信号をコントローラに出力する。
特開平７－２２５６１５号公報
　多軸モータ駆動システムを構成する際、独立に単軸駆動する軸（セミクローズド制御する軸）と、フルクローズドループを構成して駆動する軸とが混在して用いられる場合がある。この場合、以下のような課題が生じうるが、特許文献１にはその解決手段について何ら記載されておらず、また示唆もされていない。
　多軸モータ駆動システムにおいてフルクローズドループを構成する場合、多軸のうち１軸をセミクローズド制御する軸、他の１軸をフルクローズド制御する軸とする。このようなシステムのセットアップの際には、駆動軸数分のモータ配線、エンコーダ配線、さらに位置検出器の配線を行なうが、セミクローズド制御軸とフルクローズド制御軸の対応関係に誤りがないかチェックを行う必要がある。また、単軸駆動とは異なるフルクロースド制御用のパラメータを別途設定する必要がある。このようなチェックや設定作業に時間を要し、セットアップの作業効率が低下するという課題があった。
　本発明はこのような問題点に鑑みてなされたものであり、本発明の目的とするところは、セットアップを容易にすることができる多軸モータ駆動システム及び多軸モータ駆動装置を提供することにある。
　上記課題を解決するため、本発明の一の観点によれば、少なくとも位置を検出する第１検出器を備えた複数のモータと、モータ制御指令を出力する上位制御装置と、前記モータ制御指令に基づき、前記複数のモータを駆動する多軸モータ駆動装置と、前記モータの負荷側の位置を検出する少なくとも１つの第２検出器と、を有し、前記多軸モータ駆動装置は、前記モータ制御指令及び前記第１検出器による第１検出位置に基づいてセミクローズド制御を行なう第１駆動軸と、前記モータ制御指令及び前記第１検出位置並びに前記第２検出器による第２検出位置に基づいてフルクローズド制御を行なう第２駆動軸とを、前記第２駆動軸における前記モータを駆動させた際の前記第１検出位置または前記第２検出位置の変化量に基づいて判別する制御部を有する多軸モータ駆動システムが適用される。
　本発明の多軸モータ駆動システムによれば、セットアップを容易にすることができる。
実施形態の多軸モータ駆動システムの構成を概念的に表すシステム構成図である。 多軸モータ駆動システムのセットアップ時に統括制御部が実行する制御内容を表すフローチャートである。 多軸モータ駆動システムがガントリ軸を有する変形例における、多軸モータ駆動システムの構成を概念的に表すシステム構成図である。 多軸モータ駆動システムがガントリ軸を有する変形例における、セットアップ時に統括制御部が実行する制御内容を表すフローチャートである。
　以下、一実施形態について図面を参照しつつ説明する。
　図１に示すように、本実施形態の多軸モータ駆動システム１は、複数（この例では７つ。但し３つのみ図示し、残りは図示省略。）の回転型のモータ１００と、モータ制御指令を出力する上位制御装置２００と、上位制御装置２００のモータ制御指令に基づき、各モータ１００を駆動する多軸モータ駆動装置３００とを備えている。各モータ１００は、それぞれ、ブレーキ１０１と、回転軸の速度（角速度）や位置（角度）を検出して当該検出信号をフィードバックパルスとして多軸モータ駆動装置３００に出力するエンコーダ１０２（第１検出器）とを有している。なお、ブレーキ１０１を有しないモータとしてもよい。また、エンコーダ１０２による検出位置が、特許請求の範囲に記載の第１検出位置の一例に相当する。
　多軸モータ駆動装置３００は、交流電源が入力される電源部３０１と、上位制御装置２００との通信制御や多軸モータ駆動装置３００全体の制御を司る統括制御部３０２と、各モータ１００に対応して設けられ、モータ１００に電力を供給して駆動する複数（この例では８つ）の駆動部３０３と、これら複数の駆動部３０３を制御する各軸制御部３０４とを有している。なお、統括制御部３０２が、特許請求の範囲に記載の制御部の一例に相当する。
　以下では、上記８つの駆動部３０３を適宜第１～第８駆動部３０３と呼称し、また、第１～第８駆動部３０３の各々に対応するモータを第１～第８モータ１００と呼称する。図１に示す例では、第３駆動部３０３以外の７つの駆動部３０３に対応して７つの第１～第８モータ１００（第３モータ１００を除く）が設けられている。なお、図１では、第４～第７モータ１００については図示を省略している。
　多軸モータ駆動システム１は、モータ１００の負荷側の位置を検出するリニアスケール４００（第２検出器）をさらに有している。図１に示す例では、第８モータ１００の負荷機械（例えばボールねじにより移動するステージ等）の位置を検出するリニアスケール４００が１つ設けられている。このリニアスケール４００は、位置検出信号をフィードバック信号（例えばパルス信号やアナログ信号等）として多軸モータ駆動装置３００に出力する。なお、リニアスケール４００による検出位置が、特許請求の範囲に記載の第２検出位置の一例に相当する。
　多軸モータ駆動装置３００は、エンコーダ１０２及びリニアスケール４００による検出位置を統括制御部３０２に対して中継する中継部３１０を有している。この中継部３１０は、基板又はモジュール等で構成されており、多軸モータ駆動装置３００に一体的に設けられている。なお、中継部３１０を多軸モータ駆動装置３００とは別体として構成してもよい。この中継部３１０は、エンコーダ１０２からの配線及びリニアスケール４００からの配線が接続される複数（この例では８つ）のコネクタ３１１を有しており、第１～第８駆動部３０３にそれぞれ対応している。以下では、第１～第８駆動部３０３の各々に対応するコネクタ３１１を第１～第８コネクタ３１１と呼称する。なお、中継部３１０を有さず、エンコーダ１０２からの配線及びリニアスケール４００からの配線を、直接統括制御部３０２に接続するように構成しても良い。
　図１に示す例では、第１及び第２モータ１００のエンコーダ１０２からの配線は各々第１及び第２コネクタ３１１に接続され、第４～第８モータ１００のエンコーダ１０２からの配線は各々第４～第８コネクタ３１１に接続されている。一方、リニアスケール４００からの配線は、対応するモータ１００が設けられていない第３駆動部３０３に対応する第３コネクタ３１１に接続されている。
　中継部３１０においては、リニアスケール４００からの配線の接続コネクタ位置を任意に設定することが可能である。例えば、図１に示す例ではリニアスケール４００からの配線が第３コネクタ３１１に接続されているが、接続コネクタ位置を例えば第７コネクタ３１１に変更する場合、第７駆動部３０３以外の７つの駆動部３０３に対して７つの第１～第８モータ１００（第７モータ１００を除く）を接続し、これらのモータ１００のエンコーダ１０２からの配線を各々第１～第８コネクタ３１１（第７コネクタ３１１を除く）に接続すればよい。すなわち、各エンコーダ１０２からの配線が当該エンコーダ１０２のモータ１００が接続された駆動部３０３に対応した特定のコネクタ３１１に接続されるように対応付けられていれば、リニアスケール４００からの配線を任意のコネクタ３１１に接続することが可能である。
　各エンコーダ１０２の検出信号及びリニアスケール４００の検出信号は、中継部３１０を介して統括制御部３０２に入力される。この統括制御部３０２は、中継部３１０からの検出信号に基づき、リニアスケール４００で負荷側の位置を検出する第８モータ１００に対しては、リニアスケール４００からの位置フィードバックを用いたフルクローズド制御を行い、その他のモータ１００に対しては、エンコーダ１０２からの位置フィードバックを用いたセミクローズド制御を行う。この例では、第８モータ１００（ブレーキ１０１及びエンコーダ１０２を含む）、第８モータ１００を用いて駆動する負荷機械の駆動軸、及びリニアスケール４００が、特許請求の範囲に記載の第２駆動軸の一例に相当し、第８モータ１００以外のモータ１００、当該モータ１００を用いて駆動する負荷機械の駆動軸が第１駆動軸の一例に相当する。
　なお、多軸モータ駆動装置３００には、エンジニアリングツール５００が接続されている。このエンジニアリングツール５００は、例えば携帯型のハンディコントローラ等で構成されており、作業者が各種指令やデータ等を入力することが可能である。
　次に、多軸モータ駆動システム１のセットアップ時に統括制御部３０２が実行する制御内容について、図２を用いて説明する。統括制御部３０２は、例えば多軸モータ駆動装置３００の電源が投入された際に図２に示すフローを開始する。なお、電源投入前に、各モータ１００についてのモータ配線（各駆動部３０３と各モータ１００間の配線）、ブレーキ１０１の配線、及び、エンコーダ１０２の配線（エンコーダ１０２と中継部３１０間の配線）、リニアスケール４００の配線（リニアスケール４００と中継部３１０間の配線）が作業者により正しくなされているものとする。また、エンジニアリングツール５００は事前に多軸モータ駆動装置３００に接続されており、その電源は投入されているものとする。
　まずステップＳ１０では、統括制御部３０２は、フルクローズド制御を行う軸数（モータ数）をカウントするための変数ｉを０に初期化すると共に、フルクローズド制御を行う全軸数（全モータ数）を表すｉ０を所定の値に設定する。図１に示す例では、フルクローズド制御を行うモータは第８モータ１００のみであるため、ｉ０＝１となる。なお、このｉ０の値は、作業者によりエンジニアリングツール５００を介して手動入力される。
　次のステップＳ２０では、統括制御部３０２は、エンジニアリングツール５００からの選択信号に応じて、多軸モータ駆動装置３００に接続された複数のモータ１００の中からフルクローズド制御対象におけるモータ１００を選択する。図１に示す例では、フルクローズド制御を行うモータは第８モータ１００である。上記選択信号は、作業者によりエンジニアリングツール５００を介して手動入力される。なお、必要に応じ、上位制御装置２００のモータ制御指令（例えば、位置指令方向）に対する、選択されたモータ１００の回転方向を併せて設定してもよい。
　次のステップＳ３０では、統括制御部３０２は、各モータ１００のブレーキ１０１を解除した上で、各軸制御部３０４及び駆動部３０３を介して上記ステップＳ２０で選択されたモータ１００を通電してサーボオン状態とする。また、このときの中継部３１０からの検出信号に基づき、中継部３１０のコネクタ３１１に接続された全エンコーダ１０２の検出位置、及び、リニアスケール４００の検出位置を、初期位置として所定の記憶部（メモリ等）に格納する。図１に示す例では、フルクローズド制御を行うモータは第８モータ１００であるため、統括制御部３０２は第８モータ１００を通電してサーボオン状態とする。なお、サーボオン状態とは、駆動量ゼロの位置決め制御状態を示し、すなわち上記ステップＳ２０で選択されたモータ１００は、通電開始時点の位置にロックされている。
　次のステップＳ４０では、統括制御部３０２は、所定の駆動量の位置指令を各軸制御部３０４に出力し、駆動部３０３を介して上記ステップＳ２０で選択されたモータ１００を所定量（例えば１／４回転～１回転程度）駆動する。
　次のステップＳ５０では、統括制御部３０２は、フルクローズド制御用のパラメータを設定する。具体的には、まず統括制御部３０２は、上記ステップＳ４０でフルクローズド制御対象におけるモータ１００を所定量駆動させた際の中継部３１０からの検出信号に基づき、検出位置が所定量変化した中継部３１０の接続コネクタ位置を特定し、当該コネクタ３１１をリニアスケール４００からの配線が接続されたコネクタであると判別する。すなわち、図１に示す例では、第３コネクタ３１１をリニアスケール４００からの配線が接続されたコネクタであると判別する。
　次に統括制御部３０２は、上記ステップＳ４０でフルクローズド制御対象におけるモータ１００を所定量駆動させた際のリニアスケール４００による検出位置と、これに対応するエンコーダ１０２（図１に示す例では第８モータ１００のエンコーダ１０２）による検出位置とに基づき、モータ１００（図１に示す例では第８モータ１００）の回転方向と負荷機械の移動方向との対応付けを設定する。
　さらに統括制御部３０２は、上記ステップＳ４０でフルクローズド制御対象におけるモータ１００を所定量駆動させた際のリニアスケール４００による移動量ＬＳＰとエンコーダ１０２による移動量ＥＰを上記ステップＳ３０で格納した初期位置との比較により算出し、当該移動量ＬＳＰと移動量ＥＰを用いて、モータ１００（図１に示す例では第８モータ１００）の単位駆動量（例えば１回転）あたりのリニアスケール４００のパルス数ＬＳＰoを、次式（１）に基づき設定する。
　ＬＳＰo＝ＥＰo×（ＬＳＰ／ＥＰ）・・・（式１）
　ＥＰo：モータ単位駆動量あたりのエンコーダパルス数（パルス／単位駆動量）
　ＬＳＰ：リニアスケール移動量（パルス）
　ＥＰ：エンコーダ移動量（パルス）
　なお、上記ＥＰoは予め所定の記憶部（メモリ等）に格納されているか、又はエンジニアリングツール５００を介して手動入力される。
　次のステップＳ６０では、統括制御部３０２は、変数ｉに１を加える。次のステップＳ７０では、統括制御部３０２は、変数ｉが全軸数ｉ０と一致するか否かを判定する。変数ｉと全軸数ｉ０とが一致しない場合には（ステップＳ７０でＮＯ）、先のステップＳ２０に戻る。すなわち、フルクローズド制御を行うモータが複数である場合には、ステップＳ２０～ステップＳ７０をその数分だけ繰り返す。一方、変数ｉと全軸数ｉ０とが一致する場合には（ステップＳ７０でＹＥＳ）、本フローを終了する。図１に示す例では全軸数ｉ０＝１であるため、変数ｉと全軸数ｉ０とが一致し、本フローを終了する。
　なお、統括制御部３０２は、上記フローチャートに示す手順の実行により、セミクローズド制御を行うモータ１００を用いる駆動軸（第１駆動軸）と、フルクローズド制御を行うモータ１００を用いる駆動軸（第２駆動軸）との判別を行っている。ここで、「第１駆動軸と第２駆動軸の判別」とは、多軸モータ駆動装置３００の各軸出力（各駆動部３０３の出力）と各モータ１００への接続と、各軸モータ１００のエンコーダ出力と中継部３１０の各コネクタ３１１への接続との整合性を判別することを含むものである。
　すなわち、統括制御部３０２は、まずエンジニアリングツール５００からの選択信号に応じてフルクローズド制御対象におけるモータ１００を選択することで（ステップＳ２０）、フルクローズド制御を行うモータ１００への接続と、そのエンコーダ出力の中継部コネクタ３１１への接続を認識する。その上で、モータ１００を所定量駆動し（ステップＳ４０）、モータ１００の負荷側の位置を検出するリニアスケール４００の位置検出信号が、中継部３１０のいずれのコネクタ３１１に入力されているかを判別する（ステップＳ５０）。この際、中継部コネクタ３１１に入力される位置検出信号（第１検出位置または第２検出位置）の変化量を監視しておき、モータ１００の所定量駆動に応じた変化量が得られる中継部コネクタ３１１に入力される位置検出信号を、リニアスケール４００の位置検出信号（第２検出位置）とし、リニアスケール４００からの配線が接続されたコネクタ３１１を特定する（ステップＳ５０）。また、フルクローズド制御を行うモータ１００が複数あれば、上記を繰り返し、他のリニアスケール４００からの配線が接続された他のコネクタ３１１を特定する。これにより、統括制御部３０２は、フルクローズド制御を行うモータ１００を用いる駆動軸（第２駆動軸）の判別を完了する。また統括制御部３０２は、フルクローズド制御を行うモータ１００を用いる駆動軸（第２駆動軸）以外をセミクローズド制御を行うモータ１００を用いる駆動軸（第１駆動軸）と判別する。
　したがって図１に示す例では、第８モータ１００及び中継部３１０の第８コネクタ３１１、第３コネクタ３１１を用いる駆動軸がフルクローズド制御を行う駆動軸であると判別され、第１～第７モータ１００（第３モータ１００を除く）及び中継部３１０の第１～第７コネクタ３１１（第３コネクタ３１１を除く）がセミクローズド制御を行う駆動軸であると判別される。
　以上説明した多軸モータ駆動システム１においては、上述したように、多軸モータ駆動装置３００の統括制御部３０２が、セミクローズド制御を行うモータ１００を用いる駆動軸と、フルクローズド制御を行うモータ１００を用いる駆動軸とを、フルクローズド制御を行うモータ１００を駆動させた際のエンコーダ１０２による検出位置またはリニアスケール４００による検出位置の変化量に基づいて自動的に判別する。これにより、セットアップの際にどのモータ１００を用いる駆動軸がフルクローズド制御を行い、どのモータ１００を用いる駆動軸がセミクローズド制御を行うものであるかといった情報を設定する必要がないので、セットアップを容易にすることができる。
　また、本実施形態では特に、多軸モータ駆動装置３００が中継部３１０を有することにより、次の効果を奏する。すなわち、多軸モータ駆動システム１のセットアップの際には、各モータ１００についてのモータ配線（各駆動部３０３と各モータ１００間の配線）、ブレーキ１０１及びエンコーダ１０２の配線（ブレーキ１０１及びエンコーダ１０２と中継部３１０間の配線）、リニアスケール４００の配線（リニアスケール４００と中継部３１０間の配線）が行なわれる。このとき、仮に中継部３１０においてリニアスケール４００の配線が特定のコネクタ３１１にしか接続できない構成とした場合、当該特定のコネクタ３１１がいずれのコネクタであるかを確認する作業が必要となる。また、機器配置や周囲環境等の事情によってリニアスケール４００の配線を特定のコネクタ３１１に接続できない（あるいは接続し難い）場合には、機器配置等を変更する作業が必要となる。これに対し、本実施形態においては、中継部３１０においてリニアスケール４００からの配線の接続コネクタ位置を任意に設定可能である。これにより、上述したような特定のコネクタ３１１の確認作業が不要となり、また機器配置等に応じて柔軟に接続コネクタ位置を変更可能であるので、機器配置等を変更する作業も不要となる。したがって、セットアップを容易にすることができる。
　また、多軸モータ駆動システム１のセットアップにおいては、上述した配線を行なった上で、セミクローズド制御軸とフルクローズド制御軸の対応関係に誤りがないか、モータ配線や中継部３１０における各配線の接続コネクタ位置のチェックを行う必要がある。具体的には、リニアスケール４００の配線が接続されたコネクタ３１１に対応する駆動部３０３にはモータ１００が接続されておらず、且つ、各モータ１００及びエンコーダ１０２が、互いに対応する駆動部３０３及びコネクタ３１１とそれぞれ接続されているかをチェックする必要がある。特に本実施形態では、リニアスケール４００からの配線が中継部３１０の任意のコネクタ３１１に接続されるため、当該接続コネクタ位置を特定する必要がある。本実施形態によれば、多軸モータ駆動装置３００の統括制御部３０２が、フルクローズド制御対象におけるモータ１００を所定量駆動させ、検出位置が所定量変化した接続コネクタ位置を特定することで、中継部３１０のどのコネクタ３１１にリニアスケール４００からの配線が接続されているか（すなわちどの軸がフルクローズド制御軸であるか）を自動的に判別することができる。これにより、セミクローズド制御軸とフルクローズド制御軸の対応関係を容易にチェックすることができるので、作業効率が向上し、セットアップを容易にすることができる。
　また、本実施形態の多軸モータ駆動システム１のように、回転型のモータ１００を用いて負荷機械を移動させる、フルクローズドループを構成する場合には、セットアップの際にモータ１００の回転方向と負荷機械の移動方向とを対応付けてパラメータを設定する必要がある。なぜなら、フルクローズド制御の場合、上位制御装置２００から位置制御すべき対象は負荷機械であるが、負荷機械に取付けられたリニアスケール４００の進み方向は、リニアスケール４００の負荷機械に対する取付け方等により異なるため、このパラメータを設定することにより、モータ１００の回転方向と負荷機械の移動方向（リニアスケール４００の進み方向）との対応付けができ、上位制御装置２００から負荷機械を位置制御することができるようになるからである。本実施形態によれば、フルクローズド制御対象におけるモータ１００を所定量駆動させた際のリニアスケール４００による検出位置と、これに対応するエンコーダ１０２による検出位置とに基づき、モータ１００の回転方向と負荷機械の移動方向との対応付けを自動的に設定することができるので、セットアップの際のパラメータ設定作業が容易となり、セットアップを容易にすることができる。
　また、本実施形態の多軸モータ駆動システム１のように、フルクローズドループを構成する場合、セットアップの際にフルクローズド制御専用のパラメータとして、モータ１００の単位駆動量（例えば１回転）あたりのリニアスケール４００のパルス数を別途設定する必要がある。このパラメータは、リニアスケール４００の移動量からエンコーダ１０２の駆動量（回転量）を換算する場合に必要とされる各軸制御部３０４における内部換算定数として用いられる。例えば、リニアスケール４００の移動量から算出される速度から、モータ１００の角速度に変換する場合等に用いられる。通常、リニアスケール４００による移動量を各軸制御部３０４における位置制御ループへの位置フィードバック信号とし、エンコーダ１０２による駆動量（回転量）を各軸制御部３０４における速度制御ループへの速度フィードバック信号として構成するが、この場合、各軸制御部３０４における位置制御ループが出力して速度制御ループへ入力する速度指令を算出する際にこの内部換算定数を用いる。本実施形態によれば、フルクローズド制御対象におけるモータ１００を所定量駆動させた際のリニアスケール４００による移動量と、エンコーダ１０２による移動量とを用いて、モータ１００の単位駆動量あたりのリニアスケール４００のパルス数を自動的に設定することができるので、セットアップの際のパラメータ設定作業が容易となり、セットアップを容易にすることができる。
　なお、上記実施形態に限られるものではなく、その趣旨及び技術的思想を逸脱しない範囲内で種々の変形が可能である。以下、そのような変形例を順を追って説明する。
　（１）多軸モータ駆動システムがガントリ軸を有する場合
　本変形例は、多軸モータ駆動システムが、同期運転されるマスタ軸とスレーブ軸からなるガントリ軸を有する場合の一例である。
　図３に示すように、本変形例の多軸モータ駆動システム１Ａにおいては、第６駆動部３０３以外の７つの駆動部３０３に対応して７つの第１～第８モータ１００（第６モータ１００を除く）が設けられている。なお、図３では、第３、第５及び第７モータ１００については図示を省略している。この例では、第８モータ１００がマスタ軸、第４モータ１００がスレーブ軸として設定されており、これら第８及び第４モータ１００の同期運転により駆動される負荷機械（例えばボールねじにより移動するステージ等）の位置を検出するリニアスケール４００が１つ設けられている。
　本変形例では、第１～第５モータ１００のエンコーダ１０２からの配線は各々第１～第５コネクタ３１１に接続され、第７及び第８モータ１００のエンコーダ１０２からの配線は各々第７及び第８コネクタ３１１に接続されている。一方、リニアスケール４００からの配線は、対応するモータ１００が設けられていない第６駆動部３０３に対応する第６コネクタ３１１に接続されている。
　次に、多軸モータ駆動システム１Ａのセットアップ時に統括制御部３０２が実行する制御内容について、図４を用いて説明する。なお、ここでは前述の図２と異なる部分を中心に説明し、同様の部分については説明を省略する。
　ステップＳ１０は、図２と同様である。次のステップＳ２０Ａでは、統括制御部３０２は、エンジニアリングツール５００からの選択信号に応じて、多軸モータ駆動装置３００に接続された複数のモータ１００の中からフルクローズド制御対象におけるモータ１００を選択する。図３に示す例では、フルクローズド制御を行うモータはマスタ軸としての第８モータ１００及びスレーブ軸としての第４モータ１００の２つである。これらの選択信号は、作業者によりエンジニアリングツール５００を介して手動入力される。なお、必要に応じ、選択されたモータ１００の回転方向を併せて設定してもよい。
　次のステップＳ３０Ａでは、統括制御部３０２は、各モータ１００のブレーキ１０１を解除した上で、各軸制御部３０４及び駆動部３０３を介して上記ステップＳ２０Ａで選択された２つのモータ１００を通電してサーボオン状態とする。また、このときの中継部３１０からの検出信号に基づき、中継部３１０のコネクタ３１１に接続された全エンコーダ１０２の検出位置、及び、リニアスケール４００の検出位置を、初期位置として所定の記憶部（メモリ等）に格納する。図３に示す例では、フルクローズド制御を行うモータは第８モータ１００及び第４モータ１００の２つであるため、統括制御部３０２はこれらのモータ１００を通電してサーボオン状態とする。
　次のステップＳ４０Ａでは、統括制御部３０２は、所定の駆動量の位置指令を各軸制御部３０４に出力し、駆動部３０３を介して上記ステップＳ２０Ａで選択された２つのモータ１００を所定量（例えば１／４回転～１回転程度）駆動する。
　次のステップＳ５０Ａでは、統括制御部３０２は、フルクロースド制御用のパラメータをマスタ軸である第８モータ１００に対して設定する。パラメータの設定内容については、図２と同様である。なお、スレーブ軸である第４モータ１００に対しては、例えばマスタ軸である第８モータ１００のエンコーダ１０２による検出位置を位置指令とする設定を行うことにより、第８及び第４モータ１００を同期運転させることができる。残りのステップＳ６０及びステップＳ７０は、図２と同様である。
　また前述の実施形態と同様に、統括制御部３０２は、上記フローチャートに示す手順の実行により、セミクローズド制御を行うモータ１００を用いる駆動軸（第１駆動軸）と、フルクローズド制御を行うモータ１００を用いる駆動軸（第２駆動軸）との判別を行う。図３に示す例では、第４及び第８モータ１００の２つを用いる駆動軸がフルクローズド制御を行う駆動軸であると判別され、第１～第３、第５及び第７モータ１００を用いる駆動軸がセミクローズド制御を行う駆動軸であると判別される。
　以上説明した変形例においても、上記実施形態と同様の効果を得る。
　（２）フルクローズド制御対象のモータを自動的に選択する場合
　前述の実施形態では、作業者がエンジニアリングツール５００を用いて手動選択することにより、その選択信号に応じて、統括制御部３０２がフルクローズド制御対象におけるモータ１００を選択するようにしたが、これに限らず、統括制御部３０２がフルクローズド制御対象におけるモータ１００を検出し、自動的に選択を行うようにしてもよい。
　この場合、図２に示すステップＳ２０において、統括制御部３０２は、各モータ１００のブレーキ１０１を解除した上で、所定の駆動量の位置指令を各軸制御部３０４に出力し、駆動部３０３を介して複数のモータ１００を順次個別に所定量駆動する。そして、この際の中継部３１０からの検出信号に基づき、リニアスケール４００による検出位置が所定量変化したモータ１００を特定し、当該モータ１００を用いる駆動軸をフルクローズド制御対象として選択すればよい。
　本変形例によれば、フルクローズド制御対象におけるモータ１００を自動的に選択できるので、作業者が手作業で選択する必要がなくなり、セットアップをさらに容易にすることができる。
　（３）その他
　以上では、多軸モータ駆動システムが回転型のモータ１００を有する場合を一例として説明したが、モータは回転型である必要はなく、例えばリニアモータを用いてもよい。また、図２等に示す制御内容を統括制御部３０２で実行するようにしたが、各軸制御部３０４で実行してもよい。
　また以上では、８軸駆動の多軸モータ駆動システムを一例として説明したが、軸数はこれに限るものではなく、適宜変更してもよい。さらに、リニアスケール４００を１つのみ設けた場合を一例として説明したが、２つ以上設けてもよい。
　また、以上既に述べた以外にも、上記実施形態や各変形例による手法を適宜組み合わせて利用しても良い。
　その他、一々例示はしないが、その趣旨を逸脱しない範囲内において、種々の変更が加えられて実施されるものである。
　１　　　　　　　　多軸モータ駆動システム
　１Ａ　　　　　　　多軸モータ駆動システム
　１００　　　　　　モータ
　１０２　　　　　　エンコーダ（第１検出器）
　２００　　　　　　上位制御装置
　３００　　　　　　多軸モータ駆動装置
　３０２　　　　　　統括制御部（制御部）
　３１０　　　　　　中継部
　３１１　　　　　　コネクタ
　４００　　　　　　リニアスケール（第２検出器）

Claims (8)

  1. 　少なくとも位置を検出する第１検出器を備えた複数のモータと、
    　モータ制御指令を出力する上位制御装置と、
    　前記モータ制御指令に基づき、前記複数のモータを駆動する多軸モータ駆動装置と、
    　前記モータの負荷側の位置を検出する少なくとも１つの第２検出器と、を有し、
    　前記多軸モータ駆動装置は、
    　前記モータ制御指令及び前記第１検出器による第１検出位置に基づいてセミクローズド制御を行なう第１駆動軸と、前記モータ制御指令及び前記第１検出位置並びに前記第２検出器による第２検出位置に基づいてフルクローズド制御を行なう第２駆動軸とを、前記第２駆動軸における前記モータを駆動させた際の前記第１検出位置または前記第２検出位置の変化量に基づいて判別する制御部を有する
    ことを特徴とする多軸モータ駆動システム。
  2. 　前記多軸モータ駆動装置は、
    　前記第１検出器からの配線及び前記第２検出器からの配線を接続する複数のコネクタを備え、前記第２検出器からの配線の接続コネクタ位置を任意に設定可能であり、前記第１検出位置及び前記第２検出位置を前記制御部に対して中継する中継部を有することを特徴とする請求項１に記載の多軸モータ駆動システム。
  3. 　前記制御部は、
    　前記第２駆動軸における前記モータを所定量駆動させた際の前記中継部からの前記第２検出位置が所定量変化した前記中継部の接続コネクタ位置を特定し、当該コネクタを前記第２検出器からの配線が接続されたコネクタであると判別する
    ことを特徴とする請求項１または２に記載の多軸モータ駆動システム。
  4. 　前記制御部は、
    　前記第２駆動軸における前記モータを所定量駆動させた際の前記中継部からの前記第２検出位置とこれに対応する前記第１検出位置とに基づき、前記第２駆動軸における前記モータの駆動方向と前記負荷の移動方向との対応付けを設定する
    ことを特徴とする請求項１乃至３のいずれか１項に記載の多軸モータ駆動システム。
  5. 　前記制御部は、
    　前記第２駆動軸における前記モータを所定量駆動させた際の前記中継部からの前記第２検出位置とこれに対応する前記第１検出位置とに基づき、前記モータの単位駆動量あたりの前記第２検出器のパルス数を設定する
    ことを特徴とする請求項１乃至４のいずれか１項に記載の多軸モータ駆動システム。
  6. 　前記制御部は、
    　前記複数のモータを順次個別に所定量駆動させた際の前記中継部からの前記第２検出位置が所定量変化した前記モータを特定し、当該モータを用いる駆動軸を前記第２駆動軸として選択する
    ことを特徴とする請求項１乃至５のいずれか１項に記載の多軸モータ駆動システム。
  7. 　上位制御装置から出力されるモータ制御指令に基づき、第１検出器を備えた複数のモータを駆動する多軸モータ駆動装置であって、
    　前記モータ制御指令及び前記第１検出器による第１検出位置に基づいてセミクローズド制御を行なう第１駆動軸と、前記モータ制御指令及び前記第１検出位置並びに前記モータの負荷側の位置を検出する少なくとも１つの第２検出器による第２検出位置に基づいてフルクローズド制御を行なう第２駆動軸とを、前記第２駆動軸における前記モータを駆動させた際の前記第１検出位置または前記第２検出位置の変化量に基づいて判別する制御部を有する
    ことを特徴とする多軸モータ駆動装置。
  8. 　前記多軸モータ駆動装置は、
    　前記第１検出器からの配線及び前記第２検出器からの配線を接続する複数のコネクタを備え、前記第２検出器からの配線の接続コネクタ位置を任意に設定可能であり、前記第１検出位置及び前記第２検出位置を前記制御部に対して中継する中継部を有することを特徴とする請求項７に記載の多軸モータ駆動装置。
PCT/JP2011/062791 2011-06-03 2011-06-03 多軸モータ駆動システム及び多軸モータ駆動装置 WO2012164740A1 (ja)

Priority Applications (5)

Application Number Priority Date Filing Date Title
PCT/JP2011/062791 WO2012164740A1 (ja) 2011-06-03 2011-06-03 多軸モータ駆動システム及び多軸モータ駆動装置
CN201180071279.7A CN103563238B (zh) 2011-06-03 2011-06-03 多轴电动机驱动系统和多轴电动机驱动装置
DE112011105306.1T DE112011105306T5 (de) 2011-06-03 2011-06-03 Mehrachsenmotorantriebssystem und Mehrachsenmotorantriebsvorrichtung
JP2012554556A JP5622125B2 (ja) 2011-06-03 2011-06-03 多軸モータ駆動システム及び多軸モータ駆動装置
US14/093,537 US9069346B2 (en) 2011-06-03 2013-12-02 Multi-axis motor driving system and multi-axis motor driving apparatus

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2011/062791 WO2012164740A1 (ja) 2011-06-03 2011-06-03 多軸モータ駆動システム及び多軸モータ駆動装置

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US14/093,537 Continuation US9069346B2 (en) 2011-06-03 2013-12-02 Multi-axis motor driving system and multi-axis motor driving apparatus

Publications (1)

Publication Number Publication Date
WO2012164740A1 true WO2012164740A1 (ja) 2012-12-06

Family

ID=47258625

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2011/062791 WO2012164740A1 (ja) 2011-06-03 2011-06-03 多軸モータ駆動システム及び多軸モータ駆動装置

Country Status (5)

Country Link
US (1) US9069346B2 (ja)
JP (1) JP5622125B2 (ja)
CN (1) CN103563238B (ja)
DE (1) DE112011105306T5 (ja)
WO (1) WO2012164740A1 (ja)

Cited By (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102014204802A1 (de) * 2014-03-14 2015-09-17 Siemens Aktiengesellschaft Konvertersystem und Verfahren zum Konvertieren von Wechselstrom
JP2016027951A (ja) * 2014-07-09 2016-02-25 キヤノン株式会社 ロボット装置の制御方法、およびロボット装置
JP5996148B1 (ja) * 2015-04-23 2016-09-21 三菱電機株式会社 多軸制御システム設定調整支援装置
WO2019208758A1 (ja) * 2018-04-27 2019-10-31 パナソニックＩｐマネジメント株式会社 モータ駆動装置及び搬送システム

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6823910B2 (ja) * 2015-02-24 2021-02-03 蛇の目ミシン工業株式会社 サーボプレス、制御方法およびプログラム
DE102015117702A1 (de) * 2015-10-16 2017-04-20 Volkswagen Aktiengesellschaft Verfahren und Vorrichtung zur Rotorlageermittlung in einem Mehrfachelektromaschinensystem
JP6237938B1 (ja) * 2016-10-18 2017-11-29 株式会社安川電機 多軸モータ制御システム、モータ制御装置、及びモータ制御方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07225615A (ja) * 1994-02-14 1995-08-22 Matsushita Electric Ind Co Ltd フルクローズドループ位置制御サーボドライバ
JPH10268924A (ja) * 1997-03-25 1998-10-09 Mitsubishi Electric Corp サーボシステム
JP2002209397A (ja) * 2001-01-12 2002-07-26 Yaskawa Electric Corp フルクローズ・セミクローズループ判別方法
JP2007060864A (ja) * 2005-08-26 2007-03-08 Yaskawa Electric Corp 電動機制御装置およびそのフィルタ設定方法

Family Cites Families (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07230319A (ja) * 1994-02-18 1995-08-29 Shimaden:Kk サーボコントローラ系における配線異状の検出方法
US5691898A (en) * 1995-09-27 1997-11-25 Immersion Human Interface Corp. Safe and low cost computer peripherals with force feedback for consumer applications
US5659480A (en) 1995-06-27 1997-08-19 Industrial Service And Machine, Incorporated Method for coordinating motion control of a multiple axis machine
JP3625901B2 (ja) 1995-06-30 2005-03-02 三菱電機株式会社 サーボ制御システムの自動適正化方法および装置
DE19607688B4 (de) 1995-06-30 2005-10-13 Mitsubishi Denki K.K. Verfahren und Vorrichtung zur Erfassung und Diagnose eines anormalen Betriebszustandes in einem Servosteuersystem
JP2000032616A (ja) * 1998-07-08 2000-01-28 Toyota Motor Corp 電動機の誤接続検出装置
JP2003348870A (ja) * 2002-05-23 2003-12-05 Sumitomo Heavy Ind Ltd 誤動作防止機能付モータ制御システム
JP2004280506A (ja) * 2003-03-17 2004-10-07 Fanuc Ltd 数値制御装置
US20050094343A1 (en) * 2003-10-31 2005-05-05 Mintz Richard C.Jr. Decentralized control of motors
DE102008044341A1 (de) 2008-12-04 2010-06-10 Dr. Johannes Heidenhain Gmbh Reglerstruktur für mehrere mechanisch gekoppelte Antriebseinheiten

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH07225615A (ja) * 1994-02-14 1995-08-22 Matsushita Electric Ind Co Ltd フルクローズドループ位置制御サーボドライバ
JPH10268924A (ja) * 1997-03-25 1998-10-09 Mitsubishi Electric Corp サーボシステム
JP2002209397A (ja) * 2001-01-12 2002-07-26 Yaskawa Electric Corp フルクローズ・セミクローズループ判別方法
JP2007060864A (ja) * 2005-08-26 2007-03-08 Yaskawa Electric Corp 電動機制御装置およびそのフィルタ設定方法

Cited By (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE102014204802A1 (de) * 2014-03-14 2015-09-17 Siemens Aktiengesellschaft Konvertersystem und Verfahren zum Konvertieren von Wechselstrom
JP2016027951A (ja) * 2014-07-09 2016-02-25 キヤノン株式会社 ロボット装置の制御方法、およびロボット装置
JP5996148B1 (ja) * 2015-04-23 2016-09-21 三菱電機株式会社 多軸制御システム設定調整支援装置
WO2016170661A1 (ja) * 2015-04-23 2016-10-27 三菱電機株式会社 多軸制御システム設定調整支援装置
WO2019208758A1 (ja) * 2018-04-27 2019-10-31 パナソニックＩｐマネジメント株式会社 モータ駆動装置及び搬送システム
CN112041775A (zh) * 2018-04-27 2020-12-04 松下知识产权经营株式会社 电动机驱动装置和输送系统
JPWO2019208758A1 (ja) * 2018-04-27 2021-05-20 パナソニックＩｐマネジメント株式会社 モータ駆動装置及び搬送システム
JP7213471B2 (ja) 2018-04-27 2023-01-27 パナソニックＩｐマネジメント株式会社 モータ駆動装置及び搬送システム

Also Published As

Publication number Publication date
CN103563238B (zh) 2016-03-23
JP5622125B2 (ja) 2014-11-12
US20140084839A1 (en) 2014-03-27
JPWO2012164740A1 (ja) 2014-07-31
US9069346B2 (en) 2015-06-30
CN103563238A (zh) 2014-02-05
DE112011105306T5 (de) 2014-03-20

Similar Documents

Publication Publication Date Title
WO2012164740A1 (ja) 多軸モータ駆動システム及び多軸モータ駆動装置
US9488687B2 (en) Multiaxial motor driving apparatus and multiaxial motor drive device for determining whether or not there is a miswiring
US11188054B2 (en) Parameter setting device and parameter setting method
US8190287B2 (en) Tool vector display apparatus for a machine tool with rotational axes
CN110601604B (zh) 一种多电机速度同步控制系统及其控制方法
CN102941426B (zh) 一种与机器人相配合的智能变位系统
JP2012043243A (ja) 工具先端点位置を制御する多軸加工機用数値制御装置
US10946514B2 (en) Controller, work control unit, multi-axis motion control unit, and drive control unit
US20130103180A1 (en) Method for avoiding an unwanted collision between a tool and a workpiece in a machine tool
JP5519734B2 (ja) モータの駆動の準備の完了時にデータの通信速度を変更するマスタ装置
JP2004199433A (ja) 同期制御装置
US10520913B2 (en) Numerical controller
US9622201B2 (en) Synchronization of control device
US20130110278A1 (en) Control device of gear processing machine
US6999844B2 (en) Numerical controller
CN109960221B (zh) 数值控制装置
JP2008525870A (ja) 検出器信号をシミュレートするためのモジュール
CN111136652A (zh) 减速机系统及其制造、校正数据生成及校正方法、机器人
CN114706351A (zh) 多轴设备的驱控设备、驱控方法和机床设备
JP2018106279A (ja) 数値制御装置
CN115315327A (zh) 机床的控制装置、控制系统以及控制方法
JP2017162156A (ja) モーションコントローラ、同期制御方法
KR101713651B1 (ko) 다종 액츄레이터 구동형 로봇제어기
KR102594072B1 (ko) 반도체 제조 설비의 구동 장치 및 반도체 제조 설비의 구동 방법
JP4385404B2 (ja) モータ駆動装置、およびモータ駆動装置の非常停止方法

Legal Events

Date Code Title Description
WWE Wipo information: entry into national phase

Ref document number: 201180071279.7

Country of ref document: CN

ENP Entry into the national phase

Ref document number: 2012554556

Country of ref document: JP

Kind code of ref document: A

121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 11867061

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 1120111053061

Country of ref document: DE

Ref document number: 112011105306

Country of ref document: DE

122 Ep: pct application non-entry in european phase

Ref document number: 11867061

Country of ref document: EP

Kind code of ref document: A1