JP5272139B2 - ビルトインテスト回路を内蔵したジンバル制御システム - Google Patents

ビルトインテスト回路を内蔵したジンバル制御システム Download PDF

Info

Publication number
JP5272139B2
JP5272139B2 JP2009059347A JP2009059347A JP5272139B2 JP 5272139 B2 JP5272139 B2 JP 5272139B2 JP 2009059347 A JP2009059347 A JP 2009059347A JP 2009059347 A JP2009059347 A JP 2009059347A JP 5272139 B2 JP5272139 B2 JP 5272139B2
Authority
JP
Japan
Prior art keywords
circuit
signal
gimbal
built
cpu
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
JP2009059347A
Other languages
English (en)
Other versions
JP2010211691A (ja
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.)
Tamagawa Seiki Co Ltd
Original Assignee
Tamagawa Seiki 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 Tamagawa Seiki Co Ltd filed Critical Tamagawa Seiki Co Ltd
Priority to JP2009059347A priority Critical patent/JP5272139B2/ja
Publication of JP2010211691A publication Critical patent/JP2010211691A/ja
Application granted granted Critical
Publication of JP5272139B2 publication Critical patent/JP5272139B2/ja
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Safety Devices In Control Systems (AREA)
  • Control Of Position Or Direction (AREA)
  • Control Of Motors That Do Not Use Commutators (AREA)

Description

