JP7590457B2 - ロボットを用いた３ｄプリンタ及びロボットの制御装置 - Google Patents

Description

本発明は、ロボットを用いた３Ｄプリンタ、及び該ロボットの制御装置に関する。

樹脂や金属等の材料を積層して立体物を造形（印刷）する積層造形装置（いわゆる３Ｄプリンタ）は、射出成形等に比べ、複雑な形状でも容易に造形することができる。典型的な３Ｄプリンタとしては門型の加工機が挙げられるが、産業用ロボットを用いた３Ｄプリンタも周知である（例えば特許文献１及び２を参照）。

一方、ロボットの減速機の内部機構において、剛性不足等により撓みや変形が生じ得るため、モータの回転軸の回転角度を検出する入力側エンコーダに加えて、減速機の出力軸の回転角度を検出する出力側エンコーダを備えるロボットが周知である（例えば特許文献３及び４を参照）。

特表２０１９－５３７５２１号公報 特開２０１９－０９８６８２号公報 特開２０１６－０２７９５１号公報 特開２０２０－１２１３５５号公報

門型の加工機を用いた３Ｄプリンタでは、樹脂等の積層方向が限られることから、造形物の強度や剛性が不十分となる場合があった。一方、ロボットを用いた３Ｄプリンタでは、積層方向を任意に変更できるため、造形物の強度や剛性を高めることができるが、減速機構のバックラッシや、ロボットアーム先端に設けたノズルから溶融した樹脂を吐出する際にロボットが受ける反力の影響等により、ロボットの動作軌跡の精度が悪化することがある。この精度悪化を防止する手段として、ロボットの各軸を駆動するモータに入力側エンコーダを設けるだけでは、減速機のバックラッシ等の影響を正しく測定又は推定できないため、動作軌跡を適切に補正することが困難となる。

本開示の一態様は、造形対象物の材料を吐出するノズルを備えた多関節ロボットを制御するロボット制御装置であって、前記ノズルが前記造形対象物に対して前記材料を塗布しながら移動するときに従うべきプリント予定経路を含む制御指令を格納する制御指令格納部と、前記制御指令に基づいて動作した前記多関節ロボットの関節の入力側及び出力側のそれぞれの角度情報に基づいて、前記ノズルの実際の動作軌跡であるプリント済み経路を求め、該プリント済み経路と前記プリント予定経路とのズレを推定するズレ推定部と、推定された前記ズレを低減又は排除すべく前記制御指令を補正する制御指令補正部と、を有する、ロボット制御装置である。

本開示の他の態様は、造形対象物の材料を塗布して積層するノズルを備えた多関節ロボットと、前記多関節ロボットを制御する上記一態様に係るロボット制御装置と、を備える３Ｄプリンタである。

本開示によれば、ロボットを用いた３Ｄプリンタにおいて、ロボットの入力軸側だけでなく出力軸側にも角度情報取得部を設け、塗布反力による影響をも考慮したロボット動作軌跡の補正をすることにより、造形対象物を極めて高精度に成形することができる。

一実施形態に係る３Ｄプリンタに使用されるロボット及び造形対象物の概略図である。 図１のロボットに取り付けられるノズルユニットの概略図である。 比較例に係る門型３Ｄプリンタ及び造形対象物の概略図である。 図１のロボットの要部を模式的に示す図である。 第１実施例に係るロボット制御装置の機能ブロック図である。 造形対象物に樹脂フィラメントを塗布した状態を示す概略図である。 比較例として、図６の状態にさらに樹脂フィラメントを塗布した状態を示す概略図である。 プリントの粗密の一例を示す図である。 プリントの粗密の他の例を示す図である。 プリントの粗密のさらなる他の例を示す図である。 第２実施例に係るロボット制御装置の機能ブロック図である。 第２実施例において、図６の状態にさらに樹脂フィラメントを塗布した状態を示す概略図である。 ロボットの軌跡を段階的に補正する処理の一例を説明する図である。 比較例として、凹凸を有する塗布表面に樹脂フィラメントを塗布した状態を示す概略図である。 図１のロボットの要部を模式的に示す図であって、力センサが追加された図である。 第３実施例に係るロボット制御装置の機能ブロック図である。 塗布方向と塗布反力との関係の一例を示すグラフである。 第３実施例において、凹凸を有する塗布表面に樹脂フィラメントを塗布した状態を示す概略図である。 第３実施例において、塗布表面に樹脂フィラメントを積層した状態を示す概略図である。 第４実施例に係るロボット制御装置の機能ブロック図である。 第４実施例において、塗布表面に樹脂フィラメントを積層した状態を示す概略図である。

