JP2020161437A - Control device - Google Patents

Control device Download PDF

Info

Publication number
JP2020161437A
JP2020161437A JP2019062313A JP2019062313A JP2020161437A JP 2020161437 A JP2020161437 A JP 2020161437A JP 2019062313 A JP2019062313 A JP 2019062313A JP 2019062313 A JP2019062313 A JP 2019062313A JP 2020161437 A JP2020161437 A JP 2020161437A
Authority
JP
Japan
Prior art keywords
target current
axis target
zero
axis
motor
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.)
Granted
Application number
JP2019062313A
Other languages
Japanese (ja)
Other versions
JP7185576B2 (en
Inventor
義直 高橋
Yoshinao Takahashi
義直 高橋
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.)
Citizen Watch Co Ltd
Citizen Chiba Precision Co Ltd
Original Assignee
Citizen Watch Co Ltd
Citizen Chiba Precision Co Ltd
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 Citizen Watch Co Ltd, Citizen Chiba Precision Co Ltd filed Critical Citizen Watch Co Ltd
Priority to JP2019062313A priority Critical patent/JP7185576B2/en
Publication of JP2020161437A publication Critical patent/JP2020161437A/en
Application granted granted Critical
Publication of JP7185576B2 publication Critical patent/JP7185576B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Control Of Ac Motors In General (AREA)

Abstract

To provide a control device capable of accurately positioning an object to be moved by driving a motor.SOLUTION: The control device of a three-phase motor driven to move an object has a target current setting unit 120 for setting a d-axis target current and a q-axis target current in a d-q coordinate system as a target current to be supplied to the motor. The target current setting unit 120 increases the d-axis target current when the q-axis target current is to be reduced.SELECTED DRAWING: Figure 4

Description

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

従来、電子顕微鏡において、試料ステージの駆動用モータの動作または室温の変化により発生する試料ドリフトを抑制する技術が提案されている。
例えば、特許文献1に記載された走査型電子顕微鏡は、試料移動時と停止時にモータへの供給電流を同じないし、供給電流の差を20%以下とすることによりモータの熱量変化を小さくすることで、試料ステージの温度をコントロールして観察時の試料ドリフトを低減することを特徴とする。
Conventionally, in an electron microscope, a technique for suppressing sample drift generated by the operation of a driving motor of a sample stage or a change in room temperature has been proposed.
For example, the scanning electron microscope described in Patent Document 1 has the same supply current to the motor when the sample is moved and stopped, and the difference in the supply current is 20% or less to reduce the change in the amount of heat of the motor. The feature is that the temperature of the sample stage is controlled to reduce the sample drift during observation.

国際公開第2011/145290号International Publication No. 2011/145290

例えば高分解能の電子顕微鏡において、試料を載せるテーブルを移動させるためのアクチュエータとして、低速駆動中の動きも滑らかであるACサーボモータを用いることが考えられる。このACサーボモータを用いる電子顕微鏡のように、高精度の位置決め駆動が必要となる装置に用いられるモータを制御するにあたっては、モータに生じる熱による温度変化に起因する試料の位置ずれを抑制することが望まれる。
本発明は、モータの駆動によって移動させられる対象物の位置決めを精度高く行うことができる制御装置を提供することを目的とする。
For example, in a high-resolution electron microscope, it is conceivable to use an AC servomotor that moves smoothly during low-speed driving as an actuator for moving a table on which a sample is placed. When controlling a motor used in a device that requires high-precision positioning drive, such as an electron microscope that uses this AC servo motor, it is necessary to suppress the displacement of the sample due to the temperature change caused by the heat generated in the motor. Is desired.
An object of the present invention is to provide a control device capable of accurately positioning an object moved by driving a motor.

以下、本発明について説明する。以下の説明では、本発明の理解を容易にするために実施の形態中の構成要素の符号等を括弧書きで付記するが、それによって本発明が実施の形態に記載した内容に限定されるものではない。
上記目的のもと完成させた本発明は、対象物を移動させるために駆動する三相のモータ(110)の制御装置(100)であって、前記モータ(110)に供給する目標電流として、d−q座標系のd軸目標電流(Idt)及びq軸目標電流(Iqt)を設定する目標電流設定手段(120)を有し、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を小さくする場合に、前記d軸目標電流(Idt)を大きくする制御装置(100)である。
Hereinafter, the present invention will be described. In the following description, in order to facilitate understanding of the present invention, the symbols and the like of the components in the embodiments are added in parentheses, but the present invention is limited to the contents described in the embodiments. is not.
The present invention completed for the above object is a control device (100) of a three-phase motor (110) that is driven to move an object, and serves as a target current to be supplied to the motor (110). The target current setting means (120) for setting the d-axis target current (Idt) and the q-axis target current (Iqt) of the dq coordinate system is provided, and the target current setting means (120) has the q-axis target current. It is a control device (100) which increases the d-axis target current (Idt) when (Iqt) is decreased.

ここで、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を零ではない値から零にした場合に、前記d軸目標電流(Idt)を予め定められた所定電流(Idt0)まで大きくしても良い。
また、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を零にしたときから予め定められた所定増加時間(Ti)経過後に前記所定電流(Idt0)となるように徐々に前記d軸目標電流(Idt)を大きくしても良い。
また、前記目標電流設定手段(120)は、位置指令速度(Vpt)が零かつ位置偏差(pt−θd)が零となったときに、前記q軸目標電流(Iqt)を零にし、前記d軸目標電流(Idt)を零から大きくしても良い。
Here, the target current setting means (120) sets the d-axis target current (Idt) to a predetermined predetermined current (Idt0) when the q-axis target current (Iqt) is changed from a non-zero value to zero. ) May be increased.
Further, the target current setting means (120) gradually reaches the predetermined current (Idt0) after a predetermined increase time (Ti) elapses from the time when the q-axis target current (Iqt) is set to zero. The d-axis target current (Idt) may be increased.
Further, the target current setting means (120) sets the q-axis target current (Iqt) to zero when the position command speed (Vpt) becomes zero and the position deviation (pt−θd) becomes zero, and the d. The shaft target current (Idt) may be increased from zero.

他の観点から捉えると、本発明は、対象物を移動させるために駆動する三相のモータ(110)の制御装置(100)であって、前記モータ(110)に供給する目標電流として、d−q座標系のd軸目標電流(Idt)及びq軸目標電流(Iqt)を設定する目標電流設定手段(120)を有し、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を大きくする場合に、前記d軸目標電流(Idt)を小さくする制御装置(100)である。 From another point of view, the present invention is a control device (100) of a three-phase motor (110) that is driven to move an object, and the target current supplied to the motor (110) is d. The target current setting means (120) for setting the d-axis target current (Idt) and the q-axis target current (Iqt) of the −q coordinate system is provided, and the target current setting means (120) is the q-axis target current (120). It is a control device (100) which reduces the d-axis target current (Idt) when increasing Iqt).

ここで、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を零から零ではない値にした場合に、前記d軸目標電流(Idt)を零まで小さくしても良い。
また、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を零ではない値にしたときから予め定められた所定減少時間(Td)経過後に零となるように徐々に前記d軸目標電流(Idt)を小さくしても良い。
また、前記目標電流設定手段(120)は、位置指令速度(Vpt)、又は、位置偏差(pt−θd)が零ではなくなったときに、前記q軸目標電流(Iqt)を零ではない値にし、前記d軸目標電流(Idt)を小さくしても良い。
Here, the target current setting means (120) may reduce the d-axis target current (Idt) to zero when the q-axis target current (Iqt) is changed from zero to a non-zero value.
Further, the target current setting means (120) gradually sets the q-axis target current (Iqt) to zero after a predetermined decrease time (Td) elapses from the time when the q-axis target current (Iqt) is set to a non-zero value. The shaft target current (Idt) may be reduced.
Further, the target current setting means (120) sets the q-axis target current (Iqt) to a non-zero value when the position command speed (Vpt) or the position deviation (pt-θd) is no longer zero. , The d-axis target current (Idt) may be reduced.

本発明によれば、モータの駆動によって移動させられる対象物の位置決めを精度高く行うことができる。 According to the present invention, it is possible to accurately position an object that is moved by driving a motor.

本実施の形態に係る走査型電子顕微鏡の概略構成を示す図である。It is a figure which shows the schematic structure of the scanning electron microscope which concerns on this embodiment. 本実施の形態に係る走査型電子顕微鏡の試料移動ステージの概略構成を示す図である。It is a figure which shows the schematic structure of the sample moving stage of the scanning electron microscope which concerns on this embodiment. 図2のIII方向に見た図である。It is the figure seen in the III direction of FIG. 制御装置の概略構成図である。It is a schematic block diagram of a control device. 制御装置の概略構成図である。It is a schematic block diagram of a control device. d軸目標電流設定部が設定するd軸目標電流の時間変化を例示する図である。It is a figure which illustrates the time change of the d-axis target current set by the d-axis target current setting unit. d軸目標電流調整部が行うd軸目標電流を設定する処理を示すフローチャートである。It is a flowchart which shows the process which sets the d-axis target current performed by the d-axis target current adjustment part.

