JP2017112730A - State estimation device and state estimation method - Google Patents

State estimation device and state estimation method Download PDF

Info

Publication number
JP2017112730A
JP2017112730A JP2015245347A JP2015245347A JP2017112730A JP 2017112730 A JP2017112730 A JP 2017112730A JP 2015245347 A JP2015245347 A JP 2015245347A JP 2015245347 A JP2015245347 A JP 2015245347A JP 2017112730 A JP2017112730 A JP 2017112730A
Authority
JP
Japan
Prior art keywords
motor
state
state estimation
inductor
voltage
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
JP2015245347A
Other languages
Japanese (ja)
Other versions
JP6742719B2 (en
Inventor
大西　公平
Kohei Onishi
公平 大西
貴裕 野崎
Takahiro Nozaki
貴裕 野崎
飯田　亘
Wataru Iida
亘 飯田
佑貴 斉藤
Yuki Saito
佑貴 斉藤
神原　義幸
Yoshiyuki Kanbara
義幸 神原
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.)
Keio University
Original Assignee
Keio University
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 Keio University filed Critical Keio University
Priority to JP2015245347A priority Critical patent/JP6742719B2/en
Priority to PCT/JP2016/086259 priority patent/WO2017104490A1/en
Publication of JP2017112730A publication Critical patent/JP2017112730A/en
Application granted granted Critical
Publication of JP6742719B2 publication Critical patent/JP6742719B2/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • H—ELECTRICITY
    • H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
    • H02P—CONTROL OR REGULATION OF ELECTRIC MOTORS, ELECTRIC GENERATORS OR DYNAMO-ELECTRIC CONVERTERS; CONTROLLING TRANSFORMERS, REACTORS OR CHOKE COILS
    • H02P7/00—Arrangements for regulating or controlling the speed or torque of electric DC motors
    • H02P7/06—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current
    • H02P7/18—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power
    • H02P7/24—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices
    • H02P7/28—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices using semiconductor devices
    • H02P7/285—Arrangements for regulating or controlling the speed or torque of electric DC motors for regulating or controlling an individual dc dynamo-electric motor by varying field or armature current by master control with auxiliary power using discharge tubes or semiconductor devices using semiconductor devices controlling armature supply only

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Control Of Electric Motors In General (AREA)
  • Manipulator (AREA)

Abstract

PROBLEM TO BE SOLVED: To estimate a state of a control target more appropriately without using a sensor.SOLUTION: A state estimation device 1 comprises a power supply 10, a motor 20a, a state estimation inductor 30, a controller 40, and a voltmeter 50. The state estimation inductor 30 is connected in series to a circuit that connects between the power supply 10 for supplying a power to the motor 20a that is a control target and the motor 20a. The voltmeter 50 detects a both-end voltage of the state estimation inductor 30. The controller 40 estimates a state of the motor 20a on the basis of both-end of the voltage of the state estimation inductor 30 detected by the voltmeter 50.SELECTED DRAWING: Figure 2

Description

本発明は、制御対象の状態を推定する状態推定装置及び状態推定方法に関する。   The present invention relates to a state estimation device and a state estimation method for estimating a state of a control target.

従来、耐故障性の向上やコストの低減、装置の小型化等の観点からロボット等におけるモータ（電動機）のセンサレス化が求められている。特に、センサの動作に影響を与える化学物質に汚染された環境や強い放射能が存在する環境等、ロボット等に備えられるモータを劣悪な環境下で稼動させる場合、センサによってモータの状態を把握することが困難であり、モータのセンサレス化は極めて重要な課題である。
ここで、ロボット等におけるモータのセンサレス化を図るために、インダクタンスの変化によりモータを備えるロボットの部位の角度を推定する技術が知られている（例えば、特許文献１参照）。 Conventionally, there has been a demand for sensorless motors (motors) in robots and the like from the viewpoints of improving fault tolerance, reducing costs, downsizing devices, and the like. In particular, when operating a motor equipped in a robot, etc. in a poor environment, such as an environment contaminated with chemical substances that affect the operation of the sensor or an environment where strong radioactivity exists, the state of the motor is grasped by the sensor. Therefore, the sensorless motor is an extremely important issue.
Here, in order to reduce the sensor of a motor in a robot or the like, a technique for estimating an angle of a part of a robot including a motor by a change in inductance is known (for example, see Patent Document 1).

特開２００３−１６４１８７号公報JP 2003-164187 A

しかしながら、特許文献１に記載された技術においては、ロボットを駆動するアクチュエータ（モータ）のインダクタンスを同定することで、ロボットの部位の角度を推定している。このような方法では、制御に必要となる入力に対し、インダクタンス推定のための入力を重畳する必要があり、制御性能や推定精度に課題が生じる。また、角度に依存してインダクタンスが変化する構造を前提としているため、適用可能なアクチュエータの構造が限定される。
このように、従来の技術においては、センサを用いることなく制御対象の状態を適切に推定することが困難であった。 However, in the technique described in Patent Document 1, the angle of the robot part is estimated by identifying the inductance of an actuator (motor) that drives the robot. In such a method, it is necessary to superimpose an input for inductance estimation on an input necessary for control, which causes problems in control performance and estimation accuracy. In addition, since the structure is such that the inductance varies depending on the angle, the applicable actuator structure is limited.
As described above, in the conventional technique, it is difficult to appropriately estimate the state of the control target without using a sensor.

本発明の課題は、センサを用いることなく制御対象の状態をより適切に推定することである。   The subject of this invention is estimating the state of a control object more appropriately, without using a sensor.

