TW202222518A

TW202222518A - 使用了機器人的3d印表機及機器人的控制裝置

Info

Publication number: TW202222518A
Application number: TW110144216A
Authority: TW
Inventors: 近藤勇樹
Original assignee: 日商發那科股份有限公司
Priority date: 2020-12-02
Filing date: 2021-11-26
Publication date: 2022-06-16
Also published as: DE112021005044T5; CN116529086A; JPWO2022118760A1; WO2022118760A1; US20240009836A1

Abstract

提供一種可造形高強度且高精度的物品之使用了機器人的3D印表機及該機器人的控制裝置。作為3D印表機使用的機器人具有：輸入側編碼器，其取得根據控制指令而動作的機器人的關節的輸入軸的角度資訊；及輸出側編碼器，其取得輸出軸的角度資訊。控制裝置的運算部具有：控制指令儲存部，其儲存對於機器人各軸的馬達的控制指令；偏差推估部，其接收輸入側編碼器及輸出側編碼器雙方的檢測結果，推估控制指令與機器人實際的軌跡的偏差；及控制指令修正部，其利用偏差推估部的推估結果來修正控制指令。

Description

使用了機器人的3D印表機及機器人的控制裝置

發明領域

本發明是有關一種使用了機器人的3D印表機及該機器人的控制裝置。

發明背景

相較於射出成型等，積層樹脂或金屬等材料來造形(印刷)三維物體的積層造形裝置(所謂3D印表機)即使是複雜的形狀仍可容易造形。典型的3D印表機可舉出例如門型加工機，使用了產業用機器人的3D印表機亦是習知的3D印表機(參考例如專利文獻1及2)。

另，由於在機器人的減速機的內部機構，可能因剛性不足等而產生彎曲或變形，因此習知的機器人除了具備輸入側編碼器以外，還具備輸出側編碼器，前述輸入側編碼器檢測馬達的旋轉軸的旋轉角度，前述輸出側編碼器則檢測減速機的輸出軸的旋轉角度(參考例如專利文獻3及4)。先行技術文獻專利文獻

專利文獻1：日本特表2019-537521號公報專利文獻2：日本特開2019-098682號公報專利文獻3：日本特開2016-027951號公報專利文獻4：日本特開2020-121355號公報

發明概要發明欲解決之課題

使用了門型加工機的3D印表機由於樹脂等的積層方向受限，因此有時造形物的強度或剛性不足。另，使用了機器人的3D印表機由於可任意變更積層方向，因此可提高造形物的強度或剛性，但因減速機構的背隙，或從設置於機器手臂前端的噴嘴噴出熔融樹脂時，機器人所承受的反作用力的影響等，機器人動作軌跡的精度可能惡化。作為防止該精度惡化的手段，若僅於驅動機器人各軸的馬達設置輸入側編碼器，並無法正確測定或推估減速機的背隙等的影響，因而難以適當修正動作軌跡。用以解決課題之手段

本揭示的一態樣是一種機器人控制裝置，其控制多關節機器人，前述多關節機器人具備噴出造形對象物的材料的噴嘴；前述機器人控制裝置具有：控制指令儲存部，其儲存包含列印預定路徑的控制指令，前述列印預定路徑是前述噴嘴一面對於前述造形對象物塗布前述材料一面移動時所應按照的路徑；偏差推估部，其根據基於前述控制指令而動作的前述多關節機器人的關節的輸入側及輸出側各別的角度資訊，求出前述噴嘴實際的動作軌跡即列印完畢路徑，並推估該列印完畢路徑與前述列印預定路徑的偏差；及控制指令修正部，其修正前述控制指令，以減低或排除已推估的前述偏差。

本揭示的另一態樣是一種3D印表機，其具備：多關節機器人，前述多關節機器人具備塗布並積層造形對象物的材料的噴嘴；及上述一態樣的機器人控制裝置，其控制前述多關節機器人。發明效果

若依據本揭示，在使用了機器人的3D印表機，不僅於機器人的輸入軸側而且於輸出軸側亦設置角度資訊取得部，藉由考慮到塗布反作用力所造成的影響來修正機器人動作軌跡，可極為高精度地成型造形對象物。

用以實施發明之形態