図１は、好適な実施形態に係る３Ｄプリンタとして使用されるロボット１０、及び該３Ｄプリンタによって造形される造形対象物１２の概略図である。ロボット１０は、例えば６軸の産業用垂直多関節ロボットであり、床面等に設置されたベース１４と、ベース１４に対して略鉛直方向軸回りに回転可能に接続された旋回胴１６と、旋回胴１６に対して回転可能に接続された上腕１８と、上腕１８に対して回転可能に接続された前腕２０と、前腕２０に対して回転可能に接続された手首２２と、手首２２に対して回転可能に接続されたエンドエフェクタ２４とを有する。本実施形態では、エンドエフェクタ２４は、造形対象物１２を構成する材料である樹脂フィラメントを吐出して対象物１２に塗布するノズルユニットである。

図２は、ノズルユニット２４の概略構成を示す。ノズルユニット２４は、融解した糸状の樹脂材料であるフィラメント２６を造形対象物１２に塗布するノズル２７と、フィラメント２６を融解するヒータ（図示せず）と、フィラメント２６を送り出すローラ２８を備え、これらは周知のものと同様でよい。ヒータの温度及びローラ２８の回転量は、後述するロボット制御装置からの制御指令を少なくとも用いて制御することができる。またヒータの温度及びローラの回転量と、フィラメントの送り量との相関関係を表すデータは予め取得・記憶しておくことができ、このデータに基づいてフィラメントの送り量を制御することができる。

図３は、比較例に係る門型３Ｄプリンタ１１、及び門型３Ｄプリンタ１１によって造形される造形対象物１３の概略図であり、ここでは造形対象物１３の形状は造形対象物１２の形状と同一であるとする。図示のように、門型３Ｄプリンタ１１では、造形対象物１３の全体に亘って樹脂フィラメントの塗布方向が略水平方向に限定され、略鉛直方向にフィラメントが積層される。このように塗布方向及び積層方向が一様であると、特定の方向の力に対する造形物の強度が他の方向に比べ弱くなり、例えばその脚部１５のような応力が集中しやすい部位で破損しやすくなるという問題があった。

これに対し多関節ロボット１０を用いたロボット３Ｄプリンタでは、ノズル２７の位置及び姿勢はロボット１０の可動範囲内において任意に変更・決定可能であり、任意の軌跡を描くようにフィラメントを塗布することができる。一般に、フィラメントの塗布方向によって造形対象物の強度は変化するが、本実施形態では任意の軌跡を描くようにフィラメントを塗布できるため、造形対象物の強度を優先した３Ｄプリントが可能になる。例えば図１に示したように、造形対象物１２ではその部分ごとに樹脂の積層方向を変えることができ、全体として造形対象物１３よりも高強度の製品を造形・製造することができる。特に、樹脂フィラメントにファイバーを混入させることでフィラメントが異方性を有する場合は、その異方性が有効に作用するように軌跡を決めることができ、造形対象物をより高強度にすることができる。

このようにロボット１０を用いた３Ｄプリンタでは、高強度の造形物を成形できるが、一方で門型３Ｄプリンタと少なくとも同程度の精度で樹脂フィラメントを塗布できることも求められる。以下、これを実現するための具体的手段について説明する。