以下、添付図面を参照して、実施の形態について詳細に説明する。
図1は、本実施の形態に係る走査型電子顕微鏡の概略構成を示す図である。
図2は、本実施の形態に係る走査型電子顕微鏡の試料移動ステージの概略構成を示す図である。
図3は、図2のIII方向に見た図である。
本実施の形態に係る走査型電子顕微鏡50(以下、単に「顕微鏡50」と称する場合もある。)は、特許文献1に記載された走査型電子顕微鏡に対して、xテーブル33を移動させるxモータ41と、yテーブル43を移動させるyモータ61と、これらのモータの駆動を制御する制御装置100とが異なる。以下、主に、特許文献1に記載された走査型電子顕微鏡と異なる点について説明する。
Hereinafter, embodiments will be described in detail with reference to the accompanying drawings.
FIG. 1 is a diagram showing a schematic configuration of a scanning electron microscope according to the present embodiment.
FIG. 2 is a diagram showing a schematic configuration of a sample moving stage of the scanning electron microscope according to the present embodiment.
FIG. 3 is a view seen in the direction III of FIG.
The scanning electron microscope 50 according to the present embodiment (hereinafter, may be simply referred to as “microscope 50”) moves the x table 33 with respect to the scanning electron microscope described in Patent Document 1. The motor 41, the y motor 61 that moves the y table 43, and the control device 100 that controls the drive of these motors are different. Hereinafter, the differences from the scanning electron microscope described in Patent Document 1 will be mainly described.

顕微鏡50は、電子銃1と、コンデンサレンズ2と、対物レンズ3と、試料室4と、試料移動ステージ5と、2次電子検出器7と、真空ポンプ9〜13と、ステージケース14とを有している。そして、顕微鏡50は、電子銃1で発生した電子ビームを、コンデンサレンズ2、対物レンズ3を通して試料室4内の試料移動ステージ5の上に取り付けられた試料S上に照射し、試料Sから出てくる2次電子を2次電子検出器7でとらえ、試料S表面の形状を観察可能にする。 The microscope 50 includes an electron gun 1, a condenser lens 2, an objective lens 3, a sample chamber 4, a sample moving stage 5, a secondary electron detector 7, vacuum pumps 9 to 13, and a stage case 14. Have. Then, the microscope 50 irradiates the electron beam generated by the electron gun 1 onto the sample S mounted on the sample moving stage 5 in the sample chamber 4 through the condenser lens 2 and the objective lens 3, and exits the sample S. The incoming secondary electrons are captured by the secondary electron detector 7, and the shape of the surface of the sample S can be observed.

また、顕微鏡50は、zテーブル15と、チルトテーブル20とを有している。zテーブル15を駆動するための機構、及び、チルトテーブル20を駆動するための機構は、特許文献1に記載された走査型電子顕微鏡と基本的に同じであるので、その詳細な説明は省略する。 Further, the microscope 50 has a z table 15 and a tilt table 20. Since the mechanism for driving the z-table 15 and the mechanism for driving the tilt table 20 are basically the same as those of the scanning electron microscope described in Patent Document 1, detailed description thereof will be omitted. ..

顕微鏡50は、試料Sをx方向に移動させるxテーブル33を有している。xテーブル33は、クロスローラガイド34を介してチルトテーブル20に取り付けられている。また、顕微鏡50は、xテーブル33を移動させる、xボールネジ35及びxボールネジナット36を有している。また、顕微鏡50は、xボールネジ35の両端部をそれぞれ支持する軸受37、38と、軸受37、38をそれぞれチルトテーブル20に支持する軸受ハウジング39、40とを有している。xボールネジナット36は、x継手42を介して、xテーブル33に固定されている。 The microscope 50 has an x-table 33 that moves the sample S in the x-direction. The x-table 33 is attached to the tilt table 20 via the cross roller guide 34. The microscope 50 also has an x-ball screw 35 and an x-ball screw nut 36 that move the x-table 33. Further, the microscope 50 has bearings 37 and 38 that support both ends of the x-ball screw 35, and bearing housings 39 and 40 that support the bearings 37 and 38 on the tilt table 20, respectively. The x-ball screw nut 36 is fixed to the x-table 33 via the x-joint 42.

また、顕微鏡50は、xボールネジ35に連結された、xモータ41と、xカップリング44と、xモータ41を支持するxブラケット45とを有している。xブラケット45は、チルトテーブル20に固定されている。xテーブル33は、xモータ41が駆動されてxボールネジ35が回転させられ、xボールネジナット36が移送されることによりx方向に移動し、試料Sをx方向に移動させる。 Further, the microscope 50 has an x motor 41, an x coupling 44, and an x bracket 45 that supports the x motor 41, which are connected to the x ball screw 35. The x bracket 45 is fixed to the tilt table 20. The x-table 33 moves in the x-direction by driving the x-motor 41 to rotate the x-ball screw 35 and transferring the x-ball screw nut 36, and moves the sample S in the x-direction.

また、顕微鏡50は、試料Sをy方向に移動させるyテーブル43を有している。yテーブル43は、クロスローラガイド54a、54bを介してxテーブル33に取り付けられている。また、顕微鏡50は、yテーブル43を移動させる、yボールネジ55及びyボールネジナット56を有している。また、顕微鏡50は、yボールネジ55の両端部をそれぞれ支持する軸受57、58と、軸受57、58をそれぞれxテーブル33に支持する軸受ハウジング59、60とを有している。yボールネジナット56は、y継手48を介して、yテーブル43に固定されている。 Further, the microscope 50 has a y table 43 for moving the sample S in the y direction. The y-table 43 is attached to the x-table 33 via the cross roller guides 54a and 54b. The microscope 50 also has a y-ball screw 55 and a y-ball screw nut 56 that move the y-table 43. Further, the microscope 50 has bearings 57 and 58 that support both ends of the y-ball screw 55, and bearing housings 59 and 60 that support the bearings 57 and 58 on the x-table 33, respectively. The y-ball screw nut 56 is fixed to the y-table 43 via the y-joint 48.

また、顕微鏡50は、yボールネジ55に連結された、yモータ61と、yカップリング62と、yモータ61を支持するyブラケット63とを有している。yブラケット63は、xテーブル33に固定されている。yテーブル43は、yモータ61が駆動されてyボールネジ55が回転させられ、yボールネジナット56が移送されることによりy方向に移動し、試料Sをy方向に移動させる。 Further, the microscope 50 has a y motor 61, a y coupling 62, and a y bracket 63 that supports the y motor 61, which are connected to the y ball screw 55. The y bracket 63 is fixed to the x table 33. The y-table 43 moves in the y-direction by driving the y-motor 61 to rotate the y-ball screw 55 and transferring the y-ball screw nut 56 to move the sample S in the y-direction.

また、顕微鏡50は、試料Sを回転させるローテーションテーブル66を有している。ローテーションテーブル66は、軸受(不図示)を介して、yテーブル43に対して回転可能に支持されている。また、顕微鏡50は、ローテーションテーブル66を回転させる、ウォームホィール67a及びウォームギヤ67bを有している。ウォームホィール67aは、ローテーションテーブル66に取り付けられている。また、顕微鏡50は、ウォームギヤ67bの両端部をそれぞれ支持する軸受69、70と、軸受69、70をそれぞれyテーブル43に支持する軸受ハウジング71、72とを有している。 Further, the microscope 50 has a rotation table 66 for rotating the sample S. The rotation table 66 is rotatably supported with respect to the y table 43 via bearings (not shown). The microscope 50 also has a worm wheel 67a and a worm gear 67b that rotate the rotation table 66. The worm wheel 67a is attached to the rotation table 66. Further, the microscope 50 has bearings 69 and 70 that support both ends of the worm gear 67b, and bearing housings 71 and 72 that support the bearings 69 and 70 on the y table 43, respectively.

また、顕微鏡50は、ウォームギヤ67bに連結された、rモータ73と、rカップリング74と、rモータ73を支持するrブラケット75とを有している。rブラケット75は、yテーブル43に固定されている。ローテーションテーブル66は、rモータ73が駆動されてウォームギヤ67bが回転させられ、ウォームホィール67aが回転させられることにより回転し、試料Sを回転させる。 Further, the microscope 50 has an r motor 73, an r coupling 74, and an r bracket 75 that supports the r motor 73, which are connected to the worm gear 67b. The r bracket 75 is fixed to the y table 43. The rotation table 66 is rotated by driving the r motor 73 to rotate the worm gear 67b and rotating the worm wheel 67a to rotate the sample S.

