[go: up one dir, main page]

WO2018167915A1 - モータ制御システム、マニピュレータシステムおよびモータ制御方法 - Google Patents

モータ制御システム、マニピュレータシステムおよびモータ制御方法 Download PDF

Info

Publication number
WO2018167915A1
WO2018167915A1 PCT/JP2017/010669 JP2017010669W WO2018167915A1 WO 2018167915 A1 WO2018167915 A1 WO 2018167915A1 JP 2017010669 W JP2017010669 W JP 2017010669W WO 2018167915 A1 WO2018167915 A1 WO 2018167915A1
Authority
WO
WIPO (PCT)
Prior art keywords
motor
current
current value
angle position
rotation angle
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.)
Ceased
Application number
PCT/JP2017/010669
Other languages
English (en)
French (fr)
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.)
Olympus Corp
Original Assignee
Olympus Corp
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 Olympus Corp filed Critical Olympus Corp
Priority to PCT/JP2017/010669 priority Critical patent/WO2018167915A1/ja
Publication of WO2018167915A1 publication Critical patent/WO2018167915A1/ja
Priority to US16/216,267 priority patent/US20190115856A1/en
Anticipated expiration legal-status Critical
Ceased legal-status Critical Current

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
    • H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/12—Monitoring commutation; Providing indication of commutation failure
    • 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
    • H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/28—Arrangements for controlling current
    • 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
    • H02P29/00—Arrangements for regulating or controlling electric motors, appropriate for both AC and DC motors
    • H02P29/02—Providing protection against overload without automatic interruption of supply
    • H02P29/024—Detecting a fault condition, e.g. short circuit, locked rotor, open circuit or loss of load
    • 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
    • H02P6/00—Arrangements for controlling synchronous motors or other dynamo-electric motors using electronic commutation dependent on the rotor position; Electronic commutators therefor
    • H02P6/14—Electronic commutators
    • H02P6/16—Circuit arrangements for detecting position