図４は、ロボット１０の各軸周りの要部を、ロボット１０を制御するロボット制御装置３０とともに模式的に示す。ロボット１０は、制御指令に基づいて動作したロボット１０の関節の入力軸及び出力軸のそれぞれの角度情報を取得する角度情報取得部を備え、具体的には、モータ３２によって駆動される入力軸３４の回転角度を検出する入力側エンコーダ３６と、減速機３８等を介して入力軸３４に連結された出力軸４０の回転角度を検出する出力側エンコーダ４２とを有する。図示例における出力側エンコーダ４２は、出力軸４０と一体的に回転する円板又はリング状のスケール部材４４と、スケール部材４４に設けられた角度検出用のパターンを光学式に読み取るセンサ４６とを有し、入力側エンコーダ３６についても同様の構成とすることができる。

１つの回転軸に入力側エンコーダ３６及び出力側エンコーダ４２の双方を設けることにより、減速機３８の内部機構のがたつきや、剛性不足に起因する撓み・変形が発生したとしても、入力側エンコーダ３６及び出力側エンコーダ４２により検出された回転角度の双方を用いることで、ロボット１０の各関節軸の位置決め精度及び軌跡精度を向上することができる。なおこのような入力側エンコーダ３６及び出力側エンコーダ４２の構成は、例えば特許文献４に記載のものと同様でよく、故に詳細な説明は省略する。なお出力軸４０の角度情報を取得する手段としては、出力側エンコーダ４２の他、ロボットアームにカメラ（図示せず）を設け、該カメラの画像を処理する画像処理装置（図示せず）を用いることもできる。

（第１実施例）
図５は、ロボット制御装置３０の第１実施例の機能ブロック図である。制御装置３０は、例えばＣＰＵ、ＲＡＭ等を有する演算部５０と、液晶ディスプレイ等の表示装置５２と、不揮発性ストレージ、ＲＯＭ等を有する記憶装置５４とを有し、演算部５０は記憶装置５４に含まれ得る。また制御装置３０には、操作者が持ち運び可能な可搬式操作盤５６が、有線又は無線で通信可能に接続され、操作盤５６への操作者の入力内容等は制御装置３０に送信・入力される。

制御装置３０は、多関節ロボット１０の各軸のモータ３２及びノズルユニット２４に接続され、ＣＰＵ等の制御部５７によりこれらを制御する。各軸に設けられている入力側エンコーダ３６及び出力側エンコーダ４２はそれぞれ、入力軸３４及び出力軸４０の角度情報を検出可能であり、検出した角度情報を制御装置３０に送信する。ノズルユニット２４はフィラメントの送り量を検出可能であり、検出した送り量を制御装置３０に送信可能であるとともに、制御装置３０から送り量に関する指令を受信可能である。

図２に示すように、ロボット１０を３Ｄプリンタとして使用する場合、ノズル２７が塗布面６０と近接した状態を維持しながら、粘性を有する融解したフィラメント２６を吐出・塗布するので、ノズル２７は塗布反力を受ける。より具体的には、ノズル２７には、ノズル２７の軸方向に沿う反力５８と、塗布対象１２の塗布面６０に沿う反力６２とが作用する。これらの反力と、ロボット１０の減速機等の機構部内部の摩擦やバックラッシの影響とにより、制御指令と実際のロボット軌跡にはズレが生じ得る。よって入力側エンコーダ３６のみを用いたフィードバックでは、例えば図６に示すフィラメント２６ａに対するフィラメント２６ｂのように、実際のロボット軌跡が制御指令からずれたことに起因する塗布ズレが生じる可能性が比較的高い。また入力側エンコーダ３６だけではフィラメント２６ｂのような塗布ズレが生じた後に適切なフィードバックを行うことが難しいので、図６の状態からさらにフィラメントを塗布しようとすると、ノズル２７がフィラメント２６ｂに接触する等、適切な塗布反力が得られず、その結果図７に例示するように、フィラメント２６ｃのように、フィラメントが変形したり塗布面６０から浮き上がったりしてしまい、いわゆる塗布不良につながる恐れがある。

