控制算法-总程序_第1页
控制算法-总程序_第2页
免费预览已结束，剩余2页可下载查看

下载本文档

版权说明：本文档由用户提供并上传，收益归属内容提供方，若内容存在侵权，请进行举报或认领

文档简介

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++)//每轮进行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函数*********************************/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)//防止系数过大导致舵机{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. 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论