圖1是作為較佳實施形態的3D印表機來使用的機器人10，及藉由該3D印表機所造形的造形對象物12的概略圖。機器人10是例如6軸產業用垂直多關節機器人，其具有：基座14，其設置於地板面等；迴旋體16，其連接為可圍繞相對於基座14大致呈鉛直方向的軸旋轉；上臂18，其連接為可相對於迴旋體16旋轉；前臂20，其連接為可相對於上臂18旋轉；腕部22，其連接為可相對於前臂20旋轉；及端接器24，其連接為可相對於腕部22旋轉。於本實施形態，端接器24為噴嘴單元，前述噴嘴單元噴出構成造形對象物12的材料即樹脂細絲，將其塗布於對象物12。

圖2表示噴嘴單元24的概略構成。噴嘴單元24具備：噴嘴27，其將熔解的絲狀樹脂材料即細絲26塗布於造形對象物12；加熱器(未圖示)，其熔解細絲26；及輥28，其送出細絲26；該等構成亦可與習知構成一樣。加熱器的溫度及輥28的旋轉量可至少利用來自後述的機器人控制裝置的控制指令來控制。又，可預先取得/記憶表示加熱器的溫度及輥的旋轉量、與細絲的送料量的相關關係的資料，並可根據該資料來控制細絲的送料量。

圖3是比較例的門型3D印表機11，及藉由門型3D印表機11所造形的造形對象物13的概略圖，於此，造形對象物13的形狀與造形對象物12的形狀相同。如圖示，於門型3D印表機11，遍及造形對象物13整體，樹脂細絲的塗布方向限定為大致水平方向，細絲積層於大致鉛直方向。如此，若塗布方向及積層方向一樣，則造形物對於特定方向的力的強度會比其他方向弱，而有在例如像其腳部15一樣應力容易集中的部位容易損壞的問題。

相對於此，在使用了多關節機器人10的機器人3D印表機，噴嘴27的位置及姿勢可於機器人10的可動範圍內任意變更/決定，能以描繪任意軌跡的方式塗布細絲。一般而言，造形對象物的強度會依細絲的塗布方向而變化，但於本實施形態，由於能以描繪任意軌跡的方式塗布細絲，因此可實現以造形對象物的強度為優先的3D列印。例如如圖1所示，於造形對象物12，可就其各部分改變樹脂的積層方向，可造形/製造整體而言比造形對象物13高強度的製品。特言之，將纖維摻雜於樹脂細絲以使細絲具有各向異性的情況下，可決定使該各向異性有效作用的軌跡，可使得造形對象物強度更高。

如此，於使用了機器人10的3D印表機，雖可成型高強度的造形物，但亦要求能與門型3D印表機至少以相同程度的精度來塗布樹脂細絲。以下說明用以實現該要求的具體手段。

圖4示意地表示機器人10的各軸周圍的主要部分，以及控制機器人10的機器人控制裝置30。機器人10具備角度資訊取得部，前述角度資訊取得部取得根據控制指令而動作的機器人10的關節的輸入軸及輸出軸各別的角度資訊，具體而言，前述角度資訊取得部具有：輸入側編碼器36，其檢測由馬達32所驅動的輸入軸34的旋轉角度；及輸出側編碼器42，其檢測經由減速機38等連結於輸入軸34的輸出軸40的旋轉角度。圖示例的輸出側編碼器42具有：圓板或環狀的標度構件44，其與輸出軸40一體地旋轉；及感測器46，其光學式地讀取設置於標度構件44的角度檢測用圖案；輸入側編碼器36亦可採用同樣的構成。

即使發生減速機38的內部機構晃動，或起因於剛性不足而發生撓曲/變形，藉由在1個旋轉軸設置輸入側編碼器36及輸出側編碼器42雙方，利用由輸入側編碼器36及輸出側編碼器42所檢測到的旋轉角度雙方，可提升機器人10的各關節軸的定位精度及軌跡精度。再者，此類輸入側編碼器36及輸出側編碼器42的構成亦可與例如專利文獻4所記載的構成一樣，因此省略詳細說明。再者，作為取得輸出軸40的角度資訊的手段，除了輸出側編碼器42以外，亦可於機器手臂設置照相機(未圖示)，並使用處理該照相機的圖像的圖像處理裝置(未圖示)。

(第1實施例) 圖5是機器人控制裝置30的第1實施例的功能方塊圖。控制裝置30具有：運算部50，其具有例如CPU、RAM等；液晶顯示器等顯示裝置52；及記憶裝置54，其具有非揮發性儲存器、ROM等；運算部50可包含於記憶裝置54。又，操作者可攜帶的可攜式操作盤56以有線或無線的方式可通訊地連接於控制裝置30，操作者對操作盤56的輸入內容等發送/輸入到控制裝置30。

