SCARA機器人廣泛應(yīng)用于電子、汽車、塑料、食品等工業(yè)領(lǐng)域，其主要職能是完成搬運和裝配工作。隨著加工工藝的復(fù)雜性與精確性不斷提升，SCARA機器人在流水線上經(jīng)常需要與其他工業(yè)設(shè)備協(xié)同作業(yè)，難免會出現(xiàn)與障礙物發(fā)生碰撞的危險。因此，對工作范圍內(nèi)存在障礙物的SCARA機器人的運動軌跡進行規(guī)劃便顯得尤為重要。

　　軌跡規(guī)劃（Path Planning）是指給定環(huán)境的障礙物條件，以及起始點和目標點位置，要求選擇一條從起始點到目標點的路徑，使SCARA機器人能安全、無碰撞地通過所有的障礙物。這種自主地躲避障礙物并完成作業(yè)任務(wù)是SCARA機器人研究中的一個重要內(nèi)容。軌跡規(guī)劃的實質(zhì)是預(yù)先給定SCARA機器人作業(yè)路徑上的關(guān)節(jié)坐標值序列，使其沿預(yù)定路徑運動。對于四軸機器人而言，關(guān)節(jié)3的縱向運動與關(guān)節(jié)4的帶夾具運動均具有較強的靈活性，可以根據(jù)實際情況用簡單的運動指令實時控制以躲避障礙物；而關(guān)節(jié)1與關(guān)節(jié)2在水平面內(nèi)的關(guān)聯(lián)運動在很大程度上決定了SCARA機器人的主要位姿，是障礙物避碰的主導(dǎo)因素。所以，合理規(guī)劃關(guān)節(jié)1與關(guān)節(jié)2在水平面內(nèi)的關(guān)節(jié)坐標值序列是實現(xiàn)避障的前提和關(guān)鍵。本文即是針對SCARA機器人的二維避障問題，基于幾何學(xué)與人工智能學(xué)理論，提出了一種智能控制算法并加以仿真驗證。

　　2． 二維避障智能控制算法設(shè)計

　　工業(yè)現(xiàn)場的實際障礙物雖具有多種平面形狀，但任何形狀的障礙物均可用其外接圓柱體包圍。為簡化對問題的描述又不失一般性，文中假定實際障礙物為圓柱體結(jié)構(gòu)，映射到X-Y水平面上即為一圓形區(qū)域。本算法的總體思路為：先將關(guān)節(jié)1與關(guān)節(jié)2構(gòu)成的關(guān)節(jié)空間q1-q2柵格化為有限個小方塊，并對每個小方塊編號，設(shè)定坐標值；然后將直角坐標系X-Y下的圓形障礙區(qū)域轉(zhuǎn)化為關(guān)節(jié)空間中不可達的小方塊群，求出它們的編號，并給可達矩陣賦值；再采用人工智能理論中具有啟發(fā)式搜索的A*算法在關(guān)節(jié)空間中求出避障路徑點的編號序列；最后將該編號序列轉(zhuǎn)換為對應(yīng)的關(guān)節(jié)坐標值序列，關(guān)節(jié)1與關(guān)節(jié)2依次取對應(yīng)的關(guān)節(jié)角度值運動即可實現(xiàn)二維避障控制。

　　2.1 關(guān)節(jié)空間q1-q2柵格化

　　假定SCARA機器人關(guān)節(jié)1和關(guān)節(jié)2的運動范圍均為［-120 ，120 ］，取細分精度為6 （可根據(jù)實際情況靈活選擇細分精度），可將關(guān)節(jié)坐標軸q1、q2均劃分為［120-（-120）］ / 6 = 40條相等的小線段，分別在每條小線段的端點作q1軸與q2軸的平行線，所有平行線相交，可將關(guān)節(jié)空間平面劃分為40*40 = 1600個面積相等的小方塊，從而實現(xiàn)了關(guān)節(jié)空間q1-q2的柵格化，如圖3所示。

　　然后，對每個小方塊進行編號并設(shè)定關(guān)節(jié)坐標值，按照從左至右、從下至上依次增大的原則，編號?。?，1600］之間的整數(shù)，在圖3中，左下角小方塊編號為1，右上角編號為1600，1號小方塊正上方的小方塊編號為41，依此類推，可得出所有小方塊的唯一相異編號值。

　　最后對每個小方塊賦坐標值，為使坐標值分布均勻，取每個小方塊的中心坐標（q1，q2）為其坐標值。則1號小方塊的坐標值為（-117 ，-117 ），1600號小方塊的坐標值為（117 ，117 ），41號小方塊的坐標值為（-117 ，-111 ），依此類推，可得出所有小方塊的唯一相異坐標值。

　　2.2 確定障礙區(qū)域

　　在圖1中的直角坐標系下，O為坐標原點，OA2與A2B2分別為SCARA機器人的大臂與小臂，由右手螺旋法則易知，實線OA2B2表示本體處于關(guān)節(jié)坐標為（-117 ，-117 ）的位姿，對應(yīng)關(guān)節(jié)空間中的1號小方塊；虛線OMN表示本體與X軸正向重合時的位姿；虛線OA1B1則表示本體處于關(guān)節(jié)坐標為（117 ，117 ）的位姿，對應(yīng)關(guān)節(jié)空間中的1600號小方塊。圖中藍色與黑色虛線包圍的空間即為本體的活動區(qū)域，在該區(qū)域內(nèi)假設(shè)存在兩個圓形障礙物圓K1與圓K2，兩圓半徑均已知。由于本算法要求在關(guān)節(jié)坐標系下規(guī)劃避障路徑，所以要先將直角坐標系下的障礙區(qū)域轉(zhuǎn)換為關(guān)節(jié)坐標系下對應(yīng)的編號群。

相關(guān)電子資料下載

• 翼菲科技將攜Scara復(fù)合移動機器人亮相上海工博會 280
• 富士康與軟銀雙方多次聯(lián)手布局機器人 247
• 工業(yè)機器人應(yīng)該有幾個軸才合理呢？ 312
• 晶圓傳輸設(shè)備核心技術(shù)概述 2679
• 不得不知的scara機器人應(yīng)用優(yōu)勢！ 1073
• 拓斯達推出全新TRH15系列高負載SCARA機器人 312
• 匯川技術(shù)高速SCARA機器人滿足各種惡劣生產(chǎn)環(huán)境的應(yīng)用需求 2329
• SCARA機器人將迎來高位反彈 預(yù)計到2023年銷量超8萬臺 1625
• 當前的協(xié)作機器人市場基數(shù)依然偏??！ 1417
• 未來兩年SCARA市場格局依然存在較大的變數(shù) 1461