Deprecated: The each() function is deprecated. This message will be suppressed on further calls in /home/zhenxiangba/zhenxiangba.com/public_html/phproxy-improved-master/index.php on line 456
JP7185576B2 - Control device - Google Patents
[go: Go Back, main page]

JP7185576B2 - Control device - Google Patents

Control device Download PDF

Info

Publication number
JP7185576B2
JP7185576B2 JP2019062313A JP2019062313A JP7185576B2 JP 7185576 B2 JP7185576 B2 JP 7185576B2 JP 2019062313 A JP2019062313 A JP 2019062313A JP 2019062313 A JP2019062313 A JP 2019062313A JP 7185576 B2 JP7185576 B2 JP 7185576B2
Authority
JP
Japan
Prior art keywords
target current
zero
axis target
axis
current
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.)
Active
Application number
JP2019062313A
Other languages
Japanese (ja)
Other versions
JP2020161437A (en
Inventor
義直 高橋
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

Images

Landscapes

  • Control Of Ac Motors In General (AREA)

Description

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

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

国際公開第2011/145290号WO2011/145290

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

以下、本発明について説明する。以下の説明では、本発明の理解を容易にするために実施の形態中の構成要素の符号等を括弧書きで付記するが、それによって本発明が実施の形態に記載した内容に限定されるものではない。
上記目的のもと完成させた本発明は、対象物を移動させるために駆動する三相のモータ(110)の制御装置(100)であって、前記モータ(110)に供給する目標電流として、d-q座標系のd軸目標電流(Idt)及びq軸目標電流(Iqt)を設定する目標電流設定手段(120)を有し、前記目標電流設定手段(120)は、前記q軸目標電流(Iqt)を小さくする場合に、前記d軸目標電流(Idt)を大きくする制御装置(100)である。
The present invention will be described below. In the following description, the reference numerals and the like of the constituent elements in the embodiments are added in parentheses to facilitate understanding of the present invention, but the present invention is limited to the contents described in the embodiments. is not.
The present invention completed for the above purpose is a control device (100) for a three-phase motor (110) driven to move an object, wherein the target current supplied to the motor (110) is: A target current setting means (120) for setting a d-axis target current (Idt) and a q-axis target current (Iqt) in a dq coordinate system, wherein the target current setting means (120) sets the q-axis target current A control device (100) for increasing 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 current (Idt0 ).
Further, the target current setting means (120) gradually increases the q-axis target current (Iqt) to the predetermined current (Idt0) after a lapse of a predetermined increase time (Ti) from 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) is zero and the position deviation (pt-θd) is 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)である。 Viewed from another point of view, the present invention is a control device (100) for a three-phase motor (110) driven to move an object, wherein the target current supplied to the motor (110) is d It has 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, and the target current setting means (120) includes the q-axis target current ( A control device (100) for decreasing the d-axis target current (Idt) when increasing the 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 decrease 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 reduces the q-axis target current (Iqt) so that it becomes zero after a predetermined decrease time (Td) has elapsed from when the q-axis target current (Iqt) is set to a non-zero value. The axis target current (Idt) may be decreased.
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 positional deviation (pt-θd) becomes non-zero. , the d-axis target current (Idt) may be decreased.

本発明によれば、モータの駆動によって移動させられる対象物の位置決めを精度高く行うことができる。 ADVANTAGE OF THE INVENTION According to this invention, the positioning of the target object moved by the drive of a motor can be performed with high precision.

本実施の形態に係る走査型電子顕微鏡の概略構成を示す図である。1 is a diagram showing a schematic configuration of a scanning electron microscope according to an embodiment; FIG. 本実施の形態に係る走査型電子顕微鏡の試料移動ステージの概略構成を示す図である。3 is a diagram showing a schematic configuration of a sample moving stage of the scanning electron microscope according to the present embodiment; FIG. 図2のIII方向に見た図である。It is the figure seen in the III direction of FIG. 制御装置の概略構成図である。1 is a schematic configuration diagram of a control device; FIG. 制御装置の概略構成図である。1 is a schematic configuration diagram of a control device; FIG. d軸目標電流設定部が設定するd軸目標電流の時間変化を例示する図である。FIG. 5 is a diagram illustrating temporal changes in a d-axis target current set by a d-axis target current setting unit; d軸目標電流調整部が行うd軸目標電流を設定する処理を示すフローチャートである。9 is a flow chart showing processing for setting a d-axis target current performed by a d-axis target current adjustment unit;

以下、添付図面を参照して、実施の形態について詳細に説明する。
図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 this embodiment.
FIG. 2 is a diagram showing a schematic configuration of the sample moving stage of the scanning electron microscope according to this embodiment.
FIG. 3 is a view of FIG. 2 viewed in direction III.
Scanning electron microscope 50 according to the present embodiment (hereinafter, sometimes simply referred to as “microscope 50”) is different from the scanning electron microscope described in Patent Document 1 in that x table 33 is moved x The motor 41, the y-motor 61 that moves the y-table 43, and the control device 100 that controls the driving of these motors are different. Differences from the scanning electron microscope described in Patent Document 1 are mainly described below.

顕微鏡50は、電子銃1と、コンデンサレンズ2と、対物レンズ3と、試料室4と、試料移動ステージ5と、2次電子検出器7と、真空ポンプ9~13と、ステージケース14とを有している。そして、顕微鏡50は、電子銃1で発生した電子ビームを、コンデンサレンズ2、対物レンズ3を通して試料室4内の試料移動ステージ5の上に取り付けられた試料S上に照射し、試料Sから出てくる2次電子を2次電子検出器7でとらえ、試料S表面の形状を観察可能にする。 A 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. 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. The incoming secondary electrons are caught 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に記載された走査型電子顕微鏡と基本的に同じであるので、その詳細な説明は省略する。 Also, the microscope 50 has a z-table 15 and a tilt table 20 . A mechanism for driving the z-table 15 and a mechanism for driving the tilt table 20 are basically the same as those of the scanning electron microscope described in Patent Document 1, so 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 cross roller guides 34 . The microscope 50 also has an x ball screw 35 and an x ball screw nut 36 that move the x table 33 . The microscope 50 also has bearings 37 and 38 supporting both ends of the x-ball screw 35, respectively, and bearing housings 39 and 40 supporting 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方向に移動させる。 The microscope 50 also has an x-motor 41 connected to the x-ball screw 35 , an x-coupling 44 , and an x-bracket 45 supporting the x-motor 41 . 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, rotating the x-ball screw 35, and transferring the x-ball screw nut 36, thereby moving 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に固定されている。 The microscope 50 also 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 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 . The microscope 50 also has bearings 57 and 58 that support both ends of the y ball screw 55, respectively, 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方向に移動させる。 The microscope 50 also has a y-motor 61 connected to the y-ball screw 55 , a y-coupling 62 , and a y-bracket 63 supporting the y-motor 61 . 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, rotating the y-ball screw 55, and transferring the y-ball screw nut 56, thereby moving 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とを有している。 The microscope 50 also 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 67 a and a worm gear 67 b that rotate the rotation table 66 . A worm wheel 67 a is attached to the rotation table 66 . The microscope 50 also has bearings 69 and 70 that support both ends of the worm gear 67b, respectively, 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を回転させる。 The microscope 50 also 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 the worm wheel 67a, thereby causing the sample S to rotate.

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

(モータ制御について)
上述した、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を制御する態様について説明する。
(Regarding motor control)
The x-motor 41, y-motor 61 and r-motor 73 described above can be exemplified as three-phase AC servomotors.
The microscope 50 has a control device 100 that controls driving of the x motor 41 , y motor 61 and 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 "motor 110". A manner of 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. FIG.
The control device 100 is an arithmetic logic operation circuit including a CPU, ROM, RAM, EEPROM (Electrically Erasable & Programmable Read Only Memory), and the like.
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 based on the target current set by the target current setting unit 120. there is The functional configuration of the target current setting section 120 is shown in FIG. 4, and the functional configuration of the control section 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 a q-axis target current Iqt in the dq coordinate system and a d-axis target current setting unit 121 for setting a d-axis target current Idt. and a portion 122 . The dq coordinate system is a rotating orthogonal coordinate system consisting of the d-axis and the q-axis that rotate in synchronism with the rotor (permanent magnet) of the motor 110. The d-axis is the axis along the direction of the magnetic flux formed by the rotor. and the q-axis is the axis along the direction of the torque generated by the motor 110 .
Other components of the q-axis target current setting section 121, the d-axis target current setting section 122, and the target current setting section 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を有している。
The control unit 130 has 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, as shown in FIG.
The control unit 130 also includes a motor current detection unit 133 that outputs a value corresponding to the actual current that actually flows through the motor 110, and converts the current detected by the motor current detection unit 133 into a current in the dq coordinate system. and a three-phase two-axis conversion unit 135 that
The control unit 130 also has a motor rotation angle calculation unit 136 that calculates a 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相に接続されたいわゆるシャント抵抗の両端に生じる電圧から各相に流れる実電流の値を検出する。 A motor current detector 133 includes a U-phase current detector for detecting a U-phase current, which is a current that actually flows in the U-phase of the motor 110, which is a three-phase motor, and a U-phase current that actually flows in the V-phase of the motor 110. It has a V-phase current detection section for detecting a V-phase actual current, which is a current, and a W-phase current detection section for detecting a W-phase actual current, which is a current actually flowing in the W-phase of the motor 110. there is The U-phase current detector, the V-phase current detector, and the W-phase current detector detect the actual current flowing through each phase from the voltage generated across so-called shunt resistors connected to the U-phase, V-phase, and W-phase of the motor 110, respectively. 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 3-phase/2-axis conversion unit 135 receives the actual U-phase current, the actual V-phase current, and the W-phase actual current detected by the motor current detection unit 133, and the motor rotation angle calculated by the motor rotation angle calculation unit 136. θd is input. Then, the three-phase two-axis conversion unit 135 converts the U-phase actual current, the V-phase actual current, and the W-phase actual current into the d-axis actual current Ida, which is the value of the dq coordinate system, and the q-axis d-axis actual current Ida and q-axis actual current Iqa are output.
A motor rotation angle calculator 136 calculates a motor rotation angle θd based on a motor rotation angle signal θs from a 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 converts 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 converts the q-axis target current Iqt calculated by the q-axis target current setting unit 121 of the target current setting unit 120 into the q-axis actual current calculated by the three-phase two-axis conversion unit 135. It has a q-axis subtractor 141q for subtracting Iqa.

また、モータ駆動制御部131は、d軸減算部141dにて算出された偏差(Idt-Ida)が零となるようにd軸目標電圧Vdtを出力する電流制御アンプ142dを有している。また、モータ駆動制御部131は、q軸減算部141qにて算出された偏差(Iqt-Iqa)が零となるようにq軸目標電圧Vqtを出力する電流制御アンプ142qを有している。 The motor drive control unit 131 also has a current control amplifier 142d that outputs the d-axis target voltage Vdt so that the deviation (Idt-Ida) calculated by the d-axis subtraction unit 141d becomes zero. The motor drive control unit 131 also has a current control amplifier 142q that outputs the 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 converts the d-axis target voltage Vdt and the q-axis target voltage Vqt output from the current control amplifier 142d and the current control amplifier 142q into U-phase target voltage Vut and V-phase target voltage Vut of the three-phase AC coordinate system. It has a 2-axis 3-phase converter 151 that converts the voltage Vvt to the W-phase target voltage Vwt.
The 2-axis 3-phase conversion unit 151 converts the d-axis target voltage Vdt and the q-axis target voltage Vqt to the U-phase target voltage based on a predetermined formula and the motor rotation angle θd calculated by the motor rotation angle calculation unit 136. The voltage Vut, the V-phase target voltage Vvt, and the W-phase target voltage Vwt are converted. That is, the 2-axis 3-phase converter 151 converts the applied voltage applied to the motor 110 based on the values output from the current control amplifiers 142d and 142q, in other words, feedback-controlled values and 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 provides a PWM control for PWM-driving 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 two-axis three-phase conversion unit 151 . It has a PWM signal generator 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 the other three transistors are connected to the electrical coils of each phase and the negative (ground) 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 transistors 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. A position subtraction unit 123 calculates a deviation (pt-θd) by subtracting the motor rotation angle θd from the position command pt.
Here, the position command pt is output from a host controller (not shown). For example, the host control unit may be configured by a general-purpose personal computer or the like including a CPU, ROM, RAM, an operation unit such as a mouse and keyboard, and a display unit such as a liquid crystal display. For example, when the operator of the microscope 50 operates the operation unit to specify a position away from the enlarged image currently displayed on the display unit, the position command pt is information on the specified position. , the direction and distance from the center of the current observation field of view to the specified position are calculated and set.

また、目標電流設定部120は、モータ回転角度算出部136で算出されたモータ回転角度θdに基づいてモータ110の回転速度であるモータ回転速度ωdを算出するモータ回転速度算出部124を有している。モータ回転速度算出部124は、モータ回転角度算出部136で算出されたモータ回転角度θdを微分することによりモータ回転速度ωdを算出する。 The target current setting unit 120 also includes a motor rotation speed calculation unit 124 that calculates a 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 calculator 124 calculates the motor rotation speed ωd by differentiating the motor rotation angle θd calculated by the motor rotation angle calculator 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 the target rotation speed ωt so that the deviation (pt−θd) calculated by the position subtraction unit 123 becomes zero.
The q-axis target current setting unit 121 also includes 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
The q-axis target current setting unit 121 also 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 the time rate of change of the position command pt. A position command speed calculator 128 calculates a 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 adjustment unit 129 for adjusting the current.

以上のように構成された目標電流設定部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 q-axis target current setting unit 121 causes the deviation (pt-θd) calculated by the position subtraction unit 123 to become zero and the position of the controlled object to reach the target position. When it reaches, the q-axis target current Iqt is set to zero. For example, if the x-direction position of the sample S is to be controlled, the q-axis target current Iqt of the x-motor 41 is set to zero when the x-direction position 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 temporal changes in the d-axis target current Idt set by the d-axis target current setting unit 122. In FIG.
In the d-axis target current setting unit 122, the d-axis target current adjustment unit 129 adjusts the position command speed Vpt calculated by the position command speed calculation unit 128 when it is not zero or the deviation calculated 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 section 129 sets the d-axis target current Idt to zero while the motor 110 is driving. In other words, the d-axis target current adjusting section 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 of the controlled object reaches the target position, in other words, when the position command speed Vpt calculated by the position command speed calculation unit 128 is 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 is to set the d-axis target current Idt to a value other than zero in order to compensate for the amount of heat generated by 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. The deviation of the position from the target position due to an increase in the current Idt is suppressed.

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

所定電流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 temperature changes in parts that determine the position of the controlled object in order to prevent the position from deviating from the target position after the position of the controlled object reaches the target position. set to a valid value. For example, the x ball screw 35 and the x ball screw nut 36 can be exemplified as the parts that determine the position of the sample S in the x direction. A y ball screw 55 and a y ball screw nut 56 can be exemplified as parts that determine the position of the sample S in the y direction. A worm wheel 67a and a worm gear 67b can be exemplified as the parts that determine the position of the sample S in the rotational direction.

モータ110が駆動した際に発生する熱がこれらの部品に伝わり、これらの部品に温度変化が生じる。例えば、試料Sのx方向の位置を例にして説明すると、xモータ41への電流の供給に起因して発生する熱が、xボールネジ35、xボールネジナット36等の試料Sのx方向の位置を定める部品に伝わるので、これらの部品が熱膨張した状態でx方向の位置が目標位置に定められる。そして、x方向の位置が目標位置に到達した後に、xモータ41への電流供給が停止されると、減少した電流の分の熱が発生しなくなるため、xボールネジ35、xボールネジナット36等のx方向の位置を定める部品の温度が低下する。そして、これらの部品の温度が低下すると、収縮するため、試料Sの位置が目標位置からずれ、試料ドリフトが生じてしまう。 Heat generated when the motor 110 is driven is transferred to these parts, causing temperature changes in these parts. For example, taking the position of the sample S in the x direction as an example, the heat generated due to the supply of current to the x motor 41 changes the position of the sample S such as the x ball screw 35 and the x ball screw nut 36 in the x direction. , the position in the x-direction is determined as the target position with these parts thermally expanded. 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 no longer generated. The temperature of the part defining the position in the x-direction is reduced. When the temperature of these parts drops, they shrink, causing the position of the sample S to deviate from the target position, resulting in sample drift.

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

本実施の形態においては、所定電流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 results and stored in the ROM. For example, the predetermined increase time Ti can be exemplified as one number of seconds determined from the range of 20 to 30 seconds. In this way, by slowly changing the d-axis target current Idt from zero to the predetermined current Idt0 over a predetermined increase time Ti, the position of the sample S is prevented from deviating from the target position.
Note that the predetermined current Idt0 and the predetermined increase time Ti may be set based on simulation results and calculation results.

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

また、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, the d-axis target current adjustment unit 129 is adjusted when the position command speed Vpt calculated by the position command speed calculation unit 128 is not zero, or when the deviation (pt-θd) calculated by the position subtraction unit 123 is zero. , the d-axis target current Idt is decreased at a predetermined decrease 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 calculator 128 is not zero, or the deviation (pt −θd) is no longer zero, the d-axis target current adjustment unit 129 gradually reduces the d-axis target current Idt so that the d-axis target current Idt becomes zero after a predetermined decrease time Td has elapsed. Decrease. It is considered that the q-axis target current Iqt becomes a value other than zero when the position command speed Vpt becomes non-zero or when the deviation (pt-θd) calculated by the position subtraction unit 123 becomes non-zero. because it will be

所定減少時間Tdは、予め、測定結果、シミュレーション結果又は算出結果に基づいて設定され、ROMに記憶されていることを例示することができる。例えば、所定減少時間Tdは、20~30秒の範囲の中から定められた一の秒数であることを例示することができる。このように、所定減少時間Tdをかけて、d軸目標電流Idtを所定電流Idt0から零までゆっくり変化させることで、試料Sの位置が目標位置からずれることを抑制する。
なお、所定減少時間Tdは、所定増加時間Tiと同じであることを例示することができる。ただし、所定減少時間Tdは、所定増加時間Tiと異なっていても良い。
Predetermined decrease time Td can be exemplified by being set in advance based on measurement results, simulation results, or calculation results, and stored in ROM. For example, the predetermined decrease time Td can be exemplified as one number of seconds determined from the range of 20 to 30 seconds. In this way, by slowly changing the d-axis target current Idt from the predetermined current Idt0 to zero over the predetermined decrease time Td, the position of the sample S is prevented from deviating from the target position.
In addition, 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, the d-axis target current adjustment unit 129 is operated when the position command speed Vpt calculated by the position command speed calculation unit 128 is no longer zero while the d-axis target current Idt is being increased at the predetermined increase rate, or , the d-axis target current Idt is reduced to zero at the predetermined reduction rate when the deviation (pt-θd) calculated by the position subtraction unit 123 is no longer zero.

また、d軸目標電流調整部129は、d軸目標電流Idtを減少させているときに、位置指令速度算出部128が算出した位置指令速度Vptが零となり、かつ、位置減算部123にて算出された偏差(pt-θd)が零となった場合には、上記所定増加レートでd軸目標電流Idtを増加させる。 Further, when the d-axis target current adjustment unit 129 decreases 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 calculated by the position subtraction unit 123 becomes zero. 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 after the position of the sample S reaches the target position, the sample S may deviate from the target position due to temperature changes. 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 flow chart showing the process of setting the d-axis target current Idt performed by the d-axis target current adjusting section 129. As shown in FIG. The d-axis target current adjustment unit 129 repeatedly executes this process at predetermined intervals (for example, one minute).
The d-axis target current adjustment 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 adjustment unit 129 determines whether or not the position command speed Vpt is zero (S702). If the position command speed Vpt is zero (Yes in S702), the d-axis target current adjustment unit 129 determines whether the deviation (pt-θd) calculated by the position subtraction unit 123 is zero ( S703). If the deviation (pt-θd) is zero (Yes in S703), the d-axis target current adjustment unit 129 increases the d-axis target current Idt to the predetermined current Idt0 at the above-described predetermined increase rate (S704).
If the position command speed Vpt is not zero (No in S702) and if the deviation (pt-θd) is not zero (No in S703), the d-axis target current adjusting section 129 terminates 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 adjustment 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 adjustment unit 129 determines whether or not the position command speed Vpt is zero (S706). If the position command speed Vpt is zero (Yes in S706), the d-axis target current adjustment unit 129 determines whether the deviation (pt-θd) calculated by the position subtraction unit 123 is zero ( S707). If the deviation (pt−θd) is zero (Yes in S707), the d-axis target current adjustment unit 129 ends this process to maintain the d-axis target current Idt at the predetermined current Idt0.

位置指令速度Vptが零ではない場合(S706でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで所定電流Idt0から零まで減少させる(S708)。また、偏差(pt-θd)が零ではない場合(S707でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで所定電流Idt0から零まで減少させる(S708)。 If the position command speed Vpt is not zero (No in S706), the d-axis target current adjustment unit 129 decreases the d-axis target current Idt from the predetermined current Idt0 to zero at the above-described predetermined decrease rate (S708). If the deviation (pt−θd) is not zero (No in S707), the d-axis target current adjustment unit 129 decreases the d-axis target current Idt from the predetermined current Idt0 to zero at the above-described predetermined decrease rate ( 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, if the d-axis target current Idt is not equal to the predetermined current Idt0 (No in S705), the d-axis target current adjustment unit 129 determines whether or not the d-axis target current Idt is being increased (S709). ). In other words, this process determines whether or not the d-axis target current adjustment unit 129 has reached the predetermined current Idt0 after the d-axis target current adjustment unit 129 starts increasing the d-axis target current Idt to the predetermined current Idt0 at a predetermined rate of increase in S704. It determines whether In the processing of S709, the d-axis target current adjustment unit 129 may determine whether or not the predetermined increase time Ti has elapsed after starting to increase the current 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の増加を維持するべく、本処理を終了する。 If the d-axis target current Idt is being increased (Yes in S709), the d-axis target current adjustment 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 adjustment unit 129 determines whether the deviation (pt-θd) calculated by the position subtraction unit 123 is zero ( S711). If the deviation (pt−θd) is zero (Yes in S711), the d-axis target current adjustment unit 129 terminates this process so as to keep the d-axis target current Idt increasing.

他方、位置指令速度Vptが零ではない場合(S710でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで零まで減少させる(S708)。また、偏差(pt-θd)が零ではない場合(S711でNo)、d軸目標電流調整部129は、d軸目標電流Idtを、上述した所定減少レートで零まで減少させる(S708)。 On the other hand, if the position command speed Vpt is not zero (No in S710), the d-axis target current adjustment unit 129 reduces the d-axis target current Idt to zero at the above-described predetermined reduction rate (S708). Also, if the deviation (pt-θd) is not zero (No in S711), the d-axis target current adjustment unit 129 reduces the d-axis target current Idt to zero at the above-described predetermined reduction rate (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, if the d-axis target current Idt is not being increased (No in S709), the d-axis target current Since Idt has not reached zero, the d-axis target current adjustment unit 129 determines whether or not the position command speed Vpt is zero (S712). If the position command speed Vpt is zero (Yes in S712), the d-axis target current adjustment unit 129 determines whether the deviation (pt-θd) calculated by the position subtraction unit 123 is zero ( S713). If the deviation (pt-θd) is zero (Yes in S713), the d-axis target current adjustment unit 129 increases the d-axis target current Idt to the predetermined current Idt0 at the above-described predetermined increase rate (S704).
On the other hand, if the position command speed Vpt is not zero (No in S712) and if the deviation (pt−θd) is not zero (No in S713), the d-axis target current adjustment unit 129 adjusts the d-axis target current Idt This process is terminated in order to maintain the decrease of .

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

なお、上述した実施の形態においては、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 adjustment unit 129 is controlled when the position command speed Vpt calculated by the position command speed calculation unit 128 is not zero, or when the position command speed Vpt calculated by the position subtraction unit 123 is 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 is zero and the deviation (pt-θd) is zero, the d-axis target current adjustment unit 129 adjusts the d-axis target current Idt from this arbitrary negative value to It is preferable to increase the current up to a predetermined current Idt0 at a predetermined rate of increase. Further, when the d-axis target current adjustment unit 129 sets the d-axis target current Idt to the predetermined current Idt0, the position command speed Vpt becomes non-zero or the deviation (pt-θd) becomes non-zero. In this case, it is preferable to decrease the d-axis target current Idt from the predetermined current Idt0 to this arbitrary negative value.

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

また、上述した実施の形態においては、モータ電流検出部133を、U相電流検出部、V相電流検出部及びW相電流検出部の3つの電流検出部を用いた例を示したが、この構成に限定されない。U相実電流、V相実電流及びW相実電流の電流値の総和は零となることから、2つの相の電流値を検出すれば残りの相の電流の値を算出できる。ゆえに、U相電流検出部、V相電流検出部及びW相電流検出部のいずれか一つの電流検出部を省略した構成を適用しても良い。 In the above-described embodiment, the motor current detection section 133 is exemplified by using three current detection sections, namely, the U-phase current detection section, the V-phase current detection section, and the W-phase current detection section. Not limited to 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 detector, the V-phase current detector, and the W-phase current detector 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 section, 121 ... q-axis target current setting section, 122 ... d-axis target current setting section, 130 ... control section

Claims (8)

電子顕微鏡におけるテーブルを移動させるために駆動する三相のモータの制御装置であって、
前記モータに供給する目標電流として、d-q座標系のd軸目標電流及びq軸目標電流を設定する目標電流設定手段を有し、
前記目標電流設定手段は、前記q軸目標電流を小さくする場合に、前記d軸目標電流を大きくする
制御装置。
A control device for a three-phase motor driven to move a table in an electron microscope ,
a target current setting means for setting a d-axis target current and a q-axis target current in a dq coordinate system as target currents to be supplied to the motor;
The target current setting means is a control device that increases the d-axis target current when decreasing the q-axis target current.
前記目標電流設定手段は、前記q軸目標電流を零ではない値から零にした場合に、前記d軸目標電流を予め定められた所定電流まで大きくする
請求項1に記載の制御装置。
2. The control device according to claim 1, wherein said target current setting means increases said d-axis target current to a predetermined current when said q-axis target current is changed from a non-zero value to zero.
前記目標電流設定手段は、前記q軸目標電流を零にしたときから予め定められた所定増加時間経過後に前記所定電流となるように徐々に前記d軸目標電流を大きくする
請求項2に記載の制御装置。
3. The target current setting means according to claim 2, wherein said target current setting means gradually increases said d-axis target current so as to reach said predetermined current after a predetermined increase time has passed since said q-axis target current is set to zero. Control device.
前記目標電流設定手段は、位置指令速度が零かつ位置偏差が零となったときに、前記q軸目標電流を零にし、前記d軸目標電流を零から大きくする
請求項1から3のいずれか1項に記載の制御装置。
4. The target current setting means according to any one of claims 1 to 3, wherein when the position command speed is zero and the positional deviation is zero, the q-axis target current is set to zero and the d-axis target current is increased from zero. 2. The control device according to item 1.
電子顕微鏡におけるテーブルを移動させるために駆動する三相のモータの制御装置であって、
前記モータに供給する目標電流として、d-q座標系のd軸目標電流及びq軸目標電流を設定する目標電流設定手段を有し、
前記目標電流設定手段は、前記q軸目標電流を大きくする場合に、前記d軸目標電流を小さくする
制御装置。
A control device for a three-phase motor driven to move a table in an electron microscope ,
a target current setting means for setting a d-axis target current and a q-axis target current in a dq coordinate system as target currents to be supplied to the motor;
The target current setting means is a control device for decreasing the d-axis target current when increasing the q-axis target current.
前記目標電流設定手段は、前記q軸目標電流を零から零ではない値にした場合に、前記d軸目標電流を零まで小さくする
請求項5に記載の制御装置。
6. The control device according to claim 5, wherein said target current setting means reduces said d-axis target current to zero when said q-axis target current is changed from zero to a value other than zero.
前記目標電流設定手段は、前記q軸目標電流を零ではない値にしたときから予め定められた所定減少時間経過後に零となるように徐々に前記d軸目標電流を小さくする
請求項6に記載の制御装置。
7. The target current setting means according to claim 6, wherein the target current setting means gradually decreases the d-axis target current so that the q-axis target current becomes zero after a lapse of a predetermined decrease time from when the q-axis target current is set to a value other than zero. controller.
前記目標電流設定手段は、位置指令速度、又は、位置偏差が零ではなくなったときに、前記q軸目標電流を零ではない値にし、前記d軸目標電流を小さくする
請求項5から7のいずれか1項に記載の制御装置。
8. The target current setting means according to any one of claims 5 to 7, wherein the q-axis target current is set to a non-zero value and the d-axis target current is reduced when the position command speed or the positional deviation is no longer zero. 1. The control device according to claim 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 JP2020161437A (en) 2020-10-01
JP7185576B2 true 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 (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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 apparatus, stage control method, and stage system

Family Cites Families (2)

* 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 exposure apparatus

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
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 apparatus, stage control method, and stage system

Also Published As

Publication number Publication date
JP2020161437A (en) 2020-10-01

Similar Documents

Publication Publication Date Title
JP5176420B2 (en) Sensorless control device for brushless motor
KR102176579B1 (en) Method and Apparatus for controlling torque of Permanent Magnet Synchronous Motor
JP5839111B2 (en) Control device for three-phase AC induction motor and control method for three-phase AC induction motor
TW201140264A (en) Control parameter adjusting method and adjusting device
CN1902813A (en) Motor controller
EP4531265A1 (en) Differential steering control method for vehicle
JP2019083672A (en) Inverter, and drive control method for motor
JPH02254987A (en) Method and apparatus for control of induction motor
Khazaee et al. Loss minimization algorithm for surface-mounted PMSM using ripple-based extremum seeking
JP6004830B2 (en) Control device and stepping motor control method
JP7185576B2 (en) Control device
Diab Real-time implementation of full-order observer for speed sensorless vector control of induction motor drive
WO2022168339A1 (en) Computing device, control device for electric motor, computing method, control method, and program
JP4205473B2 (en) Stepping motor control method and stepping motor control device
JP2015165757A (en) Inverter controller and control method
US8324848B2 (en) System for maintaining thermal stability of a motion stage
JPS6348509A (en) Laser scanner device
Mohammed et al. Sensorless deadbeat control strategy with adaptive capability for PMSM drive machines
CN110535391B (en) Compensation method, system and device for angle error of servo motor
WO2021124603A1 (en) Motor control device and motor control method
JP7467201B2 (en) Motor Control Device
JP6034208B2 (en) Galvano scanner control device and laser processing device
JP5802517B2 (en) Machine tool and motor control method thereof
JP4171192B2 (en) Servo control device
JP2009296722A (en) Motor controller, motor control method, and air conditioner

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

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250