そこで図５に示すように、演算部５０は、予め指定又は作成されたロボット１０の各軸のモータ３２への制御指令を格納する制御指令格納部６６と、入力側エンコーダ３６及び出力側エンコーダ４２の双方の検出結果を受信して、制御指令とロボット１０の実際の軌跡とのズレを推定するズレ推定部６８と、ズレ推定部６８の推定結果を用いて制御指令を補正する制御指令補正部７０とを有する。

このように構成されたロボット３Ｄプリンタの基本的な動作を説明する。制御装置３０の記憶装置５４には、造形対象物１２の３Ｄ形状データ、３Ｄ形状データに従って造形対象物を３Ｄプリンタで成形するのに必要なプリント経路生成アルゴリズム、プリント予定経路、プリント済み経路、経路補正アルゴリズム及びプリント補正予定経路が格納される。以下、各用語について説明する。

３Ｄ形状データは、３Ｄプリンタによって造形対象物が最終的に成形されるべき形状を表すデータであり、造形対象物（の各部）に要求される強度の情報、プリント方向（造形対象物に対するフィラメント吐出時のノズルの移動方向）、及びプリントの粗密等の情報も含む。粗密の具体例としては、図８－１０に示すように、略円柱形状の造形対象物１２の内部に、断面積の異なる中空部７２ａ－７２ｃのいずれかを形成し、対象物１２の実質的密度を所望の値にすることが挙げられる。図示例では中空部の断面形状はいずれも六角形であるが、これに限られるものではなく、任意の形状とすることができる。このようなプリントの粗密は従来の門型３Ｄプリンタでも実現可能であるが、ロボットを用いた場合はフィラメントを任意の方向に積層できるので、より複雑で好適な形状の中空部を形成することができる。

プリント予定経路は、ノズル２７が造形対象物１２に対して樹脂フィラメントを塗布しながら移動するときに従うべき経路であり、造形対象物１２の３Ｄ形状データを経路生成アルゴリズムに読み込ませることで生成され、ロボット１０は制御指令に含まれるプリント予定経路を元に動作を開始・実行する。経路生成アルゴリズムは、多関節ロボットの機構干渉解析アルゴリズムを含み、ロボットが動作可能な軌跡として経路生成する。但しプリント予定経路は、機械的な経路生成アルゴリズムに完全に依存するものでなくてもよく、例えば操作者の操作によって微調整されてもよい。なお本実施形態においては、プリント１回ごとに経路の補正を蓄積して高精度化を図っており、１回分のプリントをプリントジョブとも称する。

プリント済み経路は、入力側エンコーダ３６及び出力側エンコーダ４２の検出結果、フィラメント送り量、及び後述する力センサからのフィードバック等に基づいて再現された、ノズル２７の実際の動作軌跡であり、プリントジョブごとのプリント履歴とも言える。

プリント補正予定経路は、少なくとも上述の３Ｄ形状データ、実行済みのプリント予定経路及びこれに対応するプリント済み経路を用いて、造形対象物の最終的な形状を３Ｄ形状データが表す形状に一致させるべく、プリントの最中に、実行済みのプリント予定経路とこれに対応するプリント済み経路とを滑らかに接続し、残り（未実行）のプリント予定経路に立体的な変形を加えることで補正された経路である。プリント予定経路、プリント済み経路及びプリント補正予定経路は、表示装置５２や操作盤５６等を用いて、外部のユーザインターフェースから視覚的に理解し易い状態で確認可能とすることもできる。

経路補正アルゴリズムは、プリント補正予定経路を生成するためのアルゴリズムである。元々のプリント予定経路をどこまで忠実に再現するかの度合や、補正を反映するタイミング、更新するタイミングは別途指定可能とすることができる。

