AIDT 온디바이스 STEM 방사광 X선 초고압 다이아몬드 앤빌 셀(DAC) 서브-메가바(Mbar) 압력 제어 및 레이저 가열 서보 제어기

using System;
using System.Runtime.CompilerServices;

namespace ZeliDesk.Stem.Synchrotron.DiamondAnvilCell
{
    /// <summary>
    /// 고온계 2색 분광 광량 및 루비 형광 파장 계측 상태
    /// </summary>
    public readonly ref struct DacLaserHeatingTelemetryState
    {
        public readonly double RubyR1WavelengthNm;    // 루비 형광 R1선 파장 [nm]
        public readonly double IntensityWavelength1;  // 파장 650nm 광량 강도
        public readonly double IntensityWavelength2;  // 파장 850nm 광량 강도
        public readonly double MembraneGasPressureBar;// 멤브레인 구동 가스압 [bar]

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public DacLaserHeatingTelemetryState(double r1Nm, double i1, double i2, double gasPress)
        {
            RubyR1WavelengthNm = r1Nm;
            IntensityWavelength1 = i1;
            IntensityWavelength2 = i2;
            MembraneGasPressureBar = gasPress;
        }
    }

    /// <summary>
    /// DAC 레이저 파워 및 가스 밸브 제어 출력
    /// </summary>
    public readonly ref struct DacLaserControlOutput
    {
        public readonly double EstimatedPressureGpa;    // 산출된 내부 정수압 [GPa]
        public readonly double EstimatedTemperatureK;   // 산출된 핫스팟 온도 [K]
        public readonly double LaserPowerCommandWatts;  // 가열 레이저 파워 지령 [W]
        public readonly double GasValveFlowCommand;     // 멤브레인 가스 밸브 개도율 [0.0~1.0]
        public readonly bool IsExtremeConditionStable; // 온도(+/-25K) 및 압력 안정화 여부

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public DacLaserControlOutput(double press, double temp, double laserW, double valve, bool stable)
        {
            EstimatedPressureGpa = press;
            EstimatedTemperatureK = temp;
            LaserPowerCommandWatts = laserW;
            GasValveFlowCommand = valve;
            IsExtremeConditionStable = stable;
        }
    }

    /// <summary>
    /// 10,000Hz 초고압 DAC 레이저 가열 서보 엔진
    /// </summary>
    public ref struct DacLaserHeatingServoEngine
    {
        private const double C2Const = 1.438777e-2; // m*K
        private const double Lambda1M = 650e-9;
        private const double Lambda2M = 850e-9;

        private readonly double _kpTemp;
        private readonly double _kiTemp;
        private readonly double _kdTemp;
        private readonly double _kpPress;
        private readonly double _kiPress;
        private readonly double _maxLaserWatts;

        private double _intTempErr;
        private double _prevTempErr;
        private double _intPressErr;

        public DacLaserHeatingServoEngine(
            double kpTemp,
            double kiTemp,
            double kdTemp,
            double kpPress,
            double kiPress,
            double maxLaserWatts)
        {
            _kpTemp = kpTemp;
            _kiTemp = kiTemp;
            _kdTemp = kdTemp;
            _kpPress = kpPress;
            _kiPress = kiPress;
            _maxLaserWatts = maxLaserWatts;
            _intTempErr = 0.0;
            _prevTempErr = 0.0;
            _intPressErr = 0.0;
        }

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public DacLaserControlOutput ProcessCycle(
            in DacLaserHeatingTelemetryState state,
            double targetPressureGpa,
            double targetTempK,
            double dtSeconds)
        {
            // 1. 루비 R1 형광 파장 천이 기반 압력 역산 (Mao EOS)
            double dLambda = state.RubyR1WavelengthNm - 694.24;
            double lambdaRatio = 1.0 + (dLambda / 694.24);
            double pressGpa = (1904.0 / 7.665) * (Math.Pow(Math.Max(1.0, lambdaRatio), 7.665) - 1.0);

            // 2. 2색 고온계 흑체 복사 광량 기반 절대온도 T 역산
            double iRatio = Math.Max(1e-4, state.IntensityWavelength2 / Math.Max(1e-4, state.IntensityWavelength1));
            double num = C2Const * (1.0 / Lambda1M - 1.0 / Lambda2M);
            double denom = Math.Log(iRatio) + 5.0 * Math.Log(Lambda2M / Lambda1M);
            double tempK = (denom > 1e-4) ? (num / denom) : 300.0;
            tempK = Math.Clamp(tempK, 300.0, 6000.0);

            // 3. 온도 제어 루프 (PID)
            double tempErr = targetTempK - tempK;
            _intTempErr += tempErr * dtSeconds;
            double dTempErr = (tempErr - _prevTempErr) / dtSeconds;
            _prevTempErr = tempErr;

            double laserWatts = _kpTemp * tempErr + _kiTemp * _intTempErr + _kdTemp * dTempErr;
            laserWatts = Math.Clamp(laserWatts, 0.0, _maxLaserWatts);

            // 4. 압력 제어 루프 (PI)
            double pressErr = targetPressureGpa - pressGpa;
            _intPressErr += pressErr * dtSeconds;
            double gasValve = Math.Clamp(0.5 + _kpPress * pressErr + _kiPress * _intPressErr, 0.0, 1.0);

            // 5. 극한 상태 안정화 판정 (+-25K, +-1.0 GPa)
            bool isStable = Math.Abs(tempErr) <= 25.0 && Math.Abs(pressErr) <= 1.0;

            return new DacLaserControlOutput(
                pressGpa,
                tempK,
                laserWatts,
                gasValve,
                isStable);
        }
    }
}