pd_sin.mdl

Fuzzy Precompensated Control

	      SrcBlock		      "Matrix\nConcatenation"
	      SrcPort		      1
	      Points		      [0, -10]
	      DstBlock		      "Product"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "2x2"
	      SrcPort		      1
	      Points		      [10, 0; 0, 10; 15, 0]
	      Branch {
		Points			[0, 55]
		DstBlock		"Selector2"
		DstPort			1
	      }
	      Branch {
		Points			[55, 0]
		DstBlock		"Selector1"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "Product"
	      SrcPort		      1
	      DstBlock		      "product"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "2x1"
	      SrcPort		      1
	      Points		      [0, -10]
	      DstBlock		      "Product"
	      DstPort		      2
	    }
	  }
	}
	Block {
	  BlockType		  SubSystem
	  Name			  "multiplication1\n"
	  Ports			  [2, 1]
	  Position		  [450, 40, 490, 100]
	  MinAlgLoopOccurrences	  off
	  RTWSystemCode		  "Auto"
	  FunctionWithSeparateData off
	  MaskHideContents	  off
	  System {
	    Name		    "multiplication1\n"
	    Location		    [118, 289, 573, 457]
	    Open		    off
	    ModelBrowserVisibility  off
	    ModelBrowserWidth	    200
	    ScreenColor		    "white"
	    PaperOrientation	    "landscape"
	    PaperPositionMode	    "auto"
	    PaperType		    "usletter"
	    PaperUnits		    "inches"
	    TiledPaperMargins	    [0.500000, 0.500000, 0.500000, 0.500000]
	    TiledPageScale	    1
	    ShowPageBoundaries	    off
	    ZoomFactor		    "100"
	    Block {
	      BlockType		      Inport
	      Name		      "2x2"
	      Position		      [15, 43, 45, 57]
	      IconDisplay	      "Port number"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "2x1"
	      Position		      [275, 93, 305, 107]
	      Port		      "2"
	      IconDisplay	      "Port number"
	    }
	    Block {
	      BlockType		      Concatenate
	      Name		      "Matrix\nConcatenation"
	      Ports		      [2, 1]
	      Position		      [210, 27, 270, 143]
	      Mode		      "Horizontal matrix concatenation"
	    }
	    Block {
	      BlockType		      Product
	      Name		      "Product"
	      Ports		      [2, 1]
	      Position		      [330, 66, 375, 99]
	      Multiplication	      "Matrix(*)"
	      RndMeth		      "Floor"
	    }
	    Block {
	      BlockType		      Selector
	      Name		      "Selector1"
	      Ports		      [1, 1]
	      Position		      [145, 36, 185, 74]
	      Elements		      "[1 3]"
	      InputPortWidth	      "4"
	    }
	    Block {
	      BlockType		      Selector
	      Name		      "Selector2"
	      Ports		      [1, 1]
	      Position		      [140, 96, 180, 134]
	      Elements		      "[2 4]"
	      InputPortWidth	      "4"
	    }
	    Block {
	      BlockType		      Outport
	      Name		      "product"
	      Position		      [400, 78, 430, 92]
	      IconDisplay	      "Port number"
	      BusOutputAsStruct	      off
	    }
	    Line {
	      SrcBlock		      "Selector1"
	      SrcPort		      1
	      DstBlock		      "Matrix\nConcatenation"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "Selector2"
	      SrcPort		      1
	      DstBlock		      "Matrix\nConcatenation"
	      DstPort		      2
	    }
	    Line {
	      SrcBlock		      "Matrix\nConcatenation"
	      SrcPort		      1
	      Points		      [0, -10]
	      DstBlock		      "Product"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "2x2"
	      SrcPort		      1
	      Points		      [10, 0; 0, 10; 15, 0]
	      Branch {
		Points			[0, 55]
		DstBlock		"Selector2"
		DstPort			1
	      }
	      Branch {
		Points			[55, 0]
		DstBlock		"Selector1"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "Product"
	      SrcPort		      1
	      DstBlock		      "product"
	      DstPort		      1
	    }
	    Line {
	      SrcBlock		      "2x1"
	      SrcPort		      1
	      Points		      [0, -10]
	      DstBlock		      "Product"
	      DstPort		      2
	    }
	  }
	}
	Block {
	  BlockType		  SubSystem
	  Name			  "robotdynamicSubsystem"
	  Ports			  [2, 2]
	  Position		  [85, 29, 255, 136]
	  MinAlgLoopOccurrences	  off
	  RTWSystemCode		  "Auto"
	  FunctionWithSeparateData off
	  MaskHideContents	  off
	  System {
	    Name		    "robotdynamicSubsystem"
	    Location		    [0, 82, 788, 559]
	    Open		    off
	    ModelBrowserVisibility  off
	    ModelBrowserWidth	    200
	    ScreenColor		    "white"
	    PaperOrientation	    "landscape"
	    PaperPositionMode	    "auto"
	    PaperType		    "usletter"
	    PaperUnits		    "inches"
	    TiledPaperMargins	    [0.500000, 0.500000, 0.500000, 0.500000]
	    TiledPageScale	    1
	    ShowPageBoundaries	    off
	    ZoomFactor		    "100"
	    Block {
	      BlockType		      Inport
	      Name		      "q"
	      Position		      [25, 143, 55, 157]
	      IconDisplay	      "Port number"
	    }
	    Block {
	      BlockType		      Inport
	      Name		      "qdot\n"
	      Position		      [30, 363, 60, 377]
	      Port		      "2"
	      IconDisplay	      "Port number"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux"
	      Ports		      [4, 1]
	      Position		      [455, 166, 460, 254]
	      ShowName		      off
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux1"
	      Ports		      [2, 1]
	      Position		      [575, 25, 580, 65]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux2"
	      Ports		      [2, 1]
	      Position		      [580, 70, 585, 110]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux3"
	      Ports		      [2, 1]
	      Position		      [580, 120, 585, 160]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux4"
	      Ports		      [4, 1]
	      Position		      [690, 46, 695, 134]
	      ShowName		      off
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux5"
	      Ports		      [2, 1]
	      Position		      [450, 265, 455, 305]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux6"
	      Ports		      [2, 1]
	      Position		      [450, 315, 455, 355]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux7"
	      Ports		      [2, 1]
	      Position		      [450, 375, 455, 415]
	      ShowName		      off
	      Inputs		      "2"
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Mux
	      Name		      "Mux8"
	      Ports		      [4, 1]
	      Position		      [660, 232, 670, 453]
	      ShowName		      off
	      DisplayOption	      "bar"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "c2"
	      Position		      [180, 140, 240, 170]
	      Expr		      "cos(u)"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "cor11"
	      Position		      [540, 245, 600, 275]
	      Expr		      "-2*u(2)*u(1)"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "cor12"
	      Position		      [550, 300, 610, 330]
	      Expr		      "-u(2)*u(1)"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "cor21"
	      Position		      [550, 355, 610, 385]
	      Expr		      "2.3*u(2)*u(1)"
	    }
	    Block {
	      BlockType		      Constant
	      Name		      "cor22"
	      Position		      [565, 410, 595, 440]
	      Value		      "0"
	      VectorParams1D	      on
	      SamplingMode	      "Sample based"
	      OutDataTypeMode	      "Inherit from 'Constant value'"
	      OutDataType	      "sfix(16)"
	      ConRadixGroup	      "Use specified scaling"
	      OutScaling	      "2^0"
	      SampleTime	      "inf"
	      FramePeriod	      "inf"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "factor"
	      Position		      [480, 195, 540, 225]
	      Expr		      "1/(u(1)*u(4)-u(2)*u(3))"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "m11"
	      Position		      [355, 35, 415, 65]
	      Expr		      "5.4+4.6*u"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "m12=m21"
	      Position		      [360, 95, 420, 125]
	      Expr		      "2.3+2.3*u"
	    }
	    Block {
	      BlockType		      Constant
	      Name		      "m22"
	      Position		      [295, 200, 325, 230]
	      Value		      "2.3"
	      VectorParams1D	      on
	      SamplingMode	      "Sample based"
	      OutDataTypeMode	      "Inherit from 'Constant value'"
	      OutDataType	      "sfix(16)"
	      ConRadixGroup	      "Use specified scaling"
	      OutScaling	      "2^0"
	      SampleTime	      "inf"
	      FramePeriod	      "inf"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "mi11"
	      Position		      [600, 30, 660, 60]
	      Expr		      "u(1)*u(2)"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "mi12=mi21"
	      Position		      [600, 75, 660, 105]
	      Expr		      "-u(1)*u(2)"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "mi22"
	      Position		      [605, 125, 665, 155]
	      Expr		      "u(1)*u(2)"
	    }
	    Block {
	      BlockType		      Selector
	      Name		      "q[2]"
	      Ports		      [1, 1]
	      Position		      [80, 131, 120, 169]
	      Elements		      "[2]"
	      InputPortWidth	      "2"
	    }
	    Block {
	      BlockType		      Selector
	      Name		      "qdot[1]"
	      Ports		      [1, 1]
	      Position		      [105, 306, 145, 344]
	      Elements		      "[1]"
	      InputPortWidth	      "2"
	    }
	    Block {
	      BlockType		      Selector
	      Name		      "qdot[2]"
	      Ports		      [1, 1]
	      Position		      [105, 376, 145, 414]
	      Elements		      "[2]"
	      InputPortWidth	      "2"
	    }
	    Block {
	      BlockType		      Fcn
	      Name		      "s2"
	      Position		      [185, 210, 245, 240]
	      Expr		      "sin(u)"
	    }
	    Block {
	      BlockType		      Outport
	      Name		      "Mass Inverse Matrix\n"
	      Position		      [740, 83, 770, 97]
	      IconDisplay	      "Port number"
	      BusOutputAsStruct	      off
	    }
	    Block {
	      BlockType		      Outport
	      Name		      "Coriolis/Centrifugal Matrix\n\n"
	      Position		      [745, 338, 775, 352]
	      Port		      "2"
	      IconDisplay	      "Port number"
	      BusOutputAsStruct	      off
	    }
	    Line {
	      SrcBlock		      "qdot\n"
	      SrcPort		      1
	      Points		      [0, 0; 15, 0]
	      Branch {
		Points			[0, 25]
		DstBlock		"qdot[2]"
		DstPort			1
	      }
	      Branch {
		Points			[0, -45]
		DstBlock		"qdot[1]"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "q[2]"
	      SrcPort		      1
	      Points		      [20, 0; 0, 5]
	      Branch {
		DstBlock		"c2"
		DstPort			1
	      }
	      Branch {
		Points			[0, 70]
		DstBlock		"s2"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "c2"
	      SrcPort		      1
	      Points		      [90, 0; 0, -45]
	      Branch {
		Points			[0, -60]
		DstBlock		"m11"
		DstPort			1
	      }
	      Branch {
		DstBlock		"m12=m21"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "m11"
	      SrcPort		      1
	      Points		      [20, 0; 0, 80]
	      Branch {
		DstBlock		"Mux"
		DstPort			1
	      }
	      Branch {
		DstBlock		"Mux3"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "m12=m21"
	      SrcPort		      1
	      Points		      [10, 0]
	      Branch {
		Points			[0, 90]
		Branch {
		  DstBlock		  "Mux"
		  DstPort		  2
		}
		Branch {
		  Points		  [0, 20]
		  DstBlock		  "Mux"
		  DstPort		  3
		}
	      }
	      Branch {
		Points			[0, -30]
		DstBlock		"Mux2"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "m22"
	      SrcPort		      1
	      Points		      [0, 0; 5, 0]
	      Branch {
		Points			[0, 25]
		DstBlock		"Mux"
		DstPort			4
	      }
	      Branch {
		Points			[0, -55; 120, 0; 0, -125]
		DstBlock		"Mux1"
		DstPort			1
	      }
	    }
	    Line {
	      SrcBlock		      "Mux"
	      SrcPort		      1
	      DstBlock		      "factor"
	      DstPort		      1
	    }