次に、第１実施例に係る図５の制御装置３０における処理の具体例を説明する。先ず、演算部５０の制御指令格納部６６には、上述のプリント予定経路に基づいた制御指令が格納されている。制御指令は、造形対象物１２のプリントを開始する際、ノズル２７が造形対象物１２のプリント予定経路に従って移動しつつ樹脂フィラメント２６を吐出するように、ロボット１０の各軸のモータ３２及びノズルユニット２４に送られる。ロボット１０は、送られた制御指令に従い、例えば図６に示すように、造形対象物１２に樹脂フィラメント２６ａを塗布していく。

ここで演算部５０では、入力側エンコーダ３６及び出力側エンコーダ４２の検出結果に基づいて、プリント済み経路が生成される。次にズレ推定部６８において、プリント予定経路とプリント済み経路との差に基づき、制御指定と実際のロボットの動作軌跡とのズレが計算・推定される。そして制御指令補正部７０において、推定されたズレを低減又は排除すべく制御指令が補正される。例えば図６の例では、直線状のフィラメントを１本塗布するごとに、又は１本のフィラメントを予め指定した長さで区切った各セグメントを塗布するごとに、プリント済み経路を作成し、プリント予定経路とのズレに基づいて制御指令を補正することで、フィラメント２６ｂが予定経路から大きく乖離していることを検出し、フィラメント２６ｂのズレを低減・排除するようにフィラメント２６ｂの塗布経路を補正することができる。従って、図７のフィラメント２６ｃのようにさらにズレが大きくなるような不具合が生じる可能性を大きく低減することができる。第１実施例におけるプリント済み経路としては、塗布すべきフィラメント又はセグメントの直近のフィラメント又はセグメントの情報があれば足りる。

第１実施例では、プリントを開始する前から出力側エンコーダ４２の情報を読み込み、読み込んだ情報を用いて制御指令に補正を加えることで、ロボット１０（のノズル２７）の動作軌道の高精度化を図っている。すなわち、出力側エンコーダ４２は、３Ｄプリンタ特有の現象である塗布反力の影響も含めたノズルの軌跡の誤差を正確に検出できるので、３Ｄプリンタに特有の課題を解決し、極めて高精度の３Ｄプリントが可能となる。例えば、図６のフィラメント２６ｂのような塗布ズレが発生する確率が大きく低減され、仮にフィラメント２６ｂのような塗布ズレが発生しても、図７のフィラメント２６ｃのようにさらに塗布ズレが拡大する確率が大きく低減される。

（第２実施例）
図１１は、ロボット制御装置３０の第２実施例の機能ブロック図である。なお第２実施例では、第１実施例と異なる点のみを説明し、第１実施例と同様でよい点については説明を省略する。

演算部５０は、制御指令格納部６６、ズレ推定部６８及び制御指令補正部７０に加え、ズレ補正の履歴を蓄積して、ノズル２７が従うべき軌跡を再計算する再計算部７４をさらに有し、制御指令補正部７０は、再計算された軌跡に基づいて、ズレの補正量を変更する。換言すれば、塗布の幅方向に塗布ズレが発生した後、実際の軌跡が漸近的に目標軌跡となるように１本以上のプリント補正予定経路が再計算部７４によって生成され、制御指令補正部７０においてプリント補正予定経路に基づいて制御指令が段階的に補正される。例えば、図６のフィラメント２６ｂのような塗布ズレが発生した後、フィラメント２６ｄで示すように塗布ズレを段階的に減らすような塗布が行われ、最終的にはフィラメント２６ｅのように目標軌跡に一致した塗布が行われる。第２実施例におけるプリント済み経路は、過去のプリント履歴を全て含むものであることが好ましい。

図１３は、図１２のような塗布を実現する処理の具体例を説明する。ここでは、フィラメントが塗布される経路を点群データで表しており、フィラメント２６ａでは、丸印７６で表すプリント予定経路と、三角印７８で表すプリント済み経路とが概ね一致している。しかし塗布反力のばらつき等の要因により、フィラメント２６ｂに示すように、プリント済み経路７８がプリント予定経路７６から乖離してしまったとする。

