毛英坤,李 華,張 朵,孫宇楠,蘇成志
(1.航空工業(yè)哈爾濱飛機工業(yè)集團有限責任公司,黑龍江 哈爾濱 150000;2.長春理工大學,吉林 長春 130022)
對于大批量噴涂,采用人工試湊法使機器人避免經(jīng)過奇異位形,關節(jié)運動不超過設定范圍,且運動性能最優(yōu)的狀態(tài)下實現(xiàn)連續(xù)噴涂作業(yè)已經(jīng)很成熟。伴隨著小批量多品種的噴涂生產(chǎn)需求不斷涌現(xiàn),由于事先無法進行試噴實驗,人工試湊法已不能勝任這種生產(chǎn)需求。如何根據(jù)工件模型,實時計算機器人和工件之間的最優(yōu)站位關系,使機器人避免經(jīng)過奇異位形,關節(jié)運動不超過設定范圍,且在運動性能最優(yōu)的狀態(tài)下完成連續(xù)全面噴涂作業(yè),是解決當前小批量多品種實現(xiàn)智能化噴涂的關鍵。
本文首先從機器人運動學位形出發(fā),根據(jù)機器人在某一位形下運動具有連續(xù)性的特性,把機器人在連續(xù)作業(yè)時需要滿足的關節(jié)運動范圍約束和避開奇異位形約束相結(jié)合,結(jié)合機器人運動學性能指標建立并求解機器人與工件之間的位姿優(yōu)化模型。最后,通過在一個具有移動軸的噴涂系統(tǒng)上實現(xiàn)機器人站位優(yōu)化,獲得噴涂最佳站位。
假設工件的噴涂軌跡所在坐標系為{W},其與機器人基座坐標系之間的關系為其中代表位置關系表示姿態(tài)關系。工件的噴涂軌跡轉(zhuǎn)換到機器人基坐標系之后,機器人關節(jié)空間的關節(jié)角度、關節(jié)速度便可通過機器人運動學模型建立與位姿關系和機器人運動學位形之間的函數(shù)關系。
本文采用罰函數(shù)法、粒子群優(yōu)化算法求解建立的機器人軌跡優(yōu)化放置問題。單獨求出式(1)中每一個位形c下的最優(yōu)位姿,然后比較所有位形下的最優(yōu)位姿,求得整體的最優(yōu)位姿關系。另外工件在進行噴涂軌跡規(guī)劃時,首先對工件進行子片劃分,然后對子片進行噴涂軌跡規(guī)劃,所以在優(yōu)化工件與機器人位姿的時候可以單獨對每個子片進行位姿關系優(yōu)化。
為驗證算法的可行性,搭建噴涂系統(tǒng)實現(xiàn)此算法。噴涂系統(tǒng)中使用的機器人各個關節(jié)的運動范圍與運動速度見表1所示。
表1 機器人關節(jié)運動范圍與運動速度
該機器人在設計上使關節(jié)3的運動范圍只存在一種位形,而關節(jié)5由于其運動范圍可知其工作位形分為翻轉(zhuǎn)和不翻轉(zhuǎn)兩種位形。由于機器人的機械結(jié)構(gòu)設計,該機器人不存在邊界奇異位形,當關節(jié)5的角度為零度時關節(jié)4和關節(jié)6的軸線重合為腕關節(jié)奇異位形。
根據(jù)移動軸的運動范圍,把無約束優(yōu)化問題變?yōu)橐苿虞S運動距離d的有約束問題。即:
實驗使用的噴涂軌跡根據(jù)基于點云切片技術(shù)的噴涂軌跡規(guī)劃方法獲得,圖1為汽車飛機艙門正面的噴涂軌跡。機器逆向運動學使用代數(shù)法求解,代數(shù)法結(jié)合機器人位形可以保證在某一位形下機器人只有一組逆解。實驗過程中首先把預先打磨處理好的汽車外覆蓋件固定到支架上,根據(jù)軌跡規(guī)劃算法規(guī)劃好工件的噴涂軌跡;然后輸入工件的噴涂軌跡,站位優(yōu)化算法根據(jù)輸入的噴涂軌跡自動計算出機器人的站位;最后在確定機器人和工件之間的位姿關系之后,通過控制器控制機器人移動軸運動到相應位置進行噴涂作業(yè)。
圖1 艙門噴涂軌跡
為了說明噴涂過程中站位優(yōu)化的情況,以艙門噴涂為例,圖2為噴涂艙門時,機器人站位的優(yōu)化過程,噴涂實驗結(jié)果見表2。從圖2中可以在移動軸范圍內(nèi)初始化的機器人站位均能收斂到最優(yōu)站位811.4mm處。在算法初始化機器人站位時,對于使軌跡超出機器人工作范圍的站位,取距離其最近的可行站位,作為第二次迭代的初始值。
圖2 艙門噴涂時機器人站位優(yōu)化過程
表2 噴涂實驗結(jié)果
圖3為機器人在最優(yōu)站位811.4mm處噴涂艙門時的各個關節(jié)角度變化的情況,可以看出關節(jié)1的角度變化過程沒有突變,所以機器人沒有經(jīng)過肩關節(jié)奇異點;由于機器人機構(gòu)設計,并從關節(jié)3的角度變化過程可以看出機器人在噴涂艙門時沒有經(jīng)過邊界奇異位形;關節(jié)5在第一條軌跡和第二條軌跡時改變了位形,由于是在兩條噴涂軌跡之間改變的位形,所以其不影響噴涂一條軌跡的連續(xù)性。圖4為艙門噴涂時機器人關節(jié)的角速度變化情況。從圖中可以看出噴涂時關節(jié)的角速度都保持在允許范圍之內(nèi)。
圖3 艙門噴涂機器人各軸角度變化情況
圖4 艙門噴涂機器人各軸角速度變化情況
本文針對球形腕關節(jié)機器人做了位形分析,建立了機器人站位優(yōu)化算法,能夠?qū)崿F(xiàn):
(1)機器人在連續(xù)噴涂作業(yè)時能夠?qū)崿F(xiàn)機器人站位優(yōu)化,使機器人不經(jīng)過奇異位形,且關節(jié)角度運動不超過設定范圍;
(2)機器人在噴涂過程中關節(jié)速度在設定范圍之內(nèi);
(3)在以雅克比矩陣為參數(shù)的運動學性指標優(yōu)化目標下,實現(xiàn)噴涂過程中機器人運動學性能最佳。
本文提出的機器人位形站位優(yōu)化算法也適用于其他類型腕關節(jié)機器人。