試料Sは試料ホルダ77に接着され、試料ホルダ77はローテーションテーブル66に取り付けられたホルダ台78に挿入、固定されている。
上述したようにして、試料Sは、x,y,z方向に移動させられ、また、回転させられ、傾斜させられる。
The sample S is adhered to the sample holder 77, and the sample holder 77 is inserted and fixed to the holder base 78 attached to the rotation table 66.
As described above, the sample S is moved, rotated, and tilted in the x, y, and z directions.

(モータ制御について)
上述した、xモータ41、yモータ61及びrモータ73は、3相のACサーボモータであることを例示することができる。
そして、顕微鏡50は、これらxモータ41、yモータ61及びrモータ73の駆動を制御する制御装置100を備えている。制御装置100が、xモータ41、yモータ61及びrモータ73を制御する態様は同じであるので、以下では、xモータ41、yモータ61及びrモータ73を、「モータ110」と称し、モータ110を制御する態様について説明する。
(About motor control)
It can be exemplified that the x-motor 41, the y-motor 61, and the r-motor 73 described above are three-phase AC servomotors.
The microscope 50 is provided with a control device 100 that controls the drive of the x-motor 41, the y-motor 61, and the r-motor 73. Since the control device 100 controls the x-motor 41, the y-motor 61, and the r-motor 73 in the same manner, the x-motor 41, the y-motor 61, and the r-motor 73 are hereinafter referred to as "motors 110", and the motors are referred to as "motors 110". A mode for controlling 110 will be described.

図4、図5は、制御装置100の概略構成図である。
制御装置100は、CPU、ROM、RAM、EEPROM(Electrically Erasable & Programmable Read Only Memory)等からなる算術論理演算回路である。
そして、制御装置100は、モータ110に供給する目標電流を設定する目標電流設定部120と、目標電流設定部120が設定した目標電流に基づいてフィードバック制御などを行う制御部130と、を備えている。目標電流設定部120の機能構成は、図4に示し、制御部130の機能構成は、図5に示している。
4 and 5 are schematic configuration diagrams of the control device 100.
The control device 100 is an arithmetic logical operation circuit including a CPU, ROM, RAM, EEPROM (Electrically Erasable & Programmable Read Only Memory), and the like.
Then, the control device 100 includes a target current setting unit 120 that sets a target current to be supplied to the motor 110, and a control unit 130 that performs feedback control and the like based on the target current set by the target current setting unit 120. There is. The functional configuration of the target current setting unit 120 is shown in FIG. 4, and the functional configuration of the control unit 130 is shown in FIG.

目標電流設定部120は、図4に示すように、d−q座標系のq軸目標電流Iqtを設定するq軸目標電流設定部121と、d軸目標電流Idtを設定するd軸目標電流設定部122とを有している。d−q座標系は、モータ110のロータ(永久磁石)と同期して回転するd軸およびq軸からなる回転直交座標系であり、d軸は、ロータが形成する磁束の方向に沿った軸であり、q軸は、モータ110が発生するトルクの方向に沿った軸である。
q軸目標電流設定部121、d軸目標電流設定部122、及び、目標電流設定部120が有するその他の構成要素については後で詳述する。
As shown in FIG. 4, the target current setting unit 120 includes a q-axis target current setting unit 121 for setting the q-axis target current Iqt in the dq coordinate system and a d-axis target current setting unit 121 for setting the d-axis target current Idt. It has a unit 122. The dq coordinate system is a rotation orthogonal coordinate system consisting of a d-axis and a q-axis that rotate in synchronization with the rotor (permanent magnet) of the motor 110, and the d-axis is an axis along the direction of the magnetic flux formed by the rotor. The q-axis is an axis along the direction of the torque generated by the motor 110.
Other components of the q-axis target current setting unit 121, the d-axis target current setting unit 122, and the target current setting unit 120 will be described in detail later.

制御部130は、図5に示すように、モータ110の作動を制御するモータ駆動制御部131と、モータ110を駆動させるモータ駆動部132とを有している。
また、制御部130は、モータ110に実際に流れる実電流に応じた値を出力するモータ電流検出部133と、このモータ電流検出部133によって検出された電流をd−q座標系の電流に変換する3相2軸変換部135と、を有している。
また、制御部130は、エンコーダ等の回転角センサ120からのモータ回転角度信号θsに基づいて、実際のモータ110の回転角度であるモータ回転角度θdを算出するモータ回転角度算出部136を有している。
As shown in FIG. 5, the control unit 130 includes a motor drive control unit 131 that controls the operation of the motor 110, and a motor drive unit 132 that drives the motor 110.
Further, the control unit 130 converts the motor current detection unit 133 that outputs a value corresponding to the actual current actually flowing through the motor 110 and the current detected by the motor current detection unit 133 into a current in the dq coordinate system. It has a three-phase two-axis conversion unit 135 and the like.
Further, the control unit 130 has a motor rotation angle calculation unit 136 that calculates the motor rotation angle θd, which is the actual rotation angle of the motor 110, based on the motor rotation angle signal θs from the rotation angle sensor 120 such as an encoder. ing.

モータ電流検出部133は、3相のモータであるモータ110のU相に実際に流れる電流であるU相実電流を検出するためのU相電流検出部と、モータ110のV相に実際に流れる電流であるV相実電流を検出するためのV相電流検出部と、モータ110のW相に実際に流れる電流であるW相実電流を検出するためのW相電流検出部とを有している。U相電流検出部、V相電流検出部及びW相電流検出部は、それぞれモータ110のU相、V相、W相に接続されたいわゆるシャント抵抗の両端に生じる電圧から各相に流れる実電流の値を検出する。 The motor current detection unit 133 actually flows through the U-phase current detection unit for detecting the U-phase actual current, which is the current that actually flows in the U-phase of the motor 110, which is a three-phase motor, and the V-phase of the motor 110. It has a V-phase current detection unit for detecting the V-phase actual current, which is a current, and a W-phase current detection unit for detecting the W-phase actual current, which is the current actually flowing in the W-phase of the motor 110. There is. The U-phase current detector, V-phase current detector, and W-phase current detector are the actual currents that flow from the voltage generated across the so-called shunt resistors connected to the U-phase, V-phase, and W-phase of the motor 110 to each phase. Detect the value of.

3相2軸変換部135には、モータ電流検出部133にて検出されたU相実電流,V相実電流,W相実電流、及びモータ回転角度算出部136にて算出されたモータ回転角度θdが入力される。そして、3相2軸変換部135は、予め定められた式に従って、U相実電流,V相実電流,W相実電流をd−q座標系の値であるd軸実電流Idaとq軸実電流Iqaとに変換し、変換したd軸実電流Ida,q軸実電流Iqaを出力する。
モータ回転角度算出部136は、モータ110に設けられた回転角センサ120からのモータ回転角度信号θsに基づいてモータ回転角度θdを算出する。
The three-phase two-axis conversion unit 135 includes a U-phase real current, a V-phase real current, a W-phase real current detected by the motor current detection unit 133, and a motor rotation angle calculated by the motor rotation angle calculation unit 136. θd is input. Then, the three-phase two-axis converter 135 sets the U-phase real current, the V-phase real current, and the W-phase real current into the d-axis real current Ida and the q-axis which are the values of the dq coordinate system according to a predetermined equation. It is converted to the actual current Iqa, and the converted d-axis real current Ida and q-axis real current Iqa are output.
The motor rotation angle calculation unit 136 calculates the motor rotation angle θd based on the motor rotation angle signal θs from the rotation angle sensor 120 provided in the motor 110.

モータ駆動制御部131は、目標電流設定部120のd軸目標電流設定部122にて設定されたd軸目標電流Idtから、3相2軸変換部135にて算出されたd軸実電流Idaを減算するd軸減算部141dを有している。また、モータ駆動制御部131は、目標電流設定部120のq軸目標電流設定部121にて算出されたq軸目標電流Iqtから、3相2軸変換部135にて算出されたq軸実電流Iqaを減算するq軸減算部141qを有している。 The motor drive control unit 131 calculates the d-axis actual current Ida calculated by the three-phase two-axis conversion unit 135 from the d-axis target current Idt set by the d-axis target current setting unit 122 of the target current setting unit 120. It has a d-axis subtraction unit 141d for subtraction. Further, the motor drive control unit 131 is a q-axis actual current calculated by the three-phase two-axis conversion unit 135 from the q-axis target current Iqt calculated by the q-axis target current setting unit 121 of the target current setting unit 120. It has a q-axis subtraction unit 141q for subtracting Iqa.

また、モータ駆動制御部131は、d軸減算部141dにて算出された偏差(Idt−Ida)が零となるようにd軸目標電圧Vdtを出力する電流制御アンプ142dを有している。また、モータ駆動制御部131は、q軸減算部141qにて算出された偏差(Iqt−Iqa)が零となるようにq軸目標電圧Vqtを出力する電流制御アンプ142qを有している。 Further, the motor drive control unit 131 has a current control amplifier 142d that outputs a d-axis target voltage Vdt so that the deviation (Idt-Ida) calculated by the d-axis subtraction unit 141d becomes zero. Further, the motor drive control unit 131 has a current control amplifier 142q that outputs a q-axis target voltage Vqt so that the deviation (Iqt-Iqa) calculated by the q-axis subtraction unit 141q becomes zero.