次に塗布されるフィラメント２６ｄでは、フィラメント２６ｂで生じたズレに相当する量だけ経路を補正するのではなく、四角印８０で表すプリント補正予定経路のように、上記ズレより少ない量の補正を複数回（図１２の例では４回）行い、最終的にフィラメント２６ｅのように、プリント予定経路７６にほぼ一致したプリント補正予定経路８０となるようにする。これにより、ズレを滑らかに補正して所望形状の造形対象物を得ることができる。このような点群同士の座標の擦り合わせとしては種々の手法が利用可能であるが、例えば、単純な周囲との平均を求める方法や、数値解析的な熱平衡モデルを用いる方法等が挙げられる。

第２実施例では、第１実施例と同様にプリント予定経路とプリント済み経路とのズレを検出・推定した後、経路補正アルゴリズムが実行され、３Ｄ形状データや推定したズレに基づいて、予め指定された補正強度にて上述のプリント補正予定経路が生成され、指定したタイミングで３Ｄプリントの経路（制御指令）が更新される。

ここで補正強度とは、プリント補正予定経路の生成において、軌跡のズレをどの程度の頻度で補正するか、何段階でプリント予定経路に漸近させるか、ズレの補正のために、補正対象軌跡からどれだけ離れた範囲までの他の軌跡の情報を利用するか等、操作者が予め設定・変更しておくものである。なおプリント補正予定経路の生成と、実際の３Ｄプリントは同時進行していてもよいが、上述の補正強度の設定において広範囲のズレを補正に反映するようにしている場合は、当該範囲のプリント済み経路が全て生成されるまでプリント補正予定経路の生成を待つこともある。

このように第２実施例では、塗布の幅方向（塗布面に平行な方向）でのフィラメント塗布に関し、プリント予定経路とプリント済み経路とのズレが段階的に低減されるプリント補正予定経路を生成して、該プリント補正予定経路、及び該プリント補正予定経路とプリント済み経路とのズレを用いて、漸近的に目標とする塗布状態となるように制御指令を補正するので、塗布ズレを滑らかに解消して、造形対象物の外観を所望のものとすることができる。

（第３実施例）
図１４は、比較例として、フィラメント塗布時に適正な反力が得られなかった場合の塗布状態の一例を示す。ここでは、造形対象物１２の塗布表面６１が、平坦ではなく凹凸を有している。図２に関して説明したように、フィラメント２６を塗布しているときのノズル２７には塗布反力５８及び６２が作用するが、塗布面６１が凹凸を有するような場合は特に、塗布反力が大きく変動することがある。塗布反力が想定値より大きいとフィラメント２６が潰れる等の不具合が生じ、逆に小さいとフィラメント２６が塗布面６１に馴染まず、図１４に示すように塗布面６１から剥離する等の不具合が生じる。また塗布面の凹凸以外にも、塗布面又は周囲の温度、湿度、ロボットの軌跡のブレ、ノズルの状態等によって、塗布反力は変動することがあり、この変動はプリント品質に悪影響をもたらす。

そこで図１５に示すように、第３実施例では、ノズル２７に作用する反力を測定する力センサ８２をノズルユニット２４内又はその近傍に設ける。力センサ８２の具体例としては、直交３方向の力と、回転３方向のトルクとを検出できる６軸力センサが挙げられる。このような力センサ８２の使用により、反力５８及び６２の合力の大きさ及び方向を検出することができ、当該合力を用いた簡単な計算によって、反力５８及び６２のそれぞれの大きさを求めることができる。但し塗布反力を推定する手段は６軸力センサに限られず、例えば、ノズルユニット２４の先端にスライダ及びバネを設け、該スライダの押し込み量及びバネ定数から力を求める方法や、静電容量式センサやレーザ変位計を用いて塗布面とノズルとの距離を求め、フィラメントの物性から力を求める方法なども挙げられる。またこれらの方法は、ノズルユニット内部の付属機能として実現することもできる。

