demo3.mdl

来自「Robotics TOOLBOX The Toolbox provides m」· MDL 代码 · 共 469 行

Model {
  Name			  "demo3"
  Version		  4.00
  SampleTimeColors	  off
  LibraryLinkDisplay	  "all"
  WideLines		  on
  ShowLineDimensions	  on
  ShowPortDataTypes	  off
  RecordCoverage	  off
  CovPath		  "/"
  CovSaveName		  "covdata"
  CovNameIncrementing	  off
  CovHtmlReporting	  on
  BlockNameDataTip	  off
  BlockParametersDataTip  on
  BlockDescriptionStringDataTip	off
  ToolBar		  on
  StatusBar		  on
  BrowserShowLibraryLinks off
  BrowserLookUnderMasks	  off
  Created		  "Tue Jan  8 12:29:23 2002"
  Creator		  "pic"
  UpdateHistory		  "UpdateHistoryNever"
  ModifiedByFormat	  "%<Auto>"
  LastModifiedBy	  "pic"
  ModifiedDateFormat	  "%<Auto>"
  LastModifiedDate	  "Mon Apr  8 11:37:59 2002"
  ModelVersionFormat	  "1.%<AutoIncrement:19>"
  ConfigurationManager	  "none"
  SimParamPage		  "Solver"
  StartTime		  "0.0"
  StopTime		  "10.0"
  SolverMode		  "Auto"
  Solver		  "ode45"
  RelTol		  "1e-3"
  AbsTol		  "auto"
  Refine		  "1"
  MaxStep		  "auto"
  MinStep		  "auto"
  MaxNumMinSteps	  "-1"
  InitialStep		  "auto"
  FixedStep		  "auto"
  MaxOrder		  5
  OutputOption		  "RefineOutputTimes"
  OutputTimes		  "[]"
  LoadExternalInput	  off
  ExternalInput		  "[t, u]"
  SaveTime		  on
  TimeSaveName		  "tout"
  SaveState		  off
  StateSaveName		  "xout"
  SaveOutput		  on
  OutputSaveName	  "yout"
  LoadInitialState	  off
  InitialState		  "xInitial"
  SaveFinalState	  off
  FinalStateName	  "xFinal"
  SaveFormat		  "Array"
  LimitDataPoints	  off
  MaxDataPoints		  "1000"
  Decimation		  "1"
  AlgebraicLoopMsg	  "warning"
  MinStepSizeMsg	  "warning"
  UnconnectedInputMsg	  "warning"
  UnconnectedOutputMsg	  "warning"
  UnconnectedLineMsg	  "warning"
  InheritedTsInSrcMsg	  "warning"
  SingleTaskRateTransMsg  "none"
  MultiTaskRateTransMsg	  "error"
  IntegerOverflowMsg	  "warning"
  CheckForMatrixSingularity "none"
  UnnecessaryDatatypeConvMsg "none"
  Int32ToFloatConvMsg	  "warning"
  SignalLabelMismatchMsg  "none"
  LinearizationMsg	  "none"
  VectorMatrixConversionMsg "none"
  SfunCompatibilityCheckMsg "none"
  BlockPriorityViolationMsg "warning"
  ArrayBoundsChecking	  "none"
  ConsistencyChecking	  "none"
  ZeroCross		  on
  Profile		  off
  SimulationMode	  "normal"
  RTWSystemTargetFile	  "grt.tlc"
  RTWInlineParameters	  off
  RTWRetainRTWFile	  off
  RTWTemplateMakefile	  "grt_default_tmf"
  RTWMakeCommand	  "make_rtw"
  RTWGenerateCodeOnly	  off
  TLCProfiler		  off
  TLCDebug		  off
  TLCCoverage		  off
  AccelSystemTargetFile	  "accel.tlc"
  AccelTemplateMakefile	  "accel_default_tmf"
  AccelMakeCommand	  "make_rtw"
  ExtModeMexFile	  "ext_comm"
  ExtModeBatchMode	  off
  ExtModeTrigType	  "manual"
  ExtModeTrigMode	  "oneshot"
  ExtModeTrigPort	  "1"
  ExtModeTrigElement	  "any"
  ExtModeTrigDuration	  1000
  ExtModeTrigHoldOff	  0
  ExtModeTrigDelay	  0
  ExtModeTrigDirection	  "rising"
  ExtModeTrigLevel	  0
  ExtModeArchiveMode	  "off"
  ExtModeAutoIncOneShot	  off
  ExtModeIncDirWhenArm	  off
  ExtModeAddSuffixToVar	  off
  ExtModeWriteAllDataToWs off
  ExtModeArmWhenConnect	  off
  ExtModeLogAll		  on
  OptimizeBlockIOStorage  on
  BufferReuse		  on
  ParameterPooling	  on
  BlockReductionOpt	  off
  BooleanDataType	  off
  BlockDefaults {
    Orientation		    "right"
    ForegroundColor	    "black"
    BackgroundColor	    "white"
    DropShadow		    off
    NamePlacement	    "normal"
    FontName		    "Helvetica"
    FontSize		    10
    FontWeight		    "normal"
    FontAngle		    "normal"
    ShowName		    on
  }
  AnnotationDefaults {
    HorizontalAlignment	    "center"
    VerticalAlignment	    "middle"
    ForegroundColor	    "black"
    BackgroundColor	    "white"
    DropShadow		    off
    FontName		    "Helvetica"
    FontSize		    10
    FontWeight		    "normal"
    FontAngle		    "normal"
  }
  LineDefaults {
    FontName		    "Helvetica"
    FontSize		    9
    FontWeight		    "normal"
    FontAngle		    "normal"
  }
  System {
    Name		    "demo3"
    Location		    [291, 468, 1033, 810]
    Open		    on
    ModelBrowserVisibility  off
    ModelBrowserWidth	    200
    ScreenColor		    "white"
    PaperOrientation	    "portrait"
    PaperPositionMode	    "auto"
    PaperType		    "usletter"
    PaperUnits		    "inches"
    ZoomFactor		    "100"
    AutoZoom		    on
    ReportName		    "simulink-default.rpt"
    Block {
      BlockType		      Clock
      Name		      "Clock"
      Position		      [310, 241, 380, 269]
      DisplayTime	      on
      Decimation	      "10"
    }
    Block {
      BlockType		      Gain
      Name		      "Kd"
      Position		      [540, 60, 570, 90]
      ForegroundColor	      "gray"
      Gain		      "1"
      Multiplication	      "Element-wise(K.*u)"
      SaturateOnIntegerOverflow	on
    }
    Block {
      BlockType		      Gain
      Name		      "Kp"
      Position		      [510, 15, 540, 45]
      ForegroundColor	      "gray"
      Gain		      "100"
      Multiplication	      "Element-wise(K.*u)"
      SaturateOnIntegerOverflow	on
    }
    Block {
      BlockType		      Reference
      Name		      "Model Info"
      Ports		      []
      Position		      [25, 248, 228, 302]
      ShowName		      off
      FontName		      "Arial"
      SourceBlock	      "simulink3/Signals\n& Systems/Model Info"
      SourceType	      "CMBlock"
      InitialBlockCM	      "none"
      BlockCM		      "none"
      Frame		      "on"
      DisplayStringWithTags   "Puma560 computed torque control\n%<Creator>\n%<"
"LastModificationDate>"
      MaskDisplayString	      "Puma560 computed torque control\\npic\\n11-Feb-"
"2002 14:18:39"
      HorizontalTextAlignment "Left"
      LeftAlignmentValue      "0.02"
      SourceBlockDiagram      "demo3"
      TagMaxNumber	      "20"
    }
    Block {
      BlockType		      Mux
      Name		      "Mux"
      Ports		      [4, 1]
      Position		      [505, 240, 510, 330]
      ShowName		      off
      Inputs		      "4"
      DisplayOption	      "bar"
    }
    Block {
      BlockType		      Reference
      Name		      "Robot"
      Ports		      [1, 3]
      Position		      [300, 114, 415, 186]
      BackgroundColor	      "red"
      DropShadow	      on
      SourceBlock	      "roblocks/Robot"
      SourceType	      ""
      robot		      "p560"
      q0		      "[0 0 0 0 0 0]"
    }
    Block {
      BlockType		      Sum
      Name		      "Sum"
      Ports		      [2, 1]
      Position		      [450, 20, 470, 40]
      ForegroundColor	      "gray"
      ShowName		      off
      IconShape		      "round"
      Inputs		      "|+-"
      SaturateOnIntegerOverflow	on
    }
    Block {
      BlockType		      Sum
      Name		      "Sum1"
      Ports		      [2, 1]
      Position		      [480, 65, 500, 85]
      ForegroundColor	      "gray"
      ShowName		      off
      IconShape		      "round"
      Inputs		      "|+-"
      SaturateOnIntegerOverflow	on
    }
    Block {
      BlockType		      Sum
      Name		      "Sum2"
      Ports		      [2, 1]
      Position		      [595, 20, 615, 40]
      ForegroundColor	      "gray"
      ShowName		      off
      IconShape		      "round"
      Inputs		      "|++"
      SaturateOnIntegerOverflow	on
    }
    Block {
      BlockType		      Terminator
      Name		      "Terminator"
      Position		      [105, 160, 125, 180]
      ShowName		      off
    }
    Block {
      BlockType		      Terminator
      Name		      "Terminator1"
      Position		      [435, 165, 455, 185]
      ShowName		      off
    }
    Block {
      BlockType		      ToWorkspace
      Name		      "To Workspace"
      Position		      [535, 270, 595, 300]
      VariableName	      "simout"
      MaxDataPoints	      "inf"
      Decimation	      "1"
      SampleTime	      "-1"
      SaveFormat	      "Array"
    }
    Block {
      BlockType		      Reference
      Name		      "jtraj"
      Ports		      [0, 3]
      Position		      [35, 116, 85, 184]
      BackgroundColor	      "red"
      SourceBlock	      "roblocks/jtraj"
      SourceType	      ""
      q0		      "[0 0 0 0 0 0]"
      qf		      "[pi/4 pi/2 -pi/2 0 0 0]"
      tmax		      "10"
    }
    Block {
      BlockType		      Reference
      Name		      "plot"
      Ports		      [1]
      Position		      [640, 97, 720, 153]
      BackgroundColor	      "red"
      SourceBlock	      "roblocks/plot"
      SourceType	      ""
      robot		      "p560"
    }
    Block {
      BlockType		      Reference
      Name		      "rne"
      Ports		      [3, 1]
      Position		      [165, 117, 260, 183]
      BackgroundColor	      "red"
      SourceBlock	      "roblocks/rne"
      SourceType	      ""
      robot		      "perturb(p560)"
      grav		      "[0 0 9.81]"
    }
    Line {
      SrcBlock		      "Sum"
      SrcPort		      1
      DstBlock		      "Kp"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Kp"
      SrcPort		      1
      DstBlock		      "Sum2"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Robot"
      SrcPort		      1
      Points		      [40, 0]
      Branch {
	DstBlock		"plot"
	DstPort			1
      }
      Branch {
	Points			[0, 150]
	DstBlock		"Mux"
	DstPort			2
      }
      Branch {
	DstBlock		"Sum"
	DstPort			2
      }
    }
    Line {
      SrcBlock		      "Robot"
      SrcPort		      2
      Points		      [70, 0]
      Branch {
	DstBlock		"Mux"
	DstPort			3
      }
      Branch {
	DstBlock		"Sum1"
	DstPort			2
      }
    }
    Line {
      SrcBlock		      "Sum2"
      SrcPort		      1
      Points		      [0, 190; -475, 0; 0, -50]
      DstBlock		      "rne"
      DstPort		      3
    }
    Line {
      SrcBlock		      "rne"
      SrcPort		      1
      Points		      [10, 0]
      Branch {
	DstBlock		"Robot"
	DstPort			1
      }
      Branch {
	Points			[0, 165]
	DstBlock		"Mux"
	DstPort			4
      }
    }
    Line {
      SrcBlock		      "jtraj"
      SrcPort		      1
      Points		      [15, 0]
      Branch {
	Points			[0, -100]
	DstBlock		"Sum"
	DstPort			1
      }
      Branch {
	DstBlock		"rne"
	DstPort			1
      }
    }
    Line {
      SrcBlock		      "jtraj"
      SrcPort		      2
      Points		      [30, 0]
      Branch {
	DstBlock		"rne"
	DstPort			2
      }
      Branch {
	Points			[0, -75]
	DstBlock		"Sum1"
	DstPort			1
      }
    }
    Line {
      SrcBlock		      "Mux"
      SrcPort		      1
      DstBlock		      "To Workspace"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Clock"
      SrcPort		      1
      DstBlock		      "Mux"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Sum1"
      SrcPort		      1
      DstBlock		      "Kd"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Kd"
      SrcPort		      1
      Points		      [30, 0]
      DstBlock		      "Sum2"
      DstPort		      2
    }
    Line {
      SrcBlock		      "jtraj"
      SrcPort		      3
      DstBlock		      "Terminator"
      DstPort		      1
    }
    Line {
      SrcBlock		      "Robot"
      SrcPort		      3
      DstBlock		      "Terminator1"
      DstPort		      1
    }
    Annotation {
      Position		      [163, 18]
      Text		      "Puma 560 computed torque control"
      FontSize		      18
      FontWeight	      "bold"
    }
    Annotation {
      Position		      [57, 215]
      ForegroundColor	      "blue"
      Text		      "trajectory\n(demand)"
    }
    Annotation {
      Position		      [524, 159]
      ForegroundColor	      "orange"
      Text		      "robot state\n(actual)"
    }
    Annotation {
      Position		      [540, 211]
      ForegroundColor	      "gray"
      Text		      "error"
    }
  }
}