JP2022123713A - motor controller - Google Patents

motor controller Download PDF

Info

Publication number
JP2022123713A
JP2022123713A JP2021021205A JP2021021205A JP2022123713A JP 2022123713 A JP2022123713 A JP 2022123713A JP 2021021205 A JP2021021205 A JP 2021021205A JP 2021021205 A JP2021021205 A JP 2021021205A JP 2022123713 A JP2022123713 A JP 2022123713A
Authority
JP
Japan
Prior art keywords
motor
current
control
mover
magnetic pole
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
Application number
JP2021021205A
Other languages
Japanese (ja)
Inventor
僧太 海田
Sota Kaida
仁 福原
Hitoshi Fukuhara
悌 大野
Tei Ono
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Omron Corp
Original Assignee
Omron Corp
Omron Tateisi Electronics Co
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 Omron Corp, Omron Tateisi Electronics Co filed Critical Omron Corp
Priority to JP2021021205A priority Critical patent/JP2022123713A/en
Priority to PCT/JP2021/009849 priority patent/WO2022172472A1/en
Publication of JP2022123713A publication Critical patent/JP2022123713A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/06Rotor flux based control involving the use of rotor position or rotor speed sensors
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/14Estimation or adaptation of machine parameters, e.g. flux, current or voltage
    • H02P21/18Estimation of position or speed
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P21/00Arrangements or methods for the control of electric machines by vector control, e.g. by control of field orientation
    • H02P21/22Current control, e.g. using a current control loop
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P25/00Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
    • H02P25/02Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
    • H02P25/022Synchronous motors
    • H02P25/024Synchronous motors controlled by supply frequency
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P25/00Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details
    • H02P25/02Arrangements or methods for the control of AC motors characterised by the kind of AC motor or by structural details characterised by the kind of motor
    • H02P25/06Linear motors
    • HELECTRICITY
    • H02GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02PCONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P6/00Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/14Electronic commutators
    • H02P6/16Circuit arrangements for detecting position

Abstract

To prevent, in detection of the position of a magnetic pole of a motor for a control axis configured to be applied with an unbalanced load, an unnecessary motion of a movable element of the motor, and reduce the time required for the detection of the position of the magnetic pole as much as possible.SOLUTION: A motor controller has a feedback system including a plurality of controllers that receive input of feedback signals related to the movement of a motor for a control axis configured to be applied with a predetermined unbalanced load, and executes first processing of increasing, with a current control unit, control current forming a driving force in the same phase as the phase of the control current, while maintaining a balanced state between the predetermined unbalanced load and the driving force, and second processing of calculating the position of the magnetic pole of the motor based on a displacement amount in which a movable element is displaced through the first processing and the control current increased in the first processing.SELECTED DRAWING: Figure 6

Description

本発明は、モータ制御装置に関する。 The present invention relates to a motor control device.

永久磁石同期モータは、高効率、省スペース等の利点を有することから普及が進んでおり、回転モータのみならずリニアモータとしても広く利用されている。永久磁石同期型の回転モータは、永久磁石を有する可動子(回転子)の磁極位置に応じた電圧を印加しないとトルクを発生できない等の問題があるので、磁極位置を正確に把握することが重要である。また、永久磁石型のリニアモータでは、一般的には固定子側に永久磁石を配置するが、回転モータの場合と同じように、可動子と固定子との相関において磁極位置を適切に把握して電圧印加を行わなければならない。周知のように、エンコーダを用いれば、その出力信号である位置信号に基づいてモータの速度及び磁極位置を演算することが可能であるが、インクリメンタルエンコーダを用いる場合には、電源投入時は初期磁極位置が不明であるため、この初期磁極位置を正確に検出して安定に起動する必要がある。 Permanent magnet synchronous motors are becoming more popular due to their advantages such as high efficiency and space saving, and are widely used not only as rotary motors but also as linear motors. A permanent magnet synchronous type rotary motor has problems such as being unable to generate torque unless a voltage is applied according to the magnetic pole position of a mover (rotor) having permanent magnets. is important. In a permanent magnet type linear motor, the permanent magnet is generally placed on the stator side. voltage must be applied. As is well known, if an encoder is used, it is possible to calculate the speed and magnetic pole position of the motor based on the position signal that is its output signal. Since the position is unknown, it is necessary to accurately detect this initial magnetic pole position and start stably.

また、モータの可動子に偏荷重が掛かっている場合、当該偏荷重により可動子が変位してしまうため偏荷重による影響を考慮して磁極位置の検出を行わなければならない。例えば、特許文献1に開示されている装置では、同期モータの電機子コイルに流す励磁電流によって決まる界磁位相の基準位相を中心に4種類の位相の電流を印加し、それぞれでのロータの角速度に基づいてモータの磁極位置が算出される。 In addition, when an unbalanced load is applied to the mover of the motor, the mover is displaced by the unbalanced load. Therefore, the magnetic pole position must be detected in consideration of the influence of the unbalanced load. For example, in the device disclosed in Patent Document 1, currents of four phases are applied centering on the reference phase of the field phase determined by the excitation current flowing through the armature coil of the synchronous motor, and the angular velocity of the rotor at each is The magnetic pole position of the motor is calculated based on.

特開2002-247881号公報JP-A-2002-247881

上記の特許文献1に示す技術によれば、4種類の電流印加を行い、それぞれにおいてロータの角速度を検出する必要があるため、偏荷重の作用によりロータが過大に動かないように、電流印加を切り替える度にブレーキ等の制動手段で制動力を利かせる必要がある。そのため、モータの磁極位置検出に要する時間が長くなってしまう。また、磁極位置の検出の際に可動子を変位させる回数が多いと、その分、可動子に接続された負荷装置の不要な変位に繋がり、好ましくない。特に、偏荷重が掛かる構成においては、偏荷重により可動子が加速しやすい状況に置かれているため、磁極位置の検出において不要な可動子の変位は可及的に抑制するのが好ましい。 According to the technique disclosed in Patent Document 1, it is necessary to apply four types of current and detect the angular velocity of the rotor in each of them. It is necessary to use a braking force with a braking means such as a brake each time switching is performed. Therefore, the time required to detect the magnetic pole position of the motor becomes long. Further, if the mover is displaced many times during the detection of the magnetic pole position, it leads to unnecessary displacement of the load device connected to the mover, which is not preferable. In particular, in a configuration where an unbalanced load is applied, the mover is likely to be accelerated by the unbalanced load, so it is preferable to suppress unnecessary displacement of the mover as much as possible in detecting the magnetic pole position.

本発明は、このような問題に鑑みてなされたものであり、偏荷重が掛かるように構成された制御軸用のモータの磁極位置の検出に際してモータの可動子の不要な動きを抑制し、且つ、磁極位置の検出に要する時間を可及的に短くする技術を提供することを目的とする。 The present invention has been made in view of such problems, and suppresses unnecessary movement of a mover of the motor when detecting the magnetic pole position of the motor for a control shaft configured to apply an unbalanced load, and An object of the present invention is to provide a technique for shortening the time required for detecting the magnetic pole position as much as possible.

本発明の一側面に係るモータ制御装置は、所定の偏荷重が掛かるように構成された制御軸用のモータの動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有するモータ制御装置であって、前記複数の制御器に含まれる電流制御器において、前記モータに供給される電流に関連するd軸電流及びq軸電流を制御する電流制御部と、前記電流制御部により前記モータに制御電流を印加することで、前記所定の偏
荷重と該モータの固定子から可動子が受ける駆動力とを釣り合わせた状態で、前記モータの磁極位置を検出する処理部と、を備える。そして、前記処理部は、前記所定の偏荷重と前記駆動力の釣り合い状態を保ちながら、前記電流制御部により、前記駆動力を形成する前記制御電流の位相と同位相で該制御電流を増加する第1処理と、該第1処理により前記可動子が変位した変位量と該第1処理で増加された前記制御電流とに基づいて、前記モータの磁極位置を算出する第2処理と、を実行するように構成される。
A motor control device according to one aspect of the present invention is a motor having a feedback system including a plurality of controllers to which feedback signals related to the operation of a motor for a control shaft configured to apply a predetermined unbalanced load are input. A control device, in which current controllers included in the plurality of controllers include a current controller for controlling a d-axis current and a q-axis current related to the current supplied to the motor; a processing unit that detects the magnetic pole position of the motor in a state in which the predetermined unbalanced load and the driving force that the mover receives from the stator of the motor are balanced by applying a control current to the motor. . Then, the processing unit increases the control current in the same phase as the control current forming the driving force by the current control unit while maintaining a balanced state between the predetermined unbalanced load and the driving force. A first process and a second process of calculating the magnetic pole position of the motor based on the amount of displacement of the mover by the first process and the control current increased by the first process are executed. configured to