図１６に示すように、ロボット制御装置３０の演算部５０は、制御指令格納部６６、ズレ推定部６８及び制御指令補正部７０に加え、樹脂フィラメント吐出時の力センサ８２の検出結果を用いて、塗布反力と強い相関があるフィラメントの塗布状態を推定する塗布状態推定部８４をさらに有し、制御指令補正部７０は、ズレ推定部６８の推定結果に加えて推定された塗布状態も用いて、制御指令を補正する。

具体的には、例えば図１７に示すような、塗布方向と理想的な塗布反力との関係を予め目標データとして制御装置３０の記憶装置５４等に記憶しておく。理想的反力は、フィラメントの潰れや剥離がない良好な塗布状態を得るためのものであり、フィラメントの材質及び線径、印刷速度、印刷品質並びに塗布方向等によって異なるが、これらの情報も予め記憶装置５４等に与えておくことができる。また塗布反力及びフィラメントの送り量と、フィラメント塗布時の変形の態様との関係も予めデータとして取得・記憶しておくことができる。

そして力センサ８２が検出した実際の塗布反力が、良好な塗布状態を実現できる予め定めた目標範囲内となるようにフィードバック制御を行うことができる。このように、力センサ８２をロボットアーム１８又は２０とノズルユニット２４との間に設け、塗布反力を制御装置３０にて取得可能とすることで、塗布反力の履歴を用いて、指定した目標塗布反力となるようにノズル２７を塗布面６１に押し付けることが可能になり、例えば図１８に示すような、塗布面６１の湾曲や凹凸等にフィットしたプリントが可能になる。

（第４実施例）
次に、ロボット制御装置３０の第４実施例を説明する。なお第４実施例は、第２実施例と第３実施例とを組み合わせたものに概ね相当するが、ここでは第２実施例及び第３実施例と異なる点のみを説明し、第２実施例又は第３実施例と同様でよい点については説明を省略する。

第３実施例では、塗布面６１に意図しない凹凸があってもそれにフィットしたフィラメント塗布を行うことができるが、そのような塗布を厚さ方向（塗布面６１に略垂直な方向）に反復した場合、図１９に示すように、最終的な造形対象物の外形も塗布面６１の凹凸を反映したものとなってしまうことがある。具体的には、塗布面６１の上に、塗布面６１の凹凸にフィットしたフィラメント２６ｆが塗布され、フィラメント２６ｆの上に、フィラメント２６ｆと同一形状のフィラメント２６ｇが積層されていく。

そこで図２０に示すように、ロボット制御装置３０の演算部５０は、制御指令格納部６６、ズレ推定部６８、制御指令補正部７０及び塗布状態推定部８４に加え、ズレ補正を蓄積して軌跡を再計算する再計算部７４をさらに有し、制御指令補正部７０は、第２実施例と同様に、再計算された軌跡に基づいて、ズレの補正量を変更する。換言すれば、塗布の厚さ方向に塗布ズレが発生した後、実際の軌跡が漸近的に目標軌跡となるように、制御指令が段階的に補正される。例えば、図１９のフィラメント２６ｆのように塗布面の凹凸にフィットするフィラメントが塗布された後、フィラメント２６ｈで示すように凹凸を段階的に減らすような塗布が行われ、最終的には図２１に示すように、フィラメント２６ｉのように目標軌跡に一致した塗布が行われる。

なお第４実施例では、図１３を用いて説明した第２実施例と同様に、プリント補正予定経路８０を、指定された制御指令に含まれるプリント予定経路７６に基づいて生成しているが、以前に生成したプリント済み経路に基づいて新たなプリント予定経路を生成することも可能である。例えば、塗布面６１上に意図しない大きな凹部があり、プリント済み経路と元のプリント予定経路との乖離が大きく、漸近的な補正では適切な塗布が困難となり得る場合、プリント済み経路と造形対象物との形状の差分に基づいて、先ず該凹部のみを埋めるような経路を含む新たなプリント予定経路を生成することできる。このような処理は、再計算部７４を含む第２実施例でも行うことができる。