Definitions

  • the present invention relates to a motor control system, a manipulator system, and a motor control method.
  • Patent Document 1 has a disadvantage that the cost is high because another sensor is added only for the purpose of detecting the failure of the encoder.
  • a space for installing the sensor is limited like a medical manipulator, there is a disadvantage that the apparatus becomes large if a sensor dedicated to failure detection is installed.
  • the present invention has been made in view of the above-described circumstances, and provides a motor control system, a manipulator system, and a motor control method capable of detecting a malfunction of an encoder without installing a dedicated sensor. It is aimed.
  • One embodiment of the present invention includes a motor, a position detection unit that detects a rotation angle position of the motor, and a current that controls a current value supplied to the motor based on the rotation angle position detected by the position detection unit.
  • the motor control system includes a defect determination unit that determines that the position detection unit has a defect.
  • the rotation angle position is detected by the position detection unit and supplied to the motor by the current control unit based on the detected rotation angle position.
  • the current value to be controlled is controlled, and the motor is rotated. At this time, the current value used for control is detected by the current detector.
  • the defect determination unit can determine that there is a defect in the position detection unit. That is, according to this aspect, since the current detection unit used for controlling the motor is used, it is possible to determine the malfunction of the position detection unit without installing a dedicated sensor.
  • the current detection unit may be determined to be defective.
  • the failure determination unit can determine that the current detection unit is defective. That is, according to this aspect, the malfunction of the current detection unit can be determined using the detection result of the position detection unit.
  • the DC motor with a brush may be sufficient as the said motor.
  • the current value varies due to the resistance value variation caused by the contact state between the brush and the commutator. Therefore, it is possible to easily detect that the motor is rotating due to a change in the current value.
  • the said malfunction determination part may be provided with the alerting
  • a motor an encoder that detects a rotational angle position of the motor, a sensor that detects a current value supplied to the motor, and a processor that performs an operation for controlling the motor.
  • a memory for storing the detected rotation angle position and the current value, and the processor calculates the current value to be supplied to the motor based on the detected rotation angle position, and stores the stored current value. The presence / absence of a change in current value is determined, the presence / absence of a change in the stored rotation angle position is determined, and it is determined that the current value is changing and the rotation angle position is not changed.
  • the motor control system determines that the encoder is defective.
  • the rotation angle position is detected by the encoder
  • the current value supplied to the motor is controlled by the processor based on the detected rotation angle position, and the motor is rotated. .
  • the current value used for control is detected by the sensor.
  • the processor determines whether or not the rotational angle position has changed. If the processor determines that the current value has changed and the rotation angle position has not changed, the rotation angle position is not detected even though the motor is operating. Therefore, it can be determined that the encoder is defective.
  • the processor may determine that the sensor is defective when it is determined that the rotational angle position has changed and the current value has not changed. Good. Moreover, in the said aspect, the DC motor with a brush may be sufficient as the said motor. Moreover, in the said aspect, when it determines with the said processor having the said malfunction, you may alert
  • Another aspect of the present invention is a manipulator system including any one of the motor control systems described above, an electric manipulator driven by the motor, and an operation unit that inputs an operation input for operating the manipulator.
  • a position detecting step for detecting a rotational angle position of a motor a position detecting step for detecting a rotational angle position of a motor, a current detecting step for detecting a current value supplied to the motor, and the presence / absence of a change in the detected current value are determined.
  • a failure determination step for determining that the position detection step has a failure when it is performed.
  • the rotational angle position and current value of the motor are detected by the position detection step and the current detection step. Then, whether or not the detected current value has changed is determined by the current fluctuation determination step, and whether or not the detected rotation angle position has changed is determined by the position fluctuation determination step.
  • the rotation angle position is detected even though the motor is operating. Therefore, it can be determined that there is a problem in the defect determination step.
  • the said malfunction determination step determines with the said rotation angle position having changed, and it determines with the said electric current value not changing, there exists a malfunction in the said current detection step. You may judge. By doing in this way, when it is determined that the current value has not changed in the current fluctuation determination step and the rotation angle position has been changed in the position fluctuation determination step, the motor is not operating. However, since the rotation angle position is detected, it can be determined that there is a defect by the defect determination step.
  • the manipulator system 1 includes a medical manipulator 2 that is inserted into the body and treats an affected area, an operation unit 3 that is operated by an operator, and the operation unit 3. And a control unit 4 that controls the manipulator 2 based on the input operation input.
  • the manipulator 2 is an electric type driven by a motor 5, and is operated to a desired position by rotating the motor 5 based on a voltage command Vref from the control unit 4.
  • the manipulator 2 includes an encoder (position detection unit) 6 that detects a rotation angle position n of the motor 5.
  • the motor 5 is a DC motor with a brush.
  • the operation unit 3 is configured to input a target rotation angle position ⁇ ref of the motor 5 of the manipulator 2 in accordance with an operation input such as a moving amount of a handle (not shown) operated by an operator.
  • the control unit 4 is a position / speed control unit that generates a target current command Iref based on the difference between the target rotation angle position ⁇ ref input in the operation unit 3 and the rotation angle position n of the motor 5 detected by the encoder 6. 7, a current control unit 8 that outputs a voltage control signal (PWM control signal) PWM corresponding to the generated target current command Iref, and a voltage command Vref that is input to the motor 5 according to the output voltage control signal PWM.
  • a voltage command generation unit 9 to be generated and a current detection unit 10 which is a sensor for detecting a current value I flowing through the motor 5 from the generated voltage command Vref are provided.
  • control unit 4 detects a malfunction of the encoder 6 and the current detection unit 10 based on the rotation angle position n detected by the encoder 6 and the current value I detected by the current detection unit 10. It has.
  • the failure detection unit 11 stores the current value I detected by the current detection unit 10 over a predetermined time and the rotation angle position n detected by the encoder 6 for a predetermined time. And a position storage unit 13 for storing the data. Further, the failure detection unit 11 includes a current fluctuation determination unit 14 that determines a change in the current value I based on the current value I stored for a predetermined time stored in the current storage unit 12 and a predetermined time stored for the position storage unit 13. A position variation determination unit 15 that determines a change in the rotation angle position n based on the rotation angle position n is provided.
  • the predetermined time is, for example, a time required for the shaft of the motor 5 to rotate at 45 ° at the minimum speed when the electrode of the commutator is divided into eight in the circumferential direction.
  • the failure detection unit 11 includes a failure determination unit 16 that determines a failure based on the determination results by the current variation determination unit 14 and the position variation determination unit 15.
  • the defect determination unit 16 has a problem with the encoder 6 when the position variation determination unit 15 determines that the rotation angle position n has not changed and the current variation determination unit 14 determines that the current value I varies. It comes to judge that there is.
  • the defect determination unit 16 detects the current when the position variation determination unit 15 determines that the rotation angle position n has changed and the current variation determination unit 14 determines that the current value I has not changed. It is determined that the unit 10 has a problem.
  • control part 4 is provided with the alerting
  • reporting part 17 which alert
  • any method such as monitor display, alarm sound or vibration can be adopted.
  • a motor control system 20 is configured by the motor 5, the encoder 6, and the control unit 4.
  • the manipulator 2 is operated by inserting the manipulator 2 into the patient's body and operating the operation section 3, and the affected area is treated by the manipulator 2. To do.
  • the target rotation angle position ⁇ ref corresponding to the operation input is input, and the input target rotation angle position ⁇ ref and the rotation angle position n of the motor 5 detected by the encoder 6. Based on the difference between them, the position / speed control unit 7 generates a target current command Iref.
  • the generated target current command Iref is input to the current control unit 8, and a voltage control signal PWM corresponding to the target current command Iref is output.
  • a voltage command Vref corresponding to the output voltage control signal PWM is generated by the voltage command generator 9 and supplied to the motor 5.
  • the voltage command Vref generated by the voltage command generation unit 9 is detected by the current detection unit 10 and is used by the current control unit 8 to calculate a difference from the target current command Iref.
  • the voltage control signal PWM is controlled by the unit 8.
  • step S1 detection of the current value I by the current detection unit 10
  • position detection step S2 detection of the rotational angle position n by the encoder 6
  • the position variation determination unit 15 detects the rotation angle position n of the motor 5 detected by the encoder 6 and stored in the position storage unit 13. It is determined whether or not the rotation angle position n has changed (position variation determination step S5).
  • Is used to determine whether or not the current value I of the motor 5 has changed current fluctuation determination steps S6 and S7).
  • FIG. 4 when the rotation angle position n of the motor 5 does not change and the current value I also does not change, and as shown in FIG. 5, the change in the rotation angle position n of the motor 5 changes. If there is a change in the current value I, if there is no change in the rotation angle position n of the motor 5, and if there is no change in the current value I, then a failure determination is made.
  • step S8 it is determined that there is no defect (step S8), and the processes from step S1 are repeated. Similarly, in the case of FIGS. 6 and 7, it is determined that there is no defect. If it is determined that a predetermined condition (for example, operation stop of the manipulator 2 or the like) is satisfied even if there is no defect (step S8), the process is terminated.
  • a predetermined condition for example, operation stop of the manipulator 2 or the like
  • the failure determination unit 16 causes the current detection unit 10 to malfunction. It is determined that there is, and this is notified by the notification unit 17 (defect determination step S9). When notified by the notification unit 17, the process is terminated. Further, as shown in FIG. 9, when there is no change in the rotation angle position n of the motor 5 and there is a change in the current value I, there is a problem in the encoder 6 in the defect determination unit 16. And is notified by the notification unit 17 (defect determination step S10). When notified by the notification unit 17, the process is terminated.
  • the malfunction of the encoder 6 is detected using the current value I detected for controlling the motor 5, so that the failure detection of the encoder 6 is detected.
  • the brushed DC motor is illustrated as the motor 5. Accordingly, since the two resistance values are obtained depending on the relative positional relationship between the brush and the commutator, it is easy to detect that the motor 5 is rotating due to the fluctuation of the current value I caused by the fluctuation of the resistance value. Can do. Instead of this, another type of motor in which the current value I fluctuates by rotation may be employed.
  • control unit 4 includes a current detection unit 10, a memory 22 that stores a current value I and a rotation angle position n detected by the current detection unit 10 and the encoder 6, and a CPU 21.
  • the CPU 21 generates a target current command Iref based on the difference between the target rotation angle position ⁇ ref input in the operation unit 3 and the rotation angle position n of the motor 5 detected by the encoder 6, and the generated target current command A voltage command Vref to be input to the motor 5 is generated according to Iref.
  • the CPU 21 determines a change in the current value I based on the current value I stored in the memory 22, determines a change in the rotational angle position n based on the rotational angle position n stored in the memory 22, and determines these determinations. Based on the above, it is determined whether or not the current detection unit 10 and the encoder 6 are defective. When it is determined that there is a problem, the CPU 21 notifies that fact.
  • reference numeral 23 denotes a display on which information on a failure notified by the CPU 21 is output.
  • the control unit 4 may include a plurality of CPUs 21 or a plurality of memories 22. Moreover, in this embodiment, although what was comprised by the single housing was illustrated as the control part 4, it is not restricted to this.
  • the operation unit 3 and the control unit 4 may communicate electrical signals by wire such as a cable, or may communicate wirelessly using a transmission unit and a reception unit.