上記課題を解決するため、本発明の一態様に係る状態推定装置は、
制御対象となるモータに電力を供給する電源と当該モータとを接続する回路に直列に接続されたインダクタと、
前記インダクタの両端電圧を検出する電圧検出手段と、
前記電圧検出手段によって検出された前記インダクタの両端電圧に基づいて、前記モータの状態を推定する推定手段と、
を備えることを特徴とする。 In order to solve the above problem, a state estimation device according to an aspect of the present invention includes:
A power source that supplies power to a motor to be controlled and an inductor connected in series to a circuit that connects the motor;
Voltage detecting means for detecting a voltage across the inductor;
Estimating means for estimating the state of the motor based on the voltage across the inductor detected by the voltage detecting means;
It is characterized by providing.

本発明によれば、センサを用いることなく制御対象の状態をより適切に推定することができる。   According to the present invention, it is possible to more appropriately estimate the state of the controlled object without using a sensor.

本発明の基本的原理を示す回路図である。It is a circuit diagram which shows the basic principle of this invention. 本発明を適用した状態推定装置１の具体的構成を示すブロック図である。It is a block diagram which shows the specific structure of the state estimation apparatus 1 to which this invention is applied. 本発明を用いて状態を推定した場合の実験結果を示す模式図であり、図３（Ａ）は力の推定結果、図３（Ｂ）はトルクの推定結果を示す図である。It is a schematic diagram which shows the experimental result at the time of estimating a state using this invention, FIG. 3 (A) is a figure which shows the estimation result of a force, FIG.3 (B) is a figure which shows the estimation result of a torque.

以下、本発明の実施形態について、図面を参照して説明する。
初めに、本発明に係る状態推定装置及び状態推定方法に適用される基本的原理について説明する。
［基本的原理］
図１は、本発明の基本的原理を示す回路図である。
図１に示すように、本発明に係る状態推定装置１においては、電源１０と、制御対象２０と、状態推定用インダクタ３０とを含む回路が構成される。
これらのうち、電源１０及び状態推定用インダクタ３０は、制御対象２０とは位置が離れた制御側に設置することができる。例えば、制御対象２０が化学物質や放射能等のため立ち入り困難な環境に設置される場合、電源１０及び状態推定用インダクタ３０は、立ち入り可能な環境にある制御室等に設置することができる。 Hereinafter, embodiments of the present invention will be described with reference to the drawings.
First, the basic principle applied to the state estimation device and the state estimation method according to the present invention will be described.
[Basic principles]
FIG. 1 is a circuit diagram showing the basic principle of the present invention.
As shown in FIG. 1, in the state estimation device 1 according to the present invention, a circuit including a power source 10, a control target 20, and a state estimation inductor 30 is configured.
Among these, the power supply 10 and the state estimation inductor 30 can be installed on the control side away from the controlled object 20. For example, when the controlled object 20 is installed in an environment that is difficult to enter due to chemical substances, radioactivity, or the like, the power supply 10 and the state estimating inductor 30 can be installed in a control room or the like in an accessible environment.

図１において、電源１０は、供給する電圧が可変の電源であり、制御対象２０の負荷に応じた電力を供給する。
制御対象２０は、例えばアクチュエータ（モータ）等によって構成され、電源１０から供給される電力によって動作する。なお、制御対象２０は、動作時に負荷に応じた逆起電力を発生する。
状態推定用インダクタ３０は、電源１０及び制御対象２０を含むループに直列に接続され、電源１０及び制御対象２０を流れる電流と同一の電流（以下、適宜「駆動電流」と呼ぶ。）が流れる構成となっている。状態推定用インダクタ３０は、駆動電流が流れることにより、自己インダクタンスに応じた起電力を発生する。 In FIG. 1, a power supply 10 is a power supply whose supply voltage is variable, and supplies power according to the load of the control target 20.
The control target 20 is configured by, for example, an actuator (motor) or the like, and operates by power supplied from the power supply 10. Note that the control target 20 generates a counter electromotive force according to the load during operation.
The state estimation inductor 30 is connected in series to a loop including the power supply 10 and the control target 20, and the same current as the current flowing through the power supply 10 and the control target 20 (hereinafter referred to as “drive current” as appropriate) flows. It has become. The state estimation inductor 30 generates an electromotive force according to the self-inductance when a drive current flows.

図１に示すように、制御対象２０（モータ）のイナーシャをJ、角速度をω、発生トルクをＴｍ、負荷トルクをＴｌとすると、制御対象２０の運動方程式は、式（１）によって表される。
Ｊ・ｄω＝Ｔｍ−Ｔｌ （１）
ただし、ｄωはωの時間微分である。 As shown in FIG. 1, when the inertia of the control target 20 (motor) is J, the angular velocity is ω, the generated torque is Tm, and the load torque is Tl, the equation of motion of the control target 20 is expressed by the equation (1). .
J · dω = Tm−Tl (1)
However, dω is a time derivative of ω.

また、制御対象２０の印加電圧をＶｍ、内部抵抗をＲ、電流をＩ、逆起電力をＥとすると、制御対象２０における電圧の関係は、式（２）によって表される。
Ｖｍ＝Ｒ・Ｉ＋Ｅ （２） Further, when the applied voltage of the controlled object 20 is Vm, the internal resistance is R, the current is I, and the counter electromotive force is E, the voltage relationship in the controlled object 20 is expressed by Expression (2).
Vm = R · I + E (2)

ここで、式（２）における逆起電力Ｅは、逆起電力定数Ｋｔ及び角速度ωを用いて、式（３）によって表される。
Ｅ＝Ｋｔ・ω （３） Here, the counter electromotive force E in the equation (2) is expressed by the equation (3) using the counter electromotive force constant Kt and the angular velocity ω.
E = Kt · ω (3)