控制裝置30連接於多關節機器人10的各軸的馬達32及噴嘴單元24，藉由CPU等控制部57來控制該等。設置於各軸的輸入側編碼器36及輸出側編碼器42分別可檢測輸入軸34及輸出軸40的角度資訊，並將檢測到的角度資訊發送到控制裝置30。噴嘴單元24可檢測細絲的送料量，檢測到的送料量可發送到控制裝置30，並且可從控制裝置30接收有關送料量的指令。

如圖2所示，將機器人10作為3D印表機使用時，由於一面維持噴嘴27與塗布面60靠近的狀態，一面噴出/塗布具有黏性的已熔解的細絲26，因此噴嘴27會承受塗布反作用力。更具體而言，沿著噴嘴27的軸向的反作用力58及沿著塗布對象12的塗布面60的反作用力62會作用於噴嘴27。由於該等反作用力、及機器人10的減速機等機構部內部的摩擦或背隙的影響，控制指令與實際的機器人軌跡可能產生偏差。故，於僅使用了輸入側編碼器36的回授中，例如圖6所示的相對於細絲26a的細絲26b，起因於實際的機器人軌跡偏離了控制指令而產生塗布偏差的可能性較高。又，由於僅以輸入側編碼器36，難以在產生如細絲26b的塗布偏差之後進行適當的回授，因此若在圖6的狀態下進一步塗布細絲，則噴嘴27會與細絲26b接觸等，無法獲得適當的塗布反作用力，其結果如圖7所例示，如同細絲26c，細絲會變形或從塗布面60浮起，唯恐導致所謂塗布不良。

因此，如圖5所示，運算部50具有：控制指令儲存部66，其儲存預先指定或建立的對於機器人10的各軸的馬達32的控制指令；偏差推估部68，其接收輸入側編碼器36及輸出側編碼器42雙方的檢測結果，推估控制指令與機器人10實際的軌跡的偏差；及控制指令修正部70，其利用偏差推估部68的推估結果來修正控制指令。

說明如此構成的機器人3D印表機的基本動作。於控制裝置30的記憶裝置54儲存有造形對象物12的3D形狀資料、按照3D形狀資料以3D印表機成型造形對象物所需的列印路徑生成演算法、列印預定路徑、列印完畢路徑、路徑修正演算法及列印修正預定路徑。以下說明各用語。

3D形狀資料是表示藉由3D印表機，最終應將造形對象物成型的形狀的資料，其包含對造形對象物(的各部分)所要求的強度的資訊、列印方向(對於造形對象物的細絲噴出時的噴嘴移動方向)及列印的疏密等資訊。作為疏密的具體例可舉出如圖8～10所示，於大致圓柱形狀的造形對象物12的內部，形成剖面積不同的中空部72a～72c中任一者，使對象物12的實質密度成為期望值。於圖示例中，中空部的剖面形狀均為六角形，但不限於此，可採用任意形狀。此種列印的疏密在以往的門型3D印表機亦可實現，但使用了機器人時，可於任意方向積層細絲，因而可形成形狀更複雜、更合適的中空部。

列印預定路徑是噴嘴27一面對於造形對象物12塗布樹脂細絲一面移動時所應按照的路徑，且是藉由使造形對象物12的3D形狀資料讀入於路徑生成演算法而生成，機器人10依據包含於控制指令的列印預定路徑開始/執行動作。路徑生成演算法包含多關節機器人的機構干擾分析演算法，並生成路徑以作為機器人可動作的軌跡。但列印預定路徑亦可不完全依賴機械性的路徑生成演算法，例如亦可藉由操作者的操作來微調。再者，於本實施形態，每列印1次就累積路徑的修正，以謀求高精度化，1次份的列印亦稱為列印工作。

列印完畢路徑是噴嘴27實際的動作軌跡，前述動作軌跡是根據輸入側編碼器36及輸出側編碼器42的檢測結果、細絲送料量及來自後述的力感測器的回授等而重現，前述列印完畢路徑亦可稱為各列印工作的列印履歷。

