|
《自控系統(tǒng)實(shí)驗(yàn)指導(dǎo)書》2017 實(shí)驗(yàn)二、直流電機(jī)角度控制 一、實(shí)驗(yàn)?zāi)康?/strong> - 掌握直流電機(jī)角度控制電路的組成。
- 學(xué)習(xí)直流電機(jī)角度控制系統(tǒng)的設(shè)計(jì)。
二、實(shí)驗(yàn)要求 在Proteus軟件平臺(tái)上，設(shè)計(jì)模擬控制電路實(shí)現(xiàn)對(duì)直流伺服電機(jī)（MOTOR-SERVO）的角度控制，角度控制在-100到+100度之間階躍，設(shè)計(jì)PID控制器，并調(diào)試參數(shù)使控制性能達(dá)到：階躍響應(yīng)超調(diào)≤5%。
三、控制對(duì)象 直流伺服電機(jī)（MOTOR-SERVO）及其線性功率放大電路如下，其中伺服電機(jī)含有角度檢測(cè)電位器，在反饋電位器加5V電源后，它就可以將角度轉(zhuǎn)換為0~5V電壓信號(hào)，H橋驅(qū)動(dòng)電機(jī)進(jìn)行轉(zhuǎn)動(dòng)，伺服電機(jī)的角度范圍應(yīng)修改為±179度，電機(jī)轉(zhuǎn)速分別設(shè)置為60、120、180轉(zhuǎn)/分，其他參數(shù)不能改。 四、設(shè)計(jì)提示 用示波器觀察反饋電壓、控制電壓和給定電壓波形，來測(cè)定控制系統(tǒng)的性能指標(biāo)。
實(shí)驗(yàn)小結(jié) 通過本次試驗(yàn)，我學(xué)習(xí)到了直流電機(jī)角度控制電路的組成。以及如何設(shè)計(jì)直流電機(jī)角度控制系統(tǒng)，本次實(shí)驗(yàn)較難，經(jīng)過課后努力基本解決了問題。
單片機(jī)源程序如下: - #include <reg52.h>
- #define uint unsigned int
- #define uchar unsigned char
- #define tim2 (-50000)
- #define LCD_COM 0 // Command
- #define LCD_DAT 1 // Data
- #define LCD1602_DATA P0
-
- sbit LcdRS=P2^0;
- sbit LcdRW=P2^1;
- sbit LcdEN=P2^2;
-
- sbit DAT = P3^2;
- sbit CLK = P3^3;
- sbit CS = P3^4;
- sbit SW1 = P3^0;
- sbit SW2 = P3^1;
- sbit LED = P3^7;
- sbit IN1 = P1^7;
- sbit IN2 = P1^6;
- sbit ENA = P1^5;
- bit PWM;
- uint PWMA,PWMB;
- int pos,set,e0,er;
- long speed=0;
-
- void DELAY(unsigned int t)
- {
- unsigned int i,j ;
- for(i=0;i<t;i++)
- for(j=0;j<50;j++);
- }
-
- void LCD_WRITE(unsigned char x,bit WS)
- {
- LCD1602_DATA=x;
- LcdRW=0;
- LcdRS=WS;
- LcdEN=1;
- DELAY(1);
- LcdEN=0;
- }
-
- void LCD_Initial()
- {
- LCD_WRITE(0x38,LCD_COM); DELAY(5);
- LCD_WRITE(0x38,LCD_COM); DELAY(5);
- LCD_WRITE(0x01,LCD_COM); DELAY(5);
- LCD_WRITE(0x06,LCD_COM); DELAY(5);
- LCD_WRITE(0x0c,LCD_COM); DELAY(5);
- }
-
- void GotoXY(unsigned char x,unsigned char y)
- {
- unsigned char code table[4]={0x00,0x40,0x10,0x50};
- LCD_WRITE(0x80+table[x]+y, LCD_COM);
- }
-
- void PutCh(char m)
- {
- LCD_WRITE(m,LCD_DAT);
- }
-
- void Print(unsigned char *str)
- {
- while(*str!='\0')
- {
- PutCh(*str);
- str++;
- }
- }
-
-
-
- void Timer2() interrupt 5
- {
- static uchar ms;
- TF2=0;
- if(++ms>2)
- {
- er=set-pos;
- speed+=er*15+(er-e0)*2;
- e0=er; ms=0;
- if(speed>833) speed=833;
- if(speed<-833) speed=-833;
- }
- }
-
-
-
- void Timer0() interrupt 1
- {
- ENA=PWM;
- if(PWM)
- {TH0=PWMA>>8; TL0=PWMA&0XFF;}
- else
- {TH0=PWMB>>8; TL0=PWMB&0XFF;}
- PWM=!PWM;
- }
-
-
- uint LTC1292(void)
- {
- uint i,x;
- CLK=0;DAT=1;CS=0;
- for(i=0;i<14;i++)
- {
- CLK=1;
- x<<=1;
- if(DAT==1) x++;
- CLK=0;
- }
- CS=1;
- return(x&0xfff);
- }
-
- if(speed>0) {IN1=1; IN2=0;}
- else if(speed<0) {IN1=0; IN2=1;}
- else {IN1=0; IN2=0;}
- if(s<0) s=-s;
- if(s>50000) s=50000;
- PWMA=-s; PWMB=-(50010-s);
- }
-
- void main()
- {
- int w;
- LCD_Initial();
- GotoXY(1,0); Print("Angle=0000");
- GotoXY(0,0); Print("Set=0000");
- IE=0x87; IT0=1; IT1=1;
- TMOD=0X21; TR0=1;
- RCAP2H=tim2>>8; RCAP2L=tim2&0xff;
- TH2=tim2>>8; TL2=tim2&0xff;
- ET2=1; TR2=1;
- IN2=0; IN1=0;
- while(1)
- {
- if(SW1==1)
- set=100;
- if(SW2==1)
- set=-100;
- w=(int)(-(double)LTC1292()*0.088+180);
- pos=w;
- SetPwm(speed);
- if(set>=0)
- {
- GotoXY(0,4);
- PutCh('+');
- PutCh(set/100+'0');
- PutCh((set/10)%10+'0');
- PutCh(set%10+'0');
- }
- else
- {
- GotoXY(0,4);
- PutCh('-');
- PutCh(-set/100+'0');
- PutCh((-set/10)%10+'0');
- PutCh(-set%10+'0');
- ……………………
- …………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
所有資料51hei提供下載:
| 