すると、式（２）は、式（４）のように表される。
Ｖｍ＝Ｒ・Ｉ＋Ｋｔ・ω （４）
制御対象２０の内部抵抗及び逆起電力定数Ｋｔの変化がきわめて微小であり、実質的に一定であるとみなせる場合、式（４）の両辺を時間で微分することで、式（５）が得られる。
ｄＶｍ＝Ｒ・ｄＩ＋Ｋｔ・ｄω （５） Then, Expression (2) is expressed as Expression (4).
Vm = R · I + Kt · ω (4)
When changes in the internal resistance and the back electromotive force constant Kt of the controlled object 20 are extremely small and can be regarded as being substantially constant, Expression (5) is obtained by differentiating both sides of Expression (4) with respect to time. It is done.
dVm = R · dI + Kt · dω (5)

式（５）を角速度について解くと、式（６）が得られる。
ｄω＝（ｄＶｍ−Ｒ・ｄＩ）／Ｋｔ （６）
制御対象２０と直列に状態推定用インダクタ３０を接続した場合、状態推定用インダクタ３０のインダクタンスをＬとすると、状態推定用インダクタ３０に印加される電圧ＶＬは、式（７）のように表される。
ＶＬ＝Ｌ・ｄＩ （７） When equation (5) is solved for angular velocity, equation (6) is obtained.
dω = (dVm−R · dI) / Kt (6)
When the state estimation inductor 30 is connected in series with the controlled object 20, when the inductance of the state estimation inductor 30 is L , the voltage VL applied to the state estimation inductor 30 is expressed as shown in Expression (7). Is done.
V L = L · dI (7)

制御対象２０に流れる電流と、状態推定用インダクタ３０に流れる電流とは等しいことから、式（７）の電流微分値ｄＩを（６）式に代入すると、式（８）が得られる。
ｄω＝（ΔＶｍ−Ｒ・（ＶＬ／Ｌ））／Ｋｔ
＝（ΔＶｍ・Ｌ−Ｒ・ＶＬ）／（Ｋｔ・Ｌ） （８） Since the current flowing through the controlled object 20 and the current flowing through the state estimating inductor 30 are equal, substituting the current differential value dI of Expression (7) into Expression (6) yields Expression (8).
dω = (ΔVm−R · (V L / L)) / Kt
= (ΔVm · LR−V L ) / (Kt · L) (8)

式（８）において、ΔＶｍは電源１０の供給電圧の変化量（即ち、電源１０への指令値の変化量）、ＶＬは状態推定用インダクタ３０の両端電圧（測定値）である。
これにより、式（８）から、制御側において取得可能なパラメータ（ΔＶｍ及びＶＬ）によって、制御対象２０の角加速度ｄωを推定することができる。
即ち、本発明の構成では、制御対象２０の状態が、制御側に設置された状態推定用インダクタ３０に反映されることから、状態推定用インダクタ３０の状態に着目することで、制御対象２０にセンサを備えることなく、制御側において制御対象２０の状態を推定することができる。 In Expression (8), ΔVm is the amount of change in the supply voltage of the power supply 10 (that is, the amount of change in the command value to the power supply 10), and VL is the voltage across the state estimation inductor 30 (measured value).
Thereby, the angular acceleration dω of the controlled object 20 can be estimated from the equation (8) by the parameters (ΔVm and V L ) that can be acquired on the control side.
That is, in the configuration of the present invention, since the state of the control target 20 is reflected in the state estimation inductor 30 installed on the control side, the control target 20 can be controlled by paying attention to the state of the state estimation inductor 30. The state of the controlled object 20 can be estimated on the control side without providing a sensor.

また、制御対象２０の角加速度ｄωを用いて、外乱オブザーバ等のロバスト制御を構成することが可能となる。
また、制御対象２０の角加速度ｄωが求められることにより、ロバスト制御を行うことが可能となるため、制御対象２０の位置及び力を高精度に制御することができる。これにより、制御対象２０に入力される力覚を制御側に伝達すること等が可能となり、遠隔操作されるロボットにおけるモータのセンサレス化を実現することができる。
さらに、外乱オブザーバ等により制御対象２０に加わる外力を推定することができるため、角加速度に基づく角度制御ループ及び推定した外力に基づくトルク制御ループを構成することが可能となる。 In addition, it is possible to configure robust control such as a disturbance observer using the angular acceleration dω of the controlled object 20.
In addition, robust control can be performed by obtaining the angular acceleration dω of the control target 20, so that the position and force of the control target 20 can be controlled with high accuracy. As a result, it is possible to transmit a force sense input to the controlled object 20 to the control side, and to realize sensorless motors in a remotely operated robot.
Furthermore, since the external force applied to the controlled object 20 can be estimated by a disturbance observer or the like, an angle control loop based on the angular acceleration and a torque control loop based on the estimated external force can be configured.

［具体的構成］
次に、本発明を適用した状態推定装置１の具体的構成について説明する。
図２は、本発明を適用した状態推定装置１の具体的構成を示すブロック図である。
図２に示すように、状態推定装置１は、電源１０と、制御対象２０としてのモータ２０ａと、状態推定用インダクタ３０と、制御部４０と、電圧計５０とを備えている。
これらのうち、電源１０及び状態推定用インダクタ３０は、図１における説明を参照することとし、ここでは説明を省略する。 [Specific configuration]
Next, a specific configuration of the state estimation device 1 to which the present invention is applied will be described.
FIG. 2 is a block diagram showing a specific configuration of the state estimation apparatus 1 to which the present invention is applied.
As shown in FIG. 2, the state estimation device 1 includes a power supply 10, a motor 20 a as a control target 20, a state estimation inductor 30, a control unit 40, and a voltmeter 50.
Among these, the power supply 10 and the state estimation inductor 30 are referred to the description in FIG. 1, and the description is omitted here.