上記モータ制御装置は、複数の制御器を含むフィードバック系を有しており、これらの制御器によってモータのサーボ制御が実現される。当該フィードバック系は特定の形態のものに限定されない。複数の制御器には、モータへの駆動電流を供給するインバータ等の電力変換器への電圧指令を生成する電流制御器が含まれる。電流制御部は、この電流制御器によりモータのベクトル制御を実現するために、d軸電流及びq軸電流を制御する。更に、フィードバック系には、電流制御器以外に、少なくともモータの動作をサーボ制御するための、電流制御器より上位側の制御器が含まれてもよい。上位側の制御器としては、位置制御器や速度制御器が例示できる。 The motor control device has a feedback system including a plurality of controllers, and servo control of the motor is realized by these controllers. The feedback system is not limited to any particular form. The plurality of controllers includes a current controller that generates a voltage command to a power converter such as an inverter that supplies drive current to the motor. The current controller controls the d-axis current and the q-axis current in order to realize vector control of the motor by this current controller. Furthermore, the feedback system may include, in addition to the current controller, a controller higher than the current controller for servo-controlling at least the operation of the motor. A position controller and a speed controller can be exemplified as controllers on the upper side.

ここで、処理部は、モータに制御電流を印加して所定の偏荷重とモータの固定子から可動子が受ける駆動力とを釣り合わせた状態で、第1処理、第2処理の順で処理を行うことで、モータの磁極位置を検出する。この磁極位置の検出は、例えば、モータ制御装置への電力供給が再開されたときに行われてもよく、その他、ユーザが必要とする任意のタイミングで行われてもよい。第1処理では、所定の偏荷重と駆動力の釣り合い状態において、その釣り合いのための駆動力を形成する制御電流の位相と同位相で該制御電流を増加する。このときは、電源投入後モータの磁極位置の検出は行われていないため、モータ制御装置が暫定的に保持する磁極位置を前提として上記制御電流の印加、及び第1処理における制御電流の増加処理が行われればよい。 Here, the processing unit applies a control current to the motor and balances a predetermined unbalanced load with the driving force received by the mover from the stator of the motor, and performs the first processing and the second processing in this order. to detect the magnetic pole position of the motor. This detection of the magnetic pole position may be performed, for example, when the power supply to the motor control device is restarted, or may be performed at any timing required by the user. In the first process, in a state of balance between a predetermined unbalanced load and driving force, the control current is increased in phase with the phase of the control current forming the driving force for the balance. At this time, since the magnetic pole position of the motor is not detected after the power is turned on, the application of the control current and the increase processing of the control current in the first processing are performed on the assumption that the magnetic pole position is temporarily held by the motor control device. should be performed.

ここで、フィードバック系により、第1処理により増加された制御電流による駆動力と偏荷重との釣り合い状態が維持されるため、モータの可動子が変位する。この可動子の変位量は、フィードバック系による電流制御部での電流制御に関連し、第1処理により増加された制御電流と所定の相関を有することを見出した。d軸とq軸は直交座標を形成するため、当該変位量と増加された制御電流との間には、例えば、所定の三角関数で表される相関を有する。そこで、第2処理では、第1処理を経た可動子の変位量と第1処理で増加された制御電流とに基づいて、前記モータの磁極位置が算出される。例えば、当該相関を踏まえて、前記処理部は、前記第2処理において、前記変位量と前記増加された制御電流とに基づいて、前記モータの磁極位置を形成する所定の電流軸に対する、前記第1処理前の前記駆動力を形成する前記制御電流の位相ずれを算出し、該位相ずれにより該モータの磁極位置を算出してもよい。なお、両者の相関は、三角関数で表される関係以外の相関、例えば、両者の数値関係を1対1で画定する相関であってもよい。 Here, the balance state between the driving force and the unbalanced load due to the control current increased by the first process is maintained by the feedback system, so that the mover of the motor is displaced. It was found that this displacement amount of the mover is related to the current control in the current control section by the feedback system, and has a predetermined correlation with the control current increased by the first process. Since the d-axis and the q-axis form orthogonal coordinates, there is a correlation represented by, for example, a predetermined trigonometric function between the displacement amount and the increased control current. Therefore, in the second process, the magnetic pole position of the motor is calculated based on the amount of displacement of the mover through the first process and the control current increased in the first process. For example, based on the correlation, the processing unit may, in the second processing, calculate the first A phase shift of the control current forming the driving force before one process may be calculated, and the magnetic pole position of the motor may be calculated from the phase shift. Note that the correlation between the two may be a correlation other than the relationship represented by a trigonometric function, for example, a correlation defining a one-to-one numerical relationship between the two.

このような構成により、上記のモータ制御装置は、モータの磁極位置を検出することができる。このとき、フィードバック系の制御器によって所定の偏荷重と上記駆動力とを釣り合わせた状態に置くため、モータの可動子が移動する量を可及的に抑制することができる。また、従来技術の電流指令の印加技術のように多回数、所定の処理を繰り返す必要はないため、磁極位置の検出に要する時間の短縮を図ることができる。 With such a configuration, the motor control device can detect the magnetic pole position of the motor. At this time, since the predetermined unbalanced load and the driving force are balanced by the controller of the feedback system, the moving amount of the mover of the motor can be suppressed as much as possible. In addition, since there is no need to repeat a predetermined process many times as in the conventional technique of applying a current command, it is possible to shorten the time required to detect the magnetic pole position.

ここで、上述までのモータ制御装置において、前記処理部は、前記第1処理において、所定の時定数で前記制御電流を増加させてもよい。第1処理において制御電流の増加が急
峻に行われると、フィードバック系を介した電流制御部による可動子の変位が振動的となり、モータの磁極位置の検出の精度に好ましくない影響を及ぼし得る。そこで、制御電流の増加処理を所定の時定数で行うのが好ましい。
Here, in the motor control device described above, the processing unit may increase the control current with a predetermined time constant in the first processing. If the control current is sharply increased in the first process, the displacement of the mover by the current control unit via the feedback system becomes oscillating, which may adversely affect the accuracy of detecting the magnetic pole position of the motor. Therefore, it is preferable to perform the process of increasing the control current with a predetermined time constant.

ここで、上述までのモータ制御装置において、前記処理部は、前記第1処理の前において、前記モータの前記可動子の制動状態を解消させたときに、前記フィードバック系により得られる前記可動子の速度情報に基づいて、該モータに制御電流を印加して、前記所定の偏荷重と該モータの固定子から可動子が受ける駆動力とを釣り合わせた状態を形成してもよい。モータの可動子の制動状態を解消させた時点では、まだモータの磁極位置は検出されていない。そこで、所定の偏荷重を受ける場においても可動子の速度が零となるように、換言すれば可動子が固定子と可動子との間に作用する駆動力で停止するように、モータ制御装置が有する暫定的な磁極位置に従ってモータへの制御電流の印加が行われ、第1処理及び第2処理のための釣り合い状態が形成される。 Here, in the motor control device described above, the processing unit, before the first process, controls the moving element obtained by the feedback system when the braking state of the moving element of the motor is canceled. A control current may be applied to the motor based on the speed information to form a state in which the predetermined unbalanced load and the driving force received by the mover from the stator of the motor are balanced. The magnetic pole position of the motor has not yet been detected when the braking state of the mover of the motor is released. Therefore, the motor control device is designed so that the speed of the mover becomes zero even when a predetermined unbalanced load is applied, in other words, the mover is stopped by the driving force acting between the stator and the mover. A control current is applied to the motor in accordance with the tentative magnetic pole position of , forming a balanced state for the first process and the second process.