列印修正預定路徑是至少利用上述3D形狀資料、執行完畢的列印預定路徑及與此對應的列印完畢路徑，為使造形對象物的最終形狀與3D形狀資料所示的形狀一致，而藉由在列印當中，將執行完畢的列印預定路徑及與此對應的列印完畢路徑平滑連接，且對剩餘(未執行)的列印預定路徑施加立體的變形而修正的路徑。列印預定路徑、列印完畢路徑及列印修正預定路徑亦可做成：使用顯示裝置52或操作盤56等，能夠從外部的使用者介面，在視覺上容易理解的狀態下確認。

路徑修正演算法是用以生成列印修正預定路徑的演算法。可另行指定要將原本的列印預定路徑忠實重現到何種程度，或指定反映修正的時間點、更新的時間點。

接著說明第1實施例的圖5的控制裝置30中的處理的具體例。首先，於運算部50的控制指令儲存部66，儲存有根據上述列印預定路徑的控制指令。控制指令是於開始造形對象物12的列印時送到機器人10的各軸的馬達32及噴嘴單元24，以使噴嘴27按照造形對象物12的列印預定路徑移動，並且噴出樹脂細絲26。機器人10按照送來的控制指令，例如如圖6所示，於造形對象物12逐漸塗布樹脂細絲26a。

於此，在運算部50，根據輸入側編碼器36及輸出側編碼器42的檢測結果，生成列印完畢路徑。接著於偏差推估部68，根據列印預定路徑與列印完畢路徑的差，計算/推估控制指定與實際的機器人動作軌跡的偏差。然後，於控制指令修正部70，修正控制指令以減低或排除已推估的偏差。例如於圖6的例中，每塗布1條直線狀細絲，或每塗布以預先指定的長度區劃了1條細絲的各區段(segment)，就建立列印完畢路徑，根據其與列印預定路徑的偏差來修正控制指令，藉此檢測細絲26b從預定路徑大幅脫離的情況，並修正細絲26b的塗布路徑以減低/排除細絲26b的偏差。因此，可大幅減低發生像圖7的細絲26c一樣偏差進一步變大的缺陷的可能性。第1實施例的列印完畢路徑只要包括應塗布的細絲或區段中最近的細絲或區段的資訊即足夠。

於第1實施例，藉由從開始列印前讀入輸出側編碼器42的資訊，利用讀入的資訊對控制指令施加修正，來謀求機器人10(的噴嘴27)的動作軌道的高精度化。亦即，由於輸出側編碼器42可正確檢測包含3D印表機特有的現象的影響在內的，即包含塗布反作用力的影響在內的噴嘴軌跡的誤差，因此可解決3D印表機特有的問題，實現極高精度的3D列印。例如可大幅減低發生如圖6的細絲26b的塗布偏差的機率，即使發生如細絲26b的塗布偏差，仍可大幅減低像圖7的細絲26c一樣塗布偏差進一步擴大的機率。

(第2實施例) 圖11是機器人控制裝置30的第2實施例的功能方塊圖。再者，於第2實施例僅說明與第1實施例的相異點，與第1實施例同樣即可之點則省略說明。

運算部50除了具有控制指令儲存部66、偏差推估部68及控制指令修正部70以外，進一步具有重新計算部74，前述重新計算部74累積偏差修正的履歷來重新計算噴嘴27所應按照的軌跡，控制指令修正部70根據重新計算的軌跡來變更偏差的修正量。換言之，於塗布的寬度方向發生塗布偏差之後，由重新計算部74生成1條以上的列印修正預定路徑，並且於控制指令修正部70，根據列印修正預定路徑階段性地修正控制指令，以使實際的軌跡漸進地成為目標軌跡。例如發生如圖6的細絲26b的塗布偏差後，進行如細絲26d所示之階段性地減少塗布偏差的塗布，最終進行像細絲26e一樣與目標軌跡一致的塗布。第2實施例中的列印完畢路徑宜包含所有過去的列印履歷。

圖13說明實現如圖12的塗布的處理具體例。於此，以點雲資料表示塗布細絲的路徑，於細絲26a，以圓圈標記76所示的列印預定路徑與以三角形標記78所示的列印完畢路徑大概一致。然而，由於塗布反作用力的不均等要因，如細絲26b所示，列印完畢路徑78從列印預定路徑76脫離。