モータ２０ａは、例えば、ロボットのマニピュレータを駆動するアクチュエータであり、電源１０から供給された電力に応じた力を外部に出力する。また、モータ２０ａは、電源１０、状態推定用インダクタ３０、制御部４０及び電圧計５０とは遠隔的な位置（距離が離れた地点あるいは壁等の障害物に隔たれた地点等）に設置される。ただし、本発明において、電源１０等からモータ２０ａまでの距離の遠近は特に問うものではない。   The motor 20a is, for example, an actuator that drives a robot manipulator, and outputs a force corresponding to the power supplied from the power supply 10 to the outside. Further, the motor 20a is installed at a position remote from the power source 10, the state estimation inductor 30, the control unit 40, and the voltmeter 50 (a point separated by a distance or a point separated by an obstacle such as a wall). . However, in the present invention, the distance from the power source 10 or the like to the motor 20a is not particularly questioned.

制御部４０は、電源１０から供給する電力の指令値を入力することにより、電源１０を制御する。このとき、制御部４０は、式（８）に基づいて、電圧計５０から入力される状態推定用インダクタ３０の両端電圧ＶＬによってモータ２０ａの角加速度ｄω（あるいは出力する力）を推定し、電源１０から供給する電力の指令値を決定する。
電圧計５０は、状態推定用インダクタ３０の両端電圧ＶＬを測定し、測定結果を制御部４０に出力する。なお、電圧計５０によって測定された状態推定用インダクタ３０の両端電圧ＶＬは、Ａ／Ｄ（Ａｎａｌｏｇ ｔｏ Ｄｉｇｉｔａｌ）変換されて制御部４０に出力される。 The control unit 40 controls the power supply 10 by inputting a command value of power supplied from the power supply 10. At this time, the control unit 40 estimates the angular acceleration dω (or force to be output) of the motor 20a based on the equation (8) based on the voltage VL across the state estimation inductor 30 input from the voltmeter 50, A command value of power supplied from the power supply 10 is determined.
The voltmeter 50 measures the voltage VL across the state estimating inductor 30 and outputs the measurement result to the control unit 40. Note that the both-ends voltage VL of the state estimation inductor 30 measured by the voltmeter 50 is A / D (Analog to Digital) converted and output to the control unit 40.

［動作］
次に、状態推定装置１の動作を説明する。
初めに、制御部４０において、モータ２０ａから出力する力（または位置）の目標値に応じた電源１０への指令値を算出し、電源１０に指令値を入力する。
すると、電源１０は、モータ２０ａに対して指令値に応じた電圧Ｖｍを印加し、モータ２０ａは、印加された電圧Ｖｍに応じて、力（または位置）を出力する。
このとき、状態推定装置１には、電源１０、モータ２０ａ及び状態推定用インダクタ３０に共通する電流Ｉが流れ、制御部４０は、モータ２０ａの内部抵抗Ｒ、逆起電力定数Ｋｔ、状態推定用インダクタ３０のインダクタンスＬ、電源１０の供給電圧の変化量ΔＶｍ及び状態推定用インダクタ３０の両端電圧ＶＬに応じた角加速度ｄωを算出する（式（８）参照）。 [Operation]
Next, the operation of the state estimation device 1 will be described.
First, the control unit 40 calculates a command value to the power source 10 corresponding to the target value of the force (or position) output from the motor 20 a and inputs the command value to the power source 10.
Then, the power supply 10 applies a voltage Vm corresponding to the command value to the motor 20a, and the motor 20a outputs a force (or position) according to the applied voltage Vm.
At this time, a current I that is common to the power supply 10, the motor 20a, and the state estimation inductor 30 flows through the state estimation device 1, and the control unit 40 controls the internal resistance R of the motor 20a, the back electromotive force constant Kt, the state estimation. inductance L of the inductor 30, and calculates the angular acceleration dω corresponding across voltage V L variation ΔVm and state estimation inductor 30 of the supply voltage of the power source 10 (see equation (8)).

各加速度ｄωが算出されることにより、モータ２０ａにおける速度（加速度の積分）、位置（加速度の２重積分）あるいは力等の状態を適切に推定することができる。
即ち、センサを用いることなくモータ２０ａの状態をより適切に推定することが可能となる。
これにより、例えば、モータ２０ａにおける力覚を制御側において再現し、正確な力覚を伝達しながら、バイラテラル制御によってロボットのマニピュレータを制御すること等が可能となる。
なお、本発明をバイラテラル制御に用いる場合、マスタ側及びスレーブ側において加速度の差が実質的にゼロとなり、力覚が適切に伝達される。このとき、マスタ側及びスレーブ側の絶対位置については、カメラ等で操作者が位置を視認しながら操作することから、力覚の伝達を行う上で問題とならない。 By calculating each acceleration dω, it is possible to appropriately estimate the state of the motor 20a such as speed (integration of acceleration), position (double integration of acceleration) or force.
That is, the state of the motor 20a can be estimated more appropriately without using a sensor.
Thereby, for example, it becomes possible to control the manipulator of the robot by bilateral control while reproducing the force sense in the motor 20a on the control side and transmitting the accurate force sense.
When the present invention is used for bilateral control, the difference in acceleration between the master side and the slave side becomes substantially zero, and the force sense is appropriately transmitted. At this time, the absolute positions on the master side and the slave side are operated by the operator while visually recognizing the position with a camera or the like, so that there is no problem in transmitting the force sense.

