基于tms320f2812的無刷直流電機(jī)控制-閱讀頁
2024-11-27 08:38本頁面
【正文】 Uint16 direction。 //撥碼開關(guān) 1，位置在上為 0，在下為 1 Uint32 counter=0。 //實(shí)際速度 int16 givespeed=0。 //速度差值 Uint16 null,keycode,key。 Uint16 watchduty=0。 //PID 參數(shù) float Ki=0。 float Last=0。 //傳 遞上上次變量 float PidResult=0。 //初始化 DSP 運(yùn)行時(shí)鐘 InitPieCtrl()。 //關(guān)總中斷 IER=0x0000。 //清除所有的 CPU 級中斷請求標(biāo)志 InitPieVectTable()。 //初始化 EVA 模塊 EALLOW。CAPINT_ISR。CAPINT_ISR。CAPINT_ISR。T2_ISR。 =0xFFFF。 =0x0007。 // 使能 T2 周期匹配中斷 ，外設(shè)級 //使能 PIE 中組 3 的第 1,5,6,7 個(gè)中斷 =1。 //CAPINT2 =1。 //T2PINT 1 direc=DIPS。0x0001。 Kp= 。Kd= 。 IER|=M_INT3。 //使能全局中斷 ERTM。 //啟動(dòng)定時(shí)器 T1 =1。 //允許 CPU 對 PIE 中斷請求進(jìn)行響應(yīng) Lcd_Init()。 //LCD 清屏 LcdWrite()。 //讀鍵盤碼 null=CTRLCDCR。0x00FF。 break。 break。 break。 break。 break。 break。 break。 break。 } if(givespeed0){givespeed=0。} PutValue(72,17,givespeed)。 //顯示實(shí)際速度 watchduty=(Uint16)((1(float)Duty/Period)*100)。 //顯示占空比 } } void InitEv(void) { EALLOW。 //設(shè)定 EVA 的引腳為外設(shè) EDIS。 //連續(xù)增 /減計(jì)數(shù)模式，暫不啟動(dòng)定時(shí)器 T1 的運(yùn)行 =0x0753。 //清零 T1 定時(shí)器的計(jì)數(shù)寄存器 =0x0000。 // pwm1~pwm6 強(qiáng)制低 。 //死區(qū)設(shè)為 1 個(gè) CPU 時(shí)鐘周期 =0xA6E0。 //初始占空比 30% =0x0521。 //初始占空比 30% =0x36FC。 //清空 FIFO =0x1704。 //每 100ms 中斷一次 =0x0000。 hall_status=hallamp。 //檢測 CAP1~CAP3 引腳的當(dāng)前狀態(tài) if(direction==0) //正轉(zhuǎn)換向 switch(hall_status) { case 0x0500: =0x0038。 // PWM2/PWM3 101→ ANB case 0x0100: =0x0830。 // PWM6/PWM3 001→ ANC case 0x0300: =0x0803。 // PWM6/PWM1 011→ CNA case 0x0200: =0x0083。 // PWM4/PWM1 010→ CNB case 0x0600: =0x0380。 // PWM4/PWM5 110→ BNC case 0x0400: =0x0308。 // PWM2/PWM5 100→ ANC default: break。 break。 break。 break。 break。 break。 break。 } } interrupt void CAPINT_ISR(void) { direc=DIPS。0x0001。 if(counter1000) {counter=0。 //對中斷次數(shù)累加，得到換相數(shù)以計(jì)算轉(zhuǎn)速 =0xFFFF。 //允許 CPU 對下次 PIE 中斷請求進(jìn)行響應(yīng) } interrupt void T2_ISR(void) { speed=100*counter。 //速度差值 PidResult=Kp*(EspeedLast)+Ki*Espeed+Kd*(Espeed2*Last+LLast)。 Last=Espeed。 if(Duty0) Duty=0。 ===Duty。 //將換相數(shù)清零 =0xFFFF。 //允許 CPU 對下次 PIE 中斷請求進(jìn)行響應(yīng) re
教學(xué)課件相關(guān)推薦
鄂ICP備17016276號-1