於接著塗布的細絲26d，並非以相當於發生在細絲26b的偏差的量來修正路徑，而是像四角形標記80所示的列印修正預定路徑一樣，進行複數次比上述偏差更少量的修正(於圖12的例中為4次)，最終如細絲26e，成為與列印預定路徑76幾乎一致的列印修正預定路徑80。藉此，可平滑地修正偏差，獲得期望之形狀的造形對象物。此類點雲彼此的座標的調整磨合可利用各種手法，可舉出例如單純求出與周圍的平均的方法，或利用數值分析的熱平衡模型的方法等。

於第2實施例，與第1實施例同樣地檢測/推估列印預定路徑與列印完畢路徑的偏差之後，執行路徑修正演算法，根據3D形狀資料或所推估的偏差，以預先指定的修正強度生成上述列印修正預定路徑，在指定的時間點更新3D列印的路徑(控制指令)。

於此，修正強度是指於列印修正預定路徑的生成中，由操作者預先設定/變更：以何種程度的頻率修正軌跡的偏差，於哪個階段使其逐漸接近列印預定路徑，為了修正偏差，要利用離修正對象軌跡多遠的範圍內的其他軌跡的資訊等。再者，列印修正預定路徑的生成與實際的3D列印雖可同時進行，但若於上述修正強度的設定中，欲使大範圍的偏差反映於修正時，有時會等到該範圍的列印完畢路徑全部生成為止，才進行列印修正預定路徑的生成。

如此於第2實施例，關於在塗布的寬度方向(平行於塗布面的方向)的細絲塗布，由於生成階段性地減低列印預定路徑與列印完畢路徑的偏差的列印修正預定路徑，並利用該列印修正預定路徑、及該列印修正預定路徑與列印完畢路徑的偏差來修正控制指令，以漸進地成為目標的塗布狀態，因此可平滑地消除塗布偏差，製成期望的造形對象物的外觀。

(第3實施例) 作為比較例，圖14表示細絲塗布時無法獲得適度的反作用力時的塗布狀態的一例。於此，造形對象物12的塗布表面61具有凹凸，並非平坦。如關於圖2所說明，塗布反作用力58及62會作用於塗布細絲26時的噴嘴27，當塗布面61具有凹凸時，塗布反作用力尤其可能大幅變動。若塗布反作用力大於設想值，會產生細絲26被壓扁等缺陷，反之若小於設想值，細絲26無法適應於塗布面61，而產生如圖14所示之從塗布面61剝離等缺陷。又，除了塗布面的凹凸以外，塗布反作用力會因塗布面或周圍的溫度、濕度、機器人的軌跡的偏差、噴嘴的狀態等而變動，該變動會對列印品質造成不良影響。

因此，如圖15所示，於第3實施例，於噴嘴單元24內或其附近設置力感測器82，前述力感測器82可測定作用於噴嘴27的反作用力。力感測器82的具體例可舉出6軸力感測器，前述6軸力感測器可檢測正交3方向的力及旋轉3方向的扭矩。藉由使用此類力感測器82，可檢測反作用力58及62的合力的大小及方向，藉由利用了該合力的簡單計算，可求出反作用力58及62各別的大小。但推估塗布反作用力的手段不限於6軸力感測器，可舉出例如於噴嘴單元24的前端設置滑件及彈簧，從該滑件的推入量及彈簧常數求出力的方法，或使用靜電電容式感測器或雷射位移計來求出塗布面與噴嘴的距離，從細絲的物性求出力的方法等。又，該等方法亦可作為噴嘴單元內部的附屬功能而實現。

如圖16所示，機器人控制裝置30的運算部50除了具有控制指令儲存部66、偏差推估部68及控制指令修正部70以外，進一步具有塗布狀態推估部84，前述塗布狀態推估部84利用樹脂細絲噴出時的力感測器82的檢測結果，推估與塗布反作用力具有強相關性的細絲的塗布狀態，控制指令修正部70除了利用偏差推估部68的推估結果以外，亦利用推估的塗布狀態來修正控制指令。

具體而言，例如於控制裝置30的記憶裝置54等，預先記憶如圖17所示之塗布方向與理想的塗布反作用力的關係來作為目標資料。理想的反作用力是用以獲得無細絲壓扁或剝離的良好塗布狀態的反作用力，其依細絲的材質及線徑、印刷速度、印刷品質以及塗布方向等而不同，但該等資訊亦可預先給予記憶裝置54等。又，亦可預先取得/記憶塗布反作用力及細絲的送料量、與細絲塗布時的變形態樣的關係來作為資料。