また、モータ駆動制御部131は、電流制御アンプ142d及び電流制御アンプ142qから出力されたd軸目標電圧Vdt,q軸目標電圧Vqtを、3相交流座標系のU相目標電圧Vut、V相目標電圧Vvt、W相目標電圧Vwtに変換する2軸3相変換部151を有している。
2軸3相変換部151は、予め定められた式及びモータ回転角度算出部136にて算出されたモータ回転角度θdに基づいて、d軸目標電圧Vdt及びq軸目標電圧Vqtを、U相目標電圧Vut、V相目標電圧Vvt及びW相目標電圧Vwtに変換する。つまり、2軸3相変換部151は、電流制御アンプ142d及び電流制御アンプ142qから出力された、言い換えればフィードバック制御された値と、モータ回転角度θdとに基づいてモータ110に印加する印加電圧を決定する。
Further, the motor drive control unit 131 sets the d-axis target voltage Vdt and q-axis target voltage Vqt output from the current control amplifier 142d and the current control amplifier 142q to the U-phase target voltage Vut and V-phase target of the three-phase AC coordinate system. It has a 2-axis 3-phase conversion unit 151 that converts a voltage Vvt and a W-phase target voltage Vwt.
The 2-axis 3-phase conversion unit 151 sets the d-axis target voltage Vdt and the q-axis target voltage Vqt to the U-phase target based on a predetermined formula and the motor rotation angle θd calculated by the motor rotation angle calculation unit 136. It is converted into a voltage Vut, a V-phase target voltage Vvt, and a W-phase target voltage Vwt. That is, the 2-axis 3-phase converter 151 applies the applied voltage applied to the motor 110 based on the feedback-controlled values output from the current control amplifier 142d and the current control amplifier 142q, that is, the motor rotation angle θd. decide.

また、モータ駆動制御部131は、2軸3相変換部151にて算出されたU相目標電圧Vut,V相目標電圧Vvt,W相目標電圧Vwtに基づいてモータ110をPWM駆動するためのPWM(パルス幅変調)信号を生成し、生成したPWM信号を出力するPWM信号生成部160を有している。 Further, the motor drive control unit 131 PWM drives the motor 110 based on the U-phase target voltage Vut, the V-phase target voltage Vvt, and the W-phase target voltage Vwt calculated by the 2-axis 3-phase conversion unit 151. It has a PWM signal generation unit 160 that generates a (pulse width modulation) signal and outputs the generated PWM signal.

モータ駆動部132は、所謂インバータであり、例えば、スイッチング素子として6個の独立したトランジスタ(FET)を備え、6個の内の3個のトランジスタは電源の正極側ラインと各相の電気コイルとの間に接続され、他の3個のトランジスタは各相の電気コイルと電源の負極側(アース)ラインと接続されている。そして、モータ駆動部132は、6個の中から選択した2個のトランジスタのゲートを駆動してこれらのトランジスタをスイッチング動作させることにより、モータ110の駆動を制御する。 The motor drive unit 132 is a so-called inverter, and includes, for example, six independent transistors (FETs) as switching elements, and three of the six transistors are the positive electrode side line of the power supply and the electric coils of each phase. The other three transistors are connected to the electric coil of each phase and the negative electrode side (earth) line of the power supply. Then, the motor drive unit 132 controls the drive of the motor 110 by driving the gates of two transistors selected from the six and switching these transistors.

(目標電流設定部120の詳細について)
目標電流設定部120は、図4に示すように、位置指令ptから、モータ回転角度算出部136で算出されたモータ回転角度θdを減算する位置減算部123を有している。位置減算部123は、位置指令ptからモータ回転角度θdを減算することにより、偏差(pt−θd)を算出する。
ここで、位置指令ptは、上位制御部(不図示)から出力される。上位制御部は、例えば、CPU、ROM、RAM、例えばマウスやキーボード等の操作部、例えば液晶ディスプレイ等の表示部等を備えた汎用パーソナルコンピュータ等で構成されていることを例示することができる。そして、位置指令ptは、例えば、顕微鏡50のオペレータが操作部を操作することにより、表示部上で現在表示されている拡大像から離れた位置を指定した場合に、その指定された位置の情報、現在の観察視野の中心からその指定された位置までの方向、及び距離が算出され、設定される。
(Details of target current setting unit 120)
As shown in FIG. 4, the target current setting unit 120 has a position subtraction unit 123 that subtracts the motor rotation angle θd calculated by the motor rotation angle calculation unit 136 from the position command pt. The position subtraction unit 123 calculates the deviation (pt−θd) by subtracting the motor rotation angle θd from the position command pt.
Here, the position command pt is output from the host control unit (not shown). It can be exemplified that the upper control unit is composed of, for example, a CPU, a ROM, a RAM, an operation unit such as a mouse or a keyboard, or a general-purpose personal computer provided with a display unit such as a liquid crystal display. Then, the position command pt is information on the designated position when, for example, the operator of the microscope 50 operates the operation unit to specify a position away from the magnified image currently displayed on the display unit. , The direction and distance from the center of the current observation field of view to the designated position are calculated and set.

また、目標電流設定部120は、モータ回転角度算出部136で算出されたモータ回転角度θdに基づいてモータ110の回転速度であるモータ回転速度ωdを算出するモータ回転速度算出部124を有している。モータ回転速度算出部124は、モータ回転角度算出部136で算出されたモータ回転角度θdを微分することによりモータ回転速度ωdを算出する。 Further, the target current setting unit 120 has a motor rotation speed calculation unit 124 that calculates the motor rotation speed ωd, which is the rotation speed of the motor 110, based on the motor rotation angle θd calculated by the motor rotation angle calculation unit 136. There is. The motor rotation speed calculation unit 124 calculates the motor rotation speed ωd by differentiating the motor rotation angle θd calculated by the motor rotation angle calculation unit 136.

上述したq軸目標電流設定部121は、位置減算部123にて算出された偏差(pt−θd)が零となるように目標回転速度ωtを出力する位置制御アンプ125を有している。
また、q軸目標電流設定部121は、位置制御アンプ125から出力された目標回転速度ωtから、モータ回転速度算出部124で算出されたモータ回転速度ωdを減算する速度減算部126を有している。
また、q軸目標電流設定部121は、速度減算部126にて算出された偏差(ωt−ωd)が零となるようにq軸目標電流Iqtを出力する速度制御アンプ127を有している。
The q-axis target current setting unit 121 described above has a position control amplifier 125 that outputs a target rotation speed ωt so that the deviation (pt−θd) calculated by the position subtraction unit 123 becomes zero.
Further, the q-axis target current setting unit 121 has a speed subtraction unit 126 that subtracts the motor rotation speed ωd calculated by the motor rotation speed calculation unit 124 from the target rotation speed ωt output from the position control amplifier 125. There is.
Further, the q-axis target current setting unit 121 has a speed control amplifier 127 that outputs the q-axis target current Iqt so that the deviation (ωt−ωd) calculated by the speed subtraction unit 126 becomes zero.

上述したd軸目標電流設定部122は、位置指令ptの時間変化率である位置指令速度Vptを算出する位置指令速度算出部128を有している。位置指令速度算出部128は、位置指令ptを微分することにより位置指令速度Vptを算出する。
また、d軸目標電流設定部122は、位置指令速度算出部128が算出した位置指令速度Vpt及び位置減算部123にて算出された偏差(pt−θd)に基づいてd軸目標電流Idtを調整するd軸目標電流調整部129を有している。
The d-axis target current setting unit 122 described above has a position command speed calculation unit 128 that calculates a position command speed Vpt, which is a time change rate of the position command pt. The position command speed calculation unit 128 calculates the position command speed Vpt by differentiating the position command pt.
Further, the d-axis target current setting unit 122 adjusts the d-axis target current Idt based on the position command speed Vpt calculated by the position command speed calculation unit 128 and the deviation (pt−θd) calculated by the position subtraction unit 123. It has a d-axis target current adjusting unit 129.

以上のように構成された目標電流設定部120において、q軸目標電流設定部121は、位置減算部123にて算出された偏差(pt−θd)が零となり、制御対象の位置が目標位置に到達した場合には、q軸目標電流Iqtを零に設定する。例えば、試料Sのx方向の位置が制御対象である場合には、x方向の位置が目標位置に到達したときに、xモータ41のq軸目標電流Iqtを零に設定する。 In the target current setting unit 120 configured as described above, the deviation (pt-θd) calculated by the position subtraction unit 123 of the q-axis target current setting unit 121 becomes zero, and the position of the controlled object becomes the target position. When it reaches, the q-axis target current Iqt is set to zero. For example, when the position of the sample S in the x direction is the control target, the q-axis target current Iqt of the x motor 41 is set to zero when the position in the x direction reaches the target position.

