3.2 正反解多解問題
在求解并聯機器人正反解方程的過程中存在方程多解問題:在正解計算中一組實軸坐標對應兩組虛軸坐標,其中有一組虛軸坐標位于靜平臺(平面)上方,可舍去;在反解計算中一組虛軸坐標對應兩組實軸坐標,由于本系統具有驅動軸(實軸)單軸手動功能,如果直接舍去反解計算的一組實軸解,會造成手自動切換時系統伺服軸跟隨誤差出界.產生這種情況的原因是:實軸在單軸手動時可能進入被舍棄的實軸解空間,而實軸單軸手動時系統是不進行反解計算的,因此不會發生報警事件;而在切換到自動狀態時反解生效,但實軸解為另一組解,由于理論值與實際值相差很大,造成跟隨誤差出界報警(如圖4 所示).
圖4 手自動切換過程示意圖
為了解決反解多解問題,在反解模塊中引入變量來讀取實軸實時坐標(),將其與反解計算值() 進行比較,取最接近實軸實時坐標的那組解作為輸出,經過處理后驅動實軸運動.為了節省運算時間,此判斷過程只在實軸單軸手動切換到自動狀態時生效,判斷過后一直采用選中的那組解的解析表達式計算實軸坐標,直到下次切換.
3.3 旋轉軸“過零”問題
第4 軸(旋轉軸)在經過0°點時,會出現突然反轉現象:在并聯機器人作加工時,在某些位置需要從359.999°運動到0.001°,加工過程只需要旋轉軸運動0.002°,而實際情況是旋轉軸轉動大弧359.998°,產生這種現象的原因是系統將旋轉軸當作線性軸來處理,而反解計算只能計算0°到360°的半閉半開區間,旋轉軸到360°就會歸零.這是加工所不需要的,系統也不可能在一個插補周期內完成一周的轉動.
為解決此問題,將第4 軸反解計算值與當前實時坐標相減,然后按下式修正計算值:
(8)
式中為修正后的第4軸坐標,為修正前的第4軸坐標計算值,為第4軸的當前實時坐標,| |為向上取整符號.
3.4 加工曲線生成問題
對于5 自由度加工,人工編程有很大難度,而現有的計算機輔助制造(CAM)軟件沒有針對并聯機構的模塊.為利用現有的CAM 軟件進行加工編程,在位姿正反解模塊中加入轉換模塊,將CAM 中給定的結構和正反解輸入輸出坐標相互轉化.操作者可根據不同的CAM 軟件定制不同的轉換模塊.
以UG的五軸雙擺頭結構X、Y 、Z、A、B為例說明轉換模塊的轉換過程.首先,為簡化轉換過程,將第4、第5軸偏置設為0,這樣UG在轉換時就不考慮刀長,那么UG 輸出代碼中的X、Y 、Z與并聯結構的需求一致,不需要再作轉換.我們只需要對刀軸姿態進行轉換:設單位刀軸矢量在X 軸的投影為I、在Y軸的投影為J、在Z 軸的投影為K,A為主擺角,B為副擺角,刀具軸在Z軸上,通過數學推導可得出反解模塊的刀軸矢量和A、B的關系如下(式中i、j、k依次為矢量I、J、K的模,A、B依次為轉角A、B的角度值):
(9)
同樣可得出正解模塊的轉換關系為:
轉載請注明出處。