また、上述の実施形態において、状態推定装置１は、センサを用いることなくモータ２０ａの状態を推定すると共に、モータ２０ａの状態を推定する際に生じる累積誤差をリセットするためにモータ２０ａの状態を検出するリセット用のセンサ（検出手段）を備えることも可能である。この場合、リセット用のセンサは、従来のようにモータ２０ａの状態を検出するセンサに比べて、検出精度がより粗いセンサとすれば足りる。リセット用のセンサは、検出精度がより粗いセンサであるため、劣悪な環境に設置された場合でも、従来のようにモータ２０ａの状態を検出するセンサよりも推定精度に対する環境の影響は小さいものとなる。また、リセット用のセンサは、累積誤差のリセットを行うことができれば良いため、従来のようにモータ２０ａの状態を検出するセンサとは種類の異なるセンサを用いることが可能である。そのため、リセット用のセンサとして、モータ２０ａが設置される環境に影響を受け難い種類のセンサを選択することができる。
このように、リセット用のセンサを備えることで、より高い推定精度を実現することができる。 Further, in the above-described embodiment, the state estimation device 1 estimates the state of the motor 20a without using a sensor and resets the state of the motor 20a in order to reset the accumulated error that occurs when estimating the state of the motor 20a. It is also possible to provide a reset sensor (detection means) for detection. In this case, it is sufficient that the sensor for resetting is a sensor having a coarser detection accuracy than a sensor for detecting the state of the motor 20a as in the prior art. Since the reset sensor is a sensor with a coarser detection accuracy, even if it is installed in a poor environment, the influence of the environment on the estimation accuracy is smaller than the conventional sensor that detects the state of the motor 20a. Become. Further, since the reset sensor only needs to be able to reset the accumulated error, it is possible to use a sensor of a different type from the conventional sensor that detects the state of the motor 20a. Therefore, a type of sensor that is not easily affected by the environment in which the motor 20a is installed can be selected as a reset sensor.
Thus, by providing the reset sensor, higher estimation accuracy can be realized.

［効果］
図３は、本発明を用いて状態を推定した場合の実験結果を示す模式図であり、図３（Ａ）は力の推定結果、図３（Ｂ）はトルクの推定結果を示す図である。
図３（Ａ）に示すように、力の指令値（実線）に対して、センサを用いて測定した測定値（一点鎖線）と、本発明を用いて推定した推定値（破線）とがほぼ一致している。
また、図３（Ｂ）に示すように、トルクの指令値（実線）に対して、センサを用いて測定した測定値（一点鎖線）と、本発明を用いて推定した推定値（破線）とがほぼ一致している。 [effect]
3A and 3B are schematic diagrams showing experimental results when the state is estimated using the present invention, FIG. 3A is a diagram showing a force estimation result, and FIG. 3B is a diagram showing a torque estimation result. .
As shown in FIG. 3A, with respect to the force command value (solid line), the measured value (dotted line) measured using the sensor and the estimated value (dashed line) estimated using the present invention are almost equal. Match.
Further, as shown in FIG. 3B, with respect to the torque command value (solid line), a measured value (dotted line) measured using a sensor and an estimated value (dashed line) estimated using the present invention Is almost the same.

このように、本発明によって、センサを用いることなく制御対象の状態をより適切に推定することが可能となる。
そのため、本発明によって、センサ部の故障及び誤検知がなくなるため、耐故障性の向上を図ることができ、また、センサに相当する体積が不要となるため、装置の小型化を図ることができる。さらに、本発明によって、センサに相当する重量がなくなるため、装置の軽量化を図ることができ、また、センサを設置する費用が不要となるため、装置のコスト削減を図ることができる。 Thus, according to the present invention, it is possible to more appropriately estimate the state of the controlled object without using a sensor.
Therefore, according to the present invention, failure and false detection of the sensor unit are eliminated, so that the fault tolerance can be improved, and the volume corresponding to the sensor is not required, so that the apparatus can be downsized. Further, according to the present invention, since the weight corresponding to the sensor is eliminated, the weight of the device can be reduced, and the cost for installing the sensor is not required, so that the cost of the device can be reduced.

即ち、本発明は、駆動側にセンサを配置することなく、位置及び力の高精度な制御を実現するものであり、現在のロボット技術が抱える耐故障性の向上や費用の低減、装置の小型化といった課題を解消し得るものである。これにより、従来では導入が困難であった現場におけるロボットの活用や、より安価なロボットの開発が可能となり、幅広い分野への応用が期待される。   That is, the present invention realizes high-precision control of position and force without arranging a sensor on the drive side, and improves fault tolerance and cost reduction that the current robot technology has, and downsizing the apparatus. Such a problem can be solved. This makes it possible to use robots in the field that were difficult to introduce in the past and to develop cheaper robots, and is expected to be applied in a wide range of fields.

［具体的適用例］
次に、状態推定装置１の具体的適用例について説明する。
（１）原子炉内部におけるアクチュエータへの適用
本発明は、原子炉内部で使用されるアクチュエータに適用することができる。
即ち、原子炉内部にアクチュエータを備えたマニピュレータを配置し、原子炉の制御室にマニピュレータの制御部、電源及び状態推定用インダクタンスを配置することができる。
原子炉内でセンサを備えたマニピュレータを使用した場合、センサが放射能によって短期間で故障し、頻繁にマニピュレータを交換する必要が生じる。
これに対し、本発明の構成を適用することで、センサを備えない構成によって、マニピュレータの状態をセンサで測定する場合と同様に推定することができると共に、マニピュレータの交換頻度を低下させることができる。 [Specific application examples]
Next, a specific application example of the state estimation device 1 will be described.
(1) Application to an actuator inside a nuclear reactor The present invention can be applied to an actuator used inside a nuclear reactor.
That is, a manipulator having an actuator can be arranged inside the nuclear reactor, and a manipulator control unit, a power source, and a state estimation inductance can be arranged in the nuclear reactor control room.
When a manipulator equipped with a sensor is used in a nuclear reactor, the sensor fails in a short period due to radioactivity, and it is necessary to frequently replace the manipulator.
On the other hand, by applying the configuration of the present invention, it is possible to estimate the state of the manipulator in the same manner as in the case where the state of the manipulator is measured by the sensor, and to reduce the manipulator replacement frequency. .

