運動控制實習(xí)報告

運動控制實習(xí)報告姓名：葛峰銘組員：李浩銘學(xué)院：自動化班 級： 231131專業(yè)：自動化指導(dǎo)老師：李勇波2016年8月

一、自動控制系統(tǒng)實驗概述自動控制系統(tǒng)實驗的背景和目的在現(xiàn)代化的工業(yè)生產(chǎn)中，伺服電機(jī)及三相異步電機(jī)被廣泛的應(yīng)用在冶金行業(yè)，化工行業(yè)，機(jī)械制造和食品加工等多種行業(yè)，同時運動控制是控制領(lǐng)域比較經(jīng)典和最常見的控制類型，是控制理論實踐和擴(kuò)展的基礎(chǔ)，深入了解并學(xué)習(xí)電機(jī)的控制方法和理論是有著深遠(yuǎn)的學(xué)習(xí)意義的。自動控制系統(tǒng)實驗也是綜合應(yīng)用控制理論、單片機(jī)原理及接口技術(shù)、電機(jī)拖動、微機(jī)接口技術(shù)、自動控制系統(tǒng)等課程知識的重要實踐環(huán)節(jié)。其目的在于通過試驗來驗證和研究控制理論（伺服電機(jī)控制），增強(qiáng)感性認(rèn)識，以促進(jìn)認(rèn)識的深化，培養(yǎng)學(xué)生科學(xué)的分析能力，使學(xué)生掌握一般運動控制和溫度控制的操作方法和基本技能。自動控制系統(tǒng)實驗的主要內(nèi)容伺服電動機(jī)的特性參數(shù)與調(diào)速原理（驗證性）；伺服電動機(jī)的頻率特性測定實驗（驗證性）；伺服電動機(jī)及其驅(qū)動裝置實驗（綜合性）；伺服電動機(jī)的特性及接線實驗（設(shè)計性）；伺服電動機(jī)正反轉(zhuǎn)實驗（設(shè)計性）；單片機(jī)控制系統(tǒng)鍵盤控制及顯示實驗（綜合性）；單片機(jī)控制系統(tǒng)直線插補實驗（綜合性）單片機(jī)控制系統(tǒng)位置檢測實驗（綜合性）；單片機(jī)控制系統(tǒng)X、丫軸點動實驗（綜合性）；單片機(jī)控制系統(tǒng)圓弧插補實驗（綜合性）1.3自動控制系統(tǒng)實驗預(yù)期的結(jié)果按照接線圖正確連接機(jī)箱后，能通過單片機(jī)板子實現(xiàn)步進(jìn)電機(jī)X軸和Y軸上的正轉(zhuǎn)與反轉(zhuǎn)，了解直線插補算法的原理并編寫程序?qū)崿F(xiàn)相應(yīng)功能，了解圓弧插補算法的原理并編寫程序?qū)崿F(xiàn)相應(yīng)的功能。二、自動控制系統(tǒng)實驗硬件介紹運動控制實驗儀運動控制實驗儀是一個平面兩軸驅(qū)動的運動裝置，機(jī)械部分采用絲桿螺母的傳動方式，如圖2-1所示。它可以由單片機(jī)控制，控制系統(tǒng)用一套伺服電機(jī)驅(qū)動和檢測電路板。驅(qū)動和檢測電路板上有單片機(jī)的控制接口，使用十分方便。該運動控制實驗儀配備了一只畫筆，通過編制相應(yīng)的控制程序，可以在圖板上繪出不同的圖形，使運動過程更加明了，便于觀察。運動控制儀可采用單片機(jī)控制其結(jié)構(gòu)如圖所示，單片機(jī)控制是學(xué)生掌握匯編語言編程。從硬件結(jié)構(gòu)上，單片機(jī)接口電路也與控制電路相連。'Y'/i機(jī).及其

倡口”電路拄望跆'Y'/i機(jī).及其