Landscapes

  • Engineering & Computer Science (AREA)
  • Power Engineering (AREA)
  • Manipulator (AREA)

Abstract

専用のセンサを設置することなく、エンコーダの不具合を検出することを目的として、本発明に係るモータ制御システム（２０）は、モータ（５）と、モータ（５）の回転角度位置（ｎ）を検出する位置検出部（６）と、検出された回転角度位置（ｎ）に基づいてモータ（５）に供給する電流値（Ｉ）を制御する電流制御部（８）と、モータ（５）に供給する電流値（Ｉ）を検出する電流検出部（１０）と、検出された電流値（Ｉ）の変化の有無を判定する電流変動判定部と、検出された回転角度位置（ｎ）の変化の有無を判定する位置変動判定部と、電流値（Ｉ）が変化していると判定されかつ回転角度位置（ｎ）が変化していないと判定された場合に、位置検出部（６）に不具合があると判定する不具合判定部とを備える。

Description

モータ制御システム、マニピュレータシステムおよびモータ制御方法
　本発明は、モータ制御システム、マニピュレータシステムおよびモータ制御方法に関するものである。
　モータに取り付けられ、モータの回転角度位置を検出するエンコーダの故障を検出するために、他のエンコーダあるいはポテンシオメータのような他のセンサを追加することが行われている（例えば、特許文献１参照。）。
特許５８５５４２３号公報
　特許文献１の方法では、エンコーダの故障検出のみを目的とした他のセンサを追加するので、コストが高くつくという不都合がある。また、医療用のマニピュレータのようにセンサを設置するスペースが限られている場合に、故障検出専用のセンサを設置すると装置が大型化する不都合がある。
　本発明は、上述した事情に鑑みてなされたものであって、専用のセンサを設置することなく、エンコーダの不具合を検出することができるモータ制御システム、マニピュレータシステムおよびモータ制御方法を提供することを目的としている。
　本発明の一態様は、モータと、該モータの回転角度位置を検出する位置検出部と、該位置検出部により検出された前記回転角度位置に基づいて前記モータに供給する電流値を制御する電流制御部と、該電流制御部により前記モータに供給する前記電流値を検出する電流検出部と、該電流検出部により検出された前記電流値の変化の有無を判定する電流変動判定部と、前記位置検出部により検出された前記回転角度位置の変化の有無を判定する位置変動判定部と、前記電流変動判定部により前記電流値が変化していると判定されかつ前記位置変動判定部により前記回転角度位置が変化していないと判定された場合に、前記位置検出部に不具合があると判定する不具合判定部とを備えるモータ制御システムである。
　本態様によれば、目標角度位置指令信号に基づいてモータが回転させられると、位置検出部により回転角度位置が検出されるとともに、検出された回転角度位置に基づいて電流制御部によりモータに供給する電流値が制御され、モータが回転させられる。このとき、制御に用いる電流値は電流検出部により検出される。
　そして、電流検出部により検出された電流値が変化しているか否かが電流変動判定部により判定され、回転角度位置が変化しているか否かが位置変動判定部により判定される。電流変動判定部により電流値が変化していると判定されかつ位置変動判定部により回転角度位置が変化していないと判定された場合には、モータが動作しているのに回転角度位置の検出が行われていないことになるので、不具合判定部により位置検出部に不具合があると判定することができる。
　すなわち、本態様によれば、モータの制御に用いる電流検出部を利用するので、専用のセンサを設置することなく位置検出部の不具合を判定することができる。
　上記態様においては、前記不具合判定部は、前記位置変動判定部により前記回転角度位置が変化していると判定されかつ前記電流変動判定部により前記電流値が変化していないと判定された場合に、前記電流検出部に不具合があると判定してもよい。
　このようにすることで、位置変動判定部によって回転角度位置が変化していると判定されかつ電流判定部により電流値が変化しないと判定された場合には、モータが回転しているのに電流値が変化しないことになるので、不具合判定部により電流検出部に不具合があると判定することができる。すなわち、本態様によれば、位置検出部の検出結果を利用して電流検出部の不具合を判定することができる。
　また、上記態様においては、前記モータがブラシ付直流モータであってもよい。
　このようにすることで、モータが回転している場合には、ブラシとコミュテータとの接触状態による抵抗値変動によって電流値が変動する。従って、電流値の変化によってモータが回転していることを容易に検出することができる。
　また、上記態様においては、前記不具合判定部は、前記不具合があると判定した場合にその旨を報知する報知部を備えていてもよい。
　このようにすることで、報知部による報知によって不具合の発生を作業者が容易に認識することができる。
　また、本発明の他の態様は、モータと、該モータの回転角度位置を検出するエンコーダと、前記モータに供給する電流値を検出するセンサと、前記モータを制御するための演算を行うプロセッサと、検出された前記回転角度位置および前記電流値を記憶するメモリとを備え、前記プロセッサは、検出された前記回転角度位置に基づいて前記モータに供給する前記電流値を算出し、記憶された前記電流値の変化の有無を判定し、記憶された前記回転角度位置の変化の有無を判定し、前記電流値が変化していると判定されかつ前記回転角度位置が変化していないと判定された場合に、前記エンコーダに不具合があると判定するモータ制御システムである。
　本態様によれば、モータが回転させられると、エンコーダにより回転角度位置が検出されるとともに、検出された回転角度位置に基づいてプロセッサによりモータに供給する電流値が制御され、モータが回転させられる。このとき、制御に用いる電流値はセンサにより検出される。
　そして、メモリに記憶された電流値が変化しているか否かが判定され、回転角度位置が変化しているか否かがプロセッサにより判定される。プロセッサによって、電流値が変化していると判定されかつ回転角度位置が変化していないと判定された場合には、モータが動作しているのに回転角度位置の検出が行われていないことになるので、エンコーダに不具合があると判定することができる。
　また、上記態様においては、前記プロセッサは、前記回転角度位置が変化していると判定されかつ前記電流値が変化していないと判定された場合に、前記センサに不具合があると判定してもよい。
　また、上記態様においては、前記モータがブラシ付直流モータであってもよい。
　また、上記態様においては、前記プロセッサは、前記不具合があると判定した場合にその旨を報知してもよい。
　また、本発明の他の態様は、上記いずれかのモータ制御システムと、前記モータにより駆動される電動のマニピュレータと、該マニピュレータを動作させる操作入力を入力する操作部とを備えるマニピュレータシステムである。
　このようにすることで、マニピュレータに位置検出部の不具合を検出するための専用のセンサを設ける必要がなく、マニピュレータを大型化させずに位置検出部の不具合を検出することができる。
　また、本発明の他の態様は、モータの回転角度位置を検出する位置検出ステップと、前記モータに供給する電流値を検出する電流検出ステップと、検出された前記電流値の変化の有無を判定する電流変動判定ステップと、検出された前記回転角度位置の変化の有無を判定する位置変動判定ステップと、前記電流値が変化していると判定されかつ前記回転角度位置が変化していないと判定された場合に、前記位置検出ステップに不具合があると判定する不具合判定ステップとを含むモータ制御方法である。
　本実施形態によれば、位置検出ステップおよび電流検出ステップによってモータの回転角度位置および電流値が検出される。そして、検出された電流値が変化しているか否かが電流変動判定ステップにより判定され、検出された回転角度位置が変化しているか否かが位置変動判定ステップにより判定される。電流変動判定ステップにより電流値が変化していると判定されかつ位置変動判定ステップにより回転角度位置が変化していないと判定された場合には、モータが動作しているのに回転角度位置の検出が行われていないことになるので、不具合判定ステップにより不具合があると判定することができる。
　また、上記態様においては、前記不具合判定ステップが、前記回転角度位置が変化していると判定されかつ前記電流値が変化していないと判定された場合に、前記電流検出ステップに不具合があると判定してもよい。
　このようにすることで、電流変動判定ステップにより電流値が変化していないと判定されかつ位置変動判定ステップにより回転角度位置が変化していると判定された場合には、モータが動作していないのに回転角度位置の検出が行われていることになるので、不具合判定ステップにより不具合があると判定することができる。
　本発明によれば、専用のセンサを設置することなく、エンコーダの不具合を検出することができるという効果を奏する。
本発明の一実施形態に係るマニピュレータシステムを示すブロック図である。 図１のマニピュレータシステムのモータ制御システムに備えられた故障検出部を示すブロック図である。 図１のマニピュレータシステムの動作を説明するフローチャートである。 エンコーダおよび電流検出部に不具合が検出されない第１の例を示すグラフである。 エンコーダおよび電流検出部に不具合が検出されない第２の例を示すグラフである。 エンコーダおよび電流検出部に不具合が検出されない第３の例を示すグラフである。 エンコーダおよび電流検出部に不具合が検出されない第４の例を示すグラフである。 電流検出部に不具合が検出される一例を示すグラフである。 エンコーダに不具合が検出される一例を示すグラフである。 図１のマニピュレータシステムの変形例を示すブロック図である。を説明するフローチャートである。
　以下、本発明の一実施形態に係るモータ制御システム２０およびマニピュレータシステム１について、図面を参照して以下に説明する。
　本実施形態に係るマニピュレータシステム１は、図１に示されるように、体内に挿入されて患部を処置する医療用のマニピュレータ２と、操作者により操作される操作部３と、該操作部３において入力された操作入力に基づいてマニピュレータ２を制御する制御部４とを備えている。
　マニピュレータ２は、モータ５により駆動される電動式のものであり、制御部４からの電圧指令Ｖｒｅｆに基づいてモータ５が回転させられることによって、所望の位置まで動作させられるようになっている。また、マニピュレータ２はモータ５の回転角度位置ｎを検出するエンコーダ（位置検出部）６を備えている。
　本実施形態においては、モータ５はブラシ付直流モータである。
　操作部３は、操作者により操作されるハンドル（図示略）の移動量等の操作入力に応じてマニピュレータ２のモータ５の目標回転角度位置θｒｅｆを入力するようになっている。
　制御部４は、操作部３において入力された目標回転角度位置θｒｅｆとエンコーダ６により検出されたモータ５の回転角度位置ｎとの差分に基づいて、目標電流指令Ｉｒｅｆを生成する位置・速度制御部７と、生成された目標電流指令Ｉｒｅｆに応じた電圧制御信号（ＰＷＭ制御信号）ＰＷＭを出力する電流制御部８と、出力された電圧制御信号ＰＷＭに応じてモータ５に入力する電圧指令Ｖｒｅｆを生成する電圧指令生成部９と、生成された電圧指令Ｖｒｅｆからモータ５に流れる電流値Ｉを検出するセンサである電流検出部１０とを備えている。
　また、制御部４は、エンコーダ６により検出された回転角度位置ｎと、電流検出部１０により検出された電流値Ｉとに基づいてエンコーダ６および電流検出部１０の不具合を検出する故障検出部１１を備えている。
　故障検出部１１は、図２に示されるように、電流検出部１０により検出された電流値Ｉを所定時間にわたって記憶する電流記憶部１２と、エンコーダ６により検出された回転角度位置ｎを所定時間にわたって記憶する位置記憶部１３とを備えている。
　また、故障検出部１１は、電流記憶部１２に記憶された所定時間にわたる電流値Ｉにより、電流値Ｉの変化を判定する電流変動判定部１４と、位置記憶部１３に記憶された所定時間にわたる回転角度位置ｎにより、回転角度位置ｎの変化を判定する位置変動判定部１５とを備えている。
　ここで、所定時間としては、例えば、コミュテータの電極が周方向に８分割されている場合にはモータ５のシャフトが最低速度で４５°回転するのに必要な時間である。これにより、モータ５が回転している場合には、この時系列データにおいて、ブラシとコミュテータとの位置関係による抵抗値変動によって、電流値Ｉが少なくとも１回変動する。
　さらに、故障検出部１１は、電流変動判定部１４および位置変動判定部１５による判定結果に基づいて、不具合を判定する不具合判定部１６を備えている。
　不具合判定部１６は、位置変動判定部１５により回転角度位置ｎが変化していないと判定されかつ電流変動判定部１４により電流値Ｉが変動していると判定された場合に、エンコーダ６に不具合があると判定するようになっている。
　また、不具合判定部１６は、位置変動判定部１５により回転角度位置ｎが変化していると判定されかつ電流変動判定部１４により電流値Ｉが変動していないと判定された場合に、電流検出部１０に不具合があると判定するようになっている。
　また、制御部４は、不具合判定部１６によりエンコーダ６または電流検出部１０に不具合があると判定された場合にその旨を報知する報知部１７を備えている。報知の方法は、モニタ表示、アラーム音あるいは振動等の任意の方法を採用することができる。
　モータ５、エンコーダ６および制御部４によりモータ制御システム２０が構成されている。
　このように構成された本実施形態に係るモータ制御システム２０およびマニピュレータシステム１の作用について以下に説明する。
　本実施形態に係るマニピュレータシステム１を用いて患者の患部を処置するには、マニピュレータ２を患者の体内に挿入し操作部３を操作することによりマニピュレータ２を動作させて、マニピュレータ２によって患部を処置する。
　この場合において、操作者が操作部３を操作すると、操作入力に応じた目標回転角度位置θｒｅｆが入力され、入力された目標回転角度位置θｒｅｆとエンコーダ６により検出されたモータ５の回転角度位置ｎとの差分に基づいて、位置・速度制御部７により目標電流指令Ｉｒｅｆが生成される。生成された目標電流指令Ｉｒｅｆは電流制御部８に入力され、目標電流指令Ｉｒｅｆに応じた電圧制御信号ＰＷＭが出力される。そして、出力された電圧制御信号ＰＷＭに応じた電圧指令Ｖｒｅｆが電圧指令生成部９により生成され、モータ５に供給される。
　電圧指令生成部９により生成された電圧指令Ｖｒｅｆは電流検出部１０により検出され、電流制御部８において目標電流指令Ｉｒｅｆとの差分を算出するために用いられて、差分が小さくなるように電流制御部８によって電圧制御信号ＰＷＭが制御される。
　本実施形態に係るモータ制御方法について以下に説明する。モータ制御方法は、図３に示されるように、電流検出部１０による電流値Ｉの検出（電流検出ステップＳ１）およびエンコーダ６による回転角度位置ｎの検出（位置検出ステップＳ２）は、常時行われており、検出された電流値Ｉおよび回転角度位置ｎは故障検出部１１の電流記憶部１２および位置記憶部１３に送られて所定時間にわたる時系列データとして記憶される（ステップＳ３，Ｓ４）。所定時間が経過していない場合には、ステップＳ１からの工程が繰り返される。
　そして、所定時間が経過する毎に、位置変動判定部１５により、エンコーダ６によって検出され、位置記憶部１３に記憶されているモータ５の回転角度位置ｎの時系列データを用いて、モータ５の回転角度位置ｎに変化があったか否かが判定される（位置変動判定ステップＳ５）。
　次いで、モータの回転角度位置ｎにおける変化の有無に関わらず、電流変動判定部１４により、電流検出部１０によって検出され、電流記憶部１２に記憶されているモータ５の電流値Ｉの時系列データを用いて、モータ５の電流値Ｉに変化があったか否かが判定される（電流変動判定ステップＳ６，Ｓ７）。
　図４に示されるように、モータ５の回転角度位置ｎに変化がなく、電流値Ｉにも変化がない場合、および、図５に示されるように、モータ５の回転角度位置ｎにおける変化があった場合で、かつ、電流値Ｉにおける変化もあった場合、および、モータ５の回転角度位置ｎにおける変化がなかった場合で、かつ、電流値Ｉにおける変化もなかった場合には、不具合判定部１６において不具合は存在しないものと判定され（ステップＳ８）、ステップＳ１からの工程が繰り返される。図６および図７の場合も同様に、不具合は存在しないものと判定される。また、不具合が存在しなくとも、所定の条件（例えば、マニピュレータ２の動作停止等）を満たしたと判定された場合には（ステップＳ８）、処理を終了する。
　一方、図８に示されるように、モータ５の回転角度位置ｎにおける変化があった場合で、かつ、電流値Ｉにおける変化がなかった場合には、不具合判定部１６において電流検出部１０に不具合があると判定され、報知部１７によりその旨が報知される（不具合判定ステップＳ９）。報知部１７により報知された場合、処理を終了する。
　また、図９に示されるように、モータ５の回転角度位置ｎにおける変化がなかった場合で、かつ、電流値Ｉにおける変化があった場合には、不具合判定部１６においてエンコーダ６に不具合があると判定され、報知部１７によりその旨が報知される（不具合判定ステップＳ１０）。報知部１７により報知された場合、処理を終了する。
　このように、本実施形態に係るモータ制御システム２０およびマニピュレータシステム１によれば、モータ５を制御するために検出する電流値Ｉを用いてエンコーダ６の不具合を検出するので、エンコーダ６の故障検出のための専用のセンサを設置する必要がない。したがって、コストを低減し、マニピュレータ２の大型化を防止することができるという利点がある。
　また、本実施形態に係るモータ制御システム２０およびマニピュレータシステム１によれば、エンコーダ６の検出結果を利用して電流検出部１０の不具合を判定することもできる。
　なお、本実施形態においては、モータ５としてブラシ付直流モータを例示した。これにより、ブラシとコミュテータとの相対位置関係によって２つの抵抗値を有することとなるため、抵抗値の変動に起因する電流値Ｉの変動によりモータ５が回転していることを容易に検出することができる。
　これに代えて、回転により電流値Ｉが変動する他の形式のモータを採用してもよい。
　また、本実施形態においては、制御部４として、位置・速度制御部７と、電流制御部８と、電圧指令生成部９と、故障検出部１１と、報知部１７とを用いるものを例示したが、これに代えて、図１０に示されるように、ＣＰＵ（プロセッサ）２１が目標電流指令Ｉｒｅｆの生成、不具合の判定および不具合の報知を実行するものを用いてもよい。
　この場合、制御部４は、電流検出部１０と、該電流検出部１０およびエンコーダ６によって検出された電流値Ｉおよび回転角度位置ｎを記憶するメモリ２２と、ＣＰＵ２１とにより構成されている。
　ＣＰＵ２１は、操作部３において入力された目標回転角度位置θｒｅｆとエンコーダ６により検出されたモータ５の回転角度位置ｎとの差分に基づいて、目標電流指令Ｉｒｅｆを生成し、生成された目標電流指令Ｉｒｅｆに応じてモータ５に入力する電圧指令Ｖｒｅｆを生成するようになっている。
　また、ＣＰＵ２１は、メモリ２２に記憶された電流値Ｉにより、電流値Ｉの変化を判定し、メモリ２２に記憶された回転角度位置ｎにより、回転角度位置ｎの変化を判定し、これらの判定に基づいて、電流検出部１０およびエンコーダ６に不具合があるか否かを判定するようになっている。不具合があると判定された場合には、ＣＰＵ２１がその旨を報知する。図１０中、符号２３は、ＣＰＵ２１が報知した不具合の情報が出力されるディスプレイである。
　また、制御部４は、ＣＰＵ２１を複数備えていてもよいし、メモリ２２を複数備えていてもよい。
　また、本実施形態においては、制御部４として、単一のハウジングによって構成されるものを例示したが、これに限られるものではない。
　また、本実施形態においては、操作部３と制御部４とがケーブル等の有線によって電気信号を通信してもよいし、送信部および受信部等を用いて無線によって通信してもよい。
　１　マニピュレータシステム
　２　マニピュレータ
　５　モータ
　６　エンコーダ（位置検出部）
　８　電流制御部
　１０　電流検出部（センサ）
　１４　電流変動判定部
　１５　位置変動判定部
　１６　不具合判定部
　１７　報知部
　２０　モータ制御システム
　２１　ＣＰＵ（プロセッサ）
　２２　メモリ
　Ｉ　電流値
　ｎ　回転角度位置
　Ｓ１　電流検出ステップ
　Ｓ２　位置検出ステップ
　Ｓ５　位置変動判定ステップ
　Ｓ６，Ｓ７　電流変動判定ステップ
　Ｓ９，Ｓ１０　不具合判定ステップ

