设计九 基于模糊推理自主移动机器人避障控制.docVIP

附录 设计过程和程序清单 参考程序如下： function[x,y]=obstacleavoidance(T1,N1,T2,N2,T3,N3,X0,Y0,XG,YG,STEP) hold on x(1)=X0; y(1)=Y0; t1=pi/4; t2=pi/2; t3=3*pi/4; theta=0; n=1; if((N3==0)((N1+N2)==0)) error %只有A类障碍物的情况 else if((N3==0)((N1+N2)~=0)) while(((x(n)-XG)^2+(y(n)-YG)^2)STEP^2) dr=mindetected((t1-theta),T1,N1,T2,N2,x(n),y(n)); dc=mindetected((t2-theta),T1,N1,T2,N2,x(n),y(n)); dl=mindetected((t3-theta),T1,N1,T2,N2,x(n),y(n)); tg=atan((XG-x(n))+i*(YG-y(n)))*180/pi-theta; sa=fuzzylogic(dr,dc,dl,tg); step=STER*(1-abs(sa)/100); sa=sa*pi/180; x(n+1)=x(n)+step*sin(sa); y(n