倡口”電路拄望跆*一^~尊就單片機(jī)控制系統(tǒng)單片機(jī)控制電路分為顯示電路，鍵盤電路、脈沖鎖存和光槽開關(guān)信號讀取電路光隔電路組成。五個數(shù)碼管對應(yīng)地址分別為：0000H,2000H,4000H,6000H,8000H,每個數(shù)碼管顯示數(shù)據(jù)“暗、0、1、2、3、4、5、6、7、8、9”的段選碼值對應(yīng)為00H,7EH,60H,57H,75H,69H,3DH,3FH,70H,7FH,79H。鍵盤為3X6行列示鍵盤，其中第一個鍵為復(fù)位鍵，其他鍵可以按設(shè)計自由編排。伺服電機(jī)分配脈沖對應(yīng)鎖存器地址為A000H,其中高四位是Y軸信號，低四位是X軸信號。信號從高到低排列依次為：高壓（+24V）信號（置0關(guān)斷，置1開通）、A相信號（置0關(guān)斷，置1開通）、B相信號（置0關(guān)斷，置1開通）、C相信號（置0關(guān)斷，置1開通）。光槽開關(guān)信號緩沖器74LS244讀寫地址為E000H2.3機(jī)箱內(nèi)部走線圖限位開關(guān)限位開關(guān)限位開關(guān)-TX1EN+2EN-3ICOM4ICW5ICCW6PULS+7PULS-8SIGN+1EN+2EN-3ICOM4ICW5ICCW6PULS+7PULS-8SIGN+藍(lán)色:灰色：接單片機(jī)板子VCC綠色:黑色:一共有三條引出線，紅、藍(lán)、黑，其中紅接+24V藍(lán)接）1黑為信號線）左側(cè)驅(qū)動器（下軸）的信號線右側(cè)驅(qū)動器（上軸）的信號線限位開關(guān)的信號線（限位開關(guān)限位開關(guān)+SUBV-wVuESUH^ESUH^2.3機(jī)箱內(nèi)部走線圖限位開關(guān)限位開關(guān)限位開關(guān)-TX1EN+2EN-3ICOM4ICW5ICCW6PULS+7PULS-8SIGN+1EN+2EN-3ICOM4ICW5ICCW6PULS+7PULS-8SIGN+藍(lán)色:灰色：接單片機(jī)板子VCC綠色:黑色:一共有三條引出線，紅、藍(lán)、黑，其中紅接+24V藍(lán)接）1黑為信號線）左側(cè)驅(qū)動器（下軸）的信號線右側(cè)驅(qū)動器（上軸）的信號線限位開關(guān)的信號線（限位開關(guān)限位開關(guān)+SUBV-wVuESUH^ESUH^-esahnDNCDDVEKARDesuh^

esuh^

-esah^

DNG

DDV

EKarr

SUBV