（２）狭小な空間におけるアクチュエータへの適用
本発明は、人体内部等、狭小な空間で用いられるアクチュエータに適用することができる。
人体内部での内視鏡手術で用いられるマニピュレータ等、狭小な空間で用いられるマニピュレータには、比較的大きいサイズを有するエンコーダを備えることは困難である。
このような場合に、本発明の構成を適用し、マニピュレータを駆動するアクチュエータと直列に、状態推定用インダクタ３０を人体外部に配置することで、マニピュレータの力覚を制御部側に伝えることが可能となる。 (2) Application to an actuator in a narrow space The present invention can be applied to an actuator used in a narrow space such as the inside of a human body.
It is difficult to provide an encoder having a relatively large size in a manipulator used in a narrow space such as a manipulator used in endoscopic surgery inside a human body.
In such a case, the force sense of the manipulator can be transmitted to the control unit side by applying the configuration of the present invention and arranging the state estimation inductor 30 in series with the actuator that drives the manipulator. It becomes.

（３）人間の身体的行為の実現におけるアクチュエータへの適用
人間の身体的行為を実現するために、アクチュエータの現在の状態（加速度、速度あるいは位置等）を入力として、位置（または速度）あるいは力の少なくとも一方の領域における演算を行うことで、アクチュエータの動作を決定することができる（例えば、発明者らによる国際特許出願ＰＣＴ／ＪＰ２０１４／０７３０８３参照）。
このような場合に、本発明を適用し、状態推定用インダクタ３０を備えることで、アクチュエータの現在位置を検出するセンサを備えることなく、アクチュエータの現在位置を推定することができる。 (3) Application to the actuator in the realization of the human physical action To realize the human physical action, the current state (acceleration, velocity, position, etc.) of the actuator is used as an input, and the position (or velocity) or force The operation of the actuator can be determined by performing computation in at least one of the areas (see, for example, International Patent Application PCT / JP2014 / 073083 by the inventors).
In such a case, applying the present invention and providing the state estimation inductor 30 makes it possible to estimate the current position of the actuator without providing a sensor for detecting the current position of the actuator.

（４）過酷な動作条件におけるリアルタイムな状態推定への適用
本発明は、トンネルの掘削工事等を行う掘削機を駆動するモータに適用することができる。
トンネルの掘削工事においては、地質の変化により岩盤等の硬い層に突き当たることがあり、そのまま掘り進めた場合、掘削機の故障等の原因となる。そのため、掘削の現場では、掘削機を適宜停止させ、例えば数日を費やして地層の確認を行っている。このような地層の確認のために、工事作業の効率が低下することとなる。
これに対し、掘削機を駆動するモータに本発明を適用することにより、モータが地層に対して出力している力を、センサを備えることなく、リアルタイムに推定することができる。なお、このような掘削機にセンサを設置した場合、動作条件が過酷であることから、センサの故障が頻繁に発生することとなる。
これにより、地質の変化があったことがリアルタイムに検出されるため、無用に掘削機を停止させる必要がなくなり、工事作業の効率化を図ることができる。 (4) Application to real-time state estimation under severe operating conditions The present invention can be applied to a motor that drives an excavator that performs excavation work of a tunnel or the like.
In tunnel excavation work, it may hit hard layers such as bedrock due to changes in geology, and if it is dug as it is, it may cause malfunction of the excavator. Therefore, at the excavation site, the excavator is stopped as appropriate, and for example, several days are spent to check the formation. The efficiency of the construction work will be reduced due to such confirmation of the formation.
On the other hand, by applying the present invention to the motor that drives the excavator, the force output from the motor to the formation can be estimated in real time without providing a sensor. In addition, when a sensor is installed in such an excavator, since the operation conditions are severe, sensor failures frequently occur.
As a result, it is detected in real time that there has been a change in geology, so there is no need to stop the excavator unnecessarily, and the efficiency of construction work can be improved.

以上のように構成される状態推定装置１は、電源１０と、モータ２０ａと、状態推定用インダクタ３０と、制御部４０と、電圧計５０とを備える。
状態推定用インダクタ３０は、制御対象となるモータ２０ａに電力を供給する電源１０と当該モータ２０ａとを接続する回路に直列に接続される。
電圧計５０は、状態推定用インダクタ３０の両端電圧を検出する。
制御部４０は、電圧計５０によって検出された状態推定用インダクタ３０の両端電圧に基づいて、モータ２０ａの状態を推定する。
このような構成により、状態推定装置１には、電源１０、モータ２０ａ及び状態推定用インダクタ３０に共通する電流が流れ、制御部４０は、状態推定用インダクタ３０の両端電圧に基づいてモータ２０ａの状態を推定する。
したがって、センサを用いることなくモータ２０ａの状態をより適切に推定することが可能となる。 The state estimation device 1 configured as described above includes a power supply 10, a motor 20a, a state estimation inductor 30, a control unit 40, and a voltmeter 50.
The state estimation inductor 30 is connected in series to a circuit connecting the power supply 10 that supplies power to the motor 20a to be controlled and the motor 20a.
The voltmeter 50 detects the voltage across the inductor 30 for state estimation.
The controller 40 estimates the state of the motor 20 a based on the voltage across the state estimating inductor 30 detected by the voltmeter 50.
With such a configuration, a current common to the power source 10, the motor 20 a, and the state estimation inductor 30 flows through the state estimation device 1, and the control unit 40 controls the motor 20 a based on the voltage across the state estimation inductor 30. Estimate the state.
Therefore, the state of the motor 20a can be estimated more appropriately without using a sensor.