そして、第1処理における制御電流の増加処理は、この釣り合い状態を形成するための制御電流を起点として行われる。すなわち、釣り合い状態を形成している制御電流の位相(モータ制御装置が有する暫定的な磁極位置に従った位相)を保ちながら、その電流値を増加させる。また、1処理及び第2処理のための釣り合い状態を形成するための制御電流の印加は、上記以外の形態を採用してもよい。例えば、フィードバック系により得られる可動子の位置情報や加速度情報を利用して、制御電流を印加するようにしてもよく、それ以外の制御電流の印加の形態を採用してもよい。 The control current increasing process in the first process is performed with the control current for forming this balanced state as a starting point. That is, the current value is increased while maintaining the phase of the control current forming the balanced state (the phase according to the temporary magnetic pole position of the motor control device). Moreover, the application of the control current for forming the balanced state for the first process and the second process may adopt a form other than the above. For example, the position information and acceleration information of the mover obtained by the feedback system may be used to apply the control current, or other forms of application of the control current may be employed.

また、上述までのモータ制御装置に係る技術思想は、永久磁石同期型の回転モータ、永久磁石同期型のリニアモータの何れにも適用することができる。 Further, the technical concept relating to the motor control device described above can be applied to both a permanent magnet synchronous rotary motor and a permanent magnet synchronous linear motor.

偏荷重が掛かるように構成された制御軸用のモータの磁極位置の検出に際してモータの可動子の不要な動きを抑制し、且つ、磁極位置の検出に要する時間を可及的に短くすることができる。 When detecting the magnetic pole position of a motor for a control shaft configured to apply an unbalanced load, unnecessary movement of the mover of the motor can be suppressed and the time required for detecting the magnetic pole position can be shortened as much as possible. can.

本発明の実施形態に係るサーボドライバを含むサーボシステムの概略構成を示す図である。1 is a diagram showing a schematic configuration of a servo system including a servo driver according to an embodiment of the invention; FIG. サーボドライバが有するフィードバック系の制御構造を示す図である。FIG. 3 is a diagram showing a control structure of a feedback system that a servo driver has; サーボドライバが有する電流制御器の制御構造を示す図である。FIG. 4 is a diagram showing the control structure of a current controller that the servo driver has; 垂直軸において、ブレーキの解放後、可動子の釣り合い状態を形成するための方法の説明図である。FIG. 10 is an illustration of a method for establishing armature equilibrium after release of the brake in the vertical axis; 本発明のサーボドライバによるモータの磁極位置の推定方法を説明するための第1の図である。FIG. 4 is a first diagram for explaining a method of estimating a magnetic pole position of a motor by the servo driver of the present invention; 本発明のサーボドライバによるモータの磁極位置の推定方法を説明するための第2の図である。FIG. 4 is a second diagram for explaining a method of estimating the magnetic pole position of the motor by the servo driver of the present invention; 本発明のサーボドライバによるモータの磁極位置の推定処理の流れを示すフローチャートである。4 is a flow chart showing a flow of estimation processing of the magnetic pole position of the motor by the servo driver of the present invention; モータの磁極位置の推定処理において、制御電流の増加推移を示す図である。FIG. 10 is a diagram showing an increase transition of a control current in a process of estimating a magnetic pole position of a motor;

以下、本発明の実施の形態について、図面を参照しながら詳細に説明する。なお、図中同一または相当部分には同一符号を付して、その説明は繰り返さない。本開示では、サーボシステムの一つの例示的形態として、産業用システムを示す。しかしながら、本発明に係るサーボシステムの用途は特に限定されるものではない。なお、本願明細書で示される位相は、特段の記載がない場合は、電気角に基づくものである。 BEST MODE FOR CARRYING OUT THE INVENTION Hereinafter, embodiments of the present invention will be described in detail with reference to the drawings. The same or corresponding parts in the drawings are denoted by the same reference numerals, and the description thereof will not be repeated. This disclosure presents an industrial system as one exemplary form of servo system. However, the application of the servo system according to the present invention is not particularly limited. It should be noted that the phases indicated in the specification of the present application are based on the electrical angle unless otherwise specified.

<実施例1>
図1は、本発明の実施の形態に係るサーボドライバ4を含む制御システムの概略構成図である。制御システムは、ネットワーク1と、モータ2と、負荷装置3と、サーボドライバ4と、PLC(Programmable Logic Controller)5とを備える。当該制御システムでは
、PLC5で動作指令信号が生成され、それがネットワーク1を介してサーボドライバ4に届けられる。そして、サーボドライバ4は、その動作指令信号に従って制御対象とされる負荷装置3を駆動するように構成されたモータ2をサーボ制御する。ここで、負荷装置3としては、各種の機械装置(例えば、産業用ロボットのアームや搬送装置)が例示でき、モータ2はその負荷装置3を駆動するアクチュエータとして負荷装置3に取り付けられている。例えば、モータ2は、ACサーボモータである。
<Example 1>
FIG. 1 is a schematic configuration diagram of a control system including a servo driver 4 according to an embodiment of the invention. The control system includes a network 1 , a motor 2 , a load device 3 , a servo driver 4 and a PLC (Programmable Logic Controller) 5 . In this control system, the PLC 5 generates an operation command signal, which is delivered to the servo driver 4 via the network 1 . The servo driver 4 servo-controls the motor 2 configured to drive the load device 3 to be controlled according to the operation command signal. Here, as the load device 3 , various mechanical devices (for example, an arm of an industrial robot and a transfer device) can be exemplified, and the motor 2 is attached to the load device 3 as an actuator for driving the load device 3 . For example, motor 2 is an AC servomotor.

モータ2にはエンコーダ21が取り付けられており、エンコーダ21によりモータ2の動作に関するパラメータ信号がサーボドライバ4の制御部40にフィードバック送信されている。エンコーダ21は、インクリメンタル方式のエンコーダである。制御部40にフィードバック送信されるパラメータ信号(以下、フィードバック信号という)は、たとえばモータ2の可動子位置についての位置情報、その可動子の速度の情報等を含む。また、モータ2は、負荷装置3における垂直軸(Z軸)を駆動するためのアクチュエータであり、制動のためのブレーキ装置22を備えている。なお、ブレーキ装置22は、モータ2とは別体に、負荷装置3の垂直軸に対して制動力を付与するように構成されてもよい。ブレーキ22の制動及びその解除は、図示しないブレーキ信号線を介してサーボドライバ4からの制御信号により実行される。 An encoder 21 is attached to the motor 2 , and a parameter signal regarding the operation of the motor 2 is fed back to the controller 40 of the servo driver 4 by the encoder 21 . The encoder 21 is an incremental encoder. A parameter signal (hereinafter referred to as a feedback signal) that is feedback-transmitted to the control unit 40 includes, for example, position information about the position of the mover of the motor 2, information on the speed of the mover, and the like. Also, the motor 2 is an actuator for driving the vertical axis (Z-axis) of the load device 3 and has a braking device 22 for braking. The brake device 22 may be configured separately from the motor 2 so as to apply a braking force to the vertical axis of the load device 3 . Braking and releasing of the brake 22 are executed by a control signal from the servo driver 4 via a brake signal line (not shown).

また、サーボドライバ4の制御部40は、PLC5からの動作指令信号およびエンコーダ21からのフィードバック信号に基づいてモータ2のサーボ制御を行い、インバータ6を介してモータ2に駆動電流を供給する。この供給電流は、交流電源7からインバータ6に対して送られる交流電力が利用される。本実施例では、インバータ6は三相交流を受けるタイプのものであるが、単相交流を受けるタイプのものでもよい。なお、サーボドライバ4の制御部40は、位置制御器41、速度制御器42、電流制御器43を含むフィードバック系を備えている。 Also, the control unit 40 of the servo driver 4 performs servo control of the motor 2 based on the operation command signal from the PLC 5 and the feedback signal from the encoder 21 and supplies drive current to the motor 2 via the inverter 6 . The AC power sent from the AC power supply 7 to the inverter 6 is used as the supplied current. In this embodiment, the inverter 6 is of a type that receives three-phase alternating current, but may be of a type that receives single-phase alternating current. The controller 40 of the servo driver 4 has a feedback system including a position controller 41 , a speed controller 42 and a current controller 43 .

