Files

 master

/

move_forward.m

Copy path

Blame

Blame

Latest commit

 

History

History

49 lines (48 loc) · 1.31 KB

 master

/

move_forward.m

Top

File metadata and controls

• Code
• Blame

49 lines (48 loc) · 1.31 KB

Raw

1

2

3

4

5

6

7

8

9

10

11

12

13

14

15

16

17

18

19

20

21

22

23

24

25

26

27

28

29

30

31

32

33

34

35

36

37

38

39

40

41

42

43

44

45

46

47

48

49

function [plaza,v,vmax]=move_forward(plaza,v,vmax);

[L,W]=size(plaza);%车道大小，包括边界

%step4:计算该前进和该左转的车辆

gap=zeros(L,W);

for lanes=2:W-1;

temp=find(plaza(:,lanes)==1);

nn=length(temp);%该车道的车的数量

for k=1:nn;

i=temp(k);

if(k==nn)

gap(i,lanes)=L-(temp(k)-temp(1)+1);%为周期边界循环预处理的车距

continue;

end

gap(i,lanes)=temp(k+1)-temp(k)-1;

end

end

% for i=1:L;

% for j=1:W;

% if(plaza(i,j)~=1)

% v(i,j)=-88;

% gap(i,j)=-99;

% end

% end

% end

% v

% gap

for lanes=2:W-1;

temp=find(plaza(:,lanes)==1);

nn=length(temp);

for k=1:nn;

i=temp(k);

if(v(i,lanes)<=gap(i,lanes))

pos=mod(i+v(i,lanes)-1,L)+1;

end

if(v(i,lanes)>gap(i,lanes))

pos=mod(i+gap(i,lanes)-1,L)+1;

end

if(pos~=i)

plaza(pos,lanes)=1;

v(pos,lanes)=v(i,lanes);

vmax(pos,lanes)=vmax(i,lanes);

plaza(i,lanes)=0;

v(i,lanes)=0;

vmax(i,lanes)=0;

end

end

end

end