mc9s12xs128必須看motorpid源代碼_第1頁
mc9s12xs128必須看motorpid源代碼_第2頁
mc9s12xs128必須看motorpid源代碼_第3頁
mc9s12xs128必須看motorpid源代碼_第4頁
mc9s12xs128必須看motorpid源代碼_第5頁
全文預(yù)覽已結(jié)束

下載本文檔

版權(quán)說明：本文檔由用戶提供并上傳，收益歸屬內(nèi)容提供方，若內(nèi)容存在侵權(quán)，請(qǐng)進(jìn)行舉報(bào)或認(rèn)領(lǐng)

文檔簡介

Motor (c)Copyright2009-2010, s lude /*commondefinesandmacros lude typedefstruct{intSetPoint設(shè)定目標(biāo)DesireddoubleIntegral;//積分常數(shù)IntegralConstdoubleDerivative;//微分常數(shù)DerivativeConstintLastError;//Error[-1]}//PID實(shí)staticPIDstaticPID*sptr=int int unsignedintCurrentVelocity=0;unsignedintWholeVelocity=0;unsignedcharflag=0;unsignedchar void { SYNR=0XC0|0X05;REFDV=0X80|0X01; } void{ =0x00; //T0、T1設(shè)置為輸入捕捉,頭行場(chǎng)中斷---關(guān)輸出比較通道7TCTL1=0x00; //OC7與邏輯通道斷開TCTL4 //0上升沿觸發(fā),1 TSCR1 //使能PA,門計(jì)數(shù)模式,上升沿,中斷0101 //0，1 1 } PITLD0=4000-1;//16位定時(shí)器初值設(shè)定。PITTIME*0.01MS} void{ motor motor = CTL= CAE POL= //先輸出計(jì)數(shù)到DTY時(shí)，反轉(zhuǎn)電PRCLK= //ClockA8分頻=BusClock/8=6MHzClockB8分頻SCLA=0x03; SCLB= //CH0145選擇clockSA做時(shí)鐘源;CH2367選擇clockSB //1，3CNT01=CNT23=CNT45= E }void sptr->Proportion=P_DATA;//比例常數(shù)ProportionalConstsptr->Integral=I_DATA; //積分常數(shù)IntegralConst //微分常數(shù)Derivative }intPIDCalc(int{ iErrorsptr->SetPoint pidsptr->Proportion* +sptr->Derivative*sptr->PrevError;//E[k－2]項(xiàng)sptr->PrevError=sptr->LastError;//誤差，用于下次計(jì)算sptr->LastError= } vo

溫馨提示

  • 1. 本站所有資源如無特殊說明，都需要本地電腦安裝OFFICE2007和PDF閱讀器。圖紙軟件為CAD,CAXA,PROE,UG,SolidWorks等.壓縮文件請(qǐng)下載最新的WinRAR軟件解壓。
  • 2. 本站的文檔不包含任何第三方提供的附件圖紙等，如果需要附件，請(qǐng)聯(lián)系上傳者。文件的所有權(quán)益歸上傳用戶所有。
  • 3. 本站RAR壓縮包中若帶圖紙，網(wǎng)頁內(nèi)容里面會(huì)有圖紙預(yù)覽，若沒有圖紙預(yù)覽就沒有圖紙。
  • 4. 未經(jīng)權(quán)益所有人同意不得將文件中的內(nèi)容挪作商業(yè)或盈利用途。
  • 5. 人人文庫網(wǎng)僅提供信息存儲(chǔ)空間，僅對(duì)用戶上傳內(nèi)容的表現(xiàn)方式做保護(hù)處理，對(duì)用戶上傳分享的文檔內(nèi)容本身不做任何修改或編輯，并不能對(duì)任何下載內(nèi)容負(fù)責(zé)。
  • 6. 下載文件中如有侵權(quán)或不適當(dāng)內(nèi)容，請(qǐng)與我們聯(lián)系，我們立即糾正。
  • 7. 本站不保證下載資源的準(zhǔn)確性、安全性和完整性, 同時(shí)也不承擔(dān)用戶因使用這些下載資源對(duì)自己和他人造成任何形式的傷害或損失。

評(píng)論

0/150

提交評(píng)論