TiltRotate in Sequence

TiltRotate:^FCentreX=120.0;^FCentreY=140.0;^FMagX=32.0;^FMagY=24.0;^FTiltMag=50.0;^FRotaMag=50.0;

[TiltRotate]

set _FDegToRad as #F1.0 / #F57.29578
set _FXMin as #F-20.0
set _FXMax as #F20.0
set _FYMin as #F-20.0
set _FYMax as #F20.0
set _FZMin as #F-20.0
set _FZMax as #F20.0
set _FXLines as #F10.0
set _FXSublines as #F10.0
set _FYLines as #F10.0
set _FYSublines as #F10.0

set _FTilt as *FTiltSensor * ^FTiltMag
set _FRota as *FRotaSensor * ^FRotaMag

set _FRadTilt as _FTilt * _FDegToRad
set _FCosTilt from RadCos _FRadTilt
set _FSinTilt from RadSin _FRadTilt
set _FRadRota as _FRota * _FDegToRad
set _FCosRota from RadCos _FRadRota
set _FSinRota from RadSin _FRadRota
set _FXMean as _FXMax + _FXMin
set _FXMean as _FXMean / #F2.0
set _FYMean as _FYMax + _FYMin
set _FYMean as _FYMean / #F2.0
set _FZMean as _FZMax + _FZMin
set _FZMean as _FZMean / #F2.0
set _FXDiff as _FXMax - _FXMin
set _FYDiff as _FYMax - _FYMin
set _FZDiff as _FZMax - _FZMin

set _FXStep as _FXLines - #F1.0
set _FXStep as _FXDiff / _FXStep
set _FXSubstep as _FXSublines - #F1.0
set _FXSubstep as _FXDiff / _FXSubstep

set _FYStep as _FYLines - #F1.0
set _FYStep as _FYDiff / _FYStep
set _FYSubstep as _FYSublines - #F1.0
set _FYSubstep as _FYDiff / _FYSubstep

set _FXMaxx as _FXMax + #F0.1
set _FYMaxx as _FYMax + #F0.1

step _FY from _FYMin to _FYMaxx increment _FYStep
  step _FX from _FXMin to _FXMaxx increment _FXSubstep
    if _FX == _FXMin
      gosub Calculate
    endif
    copy _FXPlot to _PLast.X
    copy _FYPlot to _PLast.Y
    gosub Calculate
    copy _FXPlot to _PThis.X
    copy _FYPlot to _PThis.Y
    call DrawLine _PLast _PThis #C0,255,0
  endstep
endstep

step _FX from _FXMin to _FXMaxx increment _FXStep
  step _FY from _FYMin to _FYMaxx increment _FYSubstep
    if _FY == _FYMin
      gosub Calculate
    endif
    copy _FXPlot to _PLast.X
    copy _FYPlot to _PLast.Y
    gosub Calculate
    copy _FXPlot to _PThis.X
    copy _FYPlot to _PThis.Y
    call DrawLine _PLast _PThis #C0,255,255
  endstep
endstep

sub Calculate
  set _FZX as _FX * _FX
  set _FZY as _FY * _FY
  set _FZ as _FZX + _FZY
  set _FZ from SquareRoot _FZ
  set _FZ from RadSin _FZ
  set _FZ2 as _FZ - _FZMean
  set _FZ2 as _FZ2 / _FZDiff
  set _FX2 as _FX - _FXMean
  set _FX2 as _FX2 / _FXDiff
  set _FY2 as _FY - _FYMean
  set _FY2 as _FY2 / _FYDiff
  set _FX3X as _FX2 * _FCosRota
  set _FX3Y as _FY2 * _FSinRota
  set _FX3 as _FX3X - _FX3Y
  set _FY3X as _FX2 * _FSinRota
  set _FY3Y as _FY2 * _FCosRota
  set _FY3Z as _FZ2 * _FCosTilt
  set _FY3XY as _FY3X + _FY3Y
  set _FY3S as _FY3XY * _FSinTilt
  set _FY3 as _FY3Z - _FY3S
  set _FXPlot as ^FMagX * _FX3
  set _FXPlot as ^FCentreX + _FXPlot
  set _FYPlot as ^FMagY * _FY3
  set _FYPlot as ^FCentreY + _FYPlot
endsub

/B!"#~."$"%~."&"'~."$"(~."&")~."$"*~."&"+~.","-~.",".~.","/~.","0~/:123~/:456~/:71!~/"827~/"917~/::4!~/";2:~/"<1:~/*='%~/B==>~/*?)(~/B??>~/*@+*~/B@@>~/2A'%~/2B)(~/2C+*~/2D-"~/BDAD~/2E."~/BEAE~/2F/"~/BFBF~/2G0"~/BGBG~/*H'I~/*J)I~."("K~"~*~)2KJ~(!?~."%"L~"~*~)2LH~(!r~"~)*L%~(!2~"~+~2!"|~,~#~#~."M+!~."N3!~"~+~2!"a~,~#~."M+"~."N3"~0!!"!~/*LLE~-~$~,~#~/*KKF~-~$~,~#~."%"L~"~*~)2LH~(!?~."("K~"~*~)2KJ~(!r~"~)*K(~(!2~"~+~2!!u~,~#~#~."M+!~."N3!~"~+~2!!Z~,~#~."M+"~."N3"~0!!""~/*KKG~-~$~,~#~/*LLD~-~$~,~#~3~/:OLL~/:PKK~/*QOP~/"Q4Q~/"Q1Q~/2RQ@~/BRRC~/2SL=~/BSSA~/2TK?~/BTTB~/:US;~/:VT<~/2WUV~/:XS<~/:YT;~/:ZR8~/*[XY~/:\[9~/2]Z\~/:M^W~/*M_M~/:N`]~/*NaN~-~
-
_FDegToRad #F1.0 #F57.29578 #F-20.0 _FXMin #F20.0 _FXMax _FYMin _FYMax _FZMin _FZMax #F10.0 _FXLines _FXSublines _FYLines _FYSublines _FTilt *FTiltSensor ^FTiltMag _FRota *FRotaSensor ^FRotaMag _FRadTilt _FCosTilt _FSinTilt _FRadRota _FCosRota _FSinRota _FXMean #F2.0 _FYMean _FZMean _FXDiff _FYDiff _FZDiff _FXStep _FXSubstep _FYStep _FYSubstep _FXMaxx #F0.1 _FYMaxx _FY _FX _FXPlot _FYPlot _FZX _FZY _FZ _FZ2 _FX2 _FY2 _FX3X _FX3Y _FX3 _FY3X _FY3Y _FY3Z _FY3XY _FY3S _FY3 ^FMagX ^FCentreX ^FMagY ^FCentreY
_PLast _PThis
#C0,255,0 #C0,255,255
-