clear;clc;
width=30 %道路宽
rl=5*width/8; %左转虚拟车道
rr=1*width/8; %右转虚拟车道
drr=pi/2*rr;
dstr=width-sqrt(rl^2-(width/8)^2); %直行距离
dl=(acos(width/8/rl))*rl; %左拐距离
ck=1.8 ; %车宽
cl=3.8 ; %车长
ddstr=sqrt((rl+ck/2)^2-(width/8+ck/2)^2)-sqrt(rl^2-(width/8)^2);
ddl=(acos(width/8/rl)-acos((width/8+ck/2)/(rl+ck/2)))*rl;
sl=dl;
sstr=dstr;
onetime=160;
dmin=2;
azb=[];
bzb=[];
alcar=[]; %行车矩阵
arcar=[];
astrcar=[];
blcar=[];
brcar=[];
bstrcar=[];
cjjlal=[];
cjjlar=[];
cjjlastr=[];%车间距
cjjlbl=[];
cjjlbr=[];
cjjlbstr=[];%车间距
完整代码链接:https://pan.baidu.com/s/1ZUfsttpdUvudgWt1iI2XcQ
提取码:dseq