Claims (11)

  1. 　モータと、
    　該モータの回転角度位置を検出する位置検出部と、
    　該位置検出部により検出された前記回転角度位置に基づいて前記モータに供給する電流値を制御する電流制御部と、
    　該電流制御部により前記モータに供給する前記電流値を検出する電流検出部と、
    　該電流検出部により検出された前記電流値の変化の有無を判定する電流変動判定部と、
    　前記位置検出部により検出された前記回転角度位置の変化の有無を判定する位置変動判定部と、
    　前記電流変動判定部により前記電流値が変化していると判定されかつ前記位置変動判定部により前記回転角度位置が変化していないと判定された場合に、前記位置検出部に不具合があると判定する不具合判定部とを備えるモータ制御システム。
  2. 　前記不具合判定部は、前記位置変動判定部により前記回転角度位置が変化していると判定されかつ前記電流変動判定部により前記電流値が変化していないと判定された場合に、前記電流検出部に不具合があると判定する請求項１に記載のモータ制御システム。
  3. 　前記モータがブラシ付直流モータである請求項１に記載のモータ制御システム。
  4. 　前記不具合判定部は、前記不具合があると判定した場合にその旨を報知する報知部を備える請求項１に記載のモータ制御システム。
  5. 　モータと、
    　該モータの回転角度位置を検出するエンコーダと、
    　前記モータに供給する電流値を検出するセンサと、
    　前記モータを制御するための演算を行うプロセッサと、
    　検出された前記回転角度位置および前記電流値を記憶するメモリとを備え、
    　前記プロセッサは、
    　検出された前記回転角度位置に基づいて前記モータに供給する前記電流値を算出し、
    　記憶された前記電流値の変化の有無を判定し、
    　記憶された前記回転角度位置の変化の有無を判定し、
    　前記電流値が変化していると判定されかつ前記回転角度位置が変化していないと判定された場合に、前記エンコーダに不具合があると判定するモータ制御システム。
  6. 　前記プロセッサは、前記回転角度位置が変化していると判定されかつ前記電流値が変化していないと判定された場合に、前記センサに不具合があると判定する請求項５に記載のモータ制御システム。
  7. 　前記モータがブラシ付直流モータである請求項５に記載のモータ制御システム。
  8. 　前記プロセッサは、前記不具合があると判定した場合にその旨を報知する請求項５に記載のモータ制御システム。
  9. 　請求項１から請求項８のいずれかに記載のモータ制御システムと、
    　前記モータにより駆動される電動のマニピュレータと、
    　該マニピュレータを動作させる操作入力を入力する操作部とを備えるマニピュレータシステム。
  10. 　モータの回転角度位置を検出する位置検出ステップと、
    　前記モータに供給する電流値を検出する電流検出ステップと、
    　検出された前記電流値の変化の有無を判定する電流変動判定ステップと、
    　検出された前記回転角度位置の変化の有無を判定する位置変動判定ステップと、
    　前記電流値が変化していると判定されかつ前記回転角度位置が変化していないと判定された場合に、前記位置検出ステップに不具合があると判定する不具合判定ステップとを含むモータ制御方法。
  11. 　前記不具合判定ステップが、前記回転角度位置が変化していると判定されかつ前記電流値が変化していないと判定された場合に、前記電流検出ステップに不具合があると判定する請求項１０に記載のモータ制御方法。
     
     