ここで、図2に基づいて、サーボドライバ4の制御部40が有するフィードバック系の制御構造について説明する。制御部40のフィードバック系は、位置制御器41、速度制御器42、電流制御器43を備えている。位置制御器41は、例えば、比例制御(P制御)を行う。具体的には、PLC5からの位置指令P_refとモータ2の位置現在値P_actとの偏差である位置偏差に、所定の位置比例ゲインを乗ずることにより速度指令V_refを算出する。なお、位置現在値P_actは、エンコーダ21の出力が位置検出器45に入力されて得られる、モータ2の現在位置を意味するパラメータである。 Here, based on FIG. 2, the control structure of the feedback system of the control section 40 of the servo driver 4 will be described. A feedback system of the control unit 40 includes a position controller 41 , a speed controller 42 and a current controller 43 . The position controller 41 performs proportional control (P control), for example. Specifically, the speed command V_ref is calculated by multiplying the position deviation, which is the deviation between the position command P_ref from the PLC 5 and the current position value P_act of the motor 2, by a predetermined position proportional gain. The current position value P_act is a parameter indicating the current position of the motor 2 obtained by inputting the output of the encoder 21 to the position detector 45 .

速度制御器42は、例えば、比例積分制御(PI制御)を行う。具体的には、位置制御器41により算出された速度指令V_refとモータ2の速度現在値V_actとの偏差である速度偏差の積分量に所定の速度積分ゲインを乗じ、その算出結果と当該速度偏差の和に所定の速度比例ゲインを乗ずることにより、トルク指令τ_refを算出する。また、速度制御器42はPI制御に代えてP制御を行ってもよい。なお、速度現在値V_actは、位置検出器45の出力が速度検出器46に入力されて得られる、モータ2の現在速度を意味するパラメータである。 The speed controller 42 performs proportional integral control (PI control), for example. Specifically, the integral amount of the speed deviation, which is the deviation between the speed command V_ref calculated by the position controller 41 and the current speed value V_act of the motor 2, is multiplied by a predetermined speed integral gain, and the calculation result and the speed deviation A torque command τ_ref is calculated by multiplying the sum of , by a predetermined speed proportional gain. Also, the speed controller 42 may perform P control instead of PI control. The current speed value V_act is a parameter representing the current speed of the motor 2 obtained by inputting the output of the position detector 45 to the speed detector 46 .

電流制御器43は、速度制御器42により算出されたトルク指令τ_refと、モータ2の位置現在値P_act及び速度現在値V_actと、インバータ6からモータ2に供給されている駆動電流とに基づいて電流指令を生成し、当該電流指令に基づいて三相交流モータの各相に対応する電圧指令をインバータ6に出力する。当該電圧指令を受けたイン
バータ6は、モータ2の各相(U相、V相、W相)に駆動電圧を印加しモータ2を駆動制御する。なお、モータ2に供給されている駆動電流は、電流検出器44により検出される。図2においては、モータ2の各相に対応する構成は簡略化されて記載されているが、実際には電流検出器44は、モータ2の各相の巻線に流れる電流を検出し、その各相の電流の値を電流制御器43に返している。電流制御器43は、トルク指令に関するフィルタ(1次のローパスフィルタ)や一又は複数のノッチフィルタを含んでもよい。
The current controller 43 adjusts the current based on the torque command τ_ref calculated by the speed controller 42 , the current position value P_act and the current speed value V_act of the motor 2 , and the drive current supplied to the motor 2 from the inverter 6 . A command is generated, and a voltage command corresponding to each phase of the three-phase AC motor is output to the inverter 6 based on the current command. Upon receiving the voltage command, the inverter 6 applies a drive voltage to each phase (U phase, V phase, W phase) of the motor 2 to drive and control the motor 2 . The driving current supplied to the motor 2 is detected by a current detector 44. FIG. In FIG. 2, the configuration corresponding to each phase of the motor 2 is illustrated in a simplified manner. The current value of each phase is returned to the current controller 43 . The current controller 43 may include a filter (primary low-pass filter) and one or more notch filters related to the torque command.

次に、図3に基づいて、電流制御器43において形成されている制御構造について説明する。電流制御器43においてはベクトル制御が行われている。そこで、電流制御器43に入力されたトルク指令τ_refは、先ず電流指令演算器51に入力される。電流指令演算器51には、更にモータ2の速度現在値V_actが入力され、d軸電流指令Id_refとq軸電流指令Iq_refが生成される。そして、d軸電流指令Id_refと、モータ2に現在流れているd軸電流Idとの偏差がd軸電流制御器52に入力され、q軸電流指令Iq_refと、モータ2に現在流れているq軸電流Iqとの偏差がq軸電流制御器53に入力される。なお、モータ2に現在流れているd軸電流Idとq軸電流Iqは、電流検出器44によって検出されたモータ2のU相、V相、W相を流れる電流Iu、Iv、Iwが電流座標変換器56に入力され、そこでdq変換処理を施すことで算出される。 Next, the control structure formed in the current controller 43 will be described with reference to FIG. Vector control is performed in the current controller 43 . Therefore, the torque command τ_ref input to the current controller 43 is first input to the current command calculator 51 . Current speed value V_act of motor 2 is further input to current command calculator 51 to generate d-axis current command Id_ref and q-axis current command Iq_ref. Then, the deviation between the d-axis current command Id_ref and the d-axis current Id currently flowing through the motor 2 is input to the d-axis current controller 52, and the q-axis current command Iq_ref and the q-axis current flowing through the motor 2 A deviation from the current Iq is input to the q-axis current controller 53 . The d-axis current Id and the q-axis current Iq currently flowing through the motor 2 are represented by the current coordinates of the currents Iu, Iv, and Iw flowing through the U-phase, V-phase, and W-phase of the motor 2 detected by the current detector 44. It is input to the converter 56, where it is calculated by performing dq conversion processing.

d軸電流制御器52は、モータ2の物性パラメータを考慮して、入力されたd軸電流の偏差から、d軸に関する電圧指令Vdを算出し、同じように、q軸電流制御器53は、モータ2の物性パラメータを考慮して、入力されたq軸電流の偏差から、q軸に関する電圧指令Vqを算出する。算出された電圧指令Vd、Vqは電圧座標変換器54に入力される。電圧座標変換器54は、入力されたd軸に関する電圧指令とq軸に関する電圧指令に対して、dq軸から三相への変換処理を施し、モータ2の各相への印加電圧の電圧指令Vu、Vv、Vwを生成する。これらの電圧指令はPWM演算部55に引き渡され、そこでインバータ6への指令として形成され、インバータ6に送られる。 The d-axis current controller 52 calculates a voltage command Vd for the d-axis from the deviation of the input d-axis current in consideration of the physical parameters of the motor 2. Similarly, the q-axis current controller 53 A voltage command Vq for the q-axis is calculated from the input deviation of the q-axis current in consideration of the physical parameters of the motor 2 . The calculated voltage commands Vd and Vq are input to the voltage coordinate converter 54 . The voltage coordinate converter 54 converts the input d-axis voltage command and q-axis voltage command from the dq-axis to a three-phase voltage command Vu , Vv, Vw. These voltage commands are handed over to the PWM calculator 55 where they are formed as commands to the inverter 6 and sent to the inverter 6 .

このように構成されるサーボドライバ4において、その電源を一度OFFにし、その後、再び電源を投入したとき、モータ2のエンコーダ21はインクリメンタル方式のエンコーダであるため、モータ2のサーボ制御を開始する前に、その磁極位置を検出しなければならない。磁極位置を正確に検出しなければモータ2の好適なサーボ制御が困難となり、また、一般的には、電源投入後には速やかで安全なモータ2の稼働が望まれる。そこで、モータ2の磁極位置の検出処理に要する時間を可及的に短くし、且つ、その検出処理の間にモータ2の出力軸の不要な動きを抑制できる磁極位置の検出処理の原理について、以下に説明する。 In the servo driver 4 configured as described above, when the power is turned off once and then turned on again, the encoder 21 of the motor 2 is an incremental encoder. Also, its magnetic pole position must be detected. If the magnetic pole position is not accurately detected, suitable servo control of the motor 2 becomes difficult, and in general, it is desired that the motor 2 operate quickly and safely after the power is turned on. Therefore, the principle of the magnetic pole position detection process that can shorten the time required for the magnetic pole position detection process of the motor 2 as much as possible and suppress unnecessary movement of the output shaft of the motor 2 during the detection process is as follows. It is explained below.

