多自由度機(jī)器人運(yùn)動(dòng)控制系統(tǒng)開發(fā).pdf

1、工業(yè)機(jī)器人在工業(yè)自動(dòng)化領(lǐng)域扮演著重要的角色,隨著電子技術(shù)、通訊技術(shù)和機(jī)械制造技術(shù)的快速發(fā)展,高精度、高可靠性、智能化已成為機(jī)器人的發(fā)展方向。本課題針對(duì)多軸機(jī)器人,進(jìn)行了基于變指數(shù)趨近律的滑模控制方法研究,同時(shí)完成了基于PC的多自由度工業(yè)機(jī)器人控制系統(tǒng)設(shè)計(jì)。
　　首先,利用拉格朗日函數(shù)法建立了多自由度工業(yè)機(jī)器人的動(dòng)力學(xué)模型,根據(jù)其模型特性和控制目標(biāo),選定了滑模變結(jié)構(gòu)控制算法進(jìn)行研究。本設(shè)計(jì)中,分別對(duì)工業(yè)機(jī)器人傳統(tǒng)滑?？刂品椒ā⒒谥?/p>

2、數(shù)趨近律的滑?？刂品椒ㄟM(jìn)行了研究。結(jié)合機(jī)器人特性,在指數(shù)和冪次趨近律基礎(chǔ)上設(shè)計(jì)了一種變指數(shù)趨近律,并推導(dǎo)出相應(yīng)的滑?？刂坡?。仿真結(jié)果表明該滑?？刂坡稍诓桓淖兿到y(tǒng)動(dòng)態(tài)響應(yīng)速度的前提下,明顯削弱了控制器輸出抖振。
　　其次,對(duì)工業(yè)機(jī)器人控制系統(tǒng)進(jìn)行了整體需求分析,結(jié)合現(xiàn)今主流的控制系統(tǒng)設(shè)計(jì)方法,制定了基于PC的控制系統(tǒng)設(shè)計(jì)方案;同時(shí),根據(jù)控制算法和通訊接口的要求,選定了基于FPGA(EP2C8Q208)+DSP(TMS320F2812

3、)+PCI9054的核心控制器設(shè)計(jì)架構(gòu),FPGA負(fù)責(zé)接口邏輯設(shè)計(jì),DSP負(fù)責(zé)控制算法實(shí)現(xiàn),PCI負(fù)責(zé)與PC的通訊,這樣既保證了控制器的效率,又簡(jiǎn)化了硬件接口設(shè)計(jì)。
　　第三,完成了基于PCI的運(yùn)動(dòng)控制核心板與調(diào)理電路板的原理圖設(shè)計(jì)、PCB設(shè)計(jì)和焊接調(diào)試。FPGA內(nèi)部邏輯設(shè)計(jì)采用Verilog HDL語(yǔ)言,實(shí)現(xiàn)了與PCI9054的接口、與DSP的接口、SPI接口、光電碼盤信號(hào)采集、高速脈沖輸出等邏輯,保證了數(shù)據(jù)在傳感器、信號(hào)處理單元

4、、上位機(jī)和執(zhí)行器之間的快速可靠傳輸。
　　第四,在控制系統(tǒng)硬件和FPGA邏輯電路設(shè)計(jì)完成后,分別編寫了在DSP運(yùn)行的下位機(jī)程序和在PC上運(yùn)行的上位機(jī)程序。DSP程序開發(fā)環(huán)境采用CCStudio V3.3,編程采用C語(yǔ)言,實(shí)現(xiàn)了控制算法和底層數(shù)據(jù)傳輸;上位機(jī)程序開發(fā)平臺(tái)采用LabVIEW,編程采用數(shù)據(jù)流框圖語(yǔ)言,實(shí)現(xiàn)了板卡控制、參數(shù)設(shè)定、數(shù)據(jù)監(jiān)測(cè)等功能。
　　最后，搭建了機(jī)器人控制系統(tǒng)實(shí)驗(yàn)平臺(tái),進(jìn)行了光電編碼器采集測(cè)試實(shí)驗(yàn)、高