PCT/JP2017/010669 2017-03-16 2017-03-16 モータ制御システム、マニピュレータシステムおよびモータ制御方法 Ceased WO2018167915A1 (ja)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/JP2017/010669 WO2018167915A1 (ja) 2017-03-16 2017-03-16 モータ制御システム、マニピュレータシステムおよびモータ制御方法
US16/216,267 US20190115856A1 (en) 2017-03-16 2018-12-11 Motor control system, manipulator system, and motor control method

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/JP2017/010669 WO2018167915A1 (ja) 2017-03-16 2017-03-16 モータ制御システム、マニピュレータシステムおよびモータ制御方法

Related Child Applications (1)

Application Number Title Priority Date Filing Date
US16/216,267 Continuation US20190115856A1 (en) 2017-03-16 2018-12-11 Motor control system, manipulator system, and motor control method

Publications (1)

Publication Number Publication Date
WO2018167915A1 true WO2018167915A1 (ja) 2018-09-20

Family

ID=63523179

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2017/010669 Ceased WO2018167915A1 (ja) 2017-03-16 2017-03-16 モータ制御システム、マニピュレータシステムおよびモータ制御方法

Country Status (2)

Country Link
US (1) US20190115856A1 (ja)
WO (1) WO2018167915A1 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113027681B (zh) * 2019-12-25 2022-06-28 新疆金风科技股份有限公司 风力发电机组运行控制方法和装置、计算机设备

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09140175A (ja) * 1995-11-16 1997-05-27 Matsushita Electric Ind Co Ltd 電動機制御装置
JP2006129636A (ja) * 2004-10-29 2006-05-18 Daihatsu Motor Co Ltd モータ回転検出の異常検出方法及び異常検出装置
JP2010022150A (ja) * 2008-07-11 2010-01-28 Toshiba Corp マイクロコンピュータ，モータ制御システム，レゾルバ信号のデジタル変換方法
JP5855423B2 (ja) * 2011-11-01 2016-02-09 オリンパス株式会社 手術支援装置

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH09140175A (ja) * 1995-11-16 1997-05-27 Matsushita Electric Ind Co Ltd 電動機制御装置
JP2006129636A (ja) * 2004-10-29 2006-05-18 Daihatsu Motor Co Ltd モータ回転検出の異常検出方法及び異常検出装置
JP2010022150A (ja) * 2008-07-11 2010-01-28 Toshiba Corp マイクロコンピュータ，モータ制御システム，レゾルバ信号のデジタル変換方法
JP5855423B2 (ja) * 2011-11-01 2016-02-09 オリンパス株式会社 手術支援装置