また、電源１０及び状態推定用インダクタ３０とモータ２０ａとは、遠隔的な位置に設置される。
これにより、劣悪な環境等に設置されたモータ２０ａにセンサを備えることなく、劣悪な環境等の外に設置された状態推定用インダクタ３０を用いて、モータ２０ａの状態を推定することができる。 The power supply 10, the state estimation inductor 30 and the motor 20a are installed at remote positions.
Thereby, the state of the motor 20a can be estimated using the state estimation inductor 30 installed outside the poor environment or the like without providing the motor 20a installed in the poor environment or the like.

また、制御部４０は、モータ２０ａへの印加電圧の指令値の変化と、状態推定用インダクタ３０の両端電圧とに基づいて、モータ２０ａの状態を推定する。
これにより、容易に取得可能な指令値あるいは測定値によって、モータ２０ａの状態を推定することが可能となる。 Further, the control unit 40 estimates the state of the motor 20a based on the change in the command value of the voltage applied to the motor 20a and the voltage across the state estimation inductor 30.
As a result, the state of the motor 20a can be estimated from the command value or measurement value that can be easily acquired.

また、制御部４０は、モータ２０ａにおける角加速度または加速度を推定する。
これにより、力覚を伝達するために必要な角加速度または加速度をより適切に推定することが可能となる。 Moreover, the control part 40 estimates the angular acceleration or acceleration in the motor 20a.
Thereby, it is possible to more appropriately estimate the angular acceleration or acceleration necessary for transmitting the force sense.

また、制御部４０は、モータ２０ａにおけるトルクまたは力を推定する。
これにより、ロボットのマニピュレータにおける力をより適切に制御することが可能となる。 Moreover, the control part 40 estimates the torque or force in the motor 20a.
Thereby, it is possible to more appropriately control the force in the manipulator of the robot.

また、状態推定装置１は、リセット用のセンサを備える。
リセット用のセンサは、制御部４０による推定誤差をリセットするためにモータ２０ａの状態を検出する。
制御部４０は、リセット用のセンサの検出結果に基づいて、モータ２０ａの状態を推定する際の累積誤差をリセットする。
これにより、状態推定装置１において、より高い推定精度を実現することができる。 Further, the state estimation device 1 includes a reset sensor.
The reset sensor detects the state of the motor 20a in order to reset the estimation error by the control unit 40.
The control unit 40 resets the accumulated error when estimating the state of the motor 20a based on the detection result of the resetting sensor.
Thereby, higher estimation accuracy can be realized in the state estimation device 1.

なお、上記実施形態は、本発明を適用した一例を示しており、本発明の技術的範囲を限定するものではない。即ち、本発明は、本発明の要旨を逸脱しない範囲で、省略や置換等種々の変更を行うことができ、上記実施形態以外の各種実施形態を取ることが可能である。本発明が取ることができる各種実施形態及びその変形は、特許請求の範囲に記載された発明とその均等の範囲に含まれる。   In addition, the said embodiment has shown an example to which this invention is applied, and does not limit the technical scope of this invention. That is, the present invention can be modified in various ways such as omission and replacement without departing from the gist of the present invention, and can take various embodiments other than the above-described embodiments. Various embodiments that the present invention can take and modifications thereof are included in the invention described in the scope of claims and the equivalents thereof.

１ 状態推定装置、１０ 電源、２０ 制御対象、２０ａ モータ、３０ 状態推定用インダクタ、４０ 制御部、５０ 電圧計   DESCRIPTION OF SYMBOLS 1 State estimation apparatus, 10 power supply, 20 Control object, 20a Motor, 30 State estimation inductor, 40 Control part, 50 Voltmeter

Claims (7)

