📄 simtrackerkalman.mdl
字号:
SampleTime "-1"
SaveFormat "Array"
}
Block {
BlockType Mux
Name "Mux"
Ports [2, 1]
Position [470, 180, 475, 260]
ShowName off
Inputs "2"
DisplayOption "bar"
}
Block {
BlockType Mux
Name "Mux1"
Ports [2, 1]
Position [316, 160, 354, 165]
Orientation "up"
NamePlacement "alternate"
ShowName off
Inputs "2"
DisplayOption "bar"
}
Block {
BlockType ToWorkspace
Name "Position"
Position [300, 115, 370, 135]
Orientation "up"
ForegroundColor "red"
BackgroundColor "yellow"
VariableName "XYCoords"
MaxDataPoints "inf"
SaveFormat "Array"
}
Block {
BlockType SubSystem
Name "Radar\nKalman Filter"
Ports [1, 2]
Position [580, 172, 665, 263]
ForegroundColor "green"
BackgroundColor "[0.000000, 0.501961, 0.501961]"
TreatAsAtomicUnit off
System {
Name "Radar\nKalman Filter"
Location [13, 247, 630, 496]
Open off
ModelBrowserVisibility off
ModelBrowserWidth 200
ScreenColor "white"
PaperOrientation "landscape"
PaperPositionMode "auto"
PaperType "usletter"
PaperUnits "inches"
ZoomFactor "100"
Block {
BlockType Inport
Name "Measurements"
Position [25, 43, 55, 57]
}
Block {
BlockType Constant
Name "\n"
Position [175, 105, 215, 125]
Orientation "up"
ForegroundColor "green"
Value "deltat"
}
Block {
BlockType UnitDelay
Name "\nxhat"
Position [300, 125, 330, 155]
Orientation "left"
ForegroundColor "green"
X0 "[0.001; 0.01; 0.001; 400; zeros(16,1)]"
SampleTime "deltat"
}
Block {
BlockType Demux
Name "Demux1"
Ports [1, 3]
Position [370, 38, 375, 82]
ForegroundColor "green"
BackgroundColor "black"
ShowName off
Outputs "[2 20 1]"
}
Block {
BlockType MATLABFcn
Name "Extended\nKalman Filter"
Position [265, 45, 325, 75]
ForegroundColor "green"
MATLABFcn "filteredoutput"
OutputDimensions "23"
}
Block {
BlockType Mux
Name "Mux2"
Ports [3, 1]
Position [220, 42, 225, 78]
ForegroundColor "green"
ShowName off
Inputs "3"
DisplayOption "bar"
}
Block {
BlockType Selector
Name "Selector"
Ports [1, 1]
Position [480, 73, 520, 207]
ForegroundColor "green"
ShowName off
Elements "[1:4]"
InputPortWidth "20"
}
Block {
BlockType Terminator
Name "Terminator"
Position [390, 95, 410, 115]
Orientation "down"
ForegroundColor "green"
NamePlacement "alternate"
ShowName off
}
Block {
BlockType ZeroOrderHold
Name "Zero-Order\nHold"
Position [95, 35, 125, 65]
ForegroundColor "green"
SampleTime "deltat"
}
Block {
BlockType Outport
Name "Resid."
Position [560, 38, 590, 52]
ForegroundColor "green"
InitialOutput "0"
}
Block {
BlockType Outport
Name "Est. Pos."
Position [565, 133, 595, 147]
ForegroundColor "green"
Port "2"
InitialOutput "0"
}
Line {
SrcBlock "Measurements"
SrcPort 1
DstBlock "Zero-Order\nHold"
DstPort 1
}
Line {
SrcBlock "Extended\nKalman Filter"
SrcPort 1
DstBlock "Demux1"
DstPort 1
}
Line {
SrcBlock "Zero-Order\nHold"
SrcPort 1
DstBlock "Mux2"
DstPort 1
}
Line {
SrcBlock "Selector"
SrcPort 1
DstBlock "Est. Pos."
DstPort 1
}
Line {
SrcBlock "Demux1"
SrcPort 1
DstBlock "Resid."
DstPort 1
}
Line {
SrcBlock "Demux1"
SrcPort 2
Points [55, 0; 0, 80]
Branch {
DstBlock "\nxhat"
DstPort 1
}
Branch {
DstBlock "Selector"
DstPort 1
}
}
Line {
SrcBlock "\n"
SrcPort 1
Points [0, -30]
DstBlock "Mux2"
DstPort 3
}
Line {
SrcBlock "\nxhat"
SrcPort 1
Points [-135, 0; 0, -80]
DstBlock "Mux2"
DstPort 2
}
Line {
SrcBlock "Mux2"
SrcPort 1
DstBlock "Extended\nKalman Filter"
DstPort 1
}
Line {
SrcBlock "Demux1"
SrcPort 3
Points [20, 0]
DstBlock "Terminator"
DstPort 1
}
Annotation {
Name "Update Time"
Position [251, 117]
}
}
}
Block {
BlockType Reference
Name "Random aircraft\nmotion"
Ports [0, 1]
Position [65, 183, 95, 217]
BackgroundColor "yellow"
FontName "Arial"
FontSize 11
FontWeight "bold"
FontAngle "italic"
SourceBlock "simulink/Sources/Band-Limited\nWhite Noise"
SourceType "Continuous White Noise."
Cov "[0.001 .001]"
Ts "0.1"
seed "[58413 74925]"
VectorParams1D on
}
Block {
BlockType ToWorkspace
Name "Residuals"
Position [700, 184, 780, 206]
ForegroundColor "green"
BackgroundColor "[0.000000, 0.501961, 0.501961]"
VariableName "residual"
MaxDataPoints "inf"
SampleTime "-1"
SaveFormat "Array"
}
Block {
BlockType Sum
Name "Sum"
Ports [2, 1]
Position [490, 205, 520, 235]
BackgroundColor "[0.501961, 0.000000, 1.000000]"
ShowName off
IconShape "round"
Inputs "|++"
}
Block {
BlockType ToWorkspace
Name "Tracker Meas. Noise\n"
Position [545, 315, 645, 335]
ForegroundColor "red"
BackgroundColor "yellow"
VariableName "Measurement_noise"
MaxDataPoints "inf"
SaveFormat "Array"
}
Block {
BlockType SubSystem
Name "Tracker Noise"
Ports [0, 1]
Position [375, 295, 445, 355]
BackgroundColor "yellow"
TreatAsAtomicUnit off
System {
Name "Tracker Noise"
Location [380, 316, 605, 445]
Open off
ModelBrowserVisibility off
ModelBrowserWidth 200
ScreenColor "white"
PaperOrientation "landscape"
PaperPositionMode "auto"
PaperType "usletter"
PaperUnits "inches"
ZoomFactor "100"
Block {
BlockType StateSpace
Name "Meas. Noise\nIntensity"
Position [120, 29, 145, 61]
BackgroundColor "[0.501961, 0.000000, 1.000000]"
A "[]"
B "[]"
C "[]"
D "K"
MaskType "Matrix Gain"
MaskDescription "Matrix Gain."
MaskHelp "Multiplies input vector by entered matrix t"
"o produce output vector (y=Au)."
MaskPromptString "Gain matrix:"
MaskStyleString "edit"
MaskTunableValueString "on"
MaskEnableString "on"
MaskVisibilityString "on"
MaskToolTipString "on"
MaskInitialization "K = @1;"
MaskDisplay "disp('K')"
MaskIconFrame on
MaskIconOpaque on
MaskIconRotate "none"
MaskIconUnits "autoscale"
MaskValueString "[300 0; 0 .01]"
}
Block {
BlockType Reference
Name "Tracker\nMeasurment\nNoise"
Ports [0, 1]
Position [25, 74, 65, 106]
BackgroundColor "yellow"
SourceBlock "simulink/Sources/Band-Limited\nWhite Noise"
SourceType "Continuous White Noise."
Cov "[1 1]"
Ts "0.1"
seed "[52341 62341]"
VectorParams1D on
}
Block {
BlockType Outport
Name "Noise Intensity"
Position [170, 40, 200, 54]
}
Line {
SrcBlock "Tracker\nMeasurment\nNoise"
SrcPort 1
Points [0, -45]
DstBlock "Meas. Noise\nIntensity"
DstPort 1
}
Line {
SrcBlock "Meas. Noise\nIntensity"
SrcPort 1
DstBlock "Noise Intensity"
DstPort 1
}
}
}
Line {
SrcBlock "Aircraft Dynamics"
SrcPort 2
Points [60, 0; 0, 10]
Branch {
DstBlock "Mux1"
DstPort 2
}
Branch {
DstBlock "Cartesian to Polar"
DstPort 2
}
}
Line {
Name "Bearing"
Labels [0, 0]
SrcBlock "Cartesian to Polar"
SrcPort 2
DstBlock "Mux"
DstPort 2
}
Line {
Name "Range"
Labels [0, 0; 0, 0; 0, 0; 0, 0; 0, 0; 0, 0]
SrcBlock "Cartesian to Polar"
SrcPort 1
DstBlock "Mux"
DstPort 1
}
Line {
SrcBlock "Mux"
SrcPort 1
DstBlock "Sum"
DstPort 1
}
Line {
SrcBlock "Sum"
SrcPort 1
Points [0, 0; 15, 0]
Branch {
DstBlock "Radar\nKalman Filter"
DstPort 1
}
Branch {
Points [0, -40; 50, 0]
DstBlock " Radar Range andBearing\n "
DstPort 1
}
}
Line {
SrcBlock "Aircraft Dynamics"
SrcPort 1
Points [40, 0]
Branch {
DstBlock "Mux1"
DstPort 1
}
Branch {
DstBlock "Cartesian to Polar"
DstPort 1
}
}
Line {
SrcBlock "Actual Speed"
SrcPort 1
Points [0, -60]
DstBlock "Aircraft Dynamics"
DstPort 2
}
Line {
SrcBlock "Radar\nKalman Filter"
SrcPort 1
DstBlock "Residuals"
DstPort 1
}
Line {
SrcBlock "Random aircraft\nmotion"
SrcPort 1
DstBlock "Aircraft Dynamics"
DstPort 1
}
Line {
SrcBlock "Radar\nKalman Filter"
SrcPort 2
DstBlock "Est. Position\n"
DstPort 1
}
Line {
SrcBlock "Mux1"
SrcPort 1
DstBlock "Position"
DstPort 1
}
Line {
SrcBlock "Tracker Noise"
SrcPort 1
Points [0, 0; 55, 0]
Branch {
DstBlock "Tracker Meas. Noise\n"
DstPort 1
}
Branch {
DstBlock "Sum"
DstPort 2
}
}
Annotation {
Name " ESTIMATION OF AIRCRAFT TRAJECTORY FROM ITS MOT"
"ION \nUSING KALMAN TRACKING FILTER"
Position [403, 38]
BackgroundColor "[0.752941, 0.752941, 0.752941]"
FontName "Arial"
FontSize 17
FontWeight "bold"
FontAngle "italic"
}
}
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -