TW201006636A - Parallel mechanism - Google Patents

Description

201006636 .六、發明說明： 本申請案基於35 U.S.C. 119的規定主張其優先權， 並於曰本提出發明專利的申請，其申請曰爲2008年6月 10日申請案號JP2008-151484及申請日20 09年2月18日 申請案號JP2009-035544，本申請案係完全根據以下說明 的內容。 【發明所屬之技術領域】 本發明是關於平行連桿機構，尤其是關於具有迴轉軸 的平行連桿機構。 【先前技術】 自以往，所熟知的有藉著複數連桿排列結合安裝有支 撐基盤的底座部和終端效應器（前端效應器）的托架的平行 連桿機構。平行連桿機構中，例如排列配置有電動馬達等 的致動器，並且最後構成連結在各電動馬達複數連桿（手 臂）可操控一個終端效應器。 具有以上構成的平行連桿機構和串列連桿機構等的關 節機構比較，不須在每個關節設置電動馬達等，也不須使 設置在關節的電動馬達等擺動可製作輕量的關節機構。並 且，平行連桿機構中，由於所有的電動馬達等的力集中在 一處可輸出大的力。此外，平行連桿機構因採用三角錐構 造其剛性非常高。如上述，由於平行連桿機構具有輕量、 高輸出、高剛性的特徵，可以非常高速移動終端效應器。 -5- 201006636 因此，平行連桿機構，例如是使用於追求以高速執行朝著 夾持搬運對象物前進，將該搬運對象物以終端效應器把持 之後，在把持著該搬運對象物的狀態下搬運到預定位置爲 止的動作等用途。 但是，使平行連桿機構以高速往返運動時，會有終端 效應器震動，夾持搬運對象物時，或者在預定位置放開時 ，終端效應器的位置精度不良的問題。因而有不須增加往 返運動所需的時間，提高終端效應器到達目標位置時終端 效應器的位置精度等的期待（即，減少搬運對象物夾持時 或放開時的位置偏移的期待）。 本發明是爲瞭解決上述問題所硏創而成，提供一種不 致增加到達目標位置爲止所需的時間，可提高到達目標位 置時終端效應器的位置精度的平行連桿機構爲目的。 並且，某先前技術的平行連桿機構，具有：可轉動支 撐於載台（托架）上的把持器（終端效應器），及和固定在底 座部的伺服馬達連結的嵌套式的連桿機構（迴轉軸）。該連 桿機構的兩端是藉萬向接頭（萬向聯軸節）所連接，構成隨 著終端效應器的移動連桿機構即使傾斜，仍可將電動馬達 的轉動驅動力傳達至終端效應器使得該終端效應器轉動。 具有以上構成的平行連桿機構，例如可適當使用於追 求以高速重複執行朝著夾持袋包裝食品或太陽能電池等搬 運對象物（工件）前進，將該搬運對象物以終端效應器把持 搬運到預定位置爲止的動作之堆棧（palletizing)作業等的 用途。在此，堆棧作業，例如有要求將方向不一定的狀態 -6 - 201006636 流動而來的矩形工件，使其方向一致放入格子狀收納盒的 動作的場合。以上的場合，在搬運把持後的工件的途中轉 動迴轉軸、終端效應器，使工件的方向（轉動角度位置）配 合收納盒的格子載放於收納盒內。 在此，如上述，構成平行連桿機構的迴轉軸，是由： 萬向接頭（萬向聯軸節）；構成可彼此滑動但不能轉動的嵌 套式的軸；及串聯連接萬向接頭的各機械元件所構成。轉 Φ 動驅動迴轉軸時，該迴轉軸藉著電動馬達的轉動力產生各 機械元件的慣性力矩與震顫爲起因的扭轉。如上述迴轉軸 串聯連接有各機械元件，因此在安裝於迴轉軸前端的終端 效應器尤其會形成大的扭轉量，並且會產生轉動力從電動 馬達傳達至終端效應器爲止的時間延遲。爲此，電動馬達 的轉動停止後，終端效應器會產生從目標轉動角度的過度 動作及震動。尤其是對於震顫爲起因的扭轉震動，幾乎不 會有衰減，而耗費至收斂爲止的時間。並且，馬達轉數即 • 使一定，萬向聯軸節的特性，由於在接頭間的從動軸會產 生角速度、角加速度及扭矩變動，因此接頭間從動軸的慣 性力矩大的場合，也會影響到終端效應器的震動。由於該 等的原因，終端效應器在把持或載放工件時（到達目標位 置時），會有實際的轉動角度從目標轉動角度位置偏離之 虞。 又，本發明是爲瞭解決上述問題所硏創而成，提供一 種可使終端效應器持續移動至目標位置爲止，朝著目標轉 動角度位置爲止轉動時，不致增加轉動時間，可提升終端 201006636 效應器到達目標位置時之該終端效應器的轉動角動位置精 度的平行連桿機構。 【發明內容】 本發明人，針對上述問題反覆專心檢討的結果，獲得 以下的知識。亦即，平行連桿機構以高速移動至目標位置 的場合，進行急加速•急停止（急減速）時，將加振力作用 於平行連桿機構，使平行連桿機構產生橫向擺動。其橫向 擺動在前端部被擴大，使終端效應器震動。並且，終端效 應器到達目標位置時，即抓取或放開搬運對象物時震動不 會收斂時，會引起終端效應器的位置偏移，使位置精度惡 化。 因此，本發明的一實施態樣中，藉複數手臂排列連結 安裝在底座部的複數個致動器，及安裝著終端效應器的托 架的平行連桿機構中，具備控制致動器的控制裝置，控制 裝置控制致動器使得停止狀態的終端效應器移動到目標位 置爲止時，終端效應器加速時的加速度大於減速時的減速 度。 根據本實施形態，終端效應器移動到目標位置爲止時 ，藉著更減小減速時的減速度以緩慢減速，降低減速時作 用的震動力，因此可降低到達目標位置時終端效應器的震 動。另一方面，更增大加速時的加速度可抑制終端效應器 到達目標位置爲止所需時間的增大。其結果，不會增大到 達目標位置爲止所需的時間，可提高到達目標位置時終端 -8- 201006636 效應器的位置精度。 本發明的一實施樣態是以上述控制裝置控制致動器， 使得停止狀態的終端效應器移動到目標位置爲止時’終端 效應器加速的時間比減速的時間短爲佳。 根據上述，可以增長減速時間，在終端效應器減速的 期間可充分降低其震動。另一方面，由於加速時間的縮短 ，可抑制到達目標位置爲止所需總時間的增大。其結果’ 不會增大到達目標位置爲止所需的時間，可更爲提高到達 目標位置時終端效應器的位置精度。 本發明的一實施樣態中，另外是以上述控制裝置預先 記億決定從驅動開始的經過時間和終端效應器的目標速度 關係的速度控制模式，根據終端效應器的現在位置、目標 位置及速度控制模式’控制致動器爲佳。 根據上述，藉著終端效應器的現在位置和目標位置的 取得，根據上述速度控制模式可決定終端效應器的目標移 動位置，即致動器的目標驅動量。 本發明的一實施樣態中，上述速度控制模式比較終端 效應器加速的時間和減速的時間相同的場合，設定停止狀 態的終端效應器到達目標位置爲止的時間不變爲佳。 根據上述，使停止狀態的終端效應器移動到目標位置 爲止時，和加速時間與減速時間相同的場合比較，可確實 防止所需時間的增大。 本發明的一實施樣態是使用電動馬達作爲上述致動器 -9- 201006636 以上說明本發明的一實施樣態構成爲控制致動器，使 停止狀態的終端效應器移動到目標位置爲止時，終端效應 器加速時的加速度大於減速時的減速度，因此不會增大到 達目標爲止所需的時間，可提高到達目標爲止時終端效應 器的位置精度。 另外，本發明的其他實施樣態是提供經由複數連桿， 排列連結有底座部及安裝可使終端效應器轉動的托架的平 行連桿機構。該平行連桿機構，具備：安裝在底座部的馬 達；一端連接在馬達的輸出軸，另一端連接在終端效應器 ’將馬達的轉動驅動力傳達至終端效應器的迴轉軸；及控 制馬達的控制裝置。該控制裝置控制馬達，使得馬達的角 速度爲零位於停止狀態的迴轉軸轉動到目標轉動角度位置 爲止時’馬達的角速度從零到形成最大角速度爲止所需的 轉動加速時間比馬達的角速度從最大角速度形成零爲止所 需的轉動減速時間短。 根據本發明的其他實施樣態，可獲得更長的馬達（即 迴轉軸）的轉動減速時間，因此可降低迴轉軸的扭轉及震 動。另一方面，縮短加速時間，因此可抑制迴轉軸轉動到 目標轉動角度位置爲止所需時間的增大。其結果，可持續 抑制馬達轉動時間的增大，更爲提高終端效應器到達目標 位置時該終端效應器的轉動角度位置精度。 本發明的其他實施態樣，另外，控制裝置以控制馬達 使得停止狀態的迴轉軸轉動到目標轉動角度位置爲止時， 上述馬達的角速度增大時的角加速度及上述馬達的角速度 -10- 201006636 減少時的角加速度爲定角加速度，並且加速時的角加速度 的絕對値大於減速時的角加速度的絕對値爲佳。 此時，迴轉軸轉動到目標轉動角度位置爲止時，使得 轉動減速時的角加速度更小而緩慢減速，減速時降低作用 的加震力，因此可降低迴轉軸的扭轉及震動。另一方面， 使轉動加速時的加速度更大以抑制迴轉軸轉動到目標轉動 角度位置爲止所需時間的增大。其結果，不致增大轉動時 Φ 間，即可提高終端效應器到達目標位置時該終端效應器的 轉動角度位置精度。 本發明的其他實施樣態中，上述控制裝置是以終端效 應器從停止狀態移動到預先所決定之預定的上升距離以上 上方時開始馬達的轉動爲佳。 如上述，例如，轉動終端效應器時，可以防止工件和 搬入或搬出工件的收納盒緣部及其他輸送帶周邊的障礙物 接觸。並且，持續防止工件的接觸等，可以更早的時間開 Φ 始工件的轉動，因此可更長時間確保轉動停止後轉動方向 的扭轉及震動之收斂用的時間。 本發明的其他實施樣態是以上述控制裝置控制馬達下 降到預先所決定的預定下降距離之前停止馬達的轉動爲佳 。並且，上述控制裝置是以控制馬達使得從馬達的轉動停 止後到終端效應器停止在目標位置爲止的時間比終端效應 器下降到預定的下降距離停止在目標位置爲止的時間還長 爲佳。 如上述，可防止工件接觸收納盒等，並且可確保馬達 -11 - 201006636 停止後終端效應器轉動方向的扭轉及震動之收斂所需的時 間。 本發明的其他實施樣態是以更具備根據使用者的操作 對控制裝置設定馬達的控制數據的設定裝置，該設定裝置 是根據使用者的操作，設定馬達的轉動加速時間、轉動減 速時間及馬達的最大角速度，控制裝置是根據設定裝置所 設定的轉動加速時間、轉動減速時間及最大角速度來控制 馬達爲佳。 如上述，可適當控制馬達。並且，例如可柔性因應工 件、終端效應器及對所運用的作業線等的變更。 本發明的其他實施樣態中，控制裝置是以控制馬達使 迴轉軸的轉動角度形成180°以下爲佳。 例如，必須順時鐘方向轉動180°以上的場合，只要使 其逆時鐘方向轉動在180°以下即可定位在相同的轉動角度 位置。因此，如此一來，可降低轉動所需的時間，增大轉 動方向的扭轉及震動的收斂時間。並可防止連接在終端效 應器的致動器或配線等形成過大的扭轉。 本發明的其他實施樣態是以控制裝置控制馬達使馬達 的轉動停止後，終端效應器停止在目標位置爲止的時間形 成預定時間以上爲佳。 如上述，在馬達的轉動停止後，可確實地確保終端效 應器轉動方向的扭轉及震動之收斂所需的時間。 根據以上說明的本發明其他實施形態，在使終端效應 器持續移動到三維空間的目標位置爲止而轉動到目標轉動 -12- 201006636 角度位置爲止時’不致增大轉動時間即可提高終端效應器 到達目標位置爲止時該終端效應器的轉動角度位置精度。 根據以下圖示’詳細說明本發明的具體實施例，得以 使本發明的其他要點、元件、過程、特徵及功效更爲顯著 【實施方式】 φ 以下’參閱圖示針對本發明的較佳實施形態詳細說明 。此外’各圖中，同一元件賦予相同符號省略重複的說明 〇 首先，合倂使用第1圖及第2圖，說明實施形態所涉 及平行連桿機構的整體構成。第1圖是表示實施形態所涉 及平行連桿機構1的整體構成的透視圖。並且，第2圖是 表示從第1圖中箭頭A1方向顯示的平行連桿機構1的圖 〇 φ 平行連桿機構1上部具有底座部2。平行連桿機構1 是將形成在底座部2下面側的平坦安裝面2a例如固定在 水平的天井等所支撐。另一方面，底座部2的下面側設置 3個支撐構件3。各支撐構件3分別支撐有電動馬達4。 電動馬達4被支撐使其馬達軸的軸線C2對於底座部2的 安裝面2a成平行（即水平）。各個支撐構件3是以底座部2 的鉛直方向軸線C 1爲中心打開相等角度（1 2 0度）所配置 ’各電動馬達4也同樣是以底座部2的鉛直方向軸線C1 爲中心打開相等角度（120度）配置（參閱第2圖）。 -13- 201006636 各電動馬達4的輸出軸上，相對於軸線C2同軸固定 有大致六角柱形的手臂支撐構件5。手臂支撐構件5藉著 電動馬達4的驅動以軸線C2爲中心轉動。並且，各電動 馬達4被連接在含馬達驅動器的電子控制裝置3〇上，電 動馬達4的輸出軸的轉動是藉著該電子控制裝置3〇所控 制。 平行連桿機構1具有3支的手臂主體6，各手臂主體 6是包括第1手臂7及第2手臂8所構成。第1手臂7例 如是以碳纖維等所形成的長型中空圓筒構件。第1手臂7 的基端部被安裝在手臂支撐構件5的側面。固定第1手臂 7使其軸線與上述軸線C2正交。 第1手臂7的遊動端部連結著第2手臂8的基端部， 第2手臂8構成可以第1手臂7的遊動端部爲中心擺動。 第2手臂8是包含一對長型的桿9、9所構成，配置使一 對的桿9、9在其長方向形成彼此平行。桿9同樣是例如 碳纖維等所形成的長型中空圓筒構件。各桿9的基端部藉 著一對球窩接頭10、10連結在第1手臂7的遊動端部。 再者，連結各桿9基端部的各球窩接頭1〇、1〇間個軸線 C3是相對於電動馬達4的軸線形成平行，因此第2手臂8 是以軸線C3爲中心擺動。 並且，在第2手臂8的基端部以連結構件11彼此連 結一方的桿9和另一方的桿9，在第2手臂8的遊動端部 以連結構件12彼此連結一方的桿9和另一方的桿9°連 結構件1 1及連結構件1 2例如具有作爲彈推構件的拉伸螺 -14- 201006636 旋彈簧，朝著使一對桿9、9彼此拉扯的方向彈推。再者 ，連結構件11和連結構件12也可以是不同的構造但是相 同的構造時從低成本的觀點來看較爲理想。任意的連桿 11、12都具有防止各桿9在本身長方向平行的軸線周圍 轉動的功能。 並且，平行連桿機構1具有可迴轉安裝終端效應器 13用的托架14。托架14是形成大致正三角形的板狀構件 φ 。該托架14是藉著3支的手臂主體6，將托架14的終端 效應器13的安裝面14a(第1圖中托架14的下面）保持形 成和底座部2的安裝面2a平行（即水平）。 托架14的各邊形成有安裝片15。各安裝片15分別 被連結在手臂主體6的遊動端部（構成第2手臂8的一對 桿9、9的遊動端部），使托架14對於各手臂主體6，以 各手臂主體6的遊動端部爲中心擺動。更詳細而言，托架 14的各安裝片15的各端部是藉著各球窩接頭16、16被 φ 連結在對應的各桿9、9的遊動端部。再者，連結一對球 窩接頭16、16的軸C4(參閱第2圖）也是相對於電動馬達 4的軸線C2成平行。因此，托架14可以水平的軸線C4 爲中心相對於各手臂主體6擺動。並且，在大致正三角形 的托架14所有的邊上，藉著3支的手臂主體6支撐托架 1 4使其以水平的軸線C4爲中心擺動。 設定使第1手臂7與第2手臂8的連結部的一對球窩 接頭10、10間的距離和第2手臂8的各桿9與托架14的 連結部的一對球窩接頭16、16間的距離相等。因此如上 -15- 201006636 述，構成第2手臂的一對桿9是在其長方向的全長彼此平 行配置。軸線C2、C3、C4皆平行於底座部2的安裝面2a ’因此第1手臂7、第2手臂8及托架14即使以各軸線 C2、C3、C4爲中心任意擺動，仍然可維持著托架14的終 端效應器13的安裝面14a和底座部2的安裝面2a的平行 關係。 並且，對應來自電子控制裝置30的指令，控制固定 在各電動馬達4的輸出軸的手臂支撐構件5的轉動位置， 可控制各第1手臂7遊動端部的位置。在該控制的各第1 手臂7遊動端部的位置上，追隨著各第2手臂8遊動端部 的位置’其結果’可決定托架14的終端效應器13的安裝 面14a的位置。此時，如上述，托架14維持著水平姿勢 的狀態移動。 又’平行連桿機構1’具有：在其中央從底座部2向 下方延伸的迴轉軸20，及使得該迴轉軸桿20轉動用的電 動馬達21。電動馬達21使其輸出軸朝著鉛直下方的狀態 固定在底座部2。迴轉軸桿20的一端部經萬向聯軸節（以 下稱「萬向節」）22及複數個齒輪的組合所構成的減速機 24連結在電動馬達21的輸出軸。再者，本實施形態是以 減速機24的減速爲5。另一方面，迴轉軸桿20的另一端 部是經由萬向節23連接在終端效應器13。另外，終端效 應器13及萬向節23的下方連接部是經軸承等自由轉動地 固定在托架14使其中心軸形成鉛直方向。迴轉軸20是藉 著桿20a和汽缸2Ob來實現，構成可自由伸縮。在此，迴 201006636 轉軸桿20爲球形花鍵，可將桿2 0a的轉動傳達至汽缸 2 0b。並且，迴轉軸桿20的兩端部是採用萬向節22、23 ’因此托架14即使藉著3個電動馬達4的驅動在上下、 前後左右的預定位置移動時，迴轉軸桿20仍可追隨著其 預定位置移動。再者，以下包含迴轉軸桿20及萬向節22 、23的構成稱爲迴轉軸25。 亦即，在電動馬達21和終端效應器13之間，串聯連 接有減速機24、萬向節22、迴轉軸桿20(桿20a、汽缸 2〇b)及萬向節23的機械元件，電動馬達21的轉動驅動力 是經由串聯連接的該等機械元件，傳達至終端效應器13' 。電動馬達21被連接在電子控制裝置30上，電動馬達 2 1的轉動爲該電子控制裝置3 0所控制，可藉此控制終端 效應器13的轉動角度位置。並且，本實施形態是如後述 設定太陽能電池晶圓作爲工件，因此終端效應器1 3使空 氣從小孔急速地噴出藉著所生成的負壓產生吸附力，使用 以接近非接觸的方式可以把持工件的所謂伯努力夾頭。並 且，工件不需要以非接觸把持之例如袋包裝食品的場合， 終端效應器13也可以使用藉吸入空氣所產生的負壓來吸 附工件的吸附墊。 如上述，電子控制裝置30藉著3個電動馬達4的控 制驅動手臂主體6，使終端效應器1 3移動到目標位置爲 止。並且，電子控制裝置30是藉控制電動馬達21驅動迴 轉軸桿20，使終端效應器13轉動到目標轉動角度位置爲 止。亦即，電子控制裝置30具有申請專利範圍記載之控 -17- 201006636 制裝置的功能。電子控制裝置3 0例如可適當使用可程式 邏輯控制器（PLC)，或者專用的控制用電腦等。電子控制 裝置30，是由：進行運算的微處理器；將執行各處理用 的程式等記億在微處理器的ROM ;及暫時記憶運算結果 等的各種數據的RAM等所構成。 另外，電子控制裝置30連接有作爲承接操作員進行 操作輸入之設定裝置的輸入裝置31。再者，輸入裝置31 ，例如可適當使用觸控面板顯示器，或者液晶顯示器和鍵 盤等。操作員可使用輸入裝置31設定電動馬達4、21的 控制數據。在此，所設定的電動馬達21的控制數據，可 舉例有決定搬運把持著工件時電動馬達21的最高轉動速 度（最大角速度）的搬運轉動速度（deg/sec);決定接取工件 時電動馬達21的最高轉動速度（最大角速度）的返回轉動 速度（deg/sec);決定增大電動馬達21的轉動速度（角速度 )的時間的轉動加速時間（msec);及決定減少電動馬達21 的轉動速度（角速度）的時間的轉動減速時間（msec)等。電 子控制裝置3 0利用所設定的控制數據執行記憶在ROM的 程式，藉此驅動電動馬達4及電動馬達21，控制終端效 應器13的三維空間的位置（X、y、z)及轉動角度（0 )。 接著，使用第3圖及第4圖說明平行連桿機構1的本 發明第1實施形態的動作。在此，終端效應器1 3是以前 進把持搬運對象物時的動作爲例來說明。並且，在把持該 搬運對象物之後，把持著該搬運對象物的狀態下搬運到預 定位置時的動作除了和以下說明動作的動作方向相反之外 -18- 201006636 其他皆相同或同樣，因此在此省略其說明。第3圖是表示 終端效應器13的移動軌跡（x(y)，z平面上）的圖，第4圖 是表示終端效應器13的水平方向（x，y平面上）的速度控制 模式的一例圖。再者，第3圖、第4圖中，實線是表示第 一實施形態涉及的平行連桿機構1的終端效應器13的移 動軌跡及速度控制模式，虛線是表示習知的平行連桿機構 (加速時間=減速時間）的終端效應器的移動軌跡及速度控 ❶ 制模式。 第3圖中，A點爲初期停止位置（現在位置），F點爲 搬運對象物的位置（即，前進把持搬運對象務實的目標位 置）。停止在A點的終端效應器13前進到F點爲止把持搬 運對象物的場合，首先，從A點到B點爲止，將終端效 應器13朝著鉛直上方舉起。再者，該區間是朝鉛直上方 (z方向）移動，因此第3圖表示的水平方向（X，y方向）的 速度控制模式的速度形成爲〇。接著，從B點到C1點爲 φ 止，終端效應器13被朝著水平方向一邊加速一邊向上方 且水平方向移動。接著，從C1點到C2點爲止，終端效 應器13 —邊保持著一定的水平方向的速度一邊向上方且 水平方向移動。另外，從D1點到D2點爲止，使終端效 應器13 —邊減速一邊朝著水平方向移動。在此，在C2點 ~D2點移動的期間，朝z方向的移動是形成爲〇。並且， ‘ ··從D2點到E點（目標位置的鉛直上方的位置）爲止，終端 效應器13 —邊在水平方向減速一邊朝著水平方向並向下 方移動。之後，從E點到F點爲止，終端效應器13被下 -19- 201006636 降到鉛直下方。再者，該區間也是向下方（Z方向）的移動 ，因此第3圖表示的水平方向（x,y方向）的速度控制模式 的速度是形成爲〇。如上述終端效應器13從A點移動到 F點爲止的場合，電子控制裝置30根據預先所記憶的決 定從驅動開始的經過時間和終端效應器1 3的目標速度關 係的速度控制模式，控制電動馬達4。以下，針對水平方 向的移動更具體加以說明。 首先，電子控制裝置30讀入終端效應器13的現在位 置（A點）及目標位置（F點）。在此，終端效應器13的現在 位置可以從各電動馬達4的驅動位置求得。並且，目標位 置是對例如以安裝在預定位置（座標）的攝影機所攝影的攝 影影像施以影像處理，辨識搬運對象物可藉此取得。接著 ，電子控制裝置30從現在位置和目標位置求得目標位置 爲止的距離，並且在所獲得的距離運用速度控制模式，設

定加速時間tl、定速時間t2、減速時間t3及最高速度V 〇 在此，速度控制模式是如第4圖的實線表示，包含加 速區域、定速區域及加速區域，設定使終端效應器13加 速時的加速度大於減速時的減速度。並且，速度控制模式 是設定使終端效應器1 3加速的時間11比減速的時間13 短。另外，速度控制模式是設定使得從A點到達F點（目 標位置）爲止所需的時間與終端效應器13加速的時間（tl，） 和減速的時間t3’）相同時（參閱第4圖中的虛線）形成相同 。再者，例如終端效應器13以120循環/分鐘往返運動的 201006636 場合，A點-F點間的所需時間（單程）爲0.25秒。 設定加速時間tl、定速時間t2、減速時間t3及最高 速度V之後’電子控制裝置30根據設定各時間速度控制 模式，在各控制週期求得終端效應器13的目標移動位置 。接著，對應所獲得的目標移動位置求得3個電動馬達4 的各個目標驅動位置。並且，在各控制週期，驅動各電動 馬達4供給驅動電流至各電動馬達使得目標驅動位置和現 φ 在位置一致。並且，驅動電動馬達4，藉此驅動各手臂主 體6 ’讓終端效應器1 3從A點移動到F點（目標位置）爲 止。 在此，第5圖是表示終端效應器13從A點移動到F 點爲止時終端效應器13的目標位置附近的移動軌跡。第 5圖是表示終端效應器13的目標軌跡和實際的移動軌跡 的圖。第5圖中，一點虛線爲終端效應器13的目標軌跡（ 目標移動軌跡）。實線爲第一實施形態所涉及平行連桿機 φ 構1的終端效應器13的移動軌跡。並且，點線是表示加 速時間tl ’和減速時間t3’相同時終端效應器的移動軌跡。 如第5圖表示，根據第一的實施形態，停止狀態的終 端效應器13移動到目標位置（F點）爲止時，使得減速時的 減速度更小以緩慢減速，藉此降低減速時作用的加震力， 因此可降低到達目標位置時終端效應器13的震動。另一 方面，使加速時的加速度更大以抑制終端效應器13到達 目標位置爲止所需時間的增大。其結果，不會增大到達目 標位置爲止所需的時間，可提高到達目標位置時終端效應 -21 - 201006636 器1 3的位置精度。 並且，根據第一實施形態，停止狀態的終端效應器 13移動到目標位置（F點）爲止時，控制電動馬達4使得終 端效應器1 3加速的時間比減速的時間t3短。爲此，由於 可採取較長的減速時間t3，因此在終端效應器13減速的 期間可充分地降低其震動。另一方面，由於縮短加速時間 11，因可抑制到達目標；f立置爲止所需總計時間的增大。其 結果，不會增大到達目標位置爲止所需的時間，可更提高 到達目標位置時終端效應器13的位置精度。 根據第一實施形態，依據終端效應器1 3的現在位置 、目標位置及速度控制模式，控制電動馬達4。因此，藉 著檢測終端效應器13的現在位置和目標位置，可根據速 度控制模式決定終端效應器13的目標移動位置，即電動 馬達4的指令電流値。 並且，根據第一實施形態，停止狀態的終端效應器 1 3到達目標位置爲止的時間和終端效應器1 3加速的時間 與減速的時間相同的場合比較，設定速度控制模式不會變 化。爲此，停止狀態的終端效應器13移動到目標位置爲 止時，和加速時間與減速時間相同的場合比較，可確實防 止所需時間的增大。 以上，針對本發明第一實施形態已作說明，但是本發 明不限於上述實施形態可作種種的變形。例如，速度控制 模式只要設定加速度 > 減速度，且加速時間 < 減速時間即 可’並且設定最高速度不增大整體的所需時間即可，其形 -22- 201006636 狀不限於第4圖表示的形狀。在此，速度控制模式的其他 例是如第6圖表示。如第6圖所示，速度控制模式也可以 不具加速區域和定速區域之間的反彎點，及定速區域和減 速區域的反彎點，形成可順利連接各區域間的形狀。另外 ，也可以加速區域中及/或減速區域中的直線部分爲0，形 成以S字彎曲連接的形狀。 第一的實施形態中，針對水平方向的移動已作說明， φ 但是針對鉛直方向的移動也同樣可運用本發明。亦即，也 可設定使終端效應器13朝著上方上升時的加速度大於朝 向下方下降時的減速度，加速時間較減速時間短。並且， 上述實施形態中，終端效應器13雖是在鉛直方向和水平 方向移動，但是也可以只在水平方向移動的構成。 接著，使用第7圖〜第9圖，針對平行連桿機構1的 第二實施形態的動作加以說明。在此，以太陽能電池用晶 圓或太陽能電池板的堆棧步驟中，終端效應器13把持太 φ 陽電池晶圓之後，持續配合著該太陽能電池晶圓的轉動角 度位置，搬運到預定位置（收納盒）爲止的場合爲例進行說 明。再者，前進把持太陽能電池晶圓時的動作，除了和以 下說明的動作的動作方向相反之外，其他皆相同或同樣， 在此省略其說明。並且第7圖是說明太陽能電池的堆棧步 驟的槪要用的鳥瞰圖。第8圖是表示從水平方向看時的終 端效應器13的運轉模式的圖。第9圖是表示終端效應器 13水平方向的移動距離爲4 0 0mm時電動馬達4、21的水 平方向（x，y)方向、垂直（z)方向及轉動（Θ )方向的速度控制 -23- 201006636 模式的一例圖。 首先，持續參閱第7圖，針對太陽能電池晶圓堆棧步 驟的槪要加以說明。該步驟中，彼此平型配置有第1輸送 帶100及第2輸送帶101，並且在該等2條輸送帶的上方 設置有平行連桿機構1。第1輸送帶100及第2輸送帶 1 〇 1分別從圖示右側朝向左側以預定的速度移動。第1輸 送帶100載放太陽能電池晶圓（以下也稱「工件」）130移 動。在此，太陽能電池晶圓130是例如縱156x橫向156x 厚度0.2 mm的矩形薄板。另一方面，第2輸送帶101載 放著放入有太陽能電池晶圓130的收納盒131。在此，收 納盒1 3 1例如將其內側間隔成3 x6的隔子狀，藉著平行連 桿機構1，將第1輸送帶100上的太陽能電池晶圓130移 載到收納盒131的各格子內。 平行連桿機構1驅動手臂主體6使得終端效應器13 移動，前進把持太陽能電池晶圓130，重複執行以終端效 應器1 3把持該太陽能電池晶圓1 3 0後搬運到收納盒1 3 1 爲止的動作。並且，平行連桿機構1將方向不一定的狀態 流動而來的矩形太陽能電池晶圓130的方向，在把持該太 陽能電池晶圓130搬運時轉動終端效應器130的方向配合 收納盒131的格子，放入到收納盒131的格子內。 更詳細說明時，第1輸送帶1 00安裝有檢測第1輸送 帶100移動量的第1編碼器110。第1編碼器110對電子 控制裝置30輸出所檢測之第i輸送帶100的移動量。另 一方面，第2輸送帶1〇1安裝有檢測第2輸送帶101移動 -24- 201006636 量的第2編碼器111。第2編碼器111對電子控制裝置30 輸出所檢測之第2輸送帶101的移動量。又，第1輸送帶 100的上方，例如安裝有CCD攝影機等的攝影裝置120。 攝影裝置120攝影傳送過來的太陽能電池晶圓130,求得 太陽能電池晶圓130的重心位置和方向（角度）0 1，輸出 至電子控制裝置30。此外，第2輸送帶101安裝有檢測 收納盒1 3 1前端部的光學感測器1 2 1。光學感測器1 2 1將 φ 檢測訊號輸出至電子控制裝置3 0。 電子控制裝置30是根據太陽能電池晶圓130的重心 位置和第1輸送帶100的移動量來運算太陽能電池晶圓 130的位置。並且，電子控制裝置30是根據收納盒131 前端部的檢測訊號和第2輸送帶101的移動量運算收納盒 131的位置。電子控制裝置30是根據所求得的太陽能電 池晶圓130的位置和收納盒131的位置，使各電動馬達4 轉動來驅動手臂主體6將太陽能電池晶圓130搬運到收納 φ 盒131。並且，在搬運太陽能電池晶圓130時，電子控制 裝置30根據所求得之太陽能電池130的方向0，轉動電 動馬達21來轉動迴轉軸（即終端效應器13)，使太陽能電 池晶圓130的方向配合收納盒131的格子。重複執行以上 的動作’藉以使得在第1輸送帶100上傳送的太陽能電池 晶圓130 —起被放入於在第2輸送帶1〇1上傳送的收納盒 1 3 1 內。 接著，說明電動馬達4、21的控制方法，即終端效應 器1 3的三維空間位置（X，y，z)及轉動角度位置（0 )的控 -25- 201006636 制方法。第8圖中，A點爲初期停止位置（工件把持位置） ，F點是相當於收納盒131的目的格子的位置（即，搬運 把持工件130時的目標位置）。再A點暫時停止，將把持 工件130後的終端效應器13搬運工件130到F點爲止的 場合，首先，從A點到B點爲止，終端效應器13不改變 水平位置地被朝鉛直上方舉起（參閱第9圖上段的垂直方 向的速度控制模式）。再者，該區間僅是朝著鉛直上方（z 方向）的移動，因此第9圖中段表示的水平方向（X，y方向 )的速度控制模式的速度形成爲0。接著，從B點到C點 爲止，終端效應器13 —邊被朝著水平方向加速一邊向上 方且水平方向移動。 接著，從C點到D點爲止，終端效應器13以一定的 速度（4m/SeC)朝水平方向移動。在此，C點〜D點移動的期 間，朝z方向的移動形成爲0。並且，從D點到E點（目 標位置的鉛直上方的位置）爲止，終端效應器13 —邊被朝 著水平方向減速一邊向水平方向且下方移動。之後，從E 點到F點爲止，終端效應器13不改變水平位置朝著鉛直 下方降下。再者，該區間也僅是朝著下方（z方向）的移動 ，因此第9圖表示的水平方向（X，y方向）之速度控制模式 的速度形成爲〇。如上述始終端效應器13從A點移動到 F點爲止的場合，電子控制裝置3 0根據預先所記憶的決 定從驅動開始的經過時間和終端效應器1 3的垂直方向及 水平方向的目標速度的關係之速度控制模式（參閱第9圖 的上段、中段），控制3個電動馬達4。 -26- 201006636 另一方面，終端效應器13上升到位於工件把持位置 5 0mm上方的B點更上方時，即，超過即使轉動終端效應 器13，工件130也不會和周圍接觸的預定安全高度（相當 於申請專利範圍記載的預定的上升距離）時起，驅動電動 馬達21，開始迴轉軸25 (即終端效應器13)的轉動（參閱第 9圖下段的轉動方向的速度控制模式）。例如180°轉動迴 轉軸25的場合，根據第9圖下段的實線所表示轉動方向 的速度控制模式，電動馬達21在tl(mseC)從停止狀態以 等角加速度轉動加速到600(rpm、減速機24的軸轉數、 以下相同）爲止之後，在t2(msec)間從600(rpm)以等角加 速度轉動減速到〇(rpm)爲止。並且，此時在比上述的安全 高度（相當於申請專利範圍記載的預定下降距離（從下降後 的位置到目標位置爲止的距離），並且上升時的安全高度 也可以和下降時的安全高度不同）高的位置停止電動馬達 21的轉動，電動馬達21的轉動停止後，確保t3(mSec)的 時間使得終端效應器13下降停止在F點（目標位置）爲止 〇 採轉動減速時間t2比轉動加速時間11長，控制使轉 動減速時的角加速度的絕對値小於轉動加速時的角加速度 的絕對値，藉此降低轉動減速時迴轉軸25的扭轉及震動 。另外，從電動馬達21的轉動停止之後到電動馬達4的 轉動停止爲止的期間確保震動收斂時間t3’可藉此充分降 低迴轉軸25的扭轉及震動。再者，例如迴轉軸25轉動 45°的場合，依據第9圖下段以點線表示的轉動轉動的速 -27- 201006636 度控制模式驅動電動馬達2 1。亦即，轉動加速時的角加 速度及轉動減速時的角加速度分別是以和迴轉軸25轉動 180°時相同的角加速度，轉動加速時間縮短至tl’，且轉 動減速時間縮短至t2’，可確保充分的震動收斂時間t3’。 如上述，電子控制裝置30是根據從驅動開始的經過時間 和終端效應器13的轉動方向的目標角速度的關係來決定 的速度控制模式（參閱第9圖的下段），控制電動馬達21。 以下，針對轉動方向的速度控制模式的設定方法，更具體 加以說明。 首先，電子控制裝置30爲操作員根據從輸入裝置31 所輸入的搬運轉動速度、轉動加速時間及轉動減速時間， 求得轉動加速時的角加速度及轉動減速時的角加速度。於 此是以在預定的範圍內儘可能增大加速時的角加速度，另 —方面減小減速時的角加速度爲佳。角加速度的最大値是 考慮迴轉軸與手臂前端所把持工件的慣性力矩及馬達的能 力（扭矩等）依作業員或設計者來決定。接著，電子控制裝 置30是從攝影裝置120讀取太陽能電池晶圓130的方向（ 角度）01。在此，太陽能電池晶圓130的方向Θ1是如上 述，可對攝影裝置120所攝影的攝影影像施以影像處理等 取得。接著，電子控制裝置30是根據預先所設定的轉動 加速時的角加速度及轉動減速時的角加速度和太陽能電池 晶圓130的方向0 1，算出太陽能電池晶圓130的方向（角 度）僅轉動· 0 1所需的轉動加速時間tl、轉動減速時間t2 ，設定轉動方向的速度控制模式。具體而言，第9圖下段 -28- 201006636 的三角形面積相當於太陽能電池晶圓130的轉動量-0 1， 因此一旦決定轉動加速時的等角加速度、轉動減速時的等 角加速度，即可決定轉動加速時間tl、轉動減速時間t2 。再者，迴轉軸25的轉動角度的最大値爲180° 在此，轉動方向的速度控制模式是如第9圖下段表示 ，包含轉動加速區域及轉動減速區域，設定使終端效應器 13的角速度加速時的加速度大於減速時的減速度。並且 Φ ，轉動方向速度控制模式是設定使終端效應器13的角速 度加速的轉動加速時間tl比減速的轉動減速時間t2短。 並且，設定使電動馬達21的轉動停止後到終端效應器13 在目標位置（F點）停止爲止的時間t3比終端效應器13從 上述安全高度下降停止再目標位置爲止的時間t4還長。 設定轉動方向的速度控制模式之後，電子控制裝置 3〇根據所設定轉動方向的速度控制模式，求得每一控制 週期終端效應器13的目標轉動角度位置。接著，對應所 # 獲得的目標轉動角度位置求得電動馬達21的目標驅動位 置。並且’每一控制週期，對電動馬達21供給驅動電流 使其從現在位置移動到目標位置，驅動電動馬達21。並 且，藉著電動馬達21的驅動，來驅動迴轉軸25使終端效 應器13僅轉動角度0。 根據第二實施形態，例如第11圖下段表示先前的轉 動方向的速度控制模式，電動馬達21的加速時間tl”和減 速時間t2”相等’且加速時的角加速度和減速時的角加速 度相等的場合比較，加速時間11比較短的同時，減速時 -29- 201006636 間t2更爲增長。並且，加速時的角加速度的絕對値更大 的同時，減速時的角加速度的絕對値更小。因此，轉動停 止瞬間前形成小的慣性力，可降低終端效應器13的轉動 震動。另一方面’爲了更縮短加速時間，可抑制迴轉軸 25轉動到目標轉動角度位置爲止所需要總計時間的增大 。其結果，不會增大工件的搬運•轉動時間，即可更爲提 高終端效應器13到達目標位置時終端效應器13的轉動角 度位置精度。 根據第二實施形態，將電動馬達21的轉動開始時間 設定在終端效應器1 3超過預定安全高度的瞬間後，例如 轉動終端效應器13時，可防止工件和收納盒緣部的接觸 。並且’可確保從電動馬達21的轉動停止起至終端效應 器13到達目標位置爲止更長的時間t3。即可確保轉動停 止後轉動方向的扭轉及震動之收斂用的時間更長。 又，根據第二實施形態，控制使電動馬達21的轉動 停止後至終端效應器13到達目標位置爲止的時間t3比終 端效應器13從安全高度下降停止到目標位置爲止的時間 t4更長。因此，可防止工件接觸等的同時，可確保從電動 馬達21的轉動停止到終端效應器13轉動方向的扭轉及震 動之收斂所需的時間。 依據第二實施形態，根據使用者的操作，設定馬達的 轉動加速時間、轉動減速時間及馬達的最大角速度，電子 控制裝置3 0根據所設定轉動加速時間、轉動減速時間及 最大角速度，控制電動馬達21。因此可適當控制電動馬 -30- 201006636 達21。並且，例如可柔性因應終端效應器13及所運用之 作業線等的變更。 另外，根據第二實施形態，電子控制裝置3〇可控制 電動馬達21使迴轉軸25的轉動角度形成180°以下。在此 ，例如必須順時針方向轉動1 8 0 °以上的場合，只要使其逆 時針方向轉動，即可在1 80°以下轉動到相同轉動角度位置 。因此，根據本實施形態，可降低轉動所需的時間，增大 0 扭轉及震動的收斂時間。 以上，雖針對第二實施形態已作說明，但是本發明不 僅限於上述實施形態可進行種種的變形。例如，轉動方向 的速度控制模式只要設定形成加速時的角加速度（絕對値） >減速時時角速度（絕對値），並且加速時間 < 減速時間即 可，其形狀不僅限於第9圖下段表示的形狀。在此，將轉 動方向的速度控制模式的其他例表示於第10圖。如第10 圖表示，轉動方向的速度控制模式也可以形成無加速區域 Φ 及定速區域之間的反彎點，可順暢連接各區域間的形狀， 並且也可以除去加速區域中及/或減速區域中的直線部分 ’ s字型曲線或者同樣和緩的模式以減小轉動開始時、停 止時及從加速切換到減速時的角速度變動。 第二實施形態是優先設定震動模式21的加速時間tl 及減速時間t2，但是也可以設定確保加速時間t丨及預定 的停止時間（震動收斂時間）t3的剩餘時間作爲減速時間t2 。如此一來，可確實地確保終端效應器13轉動方向的扭 轉及震動收斂所需的時間。另一方面，也可以採取長的減 -31 - 201006636 速時間t2時，可更爲縮短震動收斂所需的時間，因此以 減速時的角加速度和震動收斂所需時間的相關數據作爲圖 表預先記憶在電子控制裝置3 0的記憶體內，以加速時間 tl的確保和安全高度以上開始•結束爲條件適當設定減速 時的速度控制模式的構成。 第二實施形態是將平行連桿機構1運用在太陽能電池 晶圓1 30的堆棧作業的場合爲例已作說明，但是本發明涉 及的平行連桿機構1的運用範圍不限於太陽能電池晶圓 130的堆棧作業。例如，將輸送帶上流動袋包裝食品移載 到瓦愣紙箱內的作業，也可以適當運用本發明。並且，堆 棧作業的輸送帶的構成等不限於上述實施形態，也可以是 輸送帶100、101上下交叉行走的佈置。 針對本發明涉及的實施形態已作說明，爲本發明不僅 限於上述相關之各具體實施例的記載，在不脫離本案之主 旨的範圍內可進行種種的變形與變更。即根據本發明上述 記載範圍內所爲之種種變更皆包含於本發明之範疇內。 【圖式簡單說明】 第1圖是表示本發明之一實施形態所涉及平行連桿機 構的整體構成的透視圖。 第2圖是表示從第1圖中箭頭A1方向顯示的平行連 桿機構的圖。 第3圖是表示終端效應器的移動軌跡的圖。 第4圖是表示終端效應器水平方向的速度控制模式的 -32- 201006636 一例圖。 第5圖是表示終端效應器的目標軌跡與實際移動軌跡 的圖。 第6圖是表示水平方向的速度控制模式的其他例的圖 9 第7圖是說明太陽能電池的堆棧步驟的槪要用的鳥瞰 圖。 φ 第8圖是表示從水平方向看時的終端效應器的運轉模 式的圖。 第9圖是表示水平方向的移動距離爲4 0 0mm時電動 馬達的速度控制模式（垂直方向、水平方向、轉動方向）的 —•例圖。 第10圖是表示電動馬達轉動方向的速度控制模式的 其他例圖。 第Η圖是表示習知的速度控制模式（垂直方向、水平 Φ 方向、轉動方向）的圖。 【主要元件符號說明】 1 :平行連桿機構 2 :底座部 2a :安裝面 3 :支撐構件 4 :電動馬達 5 :手臂支撐構件 -33- 201006636 6 :手臂主體 7 :第1手臂 8 :第2手臂 9 :桿 1 〇 :球窩接頭 1 1、1 2 :連結構件 1 3 :終端效應器

14 :托架 14a :安裝面 15 :安裝片 1 6 :球窝接頭 20 :旋轉軸桿 20a :桿 20b :汽缸 2 1 :電動馬達

22、23:萬向聯軸節 24 :減速機 25 :迴轉軸 3 0 :電子控制裝置 31 :輸入裝置 100 :第1輸送帶 101 :第2輸送帶 1 1 〇 :第1編碼器 1 1 1 :第1編碼器 -34- 201006636 120 :攝影裝置 1 2 1 :光學感測器 1 3 0 :太陽能電池晶圓 1 3 1 :收納盒 C 1 :鉛直方向軸線 C2、C3、C4 ··軸線 11、11 ’ ：加速時間 t2 :定速時間 t3、t3’ ：減速時間 V :最高速度

-35

Claims (1)

1. 201006636 七、申請專利範圍： 1· 一種平行連桿機構，藉複數手臂排列連結安裝在底 座部的複數個致動器，及安裝著終端效應器的托架的平行 連桿機構中，具備控制上述致動器的控制裝置，其特徵爲 上述控制裝置控制上述致動器使得停止狀態的上述終 端效應器移動到目標位置爲止時，上述終端效應器加速時 的加速度大於減速時的減速度。 2.如申請專利範圍第1項記載的平行連桿機構，其中 ，上述控制裝置控制上述致動器，使得停止狀態的上述終 端效應器移動到目標位置爲止時，上述終端效應器加速的 時間比減速的時間短。 3 .如申請專利範圍第1項記載的平行連桿機構，其中 ，上述控制裝置預先記憶決定從驅動開始的經過時間和上 述終端效應器的目標速度關係的速度控制模式，根據上述 終端效應器的現在位置、上述目標位置及上述速度控制模 式，控制上述致動器。 4. 如申請專利範圍第3項記載的平行連桿機構，其中 ，上述速度控制模式比較上述終端效應器加速的時間和減 速的時間相同的場合，設定停止狀態的上述終端效應器到 達上述目標位置爲止的時間不變。 5. 如申請專利範圍第4項記載的平行連桿機構，其中 ，上述致動器爲電動馬達。 6. —種平行連桿機構，經複數連桿，排列連結有底座 -36- 201006636 部及安裝可使終端效應器轉動的托架的平行連桿機構，該 平行連桿機構，具備：安裝在上述底座部的馬達；一端連 接在上述馬達的輸出軸，另一端連接在上述終端效應器， 將上述馬達的轉動驅動力傳達至上述終端效應器的迴轉軸 ;及控制上述馬達的控制裝置，其特徵爲： 上述控制裝置控制上述馬達，使得上述馬達的角速度 爲零位於停止狀態的上述迴轉軸轉動到目標轉動角度位置 φ 爲止時’上述馬達的角速度從零到形成最大角速度爲止所 需的轉動加速時間比上述馬達的角速度從上述最大角速度 形成零爲止所需的轉動減速時間短。 7. 如申請專利範圍第6項記載的平行連桿機構，其中 ’上述控制裝置控制上述馬達使得停止狀態的上述迴轉軸 轉動驅動到目標轉動角度位置爲止時，上述馬達的角速度 增大時的角加速度及上述馬達的角速度減少時的角加速'度 爲定角加速度，並且加速時的角加速度的絕對値大於減速 0 時的角加速度的絕對値。 8. 如申請專利範圍第6項記載的平行連桿機構，其中 ，上述控制裝置爲上述終端效應器從停止狀態移動到預先 所決定之預定的上升距離以上的上方時開始上述馬達的轉 動。 9. 如申請專利範圍第6項記載的平行連桿機構，其中 ，上述控制裝置是控制上述馬達下降到預先所決定的預定 下降距離之前停止上述馬達的轉動。 10. 如申請專利範圍第9項記載的平行連桿機構，其 ^»·ίΜΐι1·Ι |·ΠΊ·1·|··ΙΙ*ί1ΓΓ·7Γιΐ>ί^·Β -37- 201006636 中，上述控制裝置是控制上述馬達使得從上述馬達的轉動 停止後到上述終端效應器停止在目標位置爲止的時間比上 述終端效應器下降到上述預定的下降距離停止在上述目標 位置爲止的時間還長。 11. 如申請專利範圍第1項記載的平行連桿機構，其 中，更具備根據使用者的操作對上述控制裝置設定上述馬 達的控制數據的設定裝置， 上述設定裝置是根據使用者的操作，設定上述馬達的 上述轉動加速時間、上述轉動減速時間及上述馬達的最大 角速度， 上述控制裝置是根據上述設定裝置所設定的上述轉動 加速時間、上述轉動減速時間及上述最大角速度來控制上 述馬達。 12. 如申請專利範圍第6項記載的平行連桿機構，其 中，上述控制裝置是控制上述馬達使上述迴轉軸的轉動角 度形成180°以下。 13. 如申請專利範圍第10項記載的平行連桿機構，其 中，上述控制裝置控制上述馬達使得上述馬達的轉動停止 後，上述終端效應器停止在目標位置爲止的時間形成預定 時間以上。 -38-