本発明は、ビルトインテスト回路を内蔵したジンバル制御システムに関し、特に、ジンバルの駆動を制御するジンバル制御システムにレゾルバの動作が正常か否かの判定を行う回路をビルトインテスト回路として内蔵させ、三相ブラシレスDCモータへの三相切替信号を生成する場合、レゾルバリファレンス出力回路からの励磁信号の異常を検出して三相ブラシレスモータの暴走を防止するための新規な改良に関する。
従来、用いられていたこの種のジンバル制御システムとしては、社内製作のみで特許出願等を行っていないため、これを示すための特許文献等を示していないが、従来構成としては、図2に示される通りである。
図2において符号1で示されるものは、図示しないジンバルの制御を行うためのジンバル制御システム2のCPUであり、このCPU1からの駆動指令4はモータドライブ回路5に入力され、このモータドライブ回路5からの三相モータ駆動信号6は三相ブラシレスモータ7に入力され、三相ブラシレスモータ7の駆動が行われるように構成されている。
前記三相ブラシレスモータ7に設けられたレゾルバ8からの角度信号9はR/D変換回路10に入力され、このR/D変換回路10からのデジタル化された角度情報11は前記CPU1に入力され、このR/D変換回路10からのU・V・W切替信号12は前記モータドライブ回路5に入力されている。
さらに、レゾルバリファレンス出力回路13からの励磁信号14は、前記レゾルバ8及びR/D変換回路10に入力されている。
従って、前述の構成によるジンバル制御システム2は、図示しないジンバルに搭載され、ここでは1個の三相ブラシレスモータ7しか示されていないが、実際には、検出軸数に応じた三相ブラシレスモータ7が採用されている。
前記レゾルバ8により検出された角度信号9に基づいて角度情報11がCPU1に送られ、CPU1からの駆動指令4に基づいて三相モータ駆動信号6が三相ブラシレスモータ7に供給されて三相駆動され、ジンバルの第1軸又は第2軸等の駆動が行われ、ジンバルによる空間安定動作等を得ることができる。尚、前記レゾルバ8は、三相ブラシレスモータ7と一体状に設けられ前記ジンバル(図示せず)の回転角度を検出している。
従来のジンバル制御システムは、以上のように構成されていたため、次のような課題が存在していた。
すなわち、図2のジンバル制御システムにおいては、レゾルバの励磁信号を監視していないため、この励磁信号を発生するレゾルバリファレンス出力回路に異常(例えば、停止状態)が発生すると、三相のU,V,W切替信号が全く異なる角度の信号に変化してしまうため、モータ駆動制御系(図2の点線四角部分A)が暴走して三相ブラシレスモータを大きく回転させ、ジンバルの回転軸が大きい力で回転し、機械的なストッパに激しく衝突してジンバルを破損させるおそれがあった。
本発明によるビルトインテスト回路を内蔵したジンバル制御システムは、CPUからの駆動指令に基づきモータドライブ回路から出力される三相モータ駆動信号により駆動される三相ブラシレスモータと、前記三相ブラシレスモータにより駆動されるジンバルに設けられ前記ジンバルの回転角度を検出するレゾルバと、前記レゾルバからの角度信号をR/D変換して角度情報を前記CPUに供給するR/D変換回路と、前記レゾルバ及びR/D変換回路に正弦波信号からなる励磁信号を供給するためのレゾルバリファレンス出力回路と、よりなり、前記角度情報に基づいて前記三相ブラシレスモータに前記三相モータ駆動信号が供給されるようにしたジンバル制御システムにおいて、前記励磁信号が入力されフォトカプラからなる波形生成器と、前記波形生成器からの矩形波信号及びクロック回路からのクロック信号が入力されプログラマブル・ロジック・デバイスからなるサンプルホールド回路と、からなるビルトインテスト回路を有し、前記サンプルホールド回路では前記矩形波信号が入力され続けている限り、正常のステータス情報が出力され、前記励磁信号が停止した時は前記サンプルホールド回路からの前記ステータ情報が前記正常から異常に切換わり、前記サンプルホールド回路から前記CPUに入力される前記正常又は異常からなるステータス情報が、前記正常時は前記CPUからの駆動指令が通常出力で前記三相ブラシレスモータが駆動され、前記ステータス情報が、前記異常時は前記CPUからの駆動指令が出力停止となり、前記三相ブラシレスモータが停止する構成である。
本発明によるビルトインテスト回路を内蔵したジンバル制御システムは、以上のように構成されているため、次のような効果を得ることができる。
すなわち、CPUからの駆動指令に基づきモータドライブ回路から出力される三相モータ駆動信号により駆動される三相ブラシレスモータと、前記三相ブラシレスモータにより駆動されるジンバルに設けられ前記ジンバルの回転角度を検出するレゾルバと、前記レゾルバからの角度信号をR/D変換して角度情報を前記CPUに供給するR/D変換回路と、前記レゾルバ及びR/D変換回路に正弦波信号からなる励磁信号を供給するためのレゾルバリファレンス出力回路と、よりなり、前記角度情報に基づいて前記三相ブラシレスモータに前記三相モータ駆動信号が供給されるようにしたジンバル制御システムにおいて、前記励磁信号が入力されフォトカプラからなる波形生成器と、前記波形生成器からの矩形波信号及びクロック回路からのクロック信号が入力されプログラマブル・ロジック・デバイスからなるサンプルホールド回路と、からなるビルトインテスト回路を有し、前記サンプルホールド回路では前記矩形波信号が入力され続けている限り、正常のステータス情報が出力され、前記励磁信号が停止した時は前記サンプルホールド回路からの前記ステータ情報が前記正常から異常に切換わり、前記サンプルホールド回路から前記CPUに入力される前記正常又は異常からなるステータス情報が、前記正常時は前記CPUからの駆動指令が通常出力で前記三相ブラシレスモータが駆動され、前記ステータス情報が、前記異常時は前記CPUからの駆動指令が出力停止となり、前記三相ブラシレスモータが停止する構成としたことにより、励磁信号が停止した場合には、ビルトインテスト回路の作用により、直ちに三相ブラシレスモータの駆動が停止され、ジンバルの暴走を未然に防ぐことができ、ジンバル機構の損傷を防止することができる。
また、異常発生時も、故障部位の特定を迅速に行うことができ、復旧作業の時間を大幅に短縮することができる。
また、このビルトインテスト回路の構成もフォトカプラからなる波形生成器とクロック回路からのクロック信号が入力されプログラマブル・ロジック・デバイスからなるサンプルホールド回路とからなることにより、極めて単純であり、部品実装時の負担が小さく、小型化が可能である。
本発明によるビルトインテスト回路を内蔵したジンバル制御システムを示すブロック図である。 従来構成を示すブロック図である。
本発明は、ジンバルの駆動を制御するジンバル制御システムにレゾルバの動作が正常か否かの判定を行う回路をビルトインテスト回路として内蔵させ、三相ブラシレスDCモータへの三相切替信号を生成する場合、レゾルバリファレンス出力回路からの励磁信号の異常を検出して三相ブラシレスモータの暴走を防止するようにしたビルトインテスト回路を内蔵したジンバル制御システムを提供することを目的とする。
以下、図面と共に本発明によるビルトインテスト回路を内蔵したジンバル制御システムの好適な実施の形態について説明する。
尚、従来例と同一又は同等部分には同一符号を付して説明する。
図1において、符号1で示されるものは、図示しないジンバルの制御を行うためのジンバル制御システム2のCPUであり、このCPU1からの駆動指令4はモータドライブ回路5に入力され、このモータドライブ回路5からの三相モータ駆動信号6は三相ブラシレスモータ7に入力され、三相ブラシレスモータ7の駆動により、図示しないジンバル機構のジンバルの有限角内の駆動が行われるように構成されている。
前記三相ブラシレスモータ7に一体状又は別体に設けられ前記ジンバルの回転角を検出するレゾルバ8からの角度信号9はR/D変換回路10に入力され、このR/D変換回路10からのデジタル化された角度情報11は前記CPU1に入力され、このR/D変換回路10からのU・V・W切替信号12は前記モータドライブ回路5に入力されている。
さらに、レゾルバリファレンス出力回路13からの励磁信号14は、前記レゾルバ8及びR/D変換回路10に入力されている。
以上の構成は、前述の図2の構成と同一であるが、本発明においては、前述の図2の構成に対して図1の点線で示されるビルトインテスト回路18を付加した構成である。
前記レゾルバリファレンス出力回路13からの前記励磁信号14は、フォトカプラからなる波形生成器20で矩形波信号21に変換され、この矩形波信号21は周知のPLD(プログラマブル・ロジック・デバイス)からなりクロック回路24のクロック信号25が入力されるサンプルホールド回路22に入力され、このサンプルホールド回路22からの正常H1又は異常L0からなるステータス情報23が前記CPU1に入力されるように構成されている。
従って、前記波形生成器20、サンプルホールド回路22及びクロック回路24によりビルトインテスト回路18が構成されている。
前述の構成において、前記ジンバル制御システム2を作動させ、三相ブラシレスモータ7が駆動され、図示しないジンバル機構のジンバルの駆動を行い、前記レゾルバ8によって得られた角度信号9に基づく角度情報11がCPU1に送られ、補正された駆動指令4により前記三相ブラシレスモータ7が駆動されて安定した前記ジンバル機構の駆動が行われる。
前述の状態で、前記レゾルバリファレンス出力回路13からの正弦波信号からなる励磁信号14は、波形生成器20によりTTLレベルの矩形波信号21に変換された後、前記サンプルホールド回路22ではこの矩形波信号21が入力し続けている限り、正常の前記ステータス情報23であるHIにレベルを維持し、前記CPU1は角度情報11に基づいた駆動指令4で三相ブラシレスモータ7の駆動を行う。
次に、前述のジンバル機構の駆動状態において、前記レゾルバリファレンス出力回路13に異常が発生して励磁信号14が停止した場合、前記矩形波信号21が停止状態となり、前記サンプルホールド回路22からのステータス情報23が、それまでの正常H1レベルから異常L0レベルに切換わり、前記CPU1の処理が行われ、異常時として駆動指令4の発生が停止し、三相ブラシレスモータ7の駆動が停止し、その暴走が停止されて前述の従来のジンバル機構の損傷発生が防止される。
本発明によるビルトインテスト回路を内蔵したジンバル制御システムは、ジンバル制御システムに限ることなく、例えば、工作機やロボット等の制御システムに適用できる。
1 CPU
2 ジンバル制御システム
4 駆動指令
5 モータドライブ回路
6 三相モータ駆動信号
7 三相ブラシレスモータ
8 レゾルバ
9 角度信号
10 R/D変換回路
11 角度情報
12 U・V・W切替信号
13 レゾルバリファレンス出力回路
14 励磁信号
18 ビルトインテスト回路
20 波形生成器
21 矩形波信号
22 サンプルホールド回路
23 ステータス情報
24 クロック回路
25 クロック信号

