基于SMP 運(yùn)動(dòng)控制內(nèi)核的機(jī)器人控制系統(tǒng)

　　手動(dòng)示教模式的功能是讓操作人員記錄機(jī)器人位置姿態(tài)并生成焊接軌跡。在機(jī)器人的實(shí)際應(yīng)用中， 需要操作人員在手動(dòng)操作模式下移動(dòng)機(jī)器人關(guān)節(jié)使焊槍末端始終沿著規(guī)定的焊接軌跡移動(dòng)， 然后在示教模式下記錄運(yùn)動(dòng)過程中的關(guān)鍵位置點(diǎn)， 并根據(jù)焊接的要求插入打開焊槍、關(guān)閉焊槍、輸入焊接速度、暫停等功能指令， 最后保存軌跡生成可再現(xiàn)的示教程序［4］。程序中對焊槍的控制是將M 指令進(jìn)行譯碼后， 交給PLC 引擎運(yùn)算， 并通過PLC 輸出點(diǎn)控制焊槍的開始點(diǎn)和結(jié)束點(diǎn)。示教功能界面如圖5 所示。在自動(dòng)運(yùn)行界面下， 操作者可重復(fù)調(diào)用保存好的示教軌跡程序， 控制機(jī)器人運(yùn)動(dòng)， 完成焊接。

5 結(jié)束語

本文介紹的基于PC 機(jī)和Windows 系統(tǒng)的機(jī)器人控制系統(tǒng)具有運(yùn)行穩(wěn)定、系統(tǒng)內(nèi)核升級方便、應(yīng)用軟件開發(fā)周期短、界面友好等優(yōu)點(diǎn)。本系統(tǒng)實(shí)現(xiàn)了對6 個(gè)自由度機(jī)器人的聯(lián)動(dòng)控制， 完成了示教編程、參數(shù)設(shè)定， 自動(dòng)運(yùn)行等功能模塊的編程。搭配松下A4N 系列伺服和廣東伺博科NBC－350 二氧化碳?xì)獗：笝C(jī)， 在實(shí)際的焊接應(yīng)用中取得了良好的效果。通過對焊接速度和焊接電流， 電壓等參數(shù)的調(diào)節(jié)， 焊接質(zhì)量達(dá)到了技術(shù)要求， 軌跡準(zhǔn)確， 焊縫平滑。接下去， 機(jī)器人系統(tǒng)的進(jìn)一步研究工作將主要在以下兩個(gè)方面：

（1） 深入研究機(jī)器人運(yùn)動(dòng)的速度前饋和加減速算法，提高機(jī)器人在高速運(yùn)動(dòng)下的定位精度， 減少振動(dòng)， 保證機(jī)器人運(yùn)動(dòng)的平穩(wěn)性；

（2） 建立機(jī)器人三維模型， 研究機(jī)器人逆運(yùn)動(dòng)學(xué)算法， 規(guī)劃機(jī)器人的空間運(yùn)動(dòng)軌跡， 編寫離線編程加工程序。

參考文獻(xiàn)：

［1］謝存禧，張鐵．機(jī)器人技術(shù)及其應(yīng)用［M］．北京：機(jī)械工業(yè)出版社，2005．

　　［2］RTEX＿SMP＿SetupGuide［Z］．SoftServoSystem．U．S．A，2006．

　　［3］MINAS＿A4N＿M(jìn)anual［Z］．Panasonic．Japan，2005．

　?。?］陳善本，林濤，等．智能化焊接機(jī)器人技術(shù)［M］．北京：機(jī)械工業(yè)出版社，2006．