ここで、図1に示すように、モータ2は負荷装置3の垂直軸を駆動するアクチュエータである。そのため、垂直軸における駆動対象の重力に起因する偏荷重がモータ2の出力軸に掛かっている。本実施形態では、偏荷重が鉛直方向に掛かるものとする。したがって、例えば、サーボドライバ4への電力供給が停止した状態から電力の供給を再開した時点、すなわち、サーボドライバ4の電源投入時においては、モータ2の磁極位置が正確に検出されていない状態、すなわち、サーボドライバ4が暫定的に保持しているd軸とq軸は、
モータ2の可動子(ロータ)に基づいて理論的に設定される軸とずれた状態となっている。そのため、モータ2の好適なサーボ制御のために、磁極位置の検出処理を行う必要がある。なお、磁極位置の検出処理は、電源投入時ではなく、電源投入後にユーザが必要とする任意のタイミングで行われてもよい。
Here, as shown in FIG. 1, the motor 2 is the actuator that drives the vertical axis of the load device 3 . Therefore, an unbalanced load is applied to the output shaft of the motor 2 due to the gravity of the driven object on the vertical axis. In this embodiment, it is assumed that the unbalanced load is applied in the vertical direction. Therefore, for example, when the power supply to the servo driver 4 is restarted after being stopped, that is, when the power of the servo driver 4 is turned on, the magnetic pole position of the motor 2 is not accurately detected. That is, the d-axis and q-axis temporarily held by the servo driver 4 are
The axis is deviated from the theoretically set axis based on the mover (rotor) of the motor 2 . Therefore, for suitable servo control of the motor 2, it is necessary to detect the magnetic pole position. Note that the magnetic pole position detection processing may be performed at any timing desired by the user after the power is turned on, instead of when the power is turned on.

ここで、サーボドライバ4の電源がオフにされモータ2が停止している間、モータ2の出力軸を制動するためにブレーキ装置22により所定の制動力が出力軸に付与されている
。そして、モータ2をサーボ制御するためにサーボドライバ4の電源が投入されると、ブレーキ装置22による制動状態が解除されるが、その場合、偏荷重が作用することで、負荷装置3における移動体(モータ2により駆動される物体)が鉛直方向に落下し、それに伴いモータ2の可動子が変位する。
Here, while the servo driver 4 is powered off and the motor 2 is stopped, the braking device 22 applies a predetermined braking force to the output shaft of the motor 2 to brake the output shaft. When the power of the servo driver 4 is turned on to servo-control the motor 2, the braking state by the braking device 22 is released. (an object driven by the motor 2) falls vertically, and the mover of the motor 2 is displaced accordingly.

本実施形態の磁極位置の検出処理においては、ブレーキ装置22による制動の解除後に、モータ2の可動子に掛かる偏荷重と、モータ2の固定子側から受ける駆動力(磁力)とが釣り合った状態で行われる。そこで、図4に基づいて、当該釣り合い状態を形成するための手法について説明する。図4は、ブレーキ装置22による制動が解除され、偏荷重によりモータ2の可動子が変位を開始したときの、固定子に対する可動子の位置や姿勢を、時間の経過とともに重ねて模式的に記載したものである。図4において、固定子には永久磁石が設けられ、その磁極はN極とS極が交互に配置されている。一方で、可動子に形成される磁極は、巻線等のコイルにより制御可能に形成される。また、図4においては、本願開示を理解しやすくするために、モータ2の可動子と固定子を永久磁石同期型のリニアモータの形態に従って記載しているが、これにはモータ2として永久磁石同期型の回転モータを排除する意図は無い。モータ2が永久磁石同期型の回転モータであっても原理的には図4に示す形態で表現できることは、当業者であれば理解できる。 In the magnetic pole position detection process of this embodiment, after the braking by the brake device 22 is released, the unbalanced load applied to the mover of the motor 2 and the driving force (magnetic force) received from the stator side of the motor 2 are balanced. is done in Therefore, a method for forming the balanced state will be described with reference to FIG. FIG. 4 schematically shows the position and posture of the mover with respect to the stator when the brake device 22 is released and the mover of the motor 2 starts to displace due to the unbalanced load, superimposed over time. It is what I did. In FIG. 4, the stator is provided with permanent magnets, the magnetic poles of which are alternately arranged as N poles and S poles. On the other hand, the magnetic poles formed in the mover are formed in a controllable manner by coils such as windings. In FIG. 4, the mover and stator of the motor 2 are described according to the form of a permanent magnet synchronous linear motor in order to facilitate understanding of the disclosure of the present application. There is no intention to exclude synchronous rotary motors. Those skilled in the art will understand that even if the motor 2 is a permanent magnet synchronous rotary motor, it can be expressed in principle in the form shown in FIG.

ここで、図4の左側(a)には、従来技術の形態による釣り合い状態の形成の様子が示されている。従来技術においては、ブレーキ装置22による制動が解除された後、可動子の巻線に流れる制御電流の位相は一定とされる。この場合、その磁極の向きは固定されたまま、偏荷重に従って可動子は固定子に対して変位していく。このとき、可動子の磁極と固定子の磁極とによって引力f1が発生した状態が示されている。この引力f1の垂直方向の分力をf11、水平方向の分力をf12とすると、分力f11は、偏荷重f2に抗するように発生する。したがって、分力f11と偏荷重f2が釣り合えば可動子を固定子に対して固定することができる。しかし、従来技術においては、可動子の磁極の向きが固定されているため、固定子側に発生する磁極との間で生じる引力や斥力によって可動子の動きを止める状態を速やかに形成する機会が限られる。そのため、落下により可動子の速度が上昇すると必ずしも可動子を止めることができるわけではない。例えば、図4(a)に示す状態で、分力f11がf2より小さい場合、可動子は止まらず、偏荷重によって更に加速し落下していく。また、瞬時的に分力f11がf2と釣り合ったとしても、落下速度が大きくなると、速度の影響で可動子はすぐに止まることは困難であり、その結果、次の固定子側に引き込まれる位置まで落下し続けてしまうと、可動子の速度が更に上昇し、可動子を止めにくくなる。 Here, the left side (a) of FIG. 4 shows the formation of the balanced state according to the prior art configuration. In the prior art, the phase of the control current flowing through the windings of the mover is kept constant after the braking by the brake device 22 is released. In this case, the mover is displaced with respect to the stator according to the unbalanced load while the direction of the magnetic pole remains fixed. At this time, a state in which an attractive force f1 is generated by the magnetic poles of the mover and the magnetic poles of the stator is shown. Assuming that the vertical component force of this attractive force f1 is f11 and the horizontal component force is f12, the component force f11 is generated to resist the unbalanced load f2. Therefore, if the force component f11 and the offset load f2 are balanced, the mover can be fixed to the stator. However, in the prior art, since the orientation of the magnetic poles of the mover is fixed, there is an opportunity to quickly create a state in which the movement of the mover is stopped by the attractive force or repulsive force generated between the magnetic poles generated on the stator side. Limited. Therefore, when the speed of the mover increases due to the fall, the mover cannot necessarily be stopped. For example, in the state shown in FIG. 4(a), when the force component f11 is smaller than f2, the mover does not stop, but accelerates further and falls due to the biased load. Also, even if the component force f11 and f2 are momentarily balanced, when the falling speed increases, it is difficult for the mover to stop immediately due to the effect of the speed, and as a result, the position where the mover is drawn to the next stator side If it continues to fall, the speed of the mover will increase further, making it difficult to stop the mover.