図6は、d軸目標電流設定部122が設定するd軸目標電流Idtの時間変化を例示する図である。
d軸目標電流設定部122においては、d軸目標電流調整部129は、位置指令速度算出部128が算出した位置指令速度Vptが零ではない場合、又は、位置減算部123にて算出された偏差(pt−θd)が零ではない場合には、d軸目標電流Idtを零に設定する。言い換えれば、d軸目標電流調整部129は、モータ110が駆動しているときのd軸目標電流Idtを零に設定する。さらに言い換えれば、d軸目標電流調整部129は、q軸目標電流Iqtが零ではないときのd軸目標電流Idtを零に設定する。
FIG. 6 is a diagram illustrating a time change of the d-axis target current Idt set by the d-axis target current setting unit 122.
In the d-axis target current setting unit 122, the d-axis target current adjusting unit 129 has a deviation calculated by the position command speed calculation unit 128 when the position command speed Vpt is not zero or by the position subtraction unit 123. If (pt−θd) is not zero, the d-axis target current Idt is set to zero. In other words, the d-axis target current adjusting unit 129 sets the d-axis target current Idt when the motor 110 is driving to zero. In other words, the d-axis target current adjusting unit 129 sets the d-axis target current Idt to zero when the q-axis target current Iqt is not zero.

一方、d軸目標電流調整部129は、制御対象の位置が目標位置に到達した場合、言い換えれば、位置指令速度算出部128が算出した位置指令速度Vptが零、かつ、位置減算部123にて算出された偏差(pt−θd)が零となった場合、d軸目標電流Idtを零以外の値とする。これは、q軸目標電流Iqtが小さくされることに起因して減少するモータ110の発熱分を補うためにd軸目標電流Idtを零以外の値とするものである。d軸はロータが形成する磁束の方向に沿った軸であり、d軸目標電流Idtが増えても、モータ110の駆動、言い換えれば、モータ110の出力軸の回転に寄与しないため、d軸目標電流Idtが増えることに起因して位置が目標位置からずれることが抑制される。 On the other hand, when the position to be controlled reaches the target position, the d-axis target current adjusting unit 129 has the position command speed Vpt calculated by the position command speed calculation unit 128 of zero and the position subtraction unit 123. When the calculated deviation (pt−θd) becomes zero, the d-axis target current Idt is set to a value other than zero. This sets the d-axis target current Idt to a value other than zero in order to compensate for the heat generation of the motor 110 that decreases due to the reduction of the q-axis target current Iqt. The d-axis is an axis along the direction of the magnetic flux formed by the rotor, and even if the d-axis target current Idt increases, it does not contribute to the drive of the motor 110, in other words, the rotation of the output shaft of the motor 110. The deviation of the position from the target position due to the increase in the current Idt is suppressed.

そして、d軸目標電流調整部129は、予め定められた所定増加レートで、零から、予め定められた所定電流Idt0まで大きくなるようにd軸目標電流Idtを設定する。言い換えれば、d軸目標電流調整部129は、予め定められた所定増加時間Ti経過後に所定電流Idt0となるように徐々にd軸目標電流Idtを増加させる。 Then, the d-axis target current adjusting unit 129 sets the d-axis target current Idt so as to increase from zero to a predetermined predetermined current Idt0 at a predetermined increase rate. In other words, the d-axis target current adjusting unit 129 gradually increases the d-axis target current Idt so that the predetermined current Idt becomes 0 after the elapse of the predetermined increase time Ti.

所定電流Idt0及び所定増加時間Tiは、制御対象の位置が目標位置となった後に、位置が目標位置からずれることを抑制するべく、制御対象の位置を定める部品の温度変化を抑制することが可能な値に設定される。例えば、試料Sのx方向の位置を定める部品としては、xボールネジ35、xボールネジナット36であることを例示することができる。試料Sのy方向の位置を定める部品としては、yボールネジ55、yボールネジナット56であることを例示することができる。試料Sの回転方向の位置を定める部品としては、ウォームホィール67a、ウォームギヤ67bであることを例示することができる。 The predetermined current Idt0 and the predetermined increase time Ti can suppress the temperature change of the component that determines the position of the control target in order to suppress the position from shifting from the target position after the position of the control target reaches the target position. Value is set. For example, x-ball screw 35 and x-ball screw nut 36 can be exemplified as the parts that determine the position of the sample S in the x direction. Examples of the component that determines the position of the sample S in the y direction include a y-ball screw 55 and a y-ball screw nut 56. Examples of the component that determines the position of the sample S in the rotation direction include a worm wheel 67a and a worm gear 67b.

モータ110が駆動した際に発生する熱がこれらの部品に伝わり、これらの部品に温度変化が生じる。例えば、試料Sのx方向の位置を例にして説明すると、xモータ41への電流の供給に起因して発生する熱が、xボールネジ35、xボールネジナット36等の試料Sのx方向の位置を定める部品に伝わるので、これらの部品が熱膨張した状態でx方向の位置が目標位置に定められる。そして、x方向の位置が目標位置に到達した後に、xモータ41への電流供給が停止されると、減少した電流の分の熱が発生しなくなるため、xボールネジ35、xボールネジナット36等のx方向の位置を定める部品の温度が低下する。そして、これらの部品の温度が低下すると、収縮するため、試料Sの位置が目標位置からずれ、試料ドリフトが生じてしまう。 The heat generated when the motor 110 is driven is transferred to these parts, causing a temperature change in these parts. For example, demonstrating the position of the sample S in the x direction as an example, the heat generated due to the supply of the current to the x motor 41 is the position of the sample S such as the x ball screw 35 and the x ball screw nut 36 in the x direction. Since it is transmitted to the parts that determine, the position in the x direction is determined as the target position in the state where these parts are thermally expanded. Then, when the current supply to the x motor 41 is stopped after the position in the x direction reaches the target position, heat corresponding to the reduced current is not generated, so that the x ball screw 35, the x ball screw nut 36, etc. The temperature of the part that determines the position in the x direction drops. Then, when the temperature of these parts decreases, the sample S contracts, so that the position of the sample S deviates from the target position and sample drift occurs.

以上の事項に鑑み、試料ドリフトを抑制するべく、所定電流Idt0及び所定増加時間Tiは、設定される。例えば、試料Sのx方向の位置が目標位置となり、q軸目標電流Iqtが零に設定されたときの、xボールネジ35、xボールネジナット36等のx方向の位置を定める部品の温度と、所定増加時間Ti経過したときのこれらの部品の温度とが同じとなるように、所定電流Idt0及び所定増加時間Tiが設定される。ゆえに、所定電流Idt0及び所定増加時間Tiは、試料Sの位置を定める部品の熱伝導率に応じて定まる。例えば、熱伝導率が小さいほど所定増加時間Tiが長くなるように設定される。 In view of the above items, the predetermined current Idt0 and the predetermined increase time Ti are set in order to suppress the sample drift. For example, when the position of the sample S in the x direction becomes the target position and the q-axis target current Iqt is set to zero, the temperature of the parts that determine the position in the x direction such as the x ball screw 35 and the x ball screw nut 36 and the predetermined temperature. The predetermined current Idt0 and the predetermined increase time Ti are set so that the temperatures of these parts become the same when the increase time Ti elapses. Therefore, the predetermined current Idt0 and the predetermined increase time Ti are determined according to the thermal conductivity of the component that determines the position of the sample S. For example, the smaller the thermal conductivity, the longer the predetermined increase time Ti is set.

本実施の形態においては、所定電流Idt0及び所定増加時間Tiは、予め測定結果に基づいて設定され、ROMに記憶されていることを例示することができる。例えば、所定増加時間Tiは、20〜30秒の範囲の中から定められた一の秒数であることを例示することができる。このように、所定増加時間Tiをかけて、d軸目標電流Idtを零から所定電流Idt0までゆっくり変化させることで、試料Sの位置が目標位置からずれることを抑制する。
なお、所定電流Idt0及び所定増加時間Tiは、シミュレーション結果や算出結果に基づいて設定されても良い。
In the present embodiment, it can be exemplified that the predetermined current Idt0 and the predetermined increase time Ti are set in advance based on the measurement result and stored in the ROM. For example, it can be exemplified that the predetermined increase time Ti is one second determined from the range of 20 to 30 seconds. In this way, the position of the sample S is suppressed from deviating from the target position by slowly changing the d-axis target current Idt from zero to the predetermined current Idt0 over a predetermined increase time Ti.
The predetermined current Idt0 and the predetermined increase time Ti may be set based on the simulation result or the calculation result.

