異常時モータ減速停止制御手段を有する数値制御装置
【課題】数値制御部の異常時にモータを短時間で停止させる。また、モータにブレーキをかけるタイミングも制御可能とする。
【解決手段】数値制御装置１０が稼働中、数値制御部１１の異常を異常検出回路１４で検出する。異常検出回路１４の異常検出信号で、サーボ部１２のモータ減速停止制御回路１２ａが作動し、速度指令「０」で速度制御を行いモータ２２を停止させる。また、モータ２２の実速度が設定速度以下になると、ＤＯ信号をオフにさせるオフ指令信号をＰＭＣ部１３に出力する。ＰＭＣ部１３は、このオフ指令信号により、ブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする。これにより、モータ２２に設けられたブレーキ装置のブレーキがかかり、モータ２２を停止させる。モータ２２は減速停止制御されるから、最短時間で停止できる。また、ブレーキをかけるタイミングも設定制御できる。
【解決手段】数値制御装置１０が稼働中、数値制御部１１の異常を異常検出回路１４で検出する。異常検出回路１４の異常検出信号で、サーボ部１２のモータ減速停止制御回路１２ａが作動し、速度指令「０」で速度制御を行いモータ２２を停止させる。また、モータ２２の実速度が設定速度以下になると、ＤＯ信号をオフにさせるオフ指令信号をＰＭＣ部１３に出力する。ＰＭＣ部１３は、このオフ指令信号により、ブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする。これにより、モータ２２に設けられたブレーキ装置のブレーキがかかり、モータ２２を停止させる。モータ２２は減速停止制御されるから、最短時間で停止できる。また、ブレーキをかけるタイミングも設定制御できる。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、数値制御装置に関し、特に数値制御装置の数値制御部での異常発生時に該数値制御装置で制御される機械のモータを非常停止させる技術に関するものである。
【背景技術】
【０００２】
数値制御装置は、該数値制御装置で制御される機械に設けられたモータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号（入出力信号）を制御するプログラマブル・マシン・コントローラ部（以下ＰＭＣ（Programmable Machine Control）部と記載する）と、サーボ部やＰＭＣ部に指令を出したり、データのやりとりを行う数値制御部とで構成されている。
図２は、従来の数値制御装置１０’と該数値制御装置１０’で制御される機械２４を含めたシステムの概要図である。サーボ部１５は数値制御部１１からの移動指令に従い、機械のモータ２２の位置、速度、電流の制御を行う。また、ＰＭＣ部１６は機械２４に対するＤＩ／ＤＯ信号を、Ｉ／Ｏ制御部（以下I／Ｏユニットと記載する）２３を介して制御する。特に、機械の可動軸が重力等の外力の影響を受けて移動するような場合、該可動軸を駆動するモータにブレーキ装置が設けられているが、このブレーキ装置のオン／オフもこのＰＭＣ部１６からのＤＯ信号によってＩ／Ｏユニット２３を介して制御されるようになっている。又、数値制御部１１の異常を検出する異常検出回路１４が設けられている。
【０００３】
数値制御部１１は、制御プログラムを実行し、機械の各軸を駆動制御するサーボ部１５に移動指令を分配し、各サーボ部１５では、この移動指令と図示していない位置、速度検出器からフィードバックされる位置、速度のフィードバック信号に基づいて、位置、速度のフィードバック制御を行い、さらには、電流のフィードバック制御を行って駆動指令をアンプ２１に出力する。アンプ２１はＰＷＭ制御等を行いモータ２２を駆動制御する。
一方、ＰＭＣ部１６は、Ｉ／Ｏユニット２３を介してＤＩ／ＤＯ信号を送受信し、機械２４に設けられたセンサやアクチュエータ、周辺機器等を、Ｉ／Ｏユニット２３を介してオン／オフ制御している。上述したようにモータ２２に設けられたブレーキ装置もこのＤＯ信号（出力信号）によってオン／オフも制御している。
以上のように数値制御装置１０’は、サーボ部１５で機械の可動軸を駆動するモータを駆動制御し、ＰＭＣ部１６で、各種センサからの信号を受信し、各種アクチュエータ、周辺機器をオン／オフ制御し、機械２４を駆動制御する。
【０００４】
数値制御装置１０’の稼働中、異常検出回路１４は数値制御部１１の異常を検出すると、サーボ部１５に異常検出信号を出力する。サーボ部１５では、この異常検出信号を受信すると、アンプ２１への駆動指令信号を停止する。アンプ２１は、駆動指令信号が停止すると、モータ２２への動力を切断する。モータ２２への動力が切断されることにより、モータ２２によりダイナミックブレーキがかかり、可動部の移動は停止する。
【０００５】
一方、ＰＭＣ部１６は、数値制御部１１と定期的にデータのやりとりを行っており、数値制御部１１とのデータのやりとりが一定時間以上途絶えた場合、異常発生として全てのＤＯ信号（出力信号）をオフとする。このＤＯ信号のオフにより、モータ２２に設けられたブレーキ装置のブレーキが作動し、モータ２２にブレーキがかかることになる。
従来の数値制御システムでは、数値制御部１１に異常が発生したとき、上述したような、非常停止制御が行われている。
【０００６】
又、数値制御システムの非常停止を行うものとして、オペレータの安全を確保するために、オペレータが危険な状態になったことを検知するセンサを設け、該センサからの信号で、モータへの動力を遮断して停止させる。この場合、動力の遮断をアラーム検出手段で検知してアラーム出力を出すが、前記センサからの信号に基づいてモータへの動力を遮断した場合には、該センサからの信号によってアラーム検出手段を無効にして、アラームを出力しないようにして、システムの再復帰を容易にした発明が知られている（特許文献１参照）。
【０００７】
【特許文献１】特許３１５３５９３号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
上述した従来技術においては、非常停止時にモータの動力を遮断することによってモータの回転、及び該モータで駆動される可動部の移動停止を行わせている。そのため、高速移動中に異常が発生し、モータ及び可動部の移動を停止させる場合、モータの動力が遮断されるだけであるから、モータ及び可動部は惰走し、その惰走距離が長くなるという問題がある。
又、可動部が垂直方向に移動するような重力軸等のように、モータ以外の外部からの力が作用し移動するような可動部においては、モータの動力を遮断しても可動部はこの重力等の外部からの力の作用で移動してしまう。このため、このように可動部を駆動するモータにはブレーキ装置が取り付けられており、モータへの動力を遮断したとき、前述したように、ブレーキ装置によりモータにブレーキをかけて、その移動を停止するようにしている。
【０００９】
しかし、上述した従来の方法では、モータの停止とブレーキ信号のタイミングが制御されておらず、ブレーキ信号がモータ停止よりも遅れた場合、重力軸等にブレーキがかかるまでの時間に、この重力軸の可動部は落下、移動することになり問題である。
そこで、本発明の目的は、数値制御部に異常が発生したとき、モータ及び可動部を短時間で停止させる数値制御装置を得ること。また、モータにブレーキをかけるタイミングも制御可能とした数値制御装置を提供することにある。
【課題を解決するための手段】
【００１０】
本発明は、モータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号を制御するプログラマブル・マシン・コントローラ部と、サーボ部に指令を出し、プログラマブル・マシン・コントローラ部とはデータのやりとりを行う数値制御部とで構成されている数値制御装置において、数値制御部の異常を検出する異常検出手段と、前記サーボ部に設けられ、前記異常検出手段から数値制御部の異常検出信号を受けてモータを減速停止させるモータ減速停止制御手段とを設け、数値制御部の異常発生時に、モータを減速制御して速やかに停止させるようにする。
また、モータ減速停止制御手段は、フィードバックされてくるモータの実速度が設定速度以下となると、プログラマブル・マシン・コントローラ部にＤＯ信号をオフする信号を送出する手段を備え、プログラマブル・マシン・コントローラ部は、ＤＯ信号をオフする信号を受けてＤＯ信号をオフにする手段を備えるものとした。
もしくは、前記プログラマブル・マシン・コントローラ部に、前記異常検出手段から異常検出信号を受信してＤＯ信号をオフする手段を備えるものとした。
さらに、前記モータにブレーキ装置を備え、前記プログラマブル・マシン・コントローラ部によりＤＯ信号がオフにされることにより、前記ブレーキ装置のブレーキが作動するようにした。
【発明の効果】
【００１１】
数値制御部の異常が検出されたとき、モータを制御して停止させることにより、短時間でモータ及び該モータで駆動される可動部を停止させることができる。また、モータの減速停止とタイミングを合わせてＤＯ信号をオフにさせることができるので、重力等の外力が作用し移動するような可動部を駆動するモータの場合、該モータの回転停止とタイミングを取って、該モータにブレーキ装置によりブレーキをかけることができる。また、モータに対して減速停止制御を行うと同時にブレーキ装置によるブレーキを同時に動作させることもできる。
【発明を実施するための最良の形態】
【００１２】
以下、本発明の一実施形態を図面と共に説明する。
図１は、本発明の一実施形態の数値制御装置と該数値制御装置で制御される機械の要部を含む数値制御システムの概要図である。なお、図１において、図２に示した従来例と同じ要素は同一符号を付している。
【００１３】
数値制御装置１０は、数値制御部１１、サーボ部１２、ＰＭＣ部１３及び数値制御部１１の異常を検出する異常検出回路１４で構成されている。そして、本実施形態の数値制御装置１０は、図２に示した従来の数値制御装置１０’と比較し、サーボ部１２にモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂが設けられていること、および、ＰＭＣ部１３において、サーボ部１２から出力されるオフ指令信号に基づいてブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする点で相違するものであり、他は、従来例と同じである。
数値制御部１１は、制御プログラムを実行し、機械の各軸のモータ２２を駆動制御するサーボ部１２に移動指令を分配し、サーボ部１２では、この移動指令とモータ２２等に取り付けられた図示していない位置、速度検出器からフィードバックされる位置、速度のフィードバック信号に基づいて、位置、速度のフィードバック制御を行い、さらには、電流のフィードバック制御を行って駆動指令をアンプ２１に出力する。アンプ２１はＰＷＭ制御等を行いモータ２２を駆動制御する。
【００１４】
一方、ＰＭＣ部１３はＩ／Ｏユニット２３介して、機械２４に設けられたセンサ等からの信号（ＤＩ信号）を入力し、アクチュエータ、周辺機器等にＤＯ信号（出力信号）を出力し、アクチュエータ、周辺機器等をオン／オフ制御する。上述したように、モータに設けられたブレーキ装置のブレーキ信号のオン／オフもこのＤＯ信号で制御している。
この通常時の動作は、従来と同一であるが、異常検出回路１４が数値制御部１１の異常を検出したときの動作が従来と相違するものである。
【００１５】
数値制御装置１０の稼働中に、異常検出回路１４により数値制御部１１の異常が検出されると、異常検出回路１４は、サーボ部１２に異常検出信号を出力する。サーボ部１２では、この異常検出信号を受信すると、ウェイトタイマ１２ｂをスタートさせ、モータ減速停止制御回路１２ａを起動し、数値制御部１１からの移動指令に基づいてそれまで実行していた、位置、速度フィードバック制御から、速度指令「０」の速度のフィードバック制御のみのモータ減速停止制御回路１２ａの動作に切り換える。異常検出信号が検出する前までは位置、速度のフィードバック制御がなされ、モータ２２は、指令速度で回転しているが、異常検出信号がサーボ部１２に入力されると、速度指令が「０」となり速度のフィードバック制御が実施される。モータ２２及び該モータ２２で駆動される可動部は速度指令が「０」となっても、直ちに停止することができず、移動する。その結果、速度偏差が増大し、モータ２２にはそれまでの移動方向とは逆方向に移動させるトルクがかかり、モータ２２及び可動部は急速に減速され停止することになる。このようにモータ２２は減速制御されて急速に停止する。又、モータ減速停止制御回路１２ａにおいては、モータ２２に取り付けられている速度検出器からフィードバックされる実速度を監視し、該実速度が設定所定速度以下になると、ＰＭＣ部１３にＤＯ信号をオフにさせるオフ指令信号を出力する。
【００１６】
ＰＭＣ部１３は、このオフ指令信号を受信すると、ブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする手段を設ける。このＤＯ信号のオフにより、Ｉ／Ｏユニット２３を介してモータ２２に取り付けられているブレーキ装置のブレーキ信号もオフとなり、モータ２２にブレーキをかけてモータ２２を停止及びロックすることになる。これによって、重力が作用する可動部が非常停止時に落下することを確実に防止できる。又、従来のようにダイナミックブレーキをかけてモータを惰走させて停止させるものではなく、速度制御してモータ２２の回転を減速停止させるものであるから、最短距離、最短時間でモータ２２及び該モータ２２で駆動される可動部を停止させることができる。そして、ウェィトタイマ１２ｂが所定時間を計時してタイムアップすると、サーボ部１２はアンプ２１への信号の送出を停止し、数値制御部１１の異常検出時の非常停止動作は終了する。
【００１７】
なお、サーボ部１２のモータ減速停止制御回路１２ａがオフ指令信号を出力するタイミングは、モータ２２の実速度が設定所定速度以下になったときであり、この設定所定速度を「０」とすれば、モータ２２の実速度が「０」になったときブレーキがかかることになる。又、ウェィトタイマ１２ｂで計時する時間は、モータが最高速度で回転中において異常が検出され、速度「０」の指令で速度フィードバックがなされて停止する時間より少し長い時間に設定されている。
【００１８】
このように、モータ２２の駆動制御を行うサーボ部１２が直接、ＰＭＣ部１３にＤＯ信号オフの指示を行うため、モータ２２の停止とブレーキのかかるタイミングがこまやかに制御され、重力が作用する可動部等の落下を防止できる。また、高速移動中においても、異常発生時からのモータ及び可動部が停止するまでの距離を短くできるものである。
【００１９】
上述したサーボ部１２に設けられるモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂは、ハードウェアの専用回路で構成してもよいが、通常サーボ部１２はプロセッサとメモリ等で構成され、位置、速度のフィードバック制御をソフトウェア処理で実行していることから、このモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂもソフトウェア処理によって実行させるようにする。すなわち、サーボ部１２に異常検出信号が入力されると、サーボ部１２のプロセッサは、位置、速度のフィードバック制御に代えて速度指令を「０」とする速度フィードバック制御を実行し、モータ２２を駆動するようにする。
【００２０】
又、上述した実施形態では、サーボ部１２よりＰＭＣ部１３へＤＯ信号をオフにさせるオフ指令信号を送出するようにしているが、異常検出回路１４から出力される異常検出信号をＰＭＣ部１３にも入力し、この異常検出信号をＤＯ信号をオフにさせるオフ指令信号としてもよい。このオフ指令信号によりＰＭＣ部１３はブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする。この場合、モータ２２は、サーボ部１２によって、速度が「０」になるように速度フィードバック制御がなされ、減速停止制御されると共に、ブレーキ装置によりブレーキがかけられてモータ２２の回転が阻止されることになり、モータ２２の回転及び該モータ２２で駆動される可動部の移動は急速に停止することになる。数値制御部１１の異常を検出したとき、できるだけ早くモータ及び可動部の移動を停止させたい場合には、このサーボ部１２のモータ減速停止制御回路１２ａによる減速停止制御とブレーキ装置による制動を同時に作動させて急速に停止させる方法を採用すればよい。
【図面の簡単な説明】
【００２１】
【図１】本発明の一実施形態の数値制御装置と該数値制御装置で制御される機械の要部を含む数値制御システムの概要図である。
【図２】数値制御装置と該数値制御装置で制御される機械を含めたシステムの従来例の概要図である。
【符号の説明】
【００２２】
１０、１０’ 数値制御装置
【技術分野】
【０００１】
本発明は、数値制御装置に関し、特に数値制御装置の数値制御部での異常発生時に該数値制御装置で制御される機械のモータを非常停止させる技術に関するものである。
【背景技術】
【０００２】
数値制御装置は、該数値制御装置で制御される機械に設けられたモータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号（入出力信号）を制御するプログラマブル・マシン・コントローラ部（以下ＰＭＣ（Programmable Machine Control）部と記載する）と、サーボ部やＰＭＣ部に指令を出したり、データのやりとりを行う数値制御部とで構成されている。
図２は、従来の数値制御装置１０’と該数値制御装置１０’で制御される機械２４を含めたシステムの概要図である。サーボ部１５は数値制御部１１からの移動指令に従い、機械のモータ２２の位置、速度、電流の制御を行う。また、ＰＭＣ部１６は機械２４に対するＤＩ／ＤＯ信号を、Ｉ／Ｏ制御部（以下I／Ｏユニットと記載する）２３を介して制御する。特に、機械の可動軸が重力等の外力の影響を受けて移動するような場合、該可動軸を駆動するモータにブレーキ装置が設けられているが、このブレーキ装置のオン／オフもこのＰＭＣ部１６からのＤＯ信号によってＩ／Ｏユニット２３を介して制御されるようになっている。又、数値制御部１１の異常を検出する異常検出回路１４が設けられている。
【０００３】
数値制御部１１は、制御プログラムを実行し、機械の各軸を駆動制御するサーボ部１５に移動指令を分配し、各サーボ部１５では、この移動指令と図示していない位置、速度検出器からフィードバックされる位置、速度のフィードバック信号に基づいて、位置、速度のフィードバック制御を行い、さらには、電流のフィードバック制御を行って駆動指令をアンプ２１に出力する。アンプ２１はＰＷＭ制御等を行いモータ２２を駆動制御する。
一方、ＰＭＣ部１６は、Ｉ／Ｏユニット２３を介してＤＩ／ＤＯ信号を送受信し、機械２４に設けられたセンサやアクチュエータ、周辺機器等を、Ｉ／Ｏユニット２３を介してオン／オフ制御している。上述したようにモータ２２に設けられたブレーキ装置もこのＤＯ信号（出力信号）によってオン／オフも制御している。
以上のように数値制御装置１０’は、サーボ部１５で機械の可動軸を駆動するモータを駆動制御し、ＰＭＣ部１６で、各種センサからの信号を受信し、各種アクチュエータ、周辺機器をオン／オフ制御し、機械２４を駆動制御する。
【０００４】
数値制御装置１０’の稼働中、異常検出回路１４は数値制御部１１の異常を検出すると、サーボ部１５に異常検出信号を出力する。サーボ部１５では、この異常検出信号を受信すると、アンプ２１への駆動指令信号を停止する。アンプ２１は、駆動指令信号が停止すると、モータ２２への動力を切断する。モータ２２への動力が切断されることにより、モータ２２によりダイナミックブレーキがかかり、可動部の移動は停止する。
【０００５】
一方、ＰＭＣ部１６は、数値制御部１１と定期的にデータのやりとりを行っており、数値制御部１１とのデータのやりとりが一定時間以上途絶えた場合、異常発生として全てのＤＯ信号（出力信号）をオフとする。このＤＯ信号のオフにより、モータ２２に設けられたブレーキ装置のブレーキが作動し、モータ２２にブレーキがかかることになる。
従来の数値制御システムでは、数値制御部１１に異常が発生したとき、上述したような、非常停止制御が行われている。
【０００６】
又、数値制御システムの非常停止を行うものとして、オペレータの安全を確保するために、オペレータが危険な状態になったことを検知するセンサを設け、該センサからの信号で、モータへの動力を遮断して停止させる。この場合、動力の遮断をアラーム検出手段で検知してアラーム出力を出すが、前記センサからの信号に基づいてモータへの動力を遮断した場合には、該センサからの信号によってアラーム検出手段を無効にして、アラームを出力しないようにして、システムの再復帰を容易にした発明が知られている（特許文献１参照）。
【０００７】
【特許文献１】特許３１５３５９３号公報
【発明の開示】
【発明が解決しようとする課題】
【０００８】
上述した従来技術においては、非常停止時にモータの動力を遮断することによってモータの回転、及び該モータで駆動される可動部の移動停止を行わせている。そのため、高速移動中に異常が発生し、モータ及び可動部の移動を停止させる場合、モータの動力が遮断されるだけであるから、モータ及び可動部は惰走し、その惰走距離が長くなるという問題がある。
又、可動部が垂直方向に移動するような重力軸等のように、モータ以外の外部からの力が作用し移動するような可動部においては、モータの動力を遮断しても可動部はこの重力等の外部からの力の作用で移動してしまう。このため、このように可動部を駆動するモータにはブレーキ装置が取り付けられており、モータへの動力を遮断したとき、前述したように、ブレーキ装置によりモータにブレーキをかけて、その移動を停止するようにしている。
【０００９】
しかし、上述した従来の方法では、モータの停止とブレーキ信号のタイミングが制御されておらず、ブレーキ信号がモータ停止よりも遅れた場合、重力軸等にブレーキがかかるまでの時間に、この重力軸の可動部は落下、移動することになり問題である。
そこで、本発明の目的は、数値制御部に異常が発生したとき、モータ及び可動部を短時間で停止させる数値制御装置を得ること。また、モータにブレーキをかけるタイミングも制御可能とした数値制御装置を提供することにある。
【課題を解決するための手段】
【００１０】
本発明は、モータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号を制御するプログラマブル・マシン・コントローラ部と、サーボ部に指令を出し、プログラマブル・マシン・コントローラ部とはデータのやりとりを行う数値制御部とで構成されている数値制御装置において、数値制御部の異常を検出する異常検出手段と、前記サーボ部に設けられ、前記異常検出手段から数値制御部の異常検出信号を受けてモータを減速停止させるモータ減速停止制御手段とを設け、数値制御部の異常発生時に、モータを減速制御して速やかに停止させるようにする。
また、モータ減速停止制御手段は、フィードバックされてくるモータの実速度が設定速度以下となると、プログラマブル・マシン・コントローラ部にＤＯ信号をオフする信号を送出する手段を備え、プログラマブル・マシン・コントローラ部は、ＤＯ信号をオフする信号を受けてＤＯ信号をオフにする手段を備えるものとした。
もしくは、前記プログラマブル・マシン・コントローラ部に、前記異常検出手段から異常検出信号を受信してＤＯ信号をオフする手段を備えるものとした。
さらに、前記モータにブレーキ装置を備え、前記プログラマブル・マシン・コントローラ部によりＤＯ信号がオフにされることにより、前記ブレーキ装置のブレーキが作動するようにした。
【発明の効果】
【００１１】
数値制御部の異常が検出されたとき、モータを制御して停止させることにより、短時間でモータ及び該モータで駆動される可動部を停止させることができる。また、モータの減速停止とタイミングを合わせてＤＯ信号をオフにさせることができるので、重力等の外力が作用し移動するような可動部を駆動するモータの場合、該モータの回転停止とタイミングを取って、該モータにブレーキ装置によりブレーキをかけることができる。また、モータに対して減速停止制御を行うと同時にブレーキ装置によるブレーキを同時に動作させることもできる。
【発明を実施するための最良の形態】
【００１２】
以下、本発明の一実施形態を図面と共に説明する。
図１は、本発明の一実施形態の数値制御装置と該数値制御装置で制御される機械の要部を含む数値制御システムの概要図である。なお、図１において、図２に示した従来例と同じ要素は同一符号を付している。
【００１３】
数値制御装置１０は、数値制御部１１、サーボ部１２、ＰＭＣ部１３及び数値制御部１１の異常を検出する異常検出回路１４で構成されている。そして、本実施形態の数値制御装置１０は、図２に示した従来の数値制御装置１０’と比較し、サーボ部１２にモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂが設けられていること、および、ＰＭＣ部１３において、サーボ部１２から出力されるオフ指令信号に基づいてブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする点で相違するものであり、他は、従来例と同じである。
数値制御部１１は、制御プログラムを実行し、機械の各軸のモータ２２を駆動制御するサーボ部１２に移動指令を分配し、サーボ部１２では、この移動指令とモータ２２等に取り付けられた図示していない位置、速度検出器からフィードバックされる位置、速度のフィードバック信号に基づいて、位置、速度のフィードバック制御を行い、さらには、電流のフィードバック制御を行って駆動指令をアンプ２１に出力する。アンプ２１はＰＷＭ制御等を行いモータ２２を駆動制御する。
【００１４】
一方、ＰＭＣ部１３はＩ／Ｏユニット２３介して、機械２４に設けられたセンサ等からの信号（ＤＩ信号）を入力し、アクチュエータ、周辺機器等にＤＯ信号（出力信号）を出力し、アクチュエータ、周辺機器等をオン／オフ制御する。上述したように、モータに設けられたブレーキ装置のブレーキ信号のオン／オフもこのＤＯ信号で制御している。
この通常時の動作は、従来と同一であるが、異常検出回路１４が数値制御部１１の異常を検出したときの動作が従来と相違するものである。
【００１５】
数値制御装置１０の稼働中に、異常検出回路１４により数値制御部１１の異常が検出されると、異常検出回路１４は、サーボ部１２に異常検出信号を出力する。サーボ部１２では、この異常検出信号を受信すると、ウェイトタイマ１２ｂをスタートさせ、モータ減速停止制御回路１２ａを起動し、数値制御部１１からの移動指令に基づいてそれまで実行していた、位置、速度フィードバック制御から、速度指令「０」の速度のフィードバック制御のみのモータ減速停止制御回路１２ａの動作に切り換える。異常検出信号が検出する前までは位置、速度のフィードバック制御がなされ、モータ２２は、指令速度で回転しているが、異常検出信号がサーボ部１２に入力されると、速度指令が「０」となり速度のフィードバック制御が実施される。モータ２２及び該モータ２２で駆動される可動部は速度指令が「０」となっても、直ちに停止することができず、移動する。その結果、速度偏差が増大し、モータ２２にはそれまでの移動方向とは逆方向に移動させるトルクがかかり、モータ２２及び可動部は急速に減速され停止することになる。このようにモータ２２は減速制御されて急速に停止する。又、モータ減速停止制御回路１２ａにおいては、モータ２２に取り付けられている速度検出器からフィードバックされる実速度を監視し、該実速度が設定所定速度以下になると、ＰＭＣ部１３にＤＯ信号をオフにさせるオフ指令信号を出力する。
【００１６】
ＰＭＣ部１３は、このオフ指令信号を受信すると、ブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする手段を設ける。このＤＯ信号のオフにより、Ｉ／Ｏユニット２３を介してモータ２２に取り付けられているブレーキ装置のブレーキ信号もオフとなり、モータ２２にブレーキをかけてモータ２２を停止及びロックすることになる。これによって、重力が作用する可動部が非常停止時に落下することを確実に防止できる。又、従来のようにダイナミックブレーキをかけてモータを惰走させて停止させるものではなく、速度制御してモータ２２の回転を減速停止させるものであるから、最短距離、最短時間でモータ２２及び該モータ２２で駆動される可動部を停止させることができる。そして、ウェィトタイマ１２ｂが所定時間を計時してタイムアップすると、サーボ部１２はアンプ２１への信号の送出を停止し、数値制御部１１の異常検出時の非常停止動作は終了する。
【００１７】
なお、サーボ部１２のモータ減速停止制御回路１２ａがオフ指令信号を出力するタイミングは、モータ２２の実速度が設定所定速度以下になったときであり、この設定所定速度を「０」とすれば、モータ２２の実速度が「０」になったときブレーキがかかることになる。又、ウェィトタイマ１２ｂで計時する時間は、モータが最高速度で回転中において異常が検出され、速度「０」の指令で速度フィードバックがなされて停止する時間より少し長い時間に設定されている。
【００１８】
このように、モータ２２の駆動制御を行うサーボ部１２が直接、ＰＭＣ部１３にＤＯ信号オフの指示を行うため、モータ２２の停止とブレーキのかかるタイミングがこまやかに制御され、重力が作用する可動部等の落下を防止できる。また、高速移動中においても、異常発生時からのモータ及び可動部が停止するまでの距離を短くできるものである。
【００１９】
上述したサーボ部１２に設けられるモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂは、ハードウェアの専用回路で構成してもよいが、通常サーボ部１２はプロセッサとメモリ等で構成され、位置、速度のフィードバック制御をソフトウェア処理で実行していることから、このモータ減速停止制御回路１２ａ、ウェイトタイマ１２ｂもソフトウェア処理によって実行させるようにする。すなわち、サーボ部１２に異常検出信号が入力されると、サーボ部１２のプロセッサは、位置、速度のフィードバック制御に代えて速度指令を「０」とする速度フィードバック制御を実行し、モータ２２を駆動するようにする。
【００２０】
又、上述した実施形態では、サーボ部１２よりＰＭＣ部１３へＤＯ信号をオフにさせるオフ指令信号を送出するようにしているが、異常検出回路１４から出力される異常検出信号をＰＭＣ部１３にも入力し、この異常検出信号をＤＯ信号をオフにさせるオフ指令信号としてもよい。このオフ指令信号によりＰＭＣ部１３はブレーキ制御用ＤＯのオフまたは全てのＤＯ信号をオフとする。この場合、モータ２２は、サーボ部１２によって、速度が「０」になるように速度フィードバック制御がなされ、減速停止制御されると共に、ブレーキ装置によりブレーキがかけられてモータ２２の回転が阻止されることになり、モータ２２の回転及び該モータ２２で駆動される可動部の移動は急速に停止することになる。数値制御部１１の異常を検出したとき、できるだけ早くモータ及び可動部の移動を停止させたい場合には、このサーボ部１２のモータ減速停止制御回路１２ａによる減速停止制御とブレーキ装置による制動を同時に作動させて急速に停止させる方法を採用すればよい。
【図面の簡単な説明】
【００２１】
【図１】本発明の一実施形態の数値制御装置と該数値制御装置で制御される機械の要部を含む数値制御システムの概要図である。
【図２】数値制御装置と該数値制御装置で制御される機械を含めたシステムの従来例の概要図である。
【符号の説明】
【００２２】
１０、１０’ 数値制御装置
【特許請求の範囲】
【請求項１】
モータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号を制御するプログラマブル・マシン・コントローラ部と、サーボ部に指令を出し、プログラマブル・マシン・コントローラ部とはデータのやりとりを行う数値制御部とで構成されている数値制御装置において、
数値制御部の異常を検出する異常検出手段と、
前記サーボ部に設けられ、前記異常検出手段から数値制御部の異常検出信号を受けてモータを減速停止させるモータ減速停止制御手段と、
を有することを特徴とする数値制御装置。
【請求項２】
前記モータ減速停止制御手段は、フィードバックされてくるモータの実速度が設定速度以下となると、プログラマブル・マシン・コントローラ部にＤＯ信号をオフする信号を送出する手段を備え、プログラマブル・マシン・コントローラ部は、ＤＯ信号をオフする信号を受けてＤＯ信号をオフにする手段を備えることを特徴とする請求項１に記載の数値制御装置。
【請求項３】
前記プログラマブル・マシン・コントローラ部は、前記異常検出手段から異常検出信号を受信し、ＤＯ信号をオフする手段を備えることを特徴とする請求項１に記載の数値制御装置。
【請求項４】
前記モータはブレーキ装置を備え、前記プログラマブル・マシン・コントローラ部によりＤＯ信号がオフにされることにより、前記ブレーキ装置のブレーキが作動するようにした請求項２または請求項３に記載の数値制御装置。
【請求項１】
モータを制御するサーボ部と、機械へのＤＩ／ＤＯ信号を制御するプログラマブル・マシン・コントローラ部と、サーボ部に指令を出し、プログラマブル・マシン・コントローラ部とはデータのやりとりを行う数値制御部とで構成されている数値制御装置において、
数値制御部の異常を検出する異常検出手段と、
前記サーボ部に設けられ、前記異常検出手段から数値制御部の異常検出信号を受けてモータを減速停止させるモータ減速停止制御手段と、
を有することを特徴とする数値制御装置。
【請求項２】
前記モータ減速停止制御手段は、フィードバックされてくるモータの実速度が設定速度以下となると、プログラマブル・マシン・コントローラ部にＤＯ信号をオフする信号を送出する手段を備え、プログラマブル・マシン・コントローラ部は、ＤＯ信号をオフする信号を受けてＤＯ信号をオフにする手段を備えることを特徴とする請求項１に記載の数値制御装置。
【請求項３】
前記プログラマブル・マシン・コントローラ部は、前記異常検出手段から異常検出信号を受信し、ＤＯ信号をオフする手段を備えることを特徴とする請求項１に記載の数値制御装置。
【請求項４】
前記モータはブレーキ装置を備え、前記プログラマブル・マシン・コントローラ部によりＤＯ信号がオフにされることにより、前記ブレーキ装置のブレーキが作動するようにした請求項２または請求項３に記載の数値制御装置。
【図１】
【図２】
【図２】
【公開番号】特開２００８−２２５５１８（Ｐ２００８−２２５５１８Ａ）
【公開日】平成２０年９月２５日（２００８．９．２５）
【国際特許分類】
【出願番号】特願２００７−５８２４６（Ｐ２００７−５８２４６）
【出願日】平成１９年３月８日（２００７．３．８）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
【公開日】平成２０年９月２５日（２００８．９．２５）
【国際特許分類】
【出願日】平成１９年３月８日（２００７．３．８）
【出願人】（３９０００８２３５）ファナック株式会社 (1,110)
【Ｆターム（参考）】
[ Back to top ]