これに対して、本願開示では、図4の右側(b)に示すように、ブレーキ装置22による制動が解除された後、制御部40のフィードバック系のフィードバック信号に基づいて、可動子の磁極の向きを好適にサーボ制御しながら、偏荷重に従って可動子は固定子に対して変位していく。具体的には、図2及び図3に示すフィードバック系において、速度指令V_refとして速度0の信号を入力するとともに、フィードバックされる速度現在値V_actと速度指令V_refに基づいて電流制御器43による電流制御が行われ、可動子の巻線に制御電流が印加される。これにより、可動子と固定子との間に、可動子を止めるための引力又は斥力を速やかに発生させる。図4(b)では、可動子の磁極と固定子の磁極とによって斥力f3が発生した状態が示されている。この斥力f3の垂直方向の分力をf31、水平方向の分力をf32とすると、分力f31は、偏荷重f4に抗するように発生する。そして、分力f31と偏荷重f4が釣り合えば可動子を固定子に対して固定することができる。図4(b)の形態では、速やかに好適な引力又は斥力を発生させることができるため、図4(a)に示すように可動子の速度が大きく上昇してしまう前にその速度を効果的に低減させ、好適にモータ2の可動子に掛かる偏荷重と、モータ2の固定子側から受ける駆動力とを釣り合わせることができる。 On the other hand, in the disclosure of the present application, as shown in the right side (b) of FIG. The mover is displaced with respect to the stator according to the unbalanced load while suitably servo-controlling the orientation. Specifically, in the feedback system shown in FIGS. 2 and 3, a signal of speed 0 is input as the speed command V_ref, and current control by the current controller 43 is performed based on the current speed value V_act and the speed command V_ref to be fed back. is performed and a control current is applied to the windings of the mover. As a result, an attractive force or a repulsive force for stopping the mover is quickly generated between the mover and the stator. FIG. 4B shows a state in which a repulsive force f3 is generated by the magnetic poles of the mover and the magnetic poles of the stator. Assuming that the vertical component force of this repulsive force f3 is f31 and the horizontal component force is f32, the component force f31 is generated to resist the unbalanced load f4. Then, when the component force f31 and the offset load f4 are balanced, the mover can be fixed to the stator. In the form of FIG. 4(b), suitable attractive force or repulsive force can be generated quickly, so that the speed of the mover can be effectively reduced before it increases significantly as shown in FIG. 4(a). , and the unbalanced load applied to the mover of the motor 2 and the driving force received from the stator side of the motor 2 can be balanced.

なお、上記の制御部40のフィードバック系のフィードバック信号に基づいた可動子の磁極の向きの制御について、速度現在値V_actが利用されているが、当該速度現在値V_actは、可動子の速度及びその移動方向に関する情報を含んでいることは理解できる。また、可動子の速度に関する情報の他に、可動子の位置に関する情報(例えば、位置現在値P_act)や可動子の加速度に関する情報(例えば、速度現在値V_actを更に微分して算出される値)も利用して可動子の磁極の向きの制御を行ってもよい。可動子の位置に関する情報を利用する場合には、位置指令P_refとして固定位置とするための信号を入力し、可動子の加速度に関する情報を利用する場合には、トルク指令τ_refとしてトルク0の信号を入力すればよい。 Note that the current speed value V_act is used for the control of the orientation of the magnetic poles of the mover based on the feedback signal of the feedback system of the control unit 40. The current speed value V_act is the speed of the mover and its It can be understood that it contains information about the direction of movement. In addition to the information about the speed of the mover, information about the position of the mover (for example, the current position value P_act) and information about the acceleration of the mover (for example, a value calculated by further differentiating the current speed value V_act) may also be used to control the orientation of the magnetic poles of the mover. When using the information on the position of the mover, a signal for fixing the position is input as the position command P_ref, and when using the information on the acceleration of the mover, the signal of torque 0 is input as the torque command τ_ref. Just enter it.

図4(b)に示すようにモータ2の可動子に掛かる偏荷重と、モータ2の固定子側から受ける駆動力とを釣り合わせることで、モータ2の磁極位置の検出処理を安定的に行うことができる。次に、図5及び図6に基づいて、モータ2の磁極位置の検出処理について説明する。図5において、モータ2の固定子側に設定された直交座標をα軸、β軸で表している。上述したフィードバック系による制御電流が印加されて、上記の釣り合い状態が形成されているときの、印加電流の電流指令をIrefとする。この時点では、サーボドライバ4は図5に示すd軸及びq軸の正確な位置は把握しておらず、暫定的に保持している磁極情報に基づいて電流指令Irefを出力している。 As shown in FIG. 4B, by balancing the unbalanced load applied to the mover of the motor 2 and the driving force received from the stator side of the motor 2, the detection processing of the magnetic pole position of the motor 2 is stably performed. be able to. Next, based on FIG.5 and FIG.6, the detection process of the magnetic pole position of the motor 2 is demonstrated. In FIG. 5, the orthogonal coordinates set on the stator side of the motor 2 are represented by the α-axis and the β-axis. Let Iref be the current command for the applied current when the control current is applied by the feedback system described above and the balanced state is established. At this time, the servo driver 4 does not know the exact positions of the d-axis and the q-axis shown in FIG. 5, and outputs the current command Iref based on the temporarily held magnetic pole information.

図5においては、電流指令演算器51によって生成された電流指令Irefに対応する電流がベクトルV1で表されている。そして、ベクトルV1の方向をα’軸とし、それに直交する方向をβ’軸とする。また、α’軸とd軸とが為す角をθbarとする。ここで、ベクトルV1のd軸成分のベクトルをV2とし、q軸成分のベクトルをV3とすると、当該ベクトルV3で表されるq軸電流が、偏荷重と釣り合うための駆動力を発生させる電流成分となる。図5に示すベクトルの相関を見ると、ベクトルV1とベクトルV2の為す角θbarを算出することで、電流指令Irefの位相を基にd軸、q軸の位置を検出可能であることが理解できる。 In FIG. 5, the current corresponding to the current command Iref generated by the current command calculator 51 is represented by vector V1. The direction of the vector V1 is defined as the α'-axis, and the direction orthogonal thereto is defined as the β'-axis. Let θbar be the angle formed by the α′-axis and the d-axis. Here, assuming that the d-axis component vector of the vector V1 is V2 and the q-axis component vector is V3, the q-axis current represented by the vector V3 is the current component that generates the driving force for balancing the unbalanced load. becomes. Looking at the vector correlation shown in FIG. 5, it can be understood that the d-axis and q-axis positions can be detected based on the phase of the current command Iref by calculating the angle θbar between the vector V1 and the vector V2. .

次に、図6では、図5に示すα’軸とβ’軸とによる直交座標に、改めてベクトルV1(電流指令Irefに対応)、ベクトルV2(d軸電流指令に対応)、ベクトルV3(q軸電流指令に対応)を配置する。ここで、上記釣り合い状態の形成のためのフィードバック系による制御を維持した状態で、電流指令Irefの位相を固定したままその指令値を増加させる。図6においては、増加された電流指令Iref’に対応する電流はベクトルV10で表されている。このように制御部40が有するフィードバック系により釣り合いを維持した状態で電流指令を増加させる処理を「第1処理」とする。 Next, in FIG. 6, a vector V1 (corresponding to the current command Iref), a vector V2 (corresponding to the d-axis current command), a vector V3 (q corresponding to the axis current command). Here, the command value is increased while the phase of the current command Iref is fixed while the control by the feedback system for forming the balanced state is maintained. In FIG. 6, the current corresponding to the increased current command Iref' is represented by vector V10. The process of increasing the current command while maintaining the balance by the feedback system of the control unit 40 is referred to as "first process".

ここで、第1処理により電流指令がIrefからIref’に増加されてもフィードバック系により釣り合い状態が維持されるため、モータ2の可動子が変位(回転)することになる。この回転について説明する。電流指令がIref’に増加されると、偏荷重に対応するq軸電流を流すべくq軸電流指令Iq’が形成されるとともに、d軸電流を流すべくd軸電流指令Id’が一義的に形成される。d軸電流指令Id’及びq軸電流指令Iq’に対応する電流がそれぞれベクトルV20、V30で表されている。そして、ベクトルV20はベクトルV2に対してΔθずれており、同じようにベクトルV30はベクトルV3に対してΔθずれている。したがって、このベクトルのずれΔθ(電気角)に対応する分だけ、モータ2の可動子が変位することになる。 Here, even if the current command is increased from Iref to Iref' by the first process, the balanced state is maintained by the feedback system, so the mover of the motor 2 is displaced (rotated). This rotation will be explained. When the current command is increased to Iref', the q-axis current command Iq' is formed to pass the q-axis current corresponding to the unbalanced load, and the d-axis current command Id' is univocally changed to pass the d-axis current. It is formed. Currents corresponding to the d-axis current command Id' and the q-axis current command Iq' are represented by vectors V20 and V30, respectively. The vector V20 is shifted by Δθ from the vector V2, and the vector V30 is similarly shifted by Δθ from the vector V3. Therefore, the mover of the motor 2 is displaced by the amount corresponding to this vector deviation Δθ (electrical angle).