また、d軸目標電流調整部129は、d軸目標電流Idtを所定電流Idt0に到達させた後、言い換えれば、所定増加時間Tiが経過した後、位置指令速度算出部128が算出した位置指令速度Vptが零、かつ、位置減算部123にて算出された偏差(pt−θd)が零である状態が継続している間中、d軸目標電流Idtを所定電流Idt0に維持する。 Further, the d-axis target current adjusting unit 129 has the position command speed calculated by the position command speed calculation unit 128 after the d-axis target current Idt reaches the predetermined current Idt0, in other words, after the predetermined increase time Ti has elapsed. The d-axis target current Idt is maintained at a predetermined current Idt0 while the state in which Vpt is zero and the deviation (pt−θd) calculated by the position subtraction unit 123 is zero continues.

また、d軸目標電流調整部129は、位置指令速度算出部128が算出した位置指令速度Vptが零でなくなった場合、又は、位置減算部123にて算出された偏差(pt−θd)が零でなくなった場合には、d軸目標電流Idtを予め定められた所定減少レートで減少させる。例えば、d軸目標電流Idtが所定電流Idt0であるときに、位置指令速度算出部128が算出した位置指令速度Vptが零でなくなった場合、又は、位置減算部123にて算出された偏差(pt−θd)が零でなくなった場合には、d軸目標電流調整部129は、予め定められた所定減少時間Td経過後にd軸目標電流Idtが零となるように徐々にd軸目標電流Idtを減少させる。位置指令速度Vptが零でなくなった場合、又は、位置減算部123にて算出された偏差(pt−θd)が零でなくなった場合には、q軸目標電流Iqtが零以外の値となると考えられるからである。 Further, in the d-axis target current adjusting unit 129, when the position command speed Vpt calculated by the position command speed calculation unit 128 is no longer zero, or the deviation (pt−θd) calculated by the position subtraction unit 123 is zero. When the value is not satisfied, the d-axis target current Idt is reduced at a predetermined reduction rate. For example, when the d-axis target current Idt is the predetermined current Idt0, the position command speed Vpt calculated by the position command speed calculation unit 128 is no longer zero, or the deviation (pt) calculated by the position subtraction unit 123. When −θd) is no longer zero, the d-axis target current adjusting unit 129 gradually sets the d-axis target current Idt so that the d-axis target current Idt becomes zero after the elapse of a predetermined decrease time Td. Reduce. When the position command speed Vpt is no longer zero, or when the deviation (pt-θd) calculated by the position subtraction unit 123 is no longer zero, it is considered that the q-axis target current Iqt becomes a value other than zero. Because it is possible.

所定減少時間Tdは、予め、測定結果、シミュレーション結果又は算出結果に基づいて設定され、ROMに記憶されていることを例示することができる。例えば、所定減少時間Tdは、20〜30秒の範囲の中から定められた一の秒数であることを例示することができる。このように、所定減少時間Tdをかけて、d軸目標電流Idtを所定電流Idt0から零までゆっくり変化させることで、試料Sの位置が目標位置からずれることを抑制する。
なお、所定減少時間Tdは、所定増加時間Tiと同じであることを例示することができる。ただし、所定減少時間Tdは、所定増加時間Tiと異なっていても良い。
It can be exemplified that the predetermined reduction time Td is set in advance based on the measurement result, the simulation result or the calculation result, and is stored in the ROM. For example, it can be exemplified that the predetermined reduction time Td is one number of seconds defined from the range of 20 to 30 seconds. In this way, the position of the sample S is suppressed from deviating from the target position by slowly changing the d-axis target current Idt from the predetermined current Idt0 to zero over a predetermined decrease time Td.
It can be exemplified that the predetermined decrease time Td is the same as the predetermined increase time Ti. However, the predetermined decrease time Td may be different from the predetermined increase time Ti.

また、d軸目標電流調整部129は、d軸目標電流Idtを上記所定増加レートで増加させているときに、位置指令速度算出部128が算出した位置指令速度Vptが零ではなくなった場合、又は、位置減算部123にて算出された偏差(pt−θd)が零ではなくなった場合には、上記所定減少レートでd軸目標電流Idtを零まで減少させる。 Further, when the d-axis target current adjusting unit 129 is increasing the d-axis target current Idt at the predetermined increase rate, the position command speed Vpt calculated by the position command speed calculation unit 128 is no longer zero, or When the deviation (pt−θd) calculated by the position subtraction unit 123 is no longer zero, the d-axis target current Idt is reduced to zero at the predetermined reduction rate.

また、d軸目標電流調整部129は、d軸目標電流Idtを減少させているときに、位置指令速度算出部128が算出した位置指令速度Vptが零となり、かつ、位置減算部123にて算出された偏差(pt−θd)が零となった場合には、上記所定増加レートでd軸目標電流Idtを増加させる。 Further, when the d-axis target current adjusting unit 129 is reducing the d-axis target current Idt, the position command speed Vpt calculated by the position command speed calculation unit 128 becomes zero, and the position command speed Vpt is calculated by the position subtraction unit 123. When the calculated deviation (pt−θd) becomes zero, the d-axis target current Idt is increased at the predetermined increase rate.

以上説明したように、目標電流設定部120が、q軸目標電流Iqt、d軸目標電流Idtを設定することで、試料Sの位置が目標位置となった後に、温度変化により目標位置からずれることが抑制される。 As described above, the target current setting unit 120 sets the q-axis target current Iqt and the d-axis target current Idt, so that the position of the sample S becomes the target position and then deviates from the target position due to the temperature change. Is suppressed.

図7は、d軸目標電流調整部129が行うd軸目標電流Idtを設定する処理を示すフローチャートである。d軸目標電流調整部129は、この処理を、予め設定された一定時間(例えば1分)ごとに繰り返し実行する。
d軸目標電流調整部129は、d軸目標電流Idtが零であるか否かを判断する(S701)。d軸目標電流Idtが零である場合(S701でYes)、d軸目標電流調整部129は、位置指令速度Vptが零であるか否かを判断する(S702)。位置指令速度Vptが零である場合(S702でYes)、d軸目標電流調整部129は、位置減算部123にて算出された偏差(pt−θd)が零であるか否かを判断する(S703)。偏差(pt−θd)が零である場合(S703でYes)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定増加レートで所定電流Idt0まで増加させる(S704)。
位置指令速度Vptが零ではない場合(S702でNo)、及び、偏差(pt−θd)が零ではない場合(S703でNo)、d軸目標電流調整部129は、本処理を終了する。
FIG. 7 is a flowchart showing a process of setting the d-axis target current Idt performed by the d-axis target current adjusting unit 129. The d-axis target current adjusting unit 129 repeatedly executes this process at predetermined fixed time intervals (for example, 1 minute).
The d-axis target current adjusting unit 129 determines whether or not the d-axis target current Idt is zero (S701). When the d-axis target current Idt is zero (Yes in S701), the d-axis target current adjusting unit 129 determines whether or not the position command speed Vpt is zero (S702). When the position command speed Vpt is zero (Yes in S702), the d-axis target current adjusting unit 129 determines whether or not the deviation (pt−θd) calculated by the position subtraction unit 123 is zero (Yes). S703). When the deviation (pt−θd) is zero (Yes in S703), the d-axis target current adjusting unit 129 increases the d-axis target current Idt to the predetermined current Idt0 at the predetermined increase rate described above (S704).
When the position command speed Vpt is not zero (No in S702) and the deviation (pt−θd) is not zero (No in S703), the d-axis target current adjusting unit 129 ends this process.

一方、d軸目標電流調整部129は、d軸目標電流Idtが零ではない場合(S701でNo)、d軸目標電流Idtが所定電流Idt0であるか否かを判断する(S705)。d軸目標電流Idtが所定電流Idt0である場合(S705でYes)、d軸目標電流調整部129は、位置指令速度Vptが零であるか否かを判断する(S706)。位置指令速度Vptが零である場合(S706でYes)、d軸目標電流調整部129は、位置減算部123にて算出された偏差(pt−θd)が零であるか否かを判断する(S707)。偏差(pt−θd)が零である場合(S707でYes)、d軸目標電流調整部129は、d軸目標電流Idtを所定電流Idt0に維持するべく、本処理を終了する。 On the other hand, when the d-axis target current Idt is not zero (No in S701), the d-axis target current adjusting unit 129 determines whether or not the d-axis target current Idt is a predetermined current Idt0 (S705). When the d-axis target current Idt is the predetermined current Idt0 (Yes in S705), the d-axis target current adjusting unit 129 determines whether or not the position command speed Vpt is zero (S706). When the position command speed Vpt is zero (Yes in S706), the d-axis target current adjusting unit 129 determines whether or not the deviation (pt−θd) calculated by the position subtraction unit 123 is zero (Yes). S707). When the deviation (pt−θd) is zero (Yes in S707), the d-axis target current adjusting unit 129 ends this process in order to maintain the d-axis target current Idt at a predetermined current Idt0.