然後，可進行回授控制，以使力感測器82檢測到的實際的塗布反作用力，落在可實現良好塗布狀態的預先決定的目標範圍內。如此，於機器手臂18或20與噴嘴單元24之間設置力感測器82，可於控制裝置30取得塗布反作用力，藉此可利用塗布反作用力的履歷，以成為指定的目標塗布反作用力的方式，將噴嘴27往塗布面61推壓，可實現例如圖18所示的，與塗布面61的彎曲或凹凸等配合(fit)的列印。

(第4實施例) 接著說明機器人控制裝置30的第4實施例。再者，第4實施例大致相當於第2實施例與第3實施例的組合，但於此僅說明與第2實施例及第3實施例的相異點，與第2實施例及第3實施例同樣即可之點則省略說明。

於第3實施例，即使於塗布面61有非預期的凹凸，仍可進行與其配合的細絲塗布，但於厚度方向(大致與塗布面61呈垂直的方向)反覆進行該類塗布時，如圖19所示，最終的造形對象物的外型有時亦反映出塗布面61的凹凸。具體而言，是於塗布面61上，塗布與塗布面61的凹凸配合的細絲26f，於細絲26f上，逐漸積層與細絲26f同一形狀的細絲26g。

因此，如圖20所示，機器人控制裝置30的運算部50除了具有控制指令儲存部66、偏差推估部68、控制指令修正部70及塗布狀態推估部84以外，進一步具有重新計算部74，前述重新計算部74可累積偏差修正來重新計算軌跡，控制指令修正部70與第2實施例同樣地根據重新計算的軌跡，來變更偏差的修正量。換言之，於塗布的厚度方向發生塗布偏差之後，階段性地修正控制指令，以使實際的軌跡漸進地成為目標軌跡。例如塗布像圖19的細絲26f一樣配合於塗布面的凹凸的細絲之後，進行如細絲26h所示之階段性地減少凹凸的塗布，最終如圖21所示，進行像細絲26i一樣與目標軌跡一致的塗布。

再者，於第4實施例，與利用圖13所說明的第2實施例同樣，是根據包含於指定的控制指令的列印預定路徑76來生成列印修正預定路徑80，但亦可根據先前生成的列印完畢路徑來生成新的列印預定路徑。例如於塗布面61上出現非預期的大凹部，列印完畢路徑與原本的列印預定路徑大幅脫離，可能難以利用漸進的修正來進行適當的塗布時，可根據列印完畢路徑與造形對象物的形狀的差分，生成新的列印預定路徑，前述新的列印預定路徑包含僅先填補該凹部的路徑。在包含重新計算部74的第2實施例亦可進行該類處理。

上述控制裝置30的各部功能亦可藉由電腦程式來提供。例如記憶裝置54記憶由運算部50執行的各處理中所利用的各種資料，或於各處理中途生成的各種資料。運算部50的各構成要素(控制指令修正部70等)可為功能模組，前述功能模組藉由以處理器執行的電腦程式來實現。又，該類電腦程式亦可採用記錄於電腦可讀取的非暫時性記錄媒體，諸如半導體記憶體、磁性記錄媒體或光記錄媒體的形式來提供。

10:多關節機器人,機器人 11:門型3D印表機 12,13:造形對象物 14:基座 15:腳部 16:旋轉體 18:上臂 20:前臂 22:腕部 24:端接器,噴嘴單元 26,26a,26b,26c,26d,26e,26f,26g,26h,26i:細絲 27:噴嘴 28:輥 30:機器人控制裝置 32:馬達 34:輸入軸 36:輸入側編碼器 38:減速機 40:輸出軸 42:輸出側編碼器 44:標度構件 46:感測器 50:運算部 52:顯示裝置 54:記憶裝置 56:操作盤 57:控制部 58,62:塗布反作用力 60,61:塗布面,塗布表面 66:控制指令儲存部 68:偏差推估部 70:控制指令修正部 72a～72c:中空部 74:重新計算部 76:列印預定路徑 78:列印完畢路徑 80:列印修正預定路徑 82:力感測器 84:塗布狀態推估部