そこで、第1処理により可動子が変位した変位量(上記のΔθに相当する)と、第1処理で増加された制御電流(上記のベクトルV10による電流)とに基づいて、モータ2の磁極位置を算出する第2処理が行われる。上記の通り、モータ2の磁極位置は、θbar
を算出すればよい。具体的には、偏荷重への釣り合いの観点からベクトルV3とベクトルV30の大きさは等しくなることから、下記の式1が成立する。

Figure 2022123713000002

・・・(式1)
そして、式1に基づいて、θbarを導出する式2は下記の通りとなる。
Figure 2022123713000003

・・・(式2)
したがって、電流指令Iref、Iref’、変位量Δθに基づいて、式2からθbarが算出できる。そして、電流指令Irefの位相とθbarに基づいて、モータ2の磁極位置を算出することができる。 Therefore, the magnetic pole position of the motor 2 is calculated based on the amount of displacement of the mover by the first process (corresponding to Δθ described above) and the control current increased by the first process (current due to vector V10 described above). A second process of calculating is performed. As described above, the magnetic pole position of the motor 2 is θbar
should be calculated. Specifically, since the magnitudes of vector V3 and vector V30 are equal from the viewpoint of balance with the unbalanced load, Equation 1 below is established.
Figure 2022123713000002

... (Formula 1)
Based on Equation 1, Equation 2 for deriving θbar is as follows.
Figure 2022123713000003

... (Formula 2)
Therefore, θbar can be calculated from Equation 2 based on the current commands Iref and Iref' and the displacement amount Δθ. Then, the magnetic pole position of the motor 2 can be calculated based on the phase of the current command Iref and θbar.

続いて、サーボドライバ4の電源投入時に実行されるモータ2の磁極位置の検出処理の流れについて、図7に基づいて説明する。図7に示す検出処理は、サーボドライバ4の電源投入時に、サーボドライバ4の制御部40において所定の制御プログラムが実行されることで実現される。先ずS101では、モータ2が有するブレーキ装置22に対して解除指令が送られ、ブレーキ装置22による制動状態が解除される。この結果、モータ2の可動子に偏荷重が掛かることになり、その偏荷重による変位が生じ始める。そこで、続くS102では、図4(b)に基づいて説明したように、制御部40のフィードバック系において、速度指令V_refとして速度0の信号を入力するとともに、フィードバックされる速度現在値V_actと速度指令V_refに基づいて電流制御器43による電流制御が行われる。この結果、モータ2に制御電流が印加され、速やかに可動子と固定子との間に可動子を停止させるための駆動力が生じる。 Next, the flow of detection processing of the magnetic pole position of the motor 2 executed when the power of the servo driver 4 is turned on will be described with reference to FIG. The detection process shown in FIG. 7 is realized by executing a predetermined control program in the control unit 40 of the servo driver 4 when the power of the servo driver 4 is turned on. First, in S101, a release command is sent to the brake device 22 of the motor 2, and the braking state by the brake device 22 is released. As a result, an unbalanced load is applied to the mover of the motor 2, and displacement due to the unbalanced load begins to occur. Therefore, in the following S102, as described with reference to FIG. 4B, in the feedback system of the control unit 40, a signal of speed 0 is input as the speed command V_ref, and the current speed value V_act to be fed back and the speed command Current control by the current controller 43 is performed based on V_ref. As a result, a control current is applied to the motor 2, and a driving force for stopping the mover is quickly generated between the mover and the stator.

ただし、何らかの理由で、上記駆動力によっても可動子の速度が十分に低減されなかった場合、可動子が可動範囲の端部まで落下して負荷装置3を破損させてしまう恐れがある。そこで、S103では、S102で行われている電流制御において可動子の速度が所定速度を超えたか否かが判定される。所定速度とは、上記駆動力によって可動子を停止させることが困難となる落下速度であり、事前の実験等によって適宜設定すればよい。そして、S103で肯定判定されると、処理はS107へ進み、ブレーキ装置22を作動させてその制動力によって可動子を停止させ、本検出処理を終了する。一方で、S103で否定判定されるとS104へ進み、S104では、可動子に掛かる偏荷重と上記駆動力とが釣り合って、可動子が停止したか否かが判定される。当該釣り合いは、フィードバック系における速度現在値V_actを利用して判定できる。S104で肯定判定すると処理はS105へ進み、否定判定するとS102以降の処理が繰り返される。 However, if for some reason the speed of the mover is not sufficiently reduced even by the driving force, the mover may fall to the end of its movable range and damage the load device 3 . Therefore, in S103, it is determined whether or not the speed of the mover exceeds a predetermined speed in the current control performed in S102. The predetermined speed is a drop speed at which it is difficult to stop the mover by the driving force, and may be appropriately set by prior experiments or the like. Then, if the determination in S103 is affirmative, the process proceeds to S107, the braking device 22 is operated to stop the mover by the braking force, and this detection process ends. On the other hand, if a negative determination is made in S103, the process proceeds to S104, where it is determined whether or not the unbalanced load applied to the mover and the driving force are balanced and the mover has stopped. The balance can be determined using the current speed value V_act in the feedback system. If an affirmative determination is made in S104, the process proceeds to S105, and if a negative determination is made, the processes after S102 are repeated.

そして、S105では、上述した第1処理が行われ、続いてS106では、上述した第2処理が行われる。これらの処理の結果、負荷装置3において偏荷重が掛かる垂直軸を駆動するモータ2の磁極位置が正確に検出されることになる。また、第1処理及び第2処理による磁極位置の検出処理では、モータ2の可動子は上記Δθに対応する分だけしか変位しないため、磁極位置の検出処理に要する時間も短くできる。なお、上記の第1処理では、電流指令IrefをIref’に増加させるが、その増加を急峻に行うと、モータ2の可動子のΔθの変位が振動的となり、モータ2の磁極位置の検出精度に好ましくない影響
を及ぼし得る。そこで、第1処理における電流指令の増加(IrefからIref’への増加)については、図8に示すように、所定の時定数Tdで当該IrefからIref’に至るように、電圧座標変換器54から電圧指令を出力するようにすればよい。
Then, in S105, the above-described first process is performed, and then in S106, the above-described second process is performed. As a result of these processes, the magnetic pole position of the motor 2 driving the vertical shaft to which the load device 3 is subjected to an unbalanced load is accurately detected. Further, in the magnetic pole position detection processing by the first processing and the second processing, the mover of the motor 2 is displaced only by the amount corresponding to Δθ, so the time required for the magnetic pole position detection processing can be shortened. In the above-described first process, the current command Iref is increased to Iref'. can have an unfavorable effect on Therefore, as shown in FIG. 8, for the increase in the current command (increase from Iref to Iref') in the first process, the voltage coordinate converter 54 to output the voltage command.

なお、本願の開示は、モータ2が永久磁石同期型の回転モータの場合、永久磁石同期型のリニアモータの場合の何れにも適用することができる。 The disclosure of the present application can be applied to both a permanent magnet synchronous rotary motor and a permanent magnet synchronous linear motor.

また、第1処理及び第2処理による磁極位置の検出処理を行うために、可動子に掛かる偏荷重と、可動子と固定子との間の駆動力とを釣り合わせる必要があるが、その釣り合い状態を形成する手法としては、図4(b)に基づいて説明した上記手法以外の方法を採用することもできる。例えば、図4(a)に示した従来技術による手法でも釣り合い状態を形成できるのであれば、その後に続いて第1処理及び第2処理による磁極位置の検出処理を行うことができる。 In addition, in order to perform the magnetic pole position detection processing by the first processing and the second processing, it is necessary to balance the unbalanced load applied to the mover and the driving force between the mover and the stator. A method other than the above-described method described with reference to FIG. For example, if the balanced state can be formed by the conventional technique shown in FIG. 4(a), then the magnetic pole position detection processing can be performed by the first processing and the second processing.

