(57)【要約】【課題】電断後に、従軸を、主軸位置に対応した位置に自動復帰させることが可能な制御装置を提供する。【解決手段】主軸と従軸とを電子カムプロファイルに従って同期制御する制御装置は、電断からの復帰時に、前記主軸の位置を取得し、取得した位置とカム同期した時点での前記主軸の位置と前記電子カムプロファイルとに基づき、前記主軸の基準位置である主軸基準位置と、前記従軸の基準位置である従軸基準位置とを算出する基準位置算出手段と、前記主軸の現在位置と、前記電子カムプロファイルと、前記基準位置算出手段により算出された前記主軸基準位置及び前記従軸基準位置とに基づき、前記主軸の現在位置に対応する前記従軸の位置を求めて、前記従軸の位置を求めた位置に移動させるための復帰制御を行う復帰制御手段と、を備える。【選択図】図４
2020166612.tif 000002
【特許請求の範囲】
【請求項１】
主軸と従軸とを電子カムプロファイルに従って同期制御する制御装置であって、
電断からの復帰時に、前記主軸の位置を取得し、取得した位置とカム同期した時点での前記主軸の位置と前記電子カムプロファイルとに基づき、前記主軸の基準位置である主軸基準位置と、前記従軸の基準位置である従軸基準位置とを算出する基準位置算出手段と、
前記主軸の現在位置と、前記電子カムプロファイルと、前記基準位置算出手段により算出された前記主軸基準位置及び前記従軸基準位置とに基づき、前記主軸の現在位置に対応する前記従軸の位置を求めて、前記従軸の位置を求めた位置に移動させるための復帰制御を行う復帰制御手段と、
を備える制御装置。
【請求項２】
前記復帰制御手段による前記復帰制御が行われる前に、前記主軸及び前記従軸の位置と前記電子カムプロファイルとの関係を示すグラフを含む状態提示画面を表示装置に表示させる情報提示手段を、さらに、備える、
請求項１記載の制御装置。
【請求項３】
前記情報提示手段は、前記復帰制御手段による前記復帰制御が行われると、前記グラフ上に示されている前記従軸の位置を当該復帰制御の進行状態に応じて変更する、
請求項２記載の制御装置。
【請求項４】
前記復帰制御手段は、前記状態提示画面に設けられた所定のアイテムが操作されたときに、前記復帰制御を開始する、
請求項２又は３に記載の制御装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本発明は、電子カム制御を行う制御装置に関する。
【背景技術】
【０００２】
機械、設備などに用いられているモータの運動を制御するためのモーション制御において、電子カムが用いられることがある。電子カムは、機械式カムの動作を電子制御で実現するものであり、電子カムでは、主軸と従軸とがソフトウェア上で定められた電子カムプロファイルに従って同期制御させる。
【０００３】
そのような同期制御（以下、電子カム制御と表記する）が行われる電子カムシステムでは、非常停止時に、従軸が、主軸の停止位置と電子カムプロファイルとにより規定される本来の位置（以下、主軸対応位置と表記する）からずれた位置で停止することがある。そして、従軸が主軸対応位置で停止していない状態で電子カム制御を再開したのでは、各軸に所望の動作を行わせることが出来ない。そのため、非常停止後に、主軸の位置から主軸対応位置を算出し、主軸を動かすことなく従軸をその主軸対応位置に移動させる技術（例えば、特許文献１）が開発されている。
【先行技術文献】
【特許文献】
【０００４】
【特許文献１】特許第５５０６４５６号公報
【発明の概要】
【発明が解決しようとする課題】
【０００５】
従軸が、主軸対応位置からずれた位置で停止するという現象は、停電や装置のメンテナンスなど、制御装置の電断時にも発生し得るが、既存の制御装置は、電断後に従軸を主軸対応位置に移動する際に、作業者が介入し、手動で復帰させる必要があるものとなっている。
【０００６】
本発明は、上記現状に鑑みてなされたものであり、電断後に、従軸を、主軸位置に対応した位置に自動復帰させることが可能な制御装置を提供することを目的とする。
【課題を解決するための手段】
【０００７】
上記課題を解決するために、本発明の一観点に係る制御装置は、主軸と従軸とを電子カムプロファイルに従って同期制御する制御装置であって、電断からの復帰時に、前記主軸の位置を取得し、取得した位置とカム同期した時点での前記主軸の位置と前記電子カムプロファイルとに基づき、前記主軸の基準位置である主軸基準位置と、前記従軸の基準位置である従軸基準位置とを算出する基準位置算出手段と、前記主軸の現在位置と、前記電子カムプロファイルと、前記基準位置算出手段により算出された前記主軸基準位置及び前記従軸基準位置とに基づき、前記主軸の現在位置に対応する前記従軸の位置を求めて、前記従軸の位置を求めた位置に移動させるための復帰制御を行う復帰制御手段と、を備える。
【０００８】
すなわち、停電や装置のメンテナンスなどによる電断が発生すると、各軸の基準位置が電断発生前の基準位置と異なってしまう場合がある。そのため、従来の制御装置では、電断後に従軸を主軸対応位置に手動で復帰させる必要があったのであるが、本発明に係る制御装置は、電断からの復帰時に、各軸の基準位置を再算出する機能を有している。従って、この制御装置によれば、停電や装置のメンテナンスなどによる電断後に、従軸を、主軸位置に対応した位置に自動復帰させることが可能となる。
【０００９】
また、制御装置に、『前記復帰制御手段による前記制御が行われる前に、前記主軸及び前記従軸の位置と前記電子カムプロファイルとの関係を示すグラフを含む状態提示画面を表示装置に表示させる情報提示手段』を付加しておいても良い。この情報提示手段は、前記復帰制御手段による前記復帰制御が行われると、前記グラフ上に示されている前記従軸の位置を当該制御の進行状態に応じて変更する手段であっても良い。なお、制御装置に情報提示手段を付加しておけば、ユーザが状況を把握しやすくなるため、利便性が高い制御装置を得ることが出来ることになる。
【００１０】
また、制御装置に情報提示手段を付加する場合には、復帰制御手段として、前記状態提示画面に設けられた所定のアイテムが操作されたときに、前記復帰制御を開始する手段を採用しておいても良い。
【発明の効果】
【００１１】
本発明によれば、停電などの制御装置の電断後に、従軸を、主軸位置に対応した位置に自動復帰させることが可能な制御装置を提供することが出来る。
【図面の簡単な説明】
【００１２】
【図１】図１は、本発明の一実施形態に係る制御装置の構成及び使用形態の説明図である。
【図２Ａ】図２Ａは、電子カムプロファイルの説明図である。
【図２Ｂ】図２Ｂは、テーブル形式の電子カムプロファイルの説明図である。
【図３】図３は、基準位置更新処理における主軸基準位置及び従軸基準位置の算出手順の説明図である。
【図４】図４は、制御装置の復帰制御部が実行する復帰制御処理の流れ図である。
【図５】図５は、対応従軸変位量の算出手順例の説明図である。
【図６】図６は、制御装置が表示パネルの画面上に表示する操作画面の説明図である。
【発明を実施するための形態】
【００１３】
図１に、本発明の一実施形態に係る制御装置１０の構成及び使用形態の説明図を示す。
【００１４】
本実施形態に係る制御装置１０は、主軸と、当該主軸の位置を基準に、位置が制御される複数の従軸を備えたサーボシステム２０を制御するために開発したＰＬＣ(Programmable Logic Controller）である。
【００１５】
制御装置１０が制御する従軸の数は特に限定されない。ただし、以下では、制御装置１０が制御するサーボシステム２０が、図１に示してあるような、モータ２２ａ、２２ｂが、それぞれ、サーボドライバ２１ａ、２１ｂにより駆動されるシステムであり、モータ２２ａ、２２ｂの軸が、それぞれ主軸、従軸である場合を例に、制御装置１０の構成及び機能を説明する。また、以下では、主軸、従軸（モータ２２ａ、２２ｂの軸）の位置を制御するための指令をサーボドライバ２１ａ、２１ｂに供給することを、単に、主軸、従軸の位置を制御するとも表記する。
【００１６】
本実施形態に係る制御装置１０は、操作パネル１８及びサーボシステム２０と接続可能なＰＬＣを、同期制御部１１、基準位置記憶部１２、基準位置更新部１３、復帰制御部１４及びＵＩ制御部１５として動作可能なように構成（プログラミング）した装置である。なお、操作パネル１８とは、制御装置１０の入出力装置として用意されている、タッチパネルを備えたコンピュータのことである。
【００１７】
基準位置記憶部１２は、主軸基準位置及び従軸基準位置を記憶しておくための不揮発性の記憶ユニットである。この基準位置記憶部１２には、カム同期した時点での主軸位置及び従軸位置（以下、各軸位置を、カム同期時主軸位置、カム同期時従軸位置と表記する）も記憶される。また、基準位置記憶部１２としては、通常、制御装置１０内の、書き換え可能な不揮発性メモリ（フラッシュＲＯＭ等）やストレージ（ＨＤＤ等）の一記憶領域が、この基準位置記憶部１２として使用される。
【００１８】
同期制御部１１は、主軸の位置（モータ２２ａの軸の回転角）を制御すると共に、設定されている電子カムプロファイルに従って、従軸の位置（モータ２２ｂの軸の回転角）を主軸の位置に対応する位置に制御する機能ブロックである。同期制御部１１が、それに従って従軸を制御する電子カムプロファイルは、図２Ａに示したような関係、すなわち、主軸の位相と従軸の変位量との関係、を示す情報である。ここで、主軸の位相とは、カム同期時主軸位置又は主軸基準位置からの変化量のことであり、従軸の変位量とは、カム同期時主軸位置又は従軸基準位置からの変化量のことである。この電子カムプロファイルとしては、例えば、図２Ｂに示したようなテーブル形式の情報を使用することが出来る。なお、図２Ｂにおいて、カム始点と示してあるデータ（位相及び変位）から、カム終点と示してあるデータまでのデータが、図２Ａにおける１周期分のデータである。以下、電子カムプロファイルが規定するカム終点における位相、変位（例えば、図２Ｂにおけるカム終点と示してあるデータ中の位相、変位）を、それぞれ、終点位相、終点変位と表記する。
【００１９】
基準位置更新部１３は、主軸と従軸とが同期制御部１１によって同期制御されている期間中は、カム終点に到達する度に基準位置更新処理を行う機能ブロックである。この基準位置更新部１３は、停電や装置のメンテナンスなどによる電断後に制御装置１０が始動された場合にも、基準位置更新処理を行う。
【００２０】
基準位置更新部１３が行う基準位置更新処理は、サーボシステム２０から主軸の位置を取得し、取得した主軸の位置に基づき、主軸基準位置及び従軸基準位置を算出し、算出結果で基準位置記憶部１２内の主軸基準位置及び従軸基準位置を更新する処理である。この基準位置更新処理は、主軸基準位置及び従軸基準位置を、以下の（１）、（２）式により算出する処理となっている。
【００２１】
主軸基準位置＝Floor((主軸現在位置−カム同期時主軸位置)÷終点位相)×終点位相＋
カム同期時主軸位置                                                    …（１）
従軸基準位置＝Floor((主軸現在位置−カム同期時主軸位置)÷終点位相)×終点変位+カム同期時従軸変位                                                      …（２）
【００２２】
（１）、（２）式における主軸現在位置が、サーボシステム２０から取得された主軸の位置である。また、Floorとは、床関数のことである。
【００２３】
すなわち、図３に示してあるように、カム同期時主軸位置、カム同期時従軸位置、終点位相、終点変位が、それぞれ、１００、１５０、２００、０である状況下、主軸現在位置４５０が取得された場合、基準位置更新処理では、同図に示してある演算により、主軸基準位置、従軸基準位置として、それぞれ、３００、１５０が算出される。
【００２４】
復帰制御部１４（図１）は、停電や装置のメンテナンスなどによる電断後に制御装置１０が始動されて基準位置更新部１３による基準位置更新処理が完了した後に、図４に示した手順の復帰制御処理を実行する機能ブロックである。
【００２５】
すなわち、電断後の基準位置更新部１３による基準位置更新処理が完了したため、この復帰制御処理を開始した復帰制御部１４は、まず、基準位置記憶部１２から、主軸基準位
置及び従軸基準位置を読み出す（ステップＳ１０１）。次いで、復帰制御部１４は、主軸の現在位置をサーボシステム２０から取得し、取得した主軸の現在位置から主軸基準位置を減ずることで主軸現在位相を算出する（ステップＳ１０２）。
【００２６】
その後、復帰制御部１４は、算出した主軸現在位相と従軸の電子カムプロファイルとから、主軸が現在位置にある場合における従軸の変位量である対応従軸変位量を算出する（ステップＳ１０３）。電子カムプロファイルがテーブル形式の情報（図２Ｂ）である場合、このステップＳ１０２では、例えば、図５に模式的に示したように、電子カムプロファイル内の、主軸現在位相に最も近い２位相についての２変位量から、直線補間により、主軸現在位相に対応する変位量である対応従軸変位量を算出する処理が行われる。
【００２７】
ステップＳ１０３の処理を終えた復帰制御部１４は、操作画面を操作パネル１８の画面上に表示する（ステップＳ１０３）。
【００２８】
図６に、このステップＳ１０３の処理により操作パネル１８の画面上に表示される操作画面３０の説明図を示す。図示してあるように、操作画面３０は、“ＡＵＴＯ”ボタン３１、“ＭＰＧ”ボタン３２、“ＲＥＴＵＲＮ”ボタン３３、グラフ領域３４、パラメータ入力欄３５〜３８を備える。
【００２９】
グラフ領域３４は、主軸及び従軸の位置（白丸）と電子カムプロファイル（曲線）との関係を示すグラフが表示される領域である。“ＡＵＴＯ”ボタン３１は、従軸の位置制御時の速度等を指定しない場合に、ユーザが、操作（押下）すべきボタンである。“ＲＥＴＵＲＮ”ボタン３３は、従軸の位置制御時の速度等を指定したい場合に、ユーザが、パラメータ入力欄３５〜３８に所望値を設定してから操作すべきボタンである。“ＭＰＧ”ボタン３２は、手動で従軸の位置を制御したい場合にユーザが操作すべきボタンである。
【００３０】
このような操作画面３０を操作パネル１８の画面上に表示した復帰制御部１４は、ユーザによる指示入力を待機する（ステップＳ１０３）。
【００３１】
そして、復帰制御部１４は、“ＡＵＴＯ”ボタン３１又は“ＲＥＴＵＲＮ”ボタン３３がユーザにより操作された場合には、デフォルトの条件又はユーザにより指定された条件で従軸の位置を対応応従軸位置まで移動させるための制御を実行（ステップＳ１０４）してから、復帰制御処理を終了する。なお、ステップＳ１０４において、復帰制御部１４は、操作画面３０上のグラフ内の、主軸及び従軸の位置（白丸）を、当該制御の進行状態に応じて変更する処理も行う。
【００３２】
また、復帰制御部１４は、“ＭＰＧ”ボタン３２がユーザにより操作された場合には、ステップＳ１０４にて、操作画面３０の画面上に、手動で従軸の位置を制御する制御用画面を表示する。そして、復帰制御部１４は、当該制御用画面に対する操作に応じた制御を従軸に対して行ってから、復帰制御処理を終了する。
【００３３】
すなわち、停電や装置のメンテナンスなどによる電断が発生すると、各軸の基準位置が電断発生前の基準位置と異なってしまう場合がある。そのため、従来の制御装置では、電断後に従軸を主軸対応位置に手動で復帰させる必要があったのであるが、上記したように、本実施形態に係る制御装置１０は、電断からの復帰時に、各軸の基準位置を再算出する機能を有している。従って、制御装置１０によれば、電断後に、従軸を、主軸位置に対応した位置に何ら問題が発生しない形で自動復帰させることが出来る。
【００３４】
《変形例》
上記した制御装置１０は、各種の変形が可能なものである。例えば、基準位置更新部１
３は、電子カムプロファイルにより規定される１周期分の制御が行われる度に、基準位置更新処理を少なくとも１回行うものであれば良い。従って、基準位置更新部１３を、上記したタイミング（カム終点への到達時）とは異なるタイミングで基準位置更新処理を行うように構成しておいても良い。また、基準位置更新処理を、上記した（１）、（２）式とは異なる式により各軸の基準位置の算出を算出する処理としておいても良い。
【００３５】
操作画面３０（図５）上のグラフは、主軸の位置と従軸の位置とが独立して表示されるものであっても良い。また、操作画面３０から、“ＭＰＧ”ボタン３２、“ＲＥＴＵＲＮ”ボタン３３及びパラメータ入力欄３５〜３８を除去しておいても良い。さらに、制御装置１０を、ユーザの示入力を待つことなく、従軸を、主軸位置に対応した位置に移動させる装置に変形しても良い。
【００３６】
《付記》
主軸と従軸とを電子カムプロファイルに従って同期制御する制御装置（１０）であって、
電断からの復帰時に、前記主軸の位置を取得し、取得した位置とカム同期した時点での前記主軸の位置と前記電子カムプロファイルとに基づき、前記主軸の基準位置である主軸基準位置と、前記従軸の基準位置である従軸基準位置とを算出する基準位置算出手段（１３）と、
前記主軸の現在位置と、前記電子カムプロファイルと、前記基準位置算出手段により算出された前記主軸基準位置及び前記従軸基準位置とに基づき、前記主軸の現在位置に対応する前記従軸の位置を求めて、前記従軸の位置を求めた位置に移動させるための復帰制御を行う復帰制御手段（１４）と、
を備える制御装置。
【符号の説明】
【００３７】
１０  制御装置
１１  同期制御部
１２  基準位置記憶部
１３  基準位置更新部
１４  復帰制御部
１８  操作パネル
２０  サーボシステム
２１ａ、２１ｂ  サーボドライバ
２２ａ，２２ｂ  モータ
３０  操作画面
３１  “ＡＵＴＯ”ボタン
３２  “ＭＰＧ”ボタン
３３  “ＲＥＴＵＲＮ”ボタン
３４〜３８  パラメータ入力欄
【図１】
2020166612.tif 000003
【図２Ａ】
2020166612.tif 000004
【図２Ｂ】
2020166612.tif 000005
【図３】
2020166612.tif 000006
【図４】
2020166612.tif 000007
【図５】
2020166612.tif 000008
【図６】
2020166612.tif 000009