private void _prog7(Action <IEnumerable <CylinderPosition> > handler)
{
// Free-breath Gating loosing signal
if (_preSetTimer == 0)
{
const ushort STEPSZ = 2;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 127, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 127, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 127, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer >= 3000)
{
const ushort STEPSZ = 8;
double target = 127 + 80 * Math.Sin((_preSetTimer - 3000) / 2500.0 * Math.PI);
ushort rtnGP = 127;
if (_preSetTimer >= 25000 && _preSetTimer < 35000)
{
rtnGP = 255;
}
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = (ushort)target, Rtn = rtnGP, StepSize = STEPSZ
};
handler(pos);
}
if (_preSetTimer == 37960)
{
_preSetTimer = 3000;
}
else
{
_preSetTimer += PRESETTIMERINCR;
}
}
private void _prog6(Action <IEnumerable <CylinderPosition> > handler)
{
// Free-breath Gating, Position 1 <-> 2
if (_preSetTimer == 0)
{
const ushort STEPSZ = 2;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 64, Rtn = 191, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 84, Rtn = 103, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 64, Rtn = 131, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer >= 3000)
{
const ushort STEPSZ = 8;
double targetLGlng = 64 - 64 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
double targetRlng = 84 - 44 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
double targetLrtn = 191 + 64 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
double targetRrtn = 103 - 24 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
double targetGrtn = 131 + 4 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = (ushort)targetLGlng, Rtn = (ushort)targetLrtn, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = (ushort)targetRlng, Rtn = (ushort)targetRrtn, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = (ushort)targetLGlng, Rtn = (ushort)targetGrtn, StepSize = STEPSZ
};
handler(pos);
}
if (_preSetTimer == 8960)
{
_preSetTimer = 3000;
}
else
{
_preSetTimer += PRESETTIMERINCR;
}
}
private void _prog8(Action <IEnumerable <CylinderPosition> > handler)
{
// Free-breath Gating base line shift
if (_preSetTimer == 0)
{
const ushort STEPSZ = 2;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 130, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 130, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 130, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer >= 3000)
{
const ushort STEPSZ = 8;
double baseline = 130 + 30 * Math.Sin((_preSetTimer - 3000) / 30000.0 * Math.PI);
double target = baseline + 50 * Math.Sin((_preSetTimer - 3000) / 3000.0 * Math.PI);
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
if (_preSetTimer == 62960)
{
_preSetTimer = 3000;
}
else
{
_preSetTimer += PRESETTIMERINCR;
}
}
private void _prog1(Action <IEnumerable <CylinderPosition> > handler)
{
// Position 1
const ushort STEPSZ = 2;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 128, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 128, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 128, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
private void _prog5(Action <IEnumerable <CylinderPosition> > handler)
{
// Breath-hold Gating
if (_preSetTimer == 0)
{
const ushort STEPSZ = 2;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 60, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 60, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 60, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer >= 3000 && _preSetTimer < 28000)
{
const ushort STEPSZ = 8;
double target = 60 + 50 * Math.Sin((_preSetTimer - 3000) / 2500.0 * Math.PI);
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer > 28000 && _preSetTimer < 38000)
{
const ushort STEPSZ = 4;
double target = 200 + 50 * Math.Cos((_preSetTimer - 28000) / 40000.0 * Math.PI);
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = (ushort)target, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
else if (_preSetTimer == 38000)
{
const ushort STEPSZ = 4;
CylinderPosition[] pos = new CylinderPosition[3];
pos[0] = new CylinderPosition()
{
Cy = Cylinder.Left, Lng = 10, Rtn = 127, StepSize = STEPSZ
};
pos[1] = new CylinderPosition()
{
Cy = Cylinder.Right, Lng = 10, Rtn = 127, StepSize = STEPSZ
};
pos[2] = new CylinderPosition()
{
Cy = Cylinder.Platform, Lng = 10, Rtn = 127, StepSize = STEPSZ
};
handler(pos);
}
if (_preSetTimer == 40000)
{
_preSetTimer = 6720;
}
else
{
_preSetTimer += PRESETTIMERINCR;
}
}