<付記1>
所定の偏荷重が掛かるように構成された制御軸用のモータ(2)の動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有するモータ制御装置(4)であって、
前記複数の制御器に含まれる電流制御器(43)において、前記モータ(2)に供給される電流に関連するd軸電流及びq軸電流を制御する電流制御部と、
前記電流制御部により前記モータ(2)に制御電流を印加することで、前記所定の偏荷重と該モータの固定子から可動子が受ける駆動力とを釣り合わせた状態で、前記モータ(2)の磁極位置を検出する処理部と、
を備え、
前記処理部は、
前記所定の偏荷重と前記駆動力の釣り合い状態を保ちながら、前記電流制御部により、前記駆動力を形成する前記制御電流の位相と同位相で該制御電流を増加する第1処理(S105)と、該第1処理により前記可動子が変位した変位量と該第1処理で増加された前記制御電流とに基づいて、前記モータの磁極位置を算出する第2処理(S106)と、を実行するように構成される、
モータ制御装置。
<Appendix 1>
A motor control device (4) having a feedback system including a plurality of controllers to which feedback signals related to the operation of a control shaft motor (2) configured to apply a predetermined unbalanced load are input,
a current control unit for controlling a d-axis current and a q-axis current related to the current supplied to the motor (2) in the current controller (43) included in the plurality of controllers;
By applying a control current to the motor (2) by the current control unit, the motor (2) can be operated in a state in which the predetermined unbalanced load and the driving force received by the mover from the stator of the motor are balanced. a processing unit that detects the magnetic pole position of
with
The processing unit is
a first process (S105) in which the current control unit increases the control current in the same phase as the control current forming the driving force while maintaining the balanced state between the predetermined unbalanced load and the driving force; and a second process (S106) of calculating the magnetic pole position of the motor based on the amount of displacement of the mover by the first process and the control current increased by the first process. configured to
motor controller.

2 モータ
3 負荷装置
4 サーボドライバ
5 PLC
6 インバータ
21 エンコーダ
22 ブレーキ装置
41 位置制御器
42 速度制御器
43 電流制御器
2 motor 3 load device 4 servo driver 5 PLC
6 inverter 21 encoder 22 brake device 41 position controller 42 speed controller 43 current controller

Claims (5)

所定の偏荷重が掛かるように構成された制御軸用のモータの動作に関連するフィードバック信号が入力される複数の制御器を含むフィードバック系を有するモータ制御装置であって、
前記複数の制御器に含まれる電流制御器において、前記モータに供給される電流に関連するd軸電流及びq軸電流を制御する電流制御部と、
前記電流制御部により前記モータに制御電流を印加することで、前記所定の偏荷重と該モータの固定子から可動子が受ける駆動力とを釣り合わせた状態で、前記モータの磁極位置を検出する処理部と、
を備え、
前記処理部は、
前記所定の偏荷重と前記駆動力の釣り合い状態を保ちながら、前記電流制御部により、前記駆動力を形成する前記制御電流の位相と同位相で該制御電流を増加する第1処理と、該第1処理により前記可動子が変位した変位量と該第1処理で増加された前記制御電流とに基づいて、前記モータの磁極位置を算出する第2処理と、を実行するように構成される、
モータ制御装置。
A motor control device having a feedback system including a plurality of controllers to which feedback signals relating to the operation of a motor for a control shaft configured to apply a predetermined unbalanced load are input,
a current controller that controls a d-axis current and a q-axis current related to the current supplied to the motor, in the current controllers included in the plurality of controllers;
By applying a control current to the motor by the current control unit, the magnetic pole position of the motor is detected in a state in which the predetermined unbalanced load and the driving force received by the mover from the stator of the motor are balanced. a processing unit;
with
The processing unit is
a first process of increasing the control current in the same phase as the control current forming the driving force by the current control unit while maintaining a balanced state between the predetermined unbalanced load and the driving force; A second process of calculating the magnetic pole position of the motor based on the displacement amount of the mover displaced by the first process and the control current increased by the first process,
motor controller.
前記処理部は、前記第2処理において、前記変位量と前記増加された制御電流とに基づいて、前記モータの磁極位置を形成する所定の電流軸に対する、前記第1処理前の前記駆動力を形成する前記制御電流の位相ずれを算出し、該位相ずれにより該モータの磁極位置を算出する、
請求項1に記載のモータ制御装置。
In the second process, the processing unit adjusts the driving force before the first process with respect to a predetermined current axis forming the magnetic pole position of the motor based on the displacement amount and the increased control current. calculating a phase shift of the control current to be formed, and calculating a magnetic pole position of the motor based on the phase shift;
The motor control device according to claim 1.
前記処理部は、前記第1処理において、所定の時定数で前記制御電流を増加させる、
請求項1又は請求項2に記載のモータ制御装置。
The processing unit increases the control current with a predetermined time constant in the first processing,
The motor control device according to claim 1 or 2.
前記処理部は、
前記第1処理の前において、前記モータの前記可動子の制動状態を解消させたときに、前記フィードバック系により得られる前記可動子の速度情報に基づいて、該モータに制御電流を印加して、前記所定の偏荷重と該モータの固定子から可動子が受ける駆動力とを釣り合わせた状態を形成する、
請求項1から請求項3の何れか1項に記載のモータ制御装置。
The processing unit is
applying a control current to the motor based on speed information of the mover obtained by the feedback system when the brake state of the mover of the motor is released before the first processing, forming a state in which the predetermined unbalanced load and the driving force received by the mover from the stator of the motor are balanced;
The motor control device according to any one of claims 1 to 3.
前記モータは、永久磁石同期型の回転モータ、又は永久磁石同期型のリニアモータである、
請求項1から請求項4の何れか1項に記載のモータ制御装置。
The motor is a permanent magnet synchronous rotary motor or a permanent magnet synchronous linear motor,
The motor control device according to any one of claims 1 to 4.
JP2021021205A 2021-02-12 2021-02-12 motor controller Pending JP2022123713A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2021021205A JP2022123713A (en) 2021-02-12 2021-02-12 motor controller
PCT/JP2021/009849 WO2022172472A1 (en) 2021-02-12 2021-03-11 Motor control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2021021205A JP2022123713A (en) 2021-02-12 2021-02-12 motor controller

Publications (1)

Publication Number Publication Date
JP2022123713A true JP2022123713A (en) 2022-08-24

Family

ID=82837637

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2021021205A Pending JP2022123713A (en) 2021-02-12 2021-02-12 motor controller

Country Status (2)

Country Link
JP (1) JP2022123713A (en)
WO (1) WO2022172472A1 (en)

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3688353B2 (en) * 1995-08-16 2005-08-24 神鋼電機株式会社 Electric motor control device
JP2000191248A (en) * 1998-12-25 2000-07-11 Toshiba Elevator Co Ltd Elevator control device
JP6707707B2 (en) * 2017-02-21 2020-06-10 株式会社日立製作所 Elevator

Also Published As

Publication number Publication date
WO2022172472A1 (en) 2022-08-18

Similar Documents

Publication Publication Date Title
JP5960008B2 (en) Brushless motor drive device
JP5933810B2 (en) Motor control device
WO2016035298A1 (en) Motor drive device and brushless motor
US9379655B2 (en) Method of field weakening control of permanent magnet motor drivers
JP5281339B2 (en) Synchronous motor drive system and control device used therefor
JP6776066B2 (en) Inverter controller and motor drive system
JP2007189766A (en) Motor drive controller and motor drive system
KR20180030132A (en) Drive system and inverter unit
US9602035B2 (en) Driving apparatus for electric motor
JP5224372B2 (en) Magnetic pole position detection method for permanent magnet synchronous motor
EP3128668B1 (en) Electric apparatus drive device
JP2009060688A (en) Controller for synchronous motors
JP2012019626A (en) Control device of ac rotary machine
JP4056237B2 (en) Control device for synchronous machine
WO2022172472A1 (en) Motor control device
US11837982B2 (en) Rotary machine control device
WO2022172473A1 (en) Motor control device
JP5479094B2 (en) Synchronous motor control method and control apparatus
WO2022168340A1 (en) Motor control device
JP6051728B2 (en) Motor control device
JP2016100997A (en) Control device of electric motor
JP2010200544A (en) Ac motor controller and control method
JP2005124359A (en) Current control method and controller for synchronous motor
JP7363161B2 (en) motor control device
JP7077878B2 (en) Motor control device

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20231212