chap5_5sim.mdl

机器人控制仿真程序一书的所有源代码

    }
    Block {
      BlockType		      Mux
      Name		      "Mux"
      Ports		      [2, 1]
      Position		      [570, 86, 575, 124]
      ShowName		      off
      Inputs		      "2"
      DisplayOption	      "bar"
    }
    Block {
      BlockType		      Mux
      Name		      "Mux1"
      Ports		      [4, 1]
      Position		      [540, 166, 545, 204]
      ShowName		      off
      DisplayOption	      "bar"
    }
    Block {
      BlockType		      Mux
      Name		      "Mux2"
      Ports		      [4, 1]
      Position		      [335, 138, 360, 207]
      ShowName		      off
    }
    Block {
      BlockType		      "S-Function"
      Name		      "S-Function"
      Ports		      [1, 1]
      Position		      [700, 82, 800, 118]
      FunctionName	      "chap5_5plant"
    }
    Block {
      BlockType		      "S-Function"
      Name		      "S-Function1"
      Ports		      [0, 1]
      Position		      [25, 133, 110, 167]
      FunctionName	      "chap5_5input"
    }
    Block {
      BlockType		      "S-Function"
      Name		      "S-Function2"
      Ports		      [1, 1]
      Position		      [390, 157, 475, 193]
      FunctionName	      "chap5_5ctrl"
    }
    Block {
      BlockType		      Sum
      Name		      "Sum9"
      Ports		      [2, 1]
      Position		      [590, 110, 610, 130]
      Orientation	      "up"
      ShowName		      off
      IconShape		      "round"
      Inputs		      "|++"
      InputSameDT	      off
      OutDataTypeMode	      "Inherit via internal rule"
    }
    Block {
      BlockType		      Switch
      Name		      "Switch"
      Position		      [555, 290, 590, 340]
      Criteria		      "u2 > Threshold"
      InputSameDT	      off
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace"
      Position		      [100, 267, 130, 293]
      VariableName	      "t"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace1"
      Position		      [705, 34, 735, 56]
      VariableName	      "T"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace2"
      Position		      [860, 83, 890, 117]
      VariableName	      "q"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace3"
      Position		      [200, 239, 230, 261]
      Orientation	      "left"
      VariableName	      "k"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace4"
      Position		      [590, 174, 620, 196]
      VariableName	      "e"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace7"
      Position		      [180, 94, 210, 116]
      VariableName	      "qd"
      MaxDataPoints	      "inf"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      FromWorkspace
      Name		      "current \niteraton \nnum"
      Position		      [215, 305, 265, 325]
      ShowName		      off
      VariableName	      "[t k]"
      SampleTime	      "0"
    }
    Line {
      SrcBlock		      "S-Function"
      SrcPort		      1
      Points		      [20, 0]
      Branch {
	DstBlock		"To Workspace2"
	DstPort			1
      }
      Branch {
	Points			[0, 310; -660, 0; 0, -245]
	DstBlock		"Mux2"
	DstPort			2
      }
    }
    Line {
      SrcBlock		      "Clock"
      SrcPort		      1
      DstBlock		      "To Workspace"
      DstPort		      1
    }
    Line {
      SrcBlock		      "S-Function1"
      SrcPort		      1
      Points		      [0, 0; 20, 0]
      Branch {
	Points			[0, -45]
	DstBlock		"To Workspace7"
	DstPort			1
      }
      Branch {
	DstBlock		"Mux2"
	DstPort			1
      }
    }
    Line {
      SrcBlock		      "Sum9"
      SrcPort		      1
      Points		      [0, -5; 45, 0]
      Branch {
	DstBlock		"S-Function"
	DstPort			1
      }
      Branch {
	Points			[0, -55]
	DstBlock		"To Workspace1"
	DstPort			1
      }
    }
    Line {
      SrcBlock		      "Switch"
      SrcPort		      1
      Points		      [90, 0; 0, -195]
      DstBlock		      "Sum9"
      DstPort		      2
    }
    Line {
      SrcBlock		      "Constant"
      SrcPort		      1
      Points		      [90, 0; 0, -30]
      DstBlock		      "Switch"
      DstPort		      3
    }
    Line {
      SrcBlock		      "Mux2"
      SrcPort		      1
      DstBlock		      "S-Function2"
      DstPort		      1
    }
    Line {
      SrcBlock		      "From\nWorkspace1"
      SrcPort		      1
      Points		      [75, 0; 0, 50]
      DstBlock		      "Switch"
      DstPort		      1
    }
    Line {
      SrcBlock		      "current \niteraton \nnum"
      SrcPort		      1
      Points		      [10, 0; 30, 0]
      Branch {
	DstBlock		"Switch"
	DstPort			2
      }
      Branch {
	Points			[0, -65]
	Branch {
	  DstBlock		  "Fcn"
	  DstPort		  1
	}
	Branch {
	  Points		  [0, -70]
	  DstBlock		  "Mux2"
	  DstPort		  3
	}
      }
    }
    Line {
      SrcBlock		      "Fcn"
      SrcPort		      1
      DstBlock		      "To Workspace3"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Mux"
      SrcPort		      1
      Points		      [5, 0; 0, 40]
      DstBlock		      "Sum9"
      DstPort		      1
    }
    Line {
      SrcBlock		      "S-Function2"
      SrcPort		      1
      DstBlock		      "Demux"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      1
      Points		      [20, 0; 0, -55]
      DstBlock		      "Mux"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      2
      Points		      [30, 0]
      DstBlock		      "Mux"
      DstPort		      2
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      3
      DstBlock		      "Mux1"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      5
      DstBlock		      "Mux1"
      DstPort		      3
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      4
      DstBlock		      "Mux1"
      DstPort		      2
    }
    Line {
      SrcBlock		      "Demux"
      SrcPort		      6
      DstBlock		      "Mux1"
      DstPort		      4
    }
    Line {
      SrcBlock		      "Mux1"
      SrcPort		      1
      DstBlock		      "To Workspace4"
      DstPort		      1
    }
    Line {
      SrcBlock		      "From\nWorkspace2"
      SrcPort		      1
      DstBlock		      "Mux2"
      DstPort		      4
    }
    Annotation {
      Name		      "Tj"
      Position		      [624, 91]
    }
    Annotation {
      Name		      "Tj-1"
      Position		      [615, 146]
    }
    Annotation {
      Name		      "j"
      Position		      [300, 306]
    }
    Annotation {
      Name		      "From\nWorkspace1\n"
      Position		      [254, 355]
    }
  }
}