制御対象となるモータに電力を供給する電源と当該モータとを接続する回路に直列に接続されたインダクタと、
前記インダクタの両端電圧を検出する電圧検出手段と、
前記電圧検出手段によって検出された前記インダクタの両端電圧に基づいて、前記モータの状態を推定する推定手段と、
を備えることを特徴とする状態推定装置。 A power source that supplies power to a motor to be controlled and an inductor connected in series to a circuit that connects the motor;
Voltage detecting means for detecting a voltage across the inductor;
Estimating means for estimating the state of the motor based on the voltage across the inductor detected by the voltage detecting means;
A state estimation device comprising: 前記電源及びインダクタと前記モータとは、遠隔的な位置に設置されることを特徴とする請求項１に記載の状態推定装置。   The state estimation apparatus according to claim 1, wherein the power source, the inductor, and the motor are installed at remote positions. 前記推定手段は、前記モータへの印加電圧の指令値の変化と、前記インダクタの両端電圧とに基づいて、前記モータの状態を推定することを特徴とする請求項１または２に記載の状態推定装置。   3. The state estimation according to claim 1, wherein the estimation unit estimates a state of the motor based on a change in a command value of a voltage applied to the motor and a voltage across the inductor. apparatus. 前記推定手段は、前記モータにおける角加速度または加速度を推定することを特徴とする請求項１から３のいずれか１項に記載の状態推定装置。   The state estimation apparatus according to claim 1, wherein the estimation unit estimates angular acceleration or acceleration in the motor. 前記推定手段は、前記モータにおけるトルクまたは力を推定することを特徴とする請求項１から４のいずれか１項に記載の状態推定装置。   The state estimation apparatus according to claim 1, wherein the estimation unit estimates a torque or a force in the motor. 前記推定手段による推定誤差をリセットするために前記モータの状態を検出する検出手段をさらに備え、
前記推定手段は、前記検出手段の検出結果に基づいて、前記モータの状態を推定する際の累積誤差をリセットすることを特徴とする請求項１から５のいずれか１項に記載の状態推定装置。 Detecting means for detecting a state of the motor to reset an estimation error by the estimating means;
6. The state estimation device according to claim 1, wherein the estimation unit resets an accumulated error when estimating the state of the motor based on a detection result of the detection unit. . 制御対象となるモータの状態を推定する状態推定方法であって、
前記モータに電力を供給する電源と当該モータとを接続する回路に直列に接続されたインダクタの両端電圧を検出し、
前記検出された前記インダクタの両端電圧に基づいて、前記モータの状態を推定することを特徴とする状態推定方法。 A state estimation method for estimating a state of a motor to be controlled,
Detecting a voltage across an inductor connected in series to a circuit connecting the motor and a power source that supplies power to the motor,
A state estimation method, wherein the state of the motor is estimated based on the detected voltage across the inductor.
JP2015245347A 2015-12-16 2015-12-16 State estimation device and state estimation method Active JP6742719B2 (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
JP2015245347A JP6742719B2 (en) 2015-12-16 2015-12-16 State estimation device and state estimation method
PCT/JP2016/086259 WO2017104490A1 (en) 2015-12-16 2016-12-06 State estimation device and state estimation method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2015245347A JP6742719B2 (en) 2015-12-16 2015-12-16 State estimation device and state estimation method

Publications (2)

Publication Number Publication Date
JP2017112730A true JP2017112730A (en) 2017-06-22
JP6742719B2 JP6742719B2 (en) 2020-08-19

Family

ID=59056447

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2015245347A Active JP6742719B2 (en) 2015-12-16 2015-12-16 State estimation device and state estimation method

Country Status (2)

Country Link
JP (1) JP6742719B2 (en)
WO (1) WO2017104490A1 (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08275517A (en) * 1993-04-07 1996-10-18 Shiyunrou Moriwaki Forward-type switching power supply
JP2004312834A (en) * 2003-04-04 2004-11-04 Nsk Ltd Motor drive controller and motorized power steering device
JP2005193751A (en) * 2004-01-06 2005-07-21 Nsk Ltd Control device of electric power steering device
JP2011053175A (en) * 2009-09-04 2011-03-17 Toyota Motor Corp Disconnection detector
JP2013063476A (en) * 2011-09-15 2013-04-11 Daihen Corp Robot controller of industrial robot
JP2015100858A (en) * 2013-11-21 2015-06-04 株式会社マキタ Electric tool

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH08275517A (en) * 1993-04-07 1996-10-18 Shiyunrou Moriwaki Forward-type switching power supply
JP2004312834A (en) * 2003-04-04 2004-11-04 Nsk Ltd Motor drive controller and motorized power steering device
JP2005193751A (en) * 2004-01-06 2005-07-21 Nsk Ltd Control device of electric power steering device
JP2011053175A (en) * 2009-09-04 2011-03-17 Toyota Motor Corp Disconnection detector
JP2013063476A (en) * 2011-09-15 2013-04-11 Daihen Corp Robot controller of industrial robot
JP2015100858A (en) * 2013-11-21 2015-06-04 株式会社マキタ Electric tool

Also Published As

Publication number Publication date
WO2017104490A1 (en) 2017-06-22
JP6742719B2 (en) 2020-08-19

Similar Documents

Publication Publication Date Title
US11833696B2 (en) Vision-based sensor system and control method for robot arms
Yao et al. Adaptive robust control of DC motors with extended state observer
KR101055848B1 (en) Driving device and method of brushless DC motor without position sensor
US9195227B2 (en) Motor control device for compensating backlash
CN110081046B (en) Multi-hydraulic servo actuator tracking synchronous control method based on backstepping control
CN104052348A (en) Control system for synchronous motor with abnormality detection and diagnosis function
US11353345B2 (en) Magnetic encoder calibration
JP6502063B2 (en) Electrohydrostatic actuator and parameter estimation method for electrohydrostatic actuator
JP6564272B2 (en) HIL simulation system and HIL simulation method
JP5872630B2 (en) Remote position detector using a hydraulic motor
US20220168895A1 (en) Collision detection
CN105222695A (en) For regulating the method and system of the aligning of the stroke sensor on control valve
Jun et al. Extended-state-observer-based nonlinear servo control of an electro-hydrostatic actuator
JP2008048579A (en) Drive controller, and control method thereof
WO2017104490A1 (en) State estimation device and state estimation method
Minav et al. Relative position control in an electro-hydraulic forklift
Sakaino et al. Oil leakage and friction compensation for electro-hydrostatic actuator using drive-side and load-side encoders
KR101053205B1 (en) Motor control unit with backlash compensation
EP2632653B1 (en) Method and apparatus for monitoring and limiting the velocity of an industrial robot
Mi et al. Fault-tolerant control of a 2-DOF robot manipulator using multi-sensor switching strategy
KR20130111664A (en) Method and system for eliminating disturbance of robot
Cho et al. Adaptation-and-collision detection scheme for safe physical human-robot interaction
WO2023100473A1 (en) Actuator device, method for controlling actuator device, and moving body
Wang et al. A novel velocity estimation method for robotic joints based on inverse hyperbolic sine tracing differential algorithm
Aghili Fault-tolerant control of robot servomotors

Legal Events

Date Code Title Description
A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20160118

A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20181214

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20190917

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20191118

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20200303

RD02 Notification of acceptance of power of attorney

Free format text: JAPANESE INTERMEDIATE CODE: A7422

Effective date: 20200408

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20200505

Free format text: JAPANESE INTERMEDIATE CODE: A821

Effective date: 20200409

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: 20200630

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20200729

R150 Certificate of patent or registration of utility model

Ref document number: 6742719

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250