上述の制御装置３０の各部の機能は、コンピュータプログラムによって提供することもできる。例えば、記憶装置５４は、演算部５０で実行される各処理で利用される各種のデータや、各処理の途中で生成される各種のデータを記憶する。演算部５０の各構成要素（制御指令補正部７０等）は、プロセッサで実行されるコンピュータプログラムにより実現される機能モジュールであり得る。またそのようなコンピュータプログラムは、半導体メモリ、磁気記録媒体または光記録媒体といった、コンピュータで読取可能な非一過性の記録媒体に記録された形で提供されてもよい。

１０ ロボット
１２ 造形対象物
２４ ノズルユニット
２６ フィラメント
２７ ノズル
３０ ロボット制御装置
３２ モータ
３６ 入力側エンコーダ
４２ 出力側エンコーダ
５０ 演算部
５２ 表示装置
５４ 記憶装置
５６ 操作盤
５７ 制御部
５８、６２ 塗布反力
６０、６１ 塗布面
６６ 制御指令格納部
６８ ズレ推定部
７０ 制御指令補正部
７４ 再計算部
８２ 力センサ
８４ 塗布状態推定部

Claims (8)

1. 造形対象物の材料を吐出するノズルを備えた多関節ロボットを制御するロボット制御装置であって、
   前記ノズルが前記造形対象物に対して前記材料を塗布しながら移動するときに従うべきプリント予定経路を含む制御指令を格納する制御指令格納部と、
   前記制御指令に基づいて動作した前記多関節ロボットの関節の入力側及び出力側のそれぞれの角度情報に基づいて、前記ノズルの実際の動作軌跡であるプリント済み経路を求め、該プリント済み経路と前記プリント予定経路とのズレを推定するズレ推定部と、
   推定された前記ズレを低減又は排除すべく前記制御指令を補正する制御指令補正部と、
   を有する、ロボット制御装置。
2. 前記プリント予定経路と前記プリント済み経路とのズレが段階的に低減され、塗布の幅方向について前記プリント予定経路に漸近するようにプリント補正予定経路を生成する再計算部をさらに有し、
   前記制御指令補正部は、前記再計算部が生成した前記プリント補正予定経路、及び該プリント補正予定経路と前記プリント済み経路とのズレに基づいて、前記制御指令を補正する、請求項１に記載のロボット制御装置。
3. 前記材料の吐出中に前記ノズルに作用する反力に基づいて前記造形対象物の塗布状態を推定する塗布状態推定部をさらに有し、
   前記制御指令補正部は、前記反力が、前記塗布状態に基づいて予め定めた目標範囲内になるように前記制御指令を補正する、請求項１又は２に記載のロボット制御装置。
4. 前記プリント予定経路と前記プリント済み経路とのズレが段階的に低減される複数のプリント補正予定経路を生成する再計算部をさらに有し、
   前記制御指令補正部は、前記プリント補正予定経路に基づいて、前記プリント済み経路が前記材料の塗布の厚さ方向について前記プリント予定経路に漸近するように前記制御指令を段階的に補正する、請求項３に記載のロボット制御装置。
5. 前記再計算部は、以前に生成したプリント済み経路及び前記造形対象物の形状に基づいて新たなプリント予定経路を生成する、請求項２又は４に記載のロボット制御装置。
6. 造形対象物の材料を塗布して積層するノズルを備えた多関節ロボットと、
   前記多関節ロボットを制御する請求項１～５のいずれか１項に記載のロボット制御装置と、を備える３Ｄプリンタ。
7. 前記多関節ロボットは、前記入力側の角度情報を取得する入力側エンコーダと、前記出力側の角度情報を取得する出力側エンコーダとを有する、請求項６に記載の３Ｄプリンタ。
8. 前記多関節ロボットは、前記ノズルに作用する反力を検出する力センサを有する、請求項６又は７に記載の３Ｄプリンタ。

Images