Also Published As

Publication number Publication date
US20190115856A1 (en) 2019-04-18

Similar Documents

Publication Publication Date Title
US8659254B2 (en) Servo system, servo motor driving device, safety unit and method for controlling servo system
CN102445920B (zh) 用于驱动单元用的碰撞识别的方法
JP5449634B1 (ja) サーボモータおよびエンコーダ
JP2018129995A5 (ja)
US10000269B2 (en) Column based electric assist marine power steering
ATE422453T1 (de) Elektrische servolenksteuervorrichtung
WO2018167915A1 (ja) モータ制御システム、マニピュレータシステムおよびモータ制御方法
JP2017200710A (ja) 関節駆動ロボットの異常診断方法及び異常診断装置
KR101726688B1 (ko) 비상조향 시스템 및 비상조향 시스템의 제어방법
JP2005054843A (ja) ブレーキ装置
JP2007301680A (ja) ロボットアーム診断装置
JP5037437B2 (ja) 内部情報出力機能を有するエンコーダ
JP5203585B2 (ja) 駆動制御装置及びその制御方法
JP2009140325A (ja) 情報処理装置、情報処理方法、およびプログラム
JP7056362B2 (ja) モータ制御装置及びプログラミング装置
KR101531340B1 (ko) 서보 모터 제어 시스템
CN116593884A (zh) 监视装置
JP2020035372A (ja) 情報処理装置及び情報処理方法
JP2008298562A (ja) 自己診断機能付き近接センサ
JP2005122530A (ja) 自走式機器およびそのプログラム
JP2013110923A (ja) アクチュエータ制御装置、アクチュエータシステム、アクチュエータ制御方法及び制御プログラム
JP2007265103A (ja) ロボット制御装置
JP2006221308A (ja) 異常検出方法および制御装置と、これらを用いた制御システム
CN113383492B (zh) 电动机驱动装置
KR101470761B1 (ko) 전방향 구동형 텔레프레전스 이동로봇의 주차 제어 장치 및 방법

Legal Events

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

Ref document number: 17900963

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 17900963

Country of ref document: EP

Kind code of ref document: A1

NENP Non-entry into the national phase

Ref country code: JP