(57)【要約】  多軸モータ駆動装置（１）は、Ａ軸モータ（２Ａ）とＢ軸モータ（２Ｂ）を制御する装置であって、測定開始位置から測定終了位置までの位置指令（１２１）を生成する位置指令生成器（１２）と、位置指令の軌跡と垂直な方向の力指令（１１１）を生成する力指令生成器（１１）と、位置指令（１２１）と力指令（１１１）とＡ軸モータ位置（３１Ａ）とＢ軸モータ位置（３１Ｂ）とを入力としてＡ軸電流指令（１３１Ａ）とＢ軸電流指令（１３１Ｂ）を生成する電流指令生成部（１３）と、Ａ軸電流指令（１３１Ａ）とＢ軸電流指令（１３１Ｂ）に基づきＡ軸モータ（２Ａ）とＢ軸モータ（２Ｂ）を制御するモータ制御部（１４）と、測定開始位置から測定終了位置までのＡ軸モータ位置（３１Ａ）とＢ軸モータ位置（３１Ｂ）を記憶するモータ位置記憶部（１５）とを備える。
2020066302.tif 000002
【特許請求の範囲】
【請求項１】
複数軸のモータを制御する多軸モータ駆動装置であって、
測定開始位置から測定終了位置までの位置指令を生成する位置指令生成器と、
前記位置指令の軌跡と垂直な方向の力指令を生成する力指令生成器と、
前記位置指令と前記力指令と前記複数軸のモータの位置とを入力として前記複数軸のモータへの電流指令を生成する電流指令生成部と、
前記電流指令に基づき前記複数軸のモータを制御するモータ制御部と、
前記測定開始位置から前記測定終了位置までの前記複数軸のモータの位置を記憶するモータ位置記憶部とを備える
多軸モータ駆動装置。
【請求項２】
前記電流指令生成部は、
前記位置指令と前記力指令と前記複数軸のモータの位置とを入力として前記複数軸のモータの前記電流指令を生成するハイブリッド制御器を含む
請求項１記載の多軸モータ駆動装置。
【請求項３】
前記電流指令生成部は、
前記位置指令に基づき前記複数軸のモータに含まれる第１モータの位置制御を行う位置制御器と、
前記力指令に基づき、前記複数軸のモータに含まれる前記第１モータと異なる第２モータの力制御を行う力制御器とを含む
請求項１記載の多軸モータ駆動装置。
【請求項４】
前記多軸モータ駆動装置は、さらに、
前記複数軸のモータの位置から測定指標を生成する測定指標計算器を備える
請求項１〜３のいずれか１項に記載の多軸モータ駆動装置。
【請求項５】
前記測定指標は、象限突起量又は表面粗さを示す
請求項４記載の多軸モータ駆動装置。
【請求項６】
前記位置指令生成器は、前記位置指令と、外部からの加工用位置指令との一方を選択的に出力する位置指令切替器を備える
請求項１〜５のいずれか１項に記載の多軸モータ駆動装置。
【発明の詳細な説明】
【技術分野】
【０００１】
本開示は、複数軸のモータを駆動する多軸モータ駆動装置による形状測定機能に関する。
【背景技術】
【０００２】
高精度な加工を行うにあたって、測定は欠くべからざる技術である。しかし測定精度は加工精度より高くする必要があるため測定精度を向上させるためにはコストがかかる。また測定そのものは目に見えるものを作り出さないため測定の価値がわかりにくい。これらの理由で、測定精度の向上には投資が進みにくい傾向がある。これは特に発展途上の加工機メーカにおいて顕著である。例えば、加工装置の高剛性化及び高精度化には努力するが、加工結果の評価についてはいまだ目視という極端な例もある。これは、本当の加工精度を必要とする用途への参入がまだ少ないためもあるが、今後の歩留まり向上及び信頼性確保のため、測定への投資も増えていくものと思われる。【０００３】
これらの加工と測定を融合させる従来の技術として、加工精度測定器を追加した加工機がある（例えば、特許文献１参照）。【０００４】
前記従来の構成は、複数のサーボモータを有する加工機に、被加工物の表面に低接触力で接触する測定子と、前記測定子の位置を測定する位置検出器とを備える形状測定器を、追加で搭載しており、加工後にエアシリンダで被加工物を測定子で倣って形状測定するものであった。
【先行技術文献】
【特許文献】
【０００５】
【特許文献１】特開２００６−３３７１４８号公報
【発明の概要】
【発明が解決しようとする課題】
【０００６】
この従来の構成では、通常は別装置である形状測定器の一部を加工機に搭載しており、測定子及びエアシリンダの追加などが加工機のコストアップになる。また加工機のコントローラにも形状測定機能を追加する必要があり、コントローラ開発への負担が大きかった。【０００７】
本開示は、前記従来の課題を解決するために、加工機としての追加コストを抑えつつ、形状測定機能を実現することができる多軸モータ駆動装置を提供することを目的とする。
【課題を解決するための手段】
【０００８】
本開示の一態様に係る多軸モータ駆動装置は、複数軸のモータを制御する多軸モータ駆動装置であって、測定開始位置から測定終了位置までの位置指令を生成する位置指令生成器と、前記位置指令の軌跡と垂直な方向の力指令を生成する力指令生成器と、前記位置指令と前記力指令と前記複数軸のモータの位置とを入力として前記複数軸のモータへの電流指令を生成する電流指令生成部と、前記電流指令に基づき前記複数軸のモータを制御するモータ制御部と、前記測定開始位置から前記測定終了位置までの前記複数軸のモータの位置を記憶するモータ位置記憶部とを備える。
【発明の効果】
【０００９】
本開示は、加工機としての付加コストを抑えつつ形状測定機能を実現できる多軸モータ制御装置を提供できる。
【図面の簡単な説明】
【００１０】
【図１】図１は、実施の形態１に係る多軸モータ駆動装置の制御ブロック図である。
【図２】図２は、実施の形態２に係る多軸モータ駆動装置の制御ブロック図である。
【図３】図３は、実施の形態３に係る多軸モータ駆動装置の制御ブロック図である。
【図４】図４は、実施の形態４に係る多軸モータ駆動装置の制御ブロック図である。
【発明を実施するための形態】
【００１１】
本開示の一態様に係る多軸モータ駆動装置は、複数軸のモータを制御する多軸モータ駆動装置であって、測定開始位置から測定終了位置までの位置指令を生成する位置指令生成器と、前記位置指令の軌跡と垂直な方向の力指令を生成する力指令生成器と、前記位置指令と前記力指令と前記複数軸のモータの位置とを入力として前記複数軸のモータへの電流指令を生成する電流指令生成部と、前記電流指令に基づき前記複数軸のモータを制御するモータ制御部と、前記測定開始位置から前記測定終了位置までの前記複数軸のモータの位置を記憶するモータ位置記憶部とを備える。これにより、加工機としてのコストアップを低減しつつ、モータ位置記憶部から測定対象の形状情報を得ることが可能となる。よって、当該多軸モータ駆動装置は、加工機としての付加コストを抑えつつ形状測定機能を実現できる。
【００１２】
例えば、前記電流指令生成部は、前記位置指令と前記力指令と前記複数軸のモータの位置とを入力として前記複数軸のモータの前記電流指令を生成するハイブリッド制御器を含んでもよい。これにより、ハイブリッド制御器を用いることで測定精度を向上できる。
【００１３】
例えば、前記電流指令生成部は、前記位置指令に基づき前記複数軸のモータに含まれる第１モータの位置制御を行う位置制御器と、前記力指令に基づき、前記複数軸のモータに含まれる前記第１モータと異なる第２モータの力制御を行う力制御器とを含んでもよい。これにより、より簡単な制御構成で測定対象の形状測定が可能となる。
【００１４】
例えば、前記多軸モータ駆動装置は、さらに、前記複数軸のモータの位置から測定指標を生成する測定指標計算器を備えてもよい。例えば、前記測定指標は、象限突起量又は表面粗さを示してもよい。これにより、多軸モータ駆動装置の記憶容量を削減しつつ、外部とのインターフェースを簡素化し、外部での測定指標管理を容易にできる。
【００１５】
例えば、前記位置指令生成器は、前記位置指令と、外部からの加工用位置指令との一方を選択的に出力する位置指令切替器を備えてもよい。これにより、加工用の動作と形状測定用の動作を切り替えることができる。
【００１６】
以下、本開示の実施の形態について、図面を参照しながら説明する。なお、以下で説明する実施の形態は、いずれも本開示の一具体例を示すものである。以下の実施の形態で示される数値、形状、材料、構成要素、構成要素の配置位置及び接続形態、ステップ、ステップの順序などは、一例であり、本開示を限定する主旨ではない。また、以下の実施の形態における構成要素のうち、最上位概念を示す独立請求項に記載されていない構成要素については、任意の構成要素として説明される。
【００１７】
（実施の形態１）
図１は、本実施の形態に係る多軸モータ駆動装置１の制御ブロック図である。多軸モータ駆動装置１は、複数軸のモータを制御する。ここでは、多軸モータ駆動装置１は、Ａ軸モータ２ＡとＢ軸モータ２Ｂとの２つのモータを制御する。
【００１８】
Ａ軸モータ２ＡにはＡ軸位置検出器３Ａが接続されており、Ｂ軸モータ２ＢにはＢ軸位置検出器３Ｂが接続されている。Ａ軸位置検出器３Ａは、Ａ軸モータ２Ａのモータ位置であるＡ軸モータ位置３１Ａを検出し、検出したＡ軸モータ位置３１Ａを多軸モータ駆動装置１にフィードバックする。Ｂ軸位置検出器３Ｂは、Ｂ軸モータ２Ｂのモータ位置であるＢ軸モータ位置３１Ｂを検出し、検出したＢ軸モータ位置３１Ｂを多軸モータ駆動装置１にフィードバックする。
【００１９】
Ａ軸モータ２Ａは、Ｙ軸ボールねじ４１を駆動し、Ｂ軸モータ２ＢはＸ軸ボールねじ４２を駆動する。２軸のボールねじにより、測定ヘッド４３をＸＹ座標上の自由な位置に動かすことができる。
【００２０】
多軸モータ駆動装置１は、力指令生成器１１と、位置指令生成器１２と、電流指令生成部１３と、モータ制御部１４と、モータ位置記憶部１５とを備える。
【００２１】
この機構を用いて、測定対象５の形状測定する場合の動作について説明する。まず、位置指令生成器１２は、測定開始位置から測定終了位置までの位置指令１２１を生成する。具体的には、測定対象５の近傍を測定ヘッド４３が動作するように、測定対象５から測定ヘッド４３の半径分だけ外側を通るような位置指令軌跡６が実現される位置指令１２１が生成される。例えば、位置指令１２１はＸＹ座標上の連続した値で表現される。この位置指令軌跡６に従い測定ヘッド４３は測定対象５に沿った軌跡を描く。このとき、形状測定のためには確実に測定ヘッド４３を測定対象５に押し付ける必要がある。
【００２２】
この測定対象に加えられる加圧力７を制御するため、力指令生成器１１は、位置指令の軌跡と垂直な方向の力指令１１１を生成する。通常、力指令１１１の値は一定値でよいが、力指令１１１の値は測定対象又は測定ヘッドの剛性に応じて調整可能である。
【００２３】
電流指令生成部１３は、位置指令１２１と、力指令１１１と、複数軸のモータの位置であるＡ軸モータ位置３１Ａ及びＢ軸モータ位置３１Ｂとを入力として複数軸のモータへの電流指令であるＡ軸電流指令１３１ＡとＢ軸電流指令１３１Ｂとを生成する。この電流指令生成部１３は、ハイブリッド制御器１３ａを含む。
【００２４】
ハイブリッド制御器１３ａには、力指令１１１と位置指令１２１、及びＡ軸モータ位置３１ＡとＢ軸モータ位置３１Ｂとが入力される。ハイブリッド制御器１３ａは、これらの力指令１１１と位置指令１２１、及びＡ軸モータ位置３１ＡとＢ軸モータ位置３１Ｂを用いて、Ａ軸電流指令１３１ＡとＢ軸電流指令１３１Ｂを生成する。ある方向に対する位置制御と、残りの方向に対する力制御とを同時に行う制御は、一般に力と位置のハイブリッド制御と呼ばれ、バリ取りロボットの倣い動作などに用いられている。具体的には、ハイブリッド制御器１３ａは、Ａ軸モータ位置３１ＡとＢ軸モータ位置３１Ｂを位置指令１２１に追従するよう位置制御を行うための電流指令における位置指令軌跡６に平行な成分と、位置指令軌跡６に垂直な方向に力指令１１１を加えるための電流指令とを合成することで、Ａ軸電流指令１３１ＡとＢ軸電流指令１３１Ｂを生成する。これにより位置と力のハイブリッド制御が実現できる。
【００２５】
モータ制御部１４は、Ａ軸電流指令１３１ＡとＢ軸電流指令１３１Ｂに基づきＡ軸モータ２ＡとＢ軸モータ２Ｂを制御する。このモータ制御部１４は、Ａ軸電流制御器１４Ａと、Ｂ軸電流制御器１４Ｂとを含む。
【００２６】
Ａ軸電流制御器１４Ａは、Ａ軸電流指令１３１ＡにＡ軸モータ２Ａの電流が追従するようＡ軸モータ２Ａの電流を制御する。Ｂ軸電流制御器１４Ｂは、Ｂ軸電流指令１３１ＢにＢ軸モータ２Ｂの電流が追従するようＢ軸モータ２Ｂの電流を制御する。
【００２７】
モータ位置記憶部１５は、複数軸のモータ位置であるＡ軸モータ位置３１ＡとＢ軸モータ位置３１Ｂとを逐次記憶する。つまり、モータ位置記憶部１５は、測定開始位置から測定終了位置までの複数軸のモータの位置を記憶する。また、モータ位置記憶部１５は、記憶した複数軸のモータ位置を表示する、あるいは図示しない外部装置に転送する。
【００２８】
この構成により、加工機に搭載された多軸モータ駆動装置１をそのまま形状測定に使用することができる。これにより、加工機としての追加コストを抑えつつ、形状測定機能を実現することができる。また、測定ヘッド４３は加工時に加工ヘッドに差し替えられる。例えば、ツールチェンジャーを装備していれば、ヘッド交換を自動化することも可能である。
【００２９】
（実施の形態２）
図２は、本実施の形態に係る多軸モータ駆動装置１Ａの制御ブロック図である。図２に示す多軸モータ駆動装置１Ａは、図１に示す多軸モータ駆動装置１に対して、電流指令生成部１３Ａの構成が電流指令生成部１３と異なる。電流指令生成部１３Ａは、力制御器１３ｂと位置制御器１３ｃを備える。
【００３０】
力制御器１３ｂには、力指令１１１とＡ軸モータ位置３１Ａが入力される。力制御器１３ｂは、入力された力指令１１１とＡ軸モータ位置３１Ａを用いてＡ軸電流指令１３１Ａを生成する。位置制御器１３ｃには、位置指令１２１とＢ軸モータ位置３１Ｂが入力される。位置制御器１３ｃは、入力された位置指令１２１とＢ軸モータ位置３１Ｂを用いてＢ軸電流指令１３１Ｂを生成する。つまり、位置制御器１３ｃは、位置指令１２１に基づき複数軸のモータに含まれるＢ軸モータ２Ｂ（第１モータ）の位置制御を行う。力制御器１３ｂは、力指令１１１に基づき、複数軸のモータに含まれるＡ軸モータ２Ａ（第２モータ）の力制御を行う。このように、各軸の電流が独立に制御される。
【００３１】
この制御構成は、測定対象５の一部を測定する場合に適用できる。例えば図２の右下に示すようにＸ軸方向の直線部分の表面粗さを測定する場合である。この例では、位置制御を必要とする軸がＸ軸であり、力制御を必要とする軸がＹ軸である。つまり、位置制御を必要とする軸と力制御を必要とする軸とが完全に分離している。このような場合に、本実施の形態の制御構成を適用できる。ここで、実際に加工と測定を常に同じ姿勢で行う必要はなく、特定の部分の測定のみが必要なケースもあり、このようなケースに本実施の形態の構成を適用できる。
【００３２】
このように、本実施の形態の構成は、実施の形態１の構成に対して、形状測定の方向に制限が生じるものの、複雑な座標変換を伴うハイブリッド制御器１３ａを用いる場合よりシンプルな制御で位置制御と力制御を実現できる。これにより、多軸モータ駆動装置１Ａの開発コスト及び製品コストを下げることができる。
【００３３】
（実施の形態３）
図３は、本実施の形態に係る多軸モータ駆動装置１Ｂの制御ブロック図である。図３に示す多軸モータ駆動装置１Ｂは、図１に示す構成に加え、測定指標計算器１６を備える。測定指標計算器１６は、モータ位置記憶部１５に記憶されている測定対象５の形状を示す多数のデータを用いて測定指標を算出する。ここで、例えば、測定指標のデータ量は、モータ位置記憶部１５に記憶されている元のデータのデータ量の少ない。
【００３４】
具体的には、測定指標は、加工精度を示す情報であり、例えば、象限突起量である。この場合、測定指標計算器１６は、２軸のモータ位置が描くべき円軌跡に対する実際のモータ位置の半径方向のずれ量を計算し、特定角度範囲におけるずれ量の最大値及び最小値を算出することで象限突起量を算出する。
【００３５】
また、位置指令軌跡６が直線である場合には、測定指標は、加工面の表面粗さであってもよい。この場合は、測定指標計算器１６は、力制御方向のモータ位置の変動から断面曲線を生成し、断面曲線の低周波数成分であるうねり曲線又は高周波数成分の粗さ曲線から、最大山高さ、最大谷高さ、又は十点平均粗さなどのパラメータを測定指標として算出する。
【００３６】
なお、測定指標計算器１６は、測定対象に応じて、計算する測定指標の種別（象限突起量又は表面粗さ等）を切り替えてもよい。
【００３７】
このように、測定指標を生成することで、形状測定結果のデータの圧縮を実現できる。これにより、多軸モータ駆動装置１Ｂのリソースを削減できる。また、外部コントローラにデータを伝えるインターフェースを簡易な手段で実現できる。また、測定指標を用いることで、測定結果を判断する作業者は、判断を容易に行うことができる。
【００３８】
（実施の形態４）
図４は、本実施の形態に係る多軸モータ駆動装置１Ｃの制御ブロック図である。図４に示す多軸モータ駆動装置１Ｃは、図１に示すモータ駆動装置１に対して、位置指令生成器１２Ａの構成が位置指令生成器１２と異なる。位置指令生成器１２Ａは、内部位置指令生成器１２ａ、外部位置指令受信器１２ｂ、及び位置指令切替器１２ｃを備える。
【００３９】
内部位置指令生成器１２ａは、図１に示す位置指令生成器１２と同様の機能を有し、測定用の位置指令軌跡６が実現される内部位置指令を生成する。外部位置指令受信器１２ｂは、図示しない外部コントローラから、例えば加工時の位置指令軌跡を受信し、当該位置指令軌跡に対応する外部位置指令を生成する。位置指令切替器１２ｃはこれら内部位置指令と外部位置指令の一方を位置指令１２１として選択的に出力する。具体的には、位置指令切替器１２ｃは、測定時には内部位置指令を位置指令１２１として出力し、加工時には外部位置指令を位置指令１２１として出力する。なお加工時には、ハイブリッド制御器１３ａにおける力制御を無効としたうえで全ての軸の位置制御が行われてもよい。
【００４０】
この構成により、多軸モータ駆動装置１Ｃは、加工時には外部コントローラからの外部位置指令軌跡に従い位置制御を行い、測定時には内部位置指令軌跡に従い形状測定を行うことが可能となる。このように、単一の多軸モータ駆動装置１Ｃにより、加工と測定とを適切に行える。
【００４１】
以上のように、本開示に係る多軸モータ駆動装置は、加工に用いる多軸サーボシステムをそのまま形状測定用に用いることで、加工機としての付加コストを抑えつつ形状測定機能を実現することができる。
【００４２】
なお、上記実施の形態では、複数軸を２軸としているが、３軸以上でもこの形状測定機能を実現できる。そのため、本開示の手法は、加工機だけでなく産業用ロボットへの適用も可能と考える。
【００４３】
また、形状測定機能の精度として加工精度と同等の精度が得られると考えるが、さらに測定精度を求める場合には、定期的に基準となる校正用測定物を用いて形状測定を行い、その誤差分を校正値として用いて本測定を行う。これにより、さらに高精度な形状測定が可能となる。
【００４４】
当然、この形状測定結果を加工機のコントローラにフィードバックして、次回以降の加工での指令補正などに使用することも可能である。
【００４５】
以上、本実施の形態に係る多軸モータ駆動装置について説明したが、本開示は、この実施の形態に限定されるものではない。
【００４６】
例えば、本開示は、多軸モータ駆動装置により実行される制御方法等として実現されてもよい。
【００４７】
また、ブロック図における機能ブロックの分割は一例であり、複数の機能ブロックを一つの機能ブロックとして実現したり、一つの機能ブロックを複数に分割したり、一部の機能を他の機能ブロックに移してもよい。また、類似する機能を有する複数の機能ブロックの機能を単一のハードウェア又はソフトウェアが並列又は時分割に処理してもよい。
【００４８】
以上、一つまたは複数の態様に係る多軸モータ駆動装置について、実施の形態に基づいて説明したが、本開示は、この実施の形態に限定されるものではない。本開示の趣旨を逸脱しない限り、当業者が思いつく各種変形を本実施の形態に施したものや、異なる実施の形態における構成要素を組み合わせて構築される形態も、一つまたは複数の態様の範囲内に含まれてもよい。
【産業上の利用可能性】
【００４９】
本開示は、多軸モータ駆動装置等に適用できる。
【符号の説明】
【００５０】
１、１Ａ、１Ｂ、１Ｃ  多軸モータ駆動装置
１１  力指令生成器
１１１  力指令
１２  位置指令生成器
１２ａ  内部位置指令生成器
１２ｂ  外部位置指令受信器
１２ｃ  位置指令切替器
１２１  位置指令
１３、１３Ａ  電流指令生成部
１３ａ  ハイブリッド制御器
１３ｂ  力制御器
１３ｃ  位置制御器
１３１Ａ  Ａ軸電流指令
１３１Ｂ  Ｂ軸電流指令
１４  モータ制御部
１４Ａ  Ａ軸電流制御器
１４Ｂ  Ｂ軸電流制御器
１５  モータ位置記憶部
１６  測定指標計算器
２Ａ  Ａ軸モータ
２Ｂ  Ｂ軸モータ
３Ａ  Ａ軸位置検出器
３Ｂ  Ｂ軸位置検出器
３１Ａ  Ａ軸モータ位置
３１Ｂ  Ｂ軸モータ位置
４１  Ｙ軸ボールねじ
４２  Ｘ軸ボールねじ
４３  測定ヘッド
５  測定対象
６  位置指令軌跡
７  加圧力
【図１】
2020066302.tif 000003
【図２】
2020066302.tif 000004
【図３】
2020066302.tif 000005
【図４】
2020066302.tif 000006
【国際調査報告】
2020066302.tif 000007
2020066302.tif 000008
2020066302.tif 000009
2020066302.tif 000010