Claims (1)

  1. CPU(1)からの駆動指令(4)に基づきモータドライブ回路(5)から出力される三相モータ駆動信号(6)により駆動される三相ブラシレスモータ(7)と、前記三相ブラシレスモータ(7)により駆動されるジンバルに設けられ前記ジンバルの回転角度を検出するレゾルバ(8)と、前記レゾルバ(8)からの角度信号(9)をR/D変換して角度情報(11)を前記CPU(1)に供給するR/D変換回路(10)と、前記レゾルバ(8)及びR/D変換回路(10)に正弦波信号からなる励磁信号(14)を供給するためのレゾルバリファレンス出力回路(13)と、よりなり、前記角度情報(11)に基づいて前記三相ブラシレスモータ(7)に前記三相モータ駆動信号(6)が供給されるようにしたジンバル制御システムにおいて、
    前記励磁信号(14)が入力されフォトカプラからなる波形生成器(20)と、前記波形生成器(20)からの矩形波信号(21)及びクロック回路(24)からのクロック信号(25)が入力されプログラマブル・ロジック・デバイスからなるサンプルホールド回路(22)と、からなるビルトインテスト回路(18)を有し、前記サンプルホールド回路(22)では前記矩形波信号(21)が入力され続けている限り、正常のステータス情報(23)が出力され、前記励磁信号(14)が停止した時は前記サンプルホールド回路(22)からの前記ステータ情報(23)が前記正常から異常に切換わり、前記サンプルホールド回路(22)から前記CPU(1)に入力される前記正常又は異常からなるステータス情報(23)が、前記正常時は前記CPU(1)からの駆動指令(4)が通常出力で前記三相ブラシレスモータが駆動され、前記ステータス情報(23)が、前記異常時は前記CPU(1)からの駆動指令(4)が出力停止となり、前記三相ブラシレスモータ(7)が停止する構成としたことを特徴とするビルトインテスト回路を内蔵したジンバル制御システム。
