/// <summary>
/// Move up safely in Z, then move X and Y, then move to destination in Z
/// </summary>
/// <param name="mmX"></param>
/// <param name="mmY"></param>
/// <param name="mmZ"></param>
public void MoveXYSafeZ(Millimeters mmX, Millimeters mmY, Millimeters mmZ)
{
// Temp
//AxisX.MoveAbs(dest.X);
//AxisY.MoveAbs(dest.Y);
AxisZ.MoveAbs(SafeZHeight);
AxisX.SetTarget(mmX);
AxisY.SetTarget(mmY);
_motionSystem.MoveLinearXY(this, AxisX.DefaultSpeed);
AxisZ.MoveAbs(mmZ);
}