load initial_track s; % y:initial data,s:data with noiseT=0.1;
% yp denotes the sample value of position% yv denotes the sample value of velocity% Y=[yp(n);yv(n)];% error deviation caused by the random acceleration % known dataY=zeros(2,200);Y0=[0;1];Y(:,1)=Y0;A=[1 T 0 1]; B=[1/2*(T)^2 T]';H=[1 0];
C0=[0 0 0 1];C=[C0 zeros(2,2*199)];Q=(0.25)^2; R=(0.25)^2;
[輸入]
圖的頂點個數(shù)N，圖中頂點之間的關系及起點A和終點B
[輸出]
若A到B無路徑，則輸出“There is no path” 否則輸出A到B路徑上個頂點
[存儲結構]
圖采用鄰接矩陣的方式存儲。
[算法的基本思想]
采用廣度優(yōu)先搜索的方法，從頂點A開始，依次訪問與A鄰接的頂點VA1,VA2,...,VAK, 訪問遍之后,若沒有訪問B，則繼續(xù)訪問與VA1鄰接的頂點VA11,VA12,...,VA1M，再訪問與VA2鄰接頂點...，如此下去，直至找到B，最先到達B點的路徑，一定是邊數(shù)最少的路徑。實現(xiàn)時采用隊列記錄被訪問過的頂點。每次訪問與隊頭頂點相鄰接的頂點，然后將隊頭頂點從隊列中刪去。若隊空，則說明到不存在通路。在訪問頂點過程中，每次把當前頂點的序號作為與其鄰接的未訪問的頂點的前驅頂點記錄下來，以便輸出時回溯。
#include<stdio.h>
int number //隊列類型
typedef struct{
int q[20]
the calculator s usage!
after you have inputed 2 operators,choose + - * / function!
But the only situation I did t deal with is that
when you choos + fuction ,and the operaters signs is like this
-A+B,just turn it to B-A!
