⭐ 欢迎来到虫虫下载站! | 📦 资源下载 📁 资源专辑 ℹ️ 关于我们
⭐ 虫虫下载站

📄 ins_simulation.mdl

📁 这是我用simulink编制的惯性导航解算的程序
💻 MDL
📖 第 1 页 / 共 5 页
字号:
	      }
	      Branch {
		Points			[0, 175]
		DstBlock		"tran(T)"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "Demux"
	      SrcPort		      1
	      Points		      [5, 0; 0, -5]
	      DstBlock		      "(psai,sita,gama)"
	      DstPort		      1
	    }
	    Line {
	      Labels		      [0, 0]
	      SrcBlock		      "Demux"
	      SrcPort		      2
	      DstBlock		      "(psai,sita,gama)"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Demux"
	      SrcPort		      3
	      Points		      [5, 0; 0, 5]
	      DstBlock		      "(psai,sita,gama)"
	      DstPort		      3
	    }
	    Line {
	      SrcBlock		      "(psai,sita,gama)"
	      SrcPort		      1
	      Points		      [0, 0; 5, 0]
	      Branch {
		DstBlock		"Derivative"
		DstPort			1
	      }
	      Branch {
		DstBlock		"Subsystem"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "Subsystem"
	      SrcPort		      1
	      Points		      [20, 0; 0, 40]
	      DstBlock		      "Product"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "Derivative"
	      SrcPort		      1
	      Points		      [135, 0]
	      DstBlock		      "Product"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Constant"
	      SrcPort		      1
	      DstBlock		      "(omega)ie"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "(omega)ie"
	      SrcPort		      1
	      DstBlock		      "Sum"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "(omega)ep"
	      SrcPort		      1
	      Points		      [280, 0]
	      DstBlock		      "Sum"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "tran(T)"
	      SrcPort		      1
	      DstBlock		      "Product1"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "Sum"
	      SrcPort		      1
	      Points		      [5, 0]
	      DstBlock		      "Product1"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Product1"
	      SrcPort		      1
	      Points		      [10, 0]
	      DstBlock		      "Sum1"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Product"
	      SrcPort		      1
	      DstBlock		      "Sum1"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "random const"
	      SrcPort		      1
	      Points		      [15, 0]
	      DstBlock		      "Sum2"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "markov"
	      SrcPort		      1
	      Points		      [40, 0; 0, 3]
	      DstBlock		      "Sum2"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "white noise"
	      SrcPort		      1
	      Points		      [110, 0]
	      DstBlock		      "Sum2"
	      DstPort		      3
	    }
	    Line {
	      SrcBlock		      "Sum1"
	      SrcPort		      1
	      DstBlock		      "Sum3"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "Sum2"
	      SrcPort		      1
	      Points		      [280, 0]
	      DstBlock		      "Sum3"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Sum3"
	      SrcPort		      1
	      DstBlock		      "Out1"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "phi"
	      SrcPort		      1
	      Points		      [65, 0]
	      DstBlock		      "(omega)ie"
	      DstPort		      2
	    }
	  }
	}
	Block {
	  BlockType		  SubSystem
	  Name			  "导航计算模块"
	  Ports			  [6, 9]
	  Position		  [645, 210, 745, 500]
	  TreatAsAtomicUnit	  off
	  System {
	    Name		    "导航计算模块"
	    Location		    [-2, 56, 1014, 759]
	    Open		    off
	    ModelBrowserVisibility  off
	    ModelBrowserWidth	    200
	    ScreenColor		    "white"
	    PaperOrientation	    "landscape"
	    PaperPositionMode	    "auto"
	    PaperType		    "A4"
	    PaperUnits		    "centimeters"
	    ZoomFactor		    "100"
	    Block {
	      BlockType		      Inport
	      Name		      "fx"
	      Position		      [25, 428, 55, 442]
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "fy"
	      Position		      [25, 498, 55, 512]
	      Port		      "2"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "fz"
	      Position		      [25, 568, 55, 582]
	      Port		      "3"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "Wibx"
	      Position		      [175, 258, 205, 272]
	      Port		      "4"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "Wiby"
	      Position		      [175, 288, 205, 302]
	      Port		      "5"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "Wibz"
	      Position		      [175, 318, 205, 332]
	      Port		      "6"
	    }
	    Block {
	      BlockType		      Constant
	      Name		      "Constant"
	      Position		      [225, 414, 250, 436]
	      Value		      "[0,1,0]"
	    }
	    Block {
	      BlockType		      Constant
	      Name		      "Constant1"
	      Position		      [225, 449, 250, 471]
	      Value		      "[1,0,0]"
	    }
	    Block {
	      BlockType		      Constant
	      Name		      "Constant2"
	      Position		      [220, 554, 245, 576]
	      Value		      "[0,0,1]"
	    }
	    Block {
	      BlockType		      Reference
	      Name		      "Dot Product"
	      Ports		      [2, 1]
	      Position		      [280, 416, 310, 449]
	      SourceBlock	      "simulink/Math\nOperations/Dot Product"
	      SourceType	      "Dot Product"
	    }
	    Block {
	      BlockType		      Reference
	      Name		      "Dot Product1"
	      Ports		      [2, 1]
	      Position		      [280, 476, 310, 509]
	      SourceBlock	      "simulink/Math\nOperations/Dot Product"
	      SourceType	      "Dot Product"
	    }
	    Block {
	      BlockType		      Reference
	      Name		      "Dot Product2"
	      Ports		      [2, 1]
	      Position		      [280, 556, 310, 589]
	      SourceBlock	      "simulink/Math\nOperations/Dot Product"
	      SourceType	      "Dot Product"
	    }
	    Block {
	      BlockType		      MATLABFcn
	      Name		      "MATLAB Fcn"
	      Position		      [605, 175, 665, 205]
	      MATLABFcn		      "asin(u(3,2))"
	    }
	    Block {
	      BlockType		      MATLABFcn
	      Name		      "MATLAB Fcn1"
	      Position		      [605, 220, 665, 250]
	      MATLABFcn		      "atan(-u(3,1)/u(3,3))"
	    }
	    Block {
	      BlockType		      MATLABFcn
	      Name		      "MATLAB Fcn2"
	      Position		      [605, 265, 665, 295]
	      MATLABFcn		      "atan(-u(1,2)/u(2,2))"
	    }
	    Block {
	      BlockType		      Math
	      Name		      "Math\nFunction"
	      Ports		      [1, 1]
	      Position		      [505, 90, 535, 120]
	      Orientation	      "up"
	      Operator		      "transpose"
	    }
	    Block {
	      BlockType		      Reference
	      Name		      "Matrix\nConcatenation"
	      Ports		      [3, 1]
	      Position		      [85, 484, 140, 526]
	      SourceBlock	      "simulink/Math\nOperations/Matrix\nConca"
"tenation"
	      SourceType	      "Matrix Concatenation"
	      numInports	      "3"
	      catMethod		      "Vertical"
	    }
	    Block {
	      BlockType		      Product
	      Name		      "Product"
	      Ports		      [2, 1]
	      Position		      [170, 481, 205, 514]
	      Multiplication	      "Matrix(*)"
	      InputSameDT	      off
	    }
	    Block {
	      BlockType		      SubSystem
	      Name		      "Subsystem"
	      Ports		      [7, 1]
	      Position		      [355, 133, 515, 337]
	      TreatAsAtomicUnit	      off
	      System {
		Name			"Subsystem"
		Location		[0, 82, 1012, 743]
		Open			off
		ModelBrowserVisibility	off
		ModelBrowserWidth	200
		ScreenColor		"white"
		PaperOrientation	"landscape"
		PaperPositionMode	"auto"
		PaperType		"A4"
		PaperUnits		"centimeters"
		ZoomFactor		"100"
		Block {
		  BlockType		  Inport
		  Name			  "Wipx1"
		  Position		  [55, 83, 85, 97]
		}
		Block {
		  BlockType		  Inport
		  Name			  "Wipy1"
		  Position		  [55, 113, 85, 127]
		  Port			  "2"
		}
		Block {
		  BlockType		  Inport
		  Name			  "Wipz1"
		  Position		  [55, 143, 85, 157]
		  Port			  "3"
		}
		Block {
		  BlockType		  Inport
		  Name			  "Cbp(姿态矩阵的转置)"
		  Position		  [55, 43, 85, 57]
		  Port			  "4"
		}
		Block {
		  BlockType		  Inport
		  Name			  "Wibx"
		  Position		  [60, 203, 90, 217]
		  Port			  "5"
		}
		Block {
		  BlockType		  Inport
		  Name			  "Wiby"
		  Position		  [60, 238, 90, 252]
		  Port			  "6"
		}
		Block {
		  BlockType		  Inport
		  Name			  "Wibz"
		  Position		  [60, 273, 90, 287]
		  Port			  "7"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant"
		  Position		  [450, 70, 480, 100]
		  Value			  "[1 0 0]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant1"
		  Position		  [455, 135, 485, 165]
		  Value			  "[0 1 0]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant2"
		  Position		  [460, 195, 490, 225]
		  Value			  "[0 0 1]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant3"
		  Position		  [525, 20, 555, 50]
		  Value			  "0"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant4"
		  Position		  [845, 45, 875, 75]
		  Value			  "1/2"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant5"
		  Position		  [60, 326, 85, 344]
		  Value			  "[1 0 0 0]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant6"
		  Position		  [65, 381, 90, 399]
		  Value			  "[0 1 0 0]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant7"
		  Position		  [70, 431, 95, 449]
		  Value			  "[0 0 1 0]"
		}
		Block {
		  BlockType		  Constant
		  Name			  "Constant8"
		  Position		  [70, 486, 95, 504]
		  Value			  "[0 0 0 1]"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product1"
		  Ports			  [2, 1]
		  Position		  [520, 76, 550, 109]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product2"
		  Ports			  [2, 1]
		  Position		  [520, 141, 550, 174]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product3"
		  Ports			  [2, 1]
		  Position		  [525, 201, 555, 234]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product5"
		  Ports			  [2, 1]
		  Position		  [150, 326, 180, 359]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product6"
		  Ports			  [2, 1]
		  Position		  [155, 381, 185, 414]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product7"
		  Ports			  [2, 1]
		  Position		  [145, 431, 175, 464]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Dot Product8"
		  Ports			  [2, 1]
		  Position		  [150, 486, 180, 519]
		  SourceBlock		  "simulink/Math\nOperations/Dot Produ"
"ct"
		  SourceType		  "Dot Product"
		}
		Block {
		  BlockType		  Gain
		  Name			  "Gain"
		  Position		  [310, 115, 340, 145]
		  Gain			  "-1"
		}
		Block {
		  BlockType		  Gain
		  Name			  "Gain1"
		  Position		  [740, 35, 770, 65]
		  Gain			  "-1"
		}
		Block {
		  BlockType		  Gain
		  Name			  "Gain2"
		  Position		  [625, 150, 640, 170]
		  Gain			  "-1"
		}
		Block {
		  BlockType		  Gain
		  Name			  "Gain3"
		  Position		  [625, 210, 640, 230]
		  Gain			  "-1"
		}
		Block {
		  BlockType		  Gain
		  Name			  "Gain4"
		  Position		  [600, 270, 615, 290]
		  Gain			  "-1"
		}
		Block {
		  BlockType		  Integrator
		  Name			  "Integrator"
		  Ports			  [1, 1]
		  Position		  [970, 200, 1000, 230]
		  Orientation		  "down"
		  NamePlacement		  "alternate"
		  InitialCondition	  "[1;0;0;0]"
		}
		Block {
		  BlockType		  MATLABFcn
		  Name			  "MATLAB Fcn"
		  Position		  [675, 355, 735, 385]
		  MATLABFcn		  "[u(1)^2+u(2)^2-u(3)^3-u(4)^2,2*(u(2"
")*u(3)-u(1)*u(4)),2*(u(2)*u(4)+u(1)*u(3))]"
		  OutputDimensions	  "3"
		}
		Block {
		  BlockType		  MATLABFcn
		  Name			  "MATLAB Fcn1"
		  Position		  [680, 435, 740, 465]
		  MATLABFcn		  "[2*(u(2)*u(3)+u(1)*u(4)), u(1)^2-u("
"2)^2+u(3)^2-u(4)^2, 2*(u(3)*u(4)-u(1)*u(2))]"
		  OutputDimensions	  "3"
		}
		Block {
		  BlockType		  MATLABFcn
		  Name			  "MATLAB Fcn2"
		  Position		  [675, 515, 735, 545]
		  MATLABFcn		  "[2*(u(2)*u(4)-u(1)*u(3)),2*(u(3)*u("
"4)+u(1)*u(2)),u(1)^2-u(2)^2-u(3)^2+u(4)^2]"
		  OutputDimensions	  "3"
		}
		Block {
		  BlockType		  Math
		  Name			  "Math\nFunction"
		  Ports			  [1, 1]
		  Position		  [870, 435, 900, 465]
		  Operator		  "transpose"
		}
		Block {
		  BlockType		  Reference
		  Name			  "Matrix\nConcatenation"
		  Ports			  [3, 1]
		  Position		  [155, 114, 210, 156]

⌨️ 快捷键说明

复制代码 Ctrl + C
搜索代码 Ctrl + F
全屏模式 F11
切换主题 Ctrl + Shift + D
显示快捷键 ?
增大字号 Ctrl + =
减小字号 Ctrl + -