位置指令速度Vptが零ではない場合(S706でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで所定電流Idt0から零まで減少させる(S708)。また、偏差(pt−θd)が零ではない場合(S707でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで所定電流Idt0から零まで減少させる(S708)。 When the position command speed Vpt is not zero (No in S706), the d-axis target current adjusting unit 129 reduces the d-axis target current Idt from the predetermined current Idt 0 to zero at the predetermined reduction rate described above (S708). When the deviation (pt−θd) is not zero (No in S707), the d-axis target current adjusting unit 129 reduces the d-axis target current Idt from the predetermined current Idt0 to zero at the predetermined reduction rate described above (No). S708).

一方、d軸目標電流調整部129は、d軸目標電流Idtが所定電流Idt0ではない場合(S705でNo)、d軸目標電流Idtを増加させている途中であるか否かを判断する(S709)。言い換えれば、この処理は、d軸目標電流調整部129が、d軸目標電流Idtを、S704にて所定増加レートで所定電流Idt0まで増加させ始めた後、所定電流Idt0に到達していないか否かを判断するものである。なお、S709の処理で、d軸目標電流調整部129は、S704にて所定増加レートで所定電流Idt0まで増加させ始めた後、所定増加時間Tiが経過したか否かを判断しても良い。 On the other hand, when the d-axis target current Idt is not the predetermined current Idt0 (No in S705), the d-axis target current adjusting unit 129 determines whether or not the d-axis target current Idt is being increased (S709). ). In other words, in this process, whether or not the d-axis target current adjusting unit 129 has not reached the predetermined current Idt0 after the d-axis target current adjusting unit 129 starts increasing the d-axis target current Idt to the predetermined current Idt0 at a predetermined increase rate in S704. It is to judge whether or not. In the process of S709, the d-axis target current adjusting unit 129 may determine whether or not the predetermined increase time Ti has elapsed after starting the increase to the predetermined current Idt0 at the predetermined increase rate in S704.

d軸目標電流Idtを増加中である場合(S709でYes)、d軸目標電流調整部129は、位置指令速度Vptが零であるか否かを判断する(S710)。位置指令速度Vptが零である場合(S710でYes)、d軸目標電流調整部129は、位置減算部123にて算出された偏差(pt−θd)が零であるか否かを判断する(S711)。偏差(pt−θd)が零である場合(S711でYes)、d軸目標電流調整部129は、d軸目標電流Idtの増加を維持するべく、本処理を終了する。 When the d-axis target current Idt is being increased (Yes in S709), the d-axis target current adjusting unit 129 determines whether or not the position command speed Vpt is zero (S710). When the position command speed Vpt is zero (Yes in S710), the d-axis target current adjusting unit 129 determines whether or not the deviation (pt−θd) calculated by the position subtraction unit 123 is zero (Yes). S711). When the deviation (pt−θd) is zero (Yes in S711), the d-axis target current adjusting unit 129 ends this process in order to maintain the increase in the d-axis target current Idt.