JP2009059347A 2009-03-12 2009-03-12 ビルトインテスト回路を内蔵したジンバル制御システム Active JP5272139B2 (ja)

Priority Applications (1)

Application Number Priority Date Filing Date Title
JP2009059347A JP5272139B2 (ja) 2009-03-12 2009-03-12 ビルトインテスト回路を内蔵したジンバル制御システム

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
JP2009059347A JP5272139B2 (ja) 2009-03-12 2009-03-12 ビルトインテスト回路を内蔵したジンバル制御システム

Publications (2)

Publication Number Publication Date
JP2010211691A JP2010211691A (ja) 2010-09-24
JP5272139B2 true JP5272139B2 (ja) 2013-08-28

Family

ID=42971744

Family Applications (1)

Application Number Title Priority Date Filing Date
JP2009059347A Active JP5272139B2 (ja) 2009-03-12 2009-03-12 ビルトインテスト回路を内蔵したジンバル制御システム

Country Status (1)

Country Link
JP (1) JP5272139B2 (ja)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101300295B1 (ko) * 2012-02-29 2013-08-28 삼성전기주식회사 빌트인 셀프 테스트 기능을 갖는 모터 구동 장치

Family Cites Families (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3351610B2 (ja) * 1994-02-23 2002-12-03 株式会社東芝 構造物の制振装置
JP3216491B2 (ja) * 1995-09-08 2001-10-09 トヨタ自動車株式会社 レゾルバ異常検出装置及び方法
JP2004134934A (ja) * 2002-10-09 2004-04-30 Tamagawa Seiki Co Ltd デジタル・アナログ信号変換器のリファレンス信号異常判定装置

Also Published As

Publication number Publication date
JP2010211691A (ja) 2010-09-24

Similar Documents

Publication Publication Date Title
JP5429181B2 (ja) モータ制御装置
JP2008043196A (ja) インバータ駆動型pmモータ駆動部の故障処理
JP2006081346A (ja) モータ制御装置
JP2007151266A (ja) ブラシレスモータ用駆動装置及びその駆動方法
JP6420405B1 (ja) 異常診断装置および異常診断方法
JP2014090655A (ja) モータ駆動制御信号の生成装置
JP5272139B2 (ja) ビルトインテスト回路を内蔵したジンバル制御システム
US10090789B2 (en) Motor control device, motor control method, and non-transitory computer readable medium encoded with computer program
JP2007151267A (ja) モータ駆動装置
JP5307997B2 (ja) ブラシレスdcモータの駆動装置
JP2006271064A (ja) 電動パワーステアリング装置
JP6457583B2 (ja) 異常診断装置および異常診断方法
JP2006280071A (ja) モータの制御方法および制御装置
JP7449950B2 (ja) 電力変換装置及びそれに用いる予兆診断方法
JP4654124B2 (ja) 永久磁石同期電動機駆動装置の制御方法、及びそれを用いた永久磁石同期電動機駆動装置
JP6133177B2 (ja) モータ駆動制御装置及びモータ駆動制御装置の制御方法
JP2010074883A (ja) モータの駆動装置
JP2006266727A (ja) 光学式エンコーダの異常検出装置及び光学式エンコーダの異常検出方法
WO2011052112A1 (ja) システムクロック監視装置およびモータ制御システム
JP2008292176A (ja) ロータリエンコーダを用いた制御システムおよび自己診断機能付きロータリエンコーダ
WO2023144923A1 (ja) 制御装置および加工機器
JP2019165551A (ja) モータ装置及びモータの駆動制御方法
JP2013013223A (ja) 電気掃除機
JP7358264B2 (ja) モータ駆動制御装置、ファン、およびモータ駆動制御方法
JP2008253036A (ja) ブラシレスモータ駆動装置

Legal Events

Date Code Title Description
A621 Written request for application examination

Free format text: JAPANESE INTERMEDIATE CODE: A621

Effective date: 20111116

A977 Report on retrieval

Free format text: JAPANESE INTERMEDIATE CODE: A971007

Effective date: 20120926

A131 Notification of reasons for refusal

Free format text: JAPANESE INTERMEDIATE CODE: A131

Effective date: 20121009

A521 Request for written amendment filed

Free format text: JAPANESE INTERMEDIATE CODE: A523

Effective date: 20121126

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

A61 First payment of annual fees (during grant procedure)

Free format text: JAPANESE INTERMEDIATE CODE: A61

Effective date: 20130404

R150 Certificate of patent or registration of utility model

Free format text: JAPANESE INTERMEDIATE CODE: R150

Ref document number: 5272139

Country of ref document: JP

Free format text: JAPANESE INTERMEDIATE CODE: R150

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250

R250 Receipt of annual fees

Free format text: JAPANESE INTERMEDIATE CODE: R250