圖1是一實施形態的3D印表機所使用的機器人及造形對象物的概略圖。圖2是安裝於圖1的機器人的噴嘴單元的概略圖。圖3是比較例的門型3D印表機及造形對象物的概略圖。圖4是示意地表示圖1的機器人的主要部分的圖。圖5是第1實施例的機器人控制裝置的功能方塊圖。圖6是表示在造形對象物塗布了樹脂細絲(filament)的狀態的概略圖。圖7是作為比較例表示在圖6的狀態下進一步塗布了樹脂細絲的狀態的概略圖。圖8是表示列印的疏密的一例的圖。圖9是表示列印的疏密的其他例的圖。圖10是表示列印的疏密的進一步其他例的圖。圖11是第2實施例的機器人控制裝置的功能方塊圖。圖12是表示第2實施例中在圖6的狀態下進一步塗布了樹脂細絲的狀態的概略圖。圖13是說明階段性地修正機器人的軌跡的處理之一例的圖。圖14是作為比較例表示於具有凹凸的塗布表面塗布了樹脂細絲的狀態的概略圖。圖15是示意地表示圖1的機器人的主要部分且追加了力感測器的圖。圖16是第3實施例的機器人控制裝置的功能方塊圖。圖17是表示塗布方向與塗布反作用力的關係之一例的圖表。圖18是表示第3實施例中在具有凹凸的塗布表面塗布了樹脂細絲的狀態的概略圖。圖19是表示第3實施例中在塗布表面積層了樹脂細絲的狀態的概略圖。圖20是第4實施例的機器人控制裝置的功能方塊圖。圖21是表示第4實施例中在塗布表面積層了樹脂細絲的狀態的概略圖。

24:噴嘴單元

30:控制裝置

32:馬達

36:輸入側編碼器

42:輸出側編碼器

50:運算部

52:顯示裝置

54:記憶裝置

56:操作盤

57:控制部

66:控制指令儲存部

68:偏差推估部

70:控制指令修正部

Claims

一種機器人控制裝置，其控制多關節機器人，前述多關節機器人具備噴出造形對象物的材料的噴嘴，前述機器人控制裝置具有：控制指令儲存部，其儲存包含列印預定路徑的控制指令，前述列印預定路徑是前述噴嘴一面對於前述造形對象物塗布前述材料一面移動時所應按照的路徑；偏差推估部，其根據基於前述控制指令而動作的前述多關節機器人的關節的輸入側及輸出側各別的角度資訊，求出前述噴嘴實際的動作軌跡即列印完畢路徑，並推估該列印完畢路徑與前述列印預定路徑的偏差；及控制指令修正部，其修正前述控制指令，以減低或排除已推估的前述偏差。
如請求項1之機器人控制裝置，其進一步具有重新計算部，前述重新計算部生成列印修正預定路徑，以使前述列印預定路徑與前述列印完畢路徑的偏差階段性地減低，就塗布的寬度方向上逐漸接近前述列印預定路徑，前述控制指令修正部根據前述重新計算部所生成的前述列印修正預定路徑、及該列印修正預定路徑與前述列印完畢路徑的偏差，來修正前述控制指令。
如請求項1或2之機器人控制裝置，其進一步具有塗布狀態推估部，前述塗布狀態推估部根據在前述材料的噴出中作用於前述噴嘴的反作用力，推估前述造形對象物的塗布狀態，前述控制指令修正部修正前述控制指令，以使前述反作用力在根據前述塗布狀態所預先決定的目標範圍內。
如請求項3之機器人控制裝置，其進一步具有重新計算部，前述重新計算部生成使前述列印預定路徑與前述列印完畢路徑的偏差階段性地減低的複數個列印修正預定路徑，前述控制指令修正部根據前述列印修正預定路徑，階段性地修正前述控制指令，以使前述列印完畢路徑就前述材料的塗布的厚度方向上逐漸接近前述列印預定路徑。
如請求項2或4之機器人控制裝置，其中前述重新計算部根據先前生成的列印完畢路徑及前述造形對象物的形狀，生成新的列印預定路徑。
一種3D印表機，具備：多關節機器人，其具備塗布並積層造形對象物的材料的噴嘴；及如請求項1至5中任一項之機器人控制裝置，其控制前述多關節機器人。
如請求項6之3D印表機，其中前述多關節機器人具有：輸入側編碼器，其取得前述輸入側的角度資訊；及輸出側編碼器，其取得前述輸出側的角度資訊。
如請求項6或7之3D印表機，其中前述多關節機器人具有力感測器，前述力感測器檢測作用於前述噴嘴的反作用力。