他方、位置指令速度Vptが零ではない場合(S710でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで零まで減少させる(S708)。また、偏差(pt−θd)が零ではない場合(S711でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで零まで減少させる(S708)。 On the other hand, when the position command speed Vpt is not zero (No in S710), the d-axis target current adjusting unit 129 reduces the d-axis target current Idt to zero at the predetermined reduction rate described above (S708). When the deviation (pt−θd) is not zero (No in S711), the d-axis target current adjusting unit 129 reduces the d-axis target current Idt to zero at the predetermined reduction rate described above (S708).

一方、d軸目標電流Idtを増加中ではない場合(S709でNo)、d軸目標電流Idtを減少させている途中、つまり、S708にて所定減少レートで減少させ始めた後、d軸目標電流Idtが零に到達していない状況であるので、d軸目標電流調整部129は、位置指令速度Vptが零であるか否かを判断する(S712)。位置指令速度Vptが零である場合(S712でYes)、d軸目標電流調整部129は、位置減算部123にて算出された偏差(pt−θd)が零であるか否かを判断する(S713)。偏差(pt−θd)が零である場合(S713でYes)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定増加レートで所定電流Idt0まで増加させる(S704)。
他方、位置指令速度Vptが零ではない場合(S712でNo)、及び、偏差(pt−θd)が零ではない場合(S713でNo)、d軸目標電流調整部129は、d軸目標電流Idtの減少を維持するべく、本処理を終了する。
On the other hand, when the d-axis target current Idt is not increasing (No in S709), the d-axis target current Idt is being decreased, that is, after starting to decrease at a predetermined decrease rate in S708, the d-axis target current Since the Idt has not reached zero, the d-axis target current adjusting unit 129 determines whether or not the position command speed Vpt is zero (S712). When the position command speed Vpt is zero (Yes in S712), the d-axis target current adjusting unit 129 determines whether or not the deviation (pt−θd) calculated by the position subtraction unit 123 is zero (Yes). S713). When the deviation (pt−θd) is zero (Yes in S713), the d-axis target current adjusting unit 129 increases the d-axis target current Idt to the predetermined current Idt0 at the predetermined increase rate described above (S704).
On the other hand, when the position command speed Vpt is not zero (No in S712) and the deviation (pt-θd) is not zero (No in S713), the d-axis target current adjusting unit 129 uses the d-axis target current Idt. This process is terminated in order to maintain the decrease in.

d軸目標電流調整部129が、この設定処理を行うことで、d軸目標電流Idtが精度高く適切な値に設定される。
そして、これにより、モータ110の駆動によって移動させられる制御対象の位置を定める部品の温度変化が抑制されるので、試料Sの位置、ひいては、xテーブル33、yテーブル43、ローテーションテーブル66等の試料Sを載せるテーブルの位置を精度高く行うことが可能となる。
By performing this setting process, the d-axis target current adjusting unit 129 sets the d-axis target current Idt to an appropriate value with high accuracy.
As a result, the temperature change of the component that determines the position of the controlled object that is moved by the drive of the motor 110 is suppressed, so that the position of the sample S, and by extension, the sample such as the x table 33, the y table 43, and the rotation table 66, etc. It is possible to accurately position the table on which S is placed.

なお、上述した実施の形態においては、d軸目標電流調整部129は、位置指令速度算出部128が算出した位置指令速度Vptが零ではない場合、又は、位置減算部123にて算出された偏差(pt−θd)が零ではない場合には、d軸目標電流Idtを零に設定するが特に零に限定されない。位置指令速度算出部128が算出した位置指令速度Vptが零ではない場合、又は、位置減算部123にて算出された偏差(pt−θd)が零ではない場合には、d軸目標電流調整部129は、零の代わりに、任意の負の値に設定しても良い。そして、d軸目標電流調整部129は、位置指令速度Vptが零、かつ、偏差(pt−θd)が零になった場合には、d軸目標電流Idtを、この任意の負の値から、所定増加レートで、所定電流Idt0まで増加させると良い。また、d軸目標電流調整部129は、d軸目標電流Idtを所定電流Idt0に設定しているときに、位置指令速度Vptが零でなくなるか、又は、偏差(pt−θd)が零でなくなった場合には、d軸目標電流Idtを、所定電流Idt0から、この任意の負の値まで減少させると良い。 In the above-described embodiment, the d-axis target current adjusting unit 129 has a deviation when the position command speed Vpt calculated by the position command speed calculation unit 128 is not zero, or a deviation calculated by the position subtraction unit 123. When (pt−θd) is not zero, the d-axis target current Idt is set to zero, but is not particularly limited to zero. If the position command speed Vpt calculated by the position command speed calculation unit 128 is not zero, or if the deviation (pt−θd) calculated by the position subtraction unit 123 is not zero, the d-axis target current adjustment unit 129 may be set to any negative value instead of zero. Then, when the position command speed Vpt becomes zero and the deviation (pt−θd) becomes zero, the d-axis target current adjusting unit 129 sets the d-axis target current Idt from this arbitrary negative value. It is preferable to increase the current to a predetermined current Idt0 at a predetermined increase rate. Further, when the d-axis target current adjusting unit 129 sets the d-axis target current Idt to the predetermined current Idt0, the position command speed Vpt is not zero, or the deviation (pt−θd) is not zero. In this case, the d-axis target current Idt may be reduced from the predetermined current Idt0 to an arbitrary negative value.

なお、上述した実施の形態においては、制御装置100を、顕微鏡50が有するモータ110の駆動を制御するために用いた例を示したが、特に顕微鏡50が有するモータ110に限定されない。つまり、位置決めを行いたい対象物は、顕微鏡50にて観察される試料S、ひいては、xテーブル33、yテーブル43、ローテーションテーブル66等の試料Sを載せるテーブルに限定されない。制御装置100を、位置決めを行いたい対象物を移動させるために駆動する三相のモータ全てに適用しても良い。 In the above-described embodiment, the control device 100 is used to control the drive of the motor 110 included in the microscope 50, but the present invention is not particularly limited to the motor 110 included in the microscope 50. That is, the object to be positioned is not limited to the sample S observed by the microscope 50, and by extension, the table on which the sample S such as the x table 33, the y table 43, and the rotation table 66 is placed. The control device 100 may be applied to all three-phase motors that drive to move an object to be positioned.

また、上述した実施の形態においては、モータ電流検出部133を、U相電流検出部、V相電流検出部及びW相電流検出部の3つの電流検出部を用いた例を示したが、この構成に限定されない。U相実電流、V相実電流及びW相実電流の電流値の総和は零となることから、2つの相の電流値を検出すれば残りの相の電流の値を算出できる。ゆえに、U相電流検出部、V相電流検出部及びW相電流検出部のいずれか一つの電流検出部を省略した構成を適用しても良い。 Further, in the above-described embodiment, an example is shown in which the motor current detection unit 133 uses three current detection units, a U-phase current detection unit, a V-phase current detection unit, and a W-phase current detection unit. It is not limited to the configuration. Since the sum of the current values of the U-phase real current, the V-phase real current, and the W-phase real current is zero, the current values of the remaining phases can be calculated by detecting the current values of the two phases. Therefore, a configuration in which any one of the U-phase current detection unit, the V-phase current detection unit, and the W-phase current detection unit is omitted may be applied.

33…xテーブル、41…xモータ、43…yテーブル、61…yモータ、50…走査型電子顕微鏡、66…ローテーションテーブル、73…rモータ、100…制御装置、120…目標電流設定部、121…q軸目標電流設定部、122…d軸目標電流設定部、130…制御部 33 ... x table, 41 ... x motor, 43 ... y table, 61 ... y motor, 50 ... scanning electron microscope, 66 ... rotation table, 73 ... r motor, 100 ... control device, 120 ... target current setting unit, 121 ... q-axis target current setting unit, 122 ... d-axis target current setting unit, 130 ... control unit

Claims (8)

対象物を移動させるために駆動する三相のモータの制御装置であって、
前記モータに供給する目標電流として、d−q座標系のd軸目標電流及びq軸目標電流を設定する目標電流設定手段を有し、
前記目標電流設定手段は、前記q軸目標電流を小さくする場合に、前記d軸目標電流を大きくする
制御装置。
A control device for a three-phase motor that drives to move an object.
As the target current supplied to the motor, there is a target current setting means for setting the d-axis target current and the q-axis target current in the dq coordinate system.
The target current setting means is a control device that increases the d-axis target current when the q-axis target current is reduced.
前記目標電流設定手段は、前記q軸目標電流を零ではない値から零にした場合に、前記d軸目標電流を予め定められた所定電流まで大きくする
請求項1に記載の制御装置。
The control device according to claim 1, wherein the target current setting means increases the d-axis target current to a predetermined predetermined current when the q-axis target current is changed from a non-zero value to zero.
前記目標電流設定手段は、前記q軸目標電流を零にしたときから予め定められた所定増加時間経過後に前記所定電流となるように徐々に前記d軸目標電流を大きくする
請求項2に記載の制御装置。
The second aspect of the present invention, wherein the target current setting means gradually increases the d-axis target current so as to reach the predetermined current after a predetermined increase time elapses from the time when the q-axis target current is set to zero. Control device.
前記目標電流設定手段は、位置指令速度が零かつ位置偏差が零となったときに、前記q軸目標電流を零にし、前記d軸目標電流を零から大きくする
請求項1から3のいずれか1項に記載の制御装置。
The target current setting means is any one of claims 1 to 3 in which the q-axis target current is set to zero and the d-axis target current is increased from zero when the position command speed becomes zero and the position deviation becomes zero. The control device according to item 1.
対象物を移動させるために駆動する三相のモータの制御装置であって、
前記モータに供給する目標電流として、d−q座標系のd軸目標電流及びq軸目標電流を設定する目標電流設定手段を有し、
前記目標電流設定手段は、前記q軸目標電流を大きくする場合に、前記d軸目標電流を小さくする
制御装置。
A control device for a three-phase motor that drives to move an object.
As the target current supplied to the motor, there is a target current setting means for setting the d-axis target current and the q-axis target current in the dq coordinate system.
The target current setting means is a control device that reduces the d-axis target current when the q-axis target current is increased.
前記目標電流設定手段は、前記q軸目標電流を零から零ではない値にした場合に、前記d軸目標電流を零まで小さくする
請求項5に記載の制御装置。
The control device according to claim 5, wherein the target current setting means reduces the d-axis target current to zero when the q-axis target current is changed from zero to a non-zero value.
前記目標電流設定手段は、前記q軸目標電流を零ではない値にしたときから予め定められた所定減少時間経過後に零となるように徐々に前記d軸目標電流を小さくする
請求項6に記載の制御装置。
The sixth aspect of claim 6 wherein the target current setting means gradually reduces the d-axis target current so that it becomes zero after a predetermined decrease time elapses from the time when the q-axis target current is set to a non-zero value. Control device.
前記目標電流設定手段は、位置指令速度、又は、位置偏差が零ではなくなったときに、前記q軸目標電流を零ではない値にし、前記d軸目標電流を小さくする
請求項5から7のいずれか1項に記載の制御装置。
Any of claims 5 to 7, wherein the target current setting means sets the q-axis target current to a non-zero value and reduces the d-axis target current when the position command speed or the position deviation is no longer zero. The control device according to item 1.
JP2019062313A 2019-03-28 2019-03-28 Control device Active JP7185576B2 (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2019062313A JP7185576B2 (en) 2019-03-28 2019-03-28 Control device

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2019062313A JP7185576B2 (en) 2019-03-28 2019-03-28 Control device

Publications (2)

Publication Number Publication Date
JP2020161437A true JP2020161437A (en) 2020-10-01
JP7185576B2 JP7185576B2 (en) 2022-12-07

Family

ID=72639764

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2019062313A Active JP7185576B2 (en) 2019-03-28 2019-03-28 Control device

Country Status (1)

Country Link
JP (1) JP7185576B2 (en)

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1118498A (en) * 1997-06-20 1999-01-22 Nec Corp Controller for servo motor
JPH11235082A (en) * 1998-02-09 1999-08-27 Nikon Corp Motor control method, stage apparatus and exposing apparatus
JP2013229530A (en) * 2012-04-27 2013-11-07 Hitachi High-Technologies Corp Stage device and charged particle beam apparatus using the same
JP2016018623A (en) * 2014-07-07 2016-02-01 株式会社日立ハイテクノロジーズ Charged particle beam device, stage control method, and stage system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH1118498A (en) * 1997-06-20 1999-01-22 Nec Corp Controller for servo motor
JPH11235082A (en) * 1998-02-09 1999-08-27 Nikon Corp Motor control method, stage apparatus and exposing apparatus
JP2013229530A (en) * 2012-04-27 2013-11-07 Hitachi High-Technologies Corp Stage device and charged particle beam apparatus using the same
JP2016018623A (en) * 2014-07-07 2016-02-01 株式会社日立ハイテクノロジーズ Charged particle beam device, stage control method, and stage system

Also Published As

Publication number Publication date
JP7185576B2 (en) 2022-12-07

Similar Documents

Publication Publication Date Title
CN103051270B (en) Motor control device that controls d-axis current of permanent magnet synchronous motor
JP2007288989A (en) Controller for motor
JPWO2005067137A1 (en) Motor control device
JP2009038921A (en) Sensorless controller for brushless motor
KR20150000363A (en) Method and Apparatus for controlling torque of Permanent Magnet Synchronous Motor
JP2012143100A (en) Control device, and measuring apparatus
JP6425898B2 (en) Inverter control device and method thereof
JP2019083672A (en) Inverter, and drive control method for motor
JP7185576B2 (en) Control device
JP2014039428A (en) Control device, and method for controlling stepping motor
JP2007135345A (en) Magnet motor controller
CN110707972B (en) Control method and system of permanent magnet vernier linear motor
JP4777051B2 (en) AC motor control device
JP2004320847A (en) Method of controlling stepping motor, and stepping motor controller
CN110535391B (en) Servo motor angle error compensation method, system and device
JP6034208B2 (en) Galvano scanner control device and laser processing device
JP7467201B2 (en) Motor Control Device
Larbaoui et al. Backstepping control with integral action of PMSM integrated according to the MRAS observer
JP5802517B2 (en) Machine tool and motor control method thereof
JP2013042631A (en) Control device of permanent magnet synchronous motor
JP4894125B2 (en) Method for positioning a permanent magnet synchronous motor
JP2018132341A (en) Highly accurate detector for motor current
JP4730659B2 (en) Motor control device
Thakar et al. Fractional-order PI controller design for PMSM: A model-based comparative study
JP2007025888A (en) Controller and control method

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20211006

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20220629

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20220802

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20220920

TRDD Decision of grant or rejection written
A01 Written decision to grant a patent or to grant a registration (utility model)

Free format text: JAPANESE INTERMEDIATE CODE: A01

Effective date: 20221115

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20221125

R150 Certificate of patent or registration of utility model

Ref document number: 7185576

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150