控制算法-總程序_第1頁
控制算法-總程序_第2頁
免費(fèi)預(yù)覽已結(jié)束，剩余2頁可下載查看

付費(fèi)下載

下載本文檔

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

文檔簡介

voidlvbo3() {uchara[3];//7uchari,j,k,temp;//3個變量{a[0]=ADV[k-for(i=0;i<2;i++)//6輪排{for(j=0;j<2-i;j++)//每輪進(jìn)行6-i次交{}}}}voidotsu_yuzhi(){intwh=128;intinIm[128];inti,t;intL=128;doublep[128];doublew1=0;doubleu0=0;doubleu1=0;doublemax=0.0;doublew0=0;intm=0;doublefor(i=0;i<128;inIm[i]=for(i=0;i<L;i++)p[i]=0;for(i=0;i<128;i++)for(m=0;m<L;m++)p[m]=p[m]/for(t=0;t<L;{w0=for(m=0;m<t+1;m++)w0+=p[m];w1=1-u0=for(m=0;m<t+1;m++)u0+=m*p[m]/w0;u1=for(m=t;m<L;m++)u1+=m*p[m]/w1;sigma[t]=w0*w1*(u0-u1)*(u0-}max=for(i=0;i<L-1;{if(max<{max=THRESHOLD=}}for(i=0;i<128;{}}void{intunsignedintlength1,length2,length3;intS;S=abs((y2-y1)*(x3-x1)-(y3-y1)*(x2-length1=sqrt((x2-x1)*(x2-x1)+(y2-y1)*(y2-length2=sqrt((x3-x1)*(x3-x1)+(y3-y1)*(y3-}/***************************PID函數(shù)*********************************/voidAngle_PID(intCENTER){floatangle_kp=7.38,angle_kd=17.2;//系 PD控if(lost_time==0||left_lost_time==0||right_lost_time==0 {//if(left_lost_time>20&& //elseif(left_lost_time==0&&if(angle<=angle_init-250)//防止系數(shù)過大導(dǎo)致舵機(jī){angle=angle_init-250;//6%-9%}{}}}for(i=Center[0];i>6;i //提取左{if(ADV[i]>(ADV[i-5]+45)&&ADV[i-1]>(ADV[i-{}

溫馨提示

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

評論

0/150

提交評論