+SUBV黃色：開關(guān)電源的紅色：開關(guān)電源的4V三、實驗程序及實驗結(jié)果分析鍵盤掃描及液晶顯示模塊首先要定義鍵盤掃描和液晶的地址，然后運用文字取模軟件獲得文字在液晶顯示的32位碼，并且定義為char型數(shù)組格式，讀寫取液晶文字碼后將程序初始化，清屏，使用液晶程序模塊(與數(shù)碼管不同液晶不用多次掃描顯示)。鍵盤掃描子程序部分，則運用flag全局變量判斷運行模塊：ucharkeyscan()〃鍵盤輸入程序{COM8255=mode8255;PC8255=0x7f;〃第1列temp=PC8255;temp=temp&0x0f;while(temp!=0x0f){delay0(5);temp=PC8255;temp=temp&0x0f;while(temp!=0x0f){temp=PC8255;switch(temp){case0x7e:{ZX();zhixianchabu1(3000,0);zhixianchabu3(2427,1607);zhixianchabu1(1277,2714);zhixianchabu4(1277,2714);zhixianchabu2(2427,1607);flag=0;PA8255=0xff;break;}逐點比較法的直線插補加工如圖1—1所示的平面斜線AB，以斜線起點A的坐標(biāo)為x0，y0，斜線AB的終點坐標(biāo)為(xe，ye)，則此直線方程為：X—X0_Xe—X0Y-Y0—Ye-Y0取判別函數(shù)F=(Y—Y0)(Xe—Xo)—(X-X0)(Ye—Y0)用逐點比較法加工時，每一次只在一個坐標(biāo)方向給出一個脈沖，使運動件在該坐標(biāo)方向上進(jìn)給一步，因此刀具的運動軌跡是折線，而不是斜線AB。折線拐點M與斜線AB之間的位置關(guān)系有如下三種情況：1)M點在AB線的上方.判別函數(shù)F>0;2)M點在AB線上，F(xiàn)=03)M點在AB線的下方，F(xiàn)<0為控制方便，將F>0和F=0兩種情況作為F>=0一種方式判別。當(dāng)判別函數(shù)F>=0時，刀具一定處在AB線的上方，或在AB線上。例如圖中的M1(X1,Y1)點，這時刀具只有沿+X方向進(jìn)給才更接近AB線，因此，根據(jù)這個判別結(jié)果，計算機(jī)在x鈾方向輸出一個脈沖，使刀具在+x方向前進(jìn)一個脈沖當(dāng)量的距離。到達(dá)M2點。對刀具相對工件的移動方向的控制可根據(jù)線段所處的象限來決定。若線段處在第三象限，在x或y方向輸出脈沖時，使伺服電動機(jī)反轉(zhuǎn)即可。而判別式和脈沖分配方式與第一象限相同；若線段處在第二象限可使X向電動機(jī)反轉(zhuǎn)而y向電動機(jī)正轉(zhuǎn)，第四象限使X向電動機(jī)反轉(zhuǎn)，Y向電動機(jī)正轉(zhuǎn)定義四象限直線插補程序，以第一象限為例，其他只需改變電機(jī)的轉(zhuǎn)動的方向：voidzhixianchabu1(inta,intb){intX,Y;intxm,ym,Nxy;//xe,ye;signedintFm;xm=0;〃置x,y起點坐標(biāo)ym=0;X=a;Y=b;Nxy=abs(X-0)+abs(Y-0);〃總步數(shù)while(Nxy){Fm=ym*X-xm*Y; 〃直線插補的偏差辨別式if(Fm>=0){Xright();xm++;Fm=ym*X-xm*Y;Nxy--;)else{Yright();ym++;Fm=ym*X-xm*Y;Nxy--; }}}直線插補程序，延時函數(shù)及方向電機(jī)轉(zhuǎn)動函數(shù)：voiddelay3(){uintx;for(x=10;x>0;x--);}voidXright(){inti;for(i=0;i<10;i++){PA8255=0x00;delay3();PA8255=0x01;delay3();})

3.3逐點比較法的圓弧插補在圖3-6中AB是被加工圓弧。加工程序中給出的已知條件通常是A點B點的坐標(biāo)值，圓心0’點相對圓弧起點A的增量坐標(biāo)值。由圖可知：圓心0’點相對A點的增量坐標(biāo)值為(一Io，—Jo)。改變符號后就成為A點相對0’點的增量值Io,Jo。由此可求出圓弧的半徑值R：R2=Io2+Jo2在以圓心0'點為原點的I、J坐標(biāo)系中，圓的方程可表示為：I2+J2=R2設(shè)刀具已位于M1點，則Mi點對圓弧AB的位置有三種情況：Mi在圓弧外側(cè)，則0'Mi>R,Ii2+Ji2>R2Mi在圓弧上，則0’Mi=R,Ii2+Ji2=R2Mi在圓弧內(nèi)側(cè)，0’Mi<R,Ii2+Ji2<R2上述為在第一象限逆時針加工圓弧(稱逆圓弧)的情況，而在第一象隕順時針加工圓弧(順圓弧)和第二、三、四象限加工順圓弧和逆圓弧時，判別式都不相同。帶符號運算時，無論在哪個象限工作，順圓弧或逆圓弧，歸納起來有如下四種情+X方向走一步Ii+1=Ii+1Fi+1=Fi+2Ii+1-X方向走一步Ii+1=Ii-1Fi+1=Fi-2Ii+1+Y方向走一步Ji+1=Ji+1Fi+1=Fi+2Ji+1-Y方向走一步Ji+1=Ji-1Fi+1=Fi-2Ji+1圖3-7四個象限進(jìn)給方向定義四象限圓弧插補程序，以第一象限為例，其他只需改變電機(jī)的轉(zhuǎn)動的方向:voidCirclcl(floa7工n, 口口二jTijfl3itxcjflontyc,ir.tr】 //第一冢限圓弧插斗j=igniii'nttm;fir-Kir-xn+\ii+v7D-r^T:L.xi,.r./c|J匚/LTifn<=J)fnFf