AIDT 온디바이스 STEM 방사광 X선 극저온 포획 이온(Trapped-Ion) 광집게(Optical Tweezer) 양자 레지스터 셔틀링 초정밀 빔 편향 서보 제어기

using System;
using System.Runtime.CompilerServices;

namespace ZeliDesk.Stem.TrappedIon
{
    /// <summary>
    /// 포획 이온 광집게 텔레메트리 상태 구조체
    /// </summary>
    public readonly ref struct TrappedIonTweezerTelemetryState
    {
        public readonly double CurrentPositionMicrons;   // 현재 이온 트랩 위치 [um]
        public readonly double TargetPositionMicrons;    // 목표 셔틀링 위치 [um]
        public readonly double TargetVelocityMicronsPerSec; // 목표 속도 [um/s]
        public readonly double TargetAccelerationMicronsPerSec2; // 목표 가속도 [um/s^2]
        public readonly double TrapAxialFrequencyKhz;    // 트랩 축 주파수 [kHz]
        public readonly double LaserPowerMilliWatts;     // 집게 레이저 출력 [mW]

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public TrappedIonTweezerTelemetryState(
            double curPos, double tgtPos, double tgtVel, double tgtAcc, double trapFreq, double pwr)
        {
            CurrentPositionMicrons = curPos;
            TargetPositionMicrons = tgtPos;
            TargetVelocityMicronsPerSec = tgtVel;
            TargetAccelerationMicronsPerSec2 = tgtAcc;
            TrapAxialFrequencyKhz = trapFreq;
            LaserPowerMilliWatts = pwr;
        }
    }

    /// <summary>
    /// AOD RF 제어 명령 구조체
    /// </summary>
    public readonly ref struct TweezerServoCommand
    {
        public readonly double AodCenterFrequencyMhz;    // AOD 구동 RF 주파수 [MHz]
        public readonly double RfAmplitudeDbm;           // RF 구동 파워 [dBm]
        public readonly double PredictedPhononExcitation; // 계산된 포논 들뜸 지수 Delta n
        public readonly bool ShuttlingWithinTolerance;   // 셔틀링 궤적 허용오차 내 수렴 여부

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public TweezerServoCommand(double freq, double amp, double phonon, bool inTol)
        {
            AodCenterFrequencyMhz = freq;
            RfAmplitudeDbm = amp;
            PredictedPhononExcitation = phonon;
            ShuttlingWithinTolerance = inTol;
        }
    }

    /// <summary>
    /// 10,000Hz 주기 포획 이온 광집게 초정밀 편향 서보 엔진
    /// </summary>
    public ref struct TrappedIonOpticalTweezerServoEngine
    {
        private const double BaseRfCenterFreqMhz = 80.0;     // 기준 중심 주파수 [MHz]
        private const double AcousticVelocityMPerS = 650.0;  // TeO2 결정 음속 [m/s]
        private const double LaserWavelengthNm = 532.0;      // 집게 레이저 파장 [nm]
        private const double ObjectiveFocalLengthMm = 10.0;  // 대물렌즈 초점거리 [mm]

        private double _prevErrorMicrons;

        [MethodImpl(MethodImplOptions.AggressiveInlining)]
        public TweezerServoCommand UpdateServo(in TrappedIonTweezerTelemetryState state, double dtSeconds)
        {
            double error = state.TargetPositionMicrons - state.CurrentPositionMicrons;
            double errorDerivative = (dtSeconds > 1e-9) ? (error - _prevErrorMicrons) / dtSeconds : 0.0;
            _prevErrorMicrons = error;

            // 광학 전달 스케일: um 당 필요한 RF 주파수 편차 [MHz/um]
            // df/dx = v / (f_obj * lambda)
            // v = 650 m/s, f_obj = 0.01 m, lambda = 532e-9 m -> factor
            double optScaleMhzPerUm = (AcousticVelocityMPerS / (ObjectiveFocalLengthMm * 1e-3 * LaserWavelengthNm * 1e-9)) * 1e-6 * 1e-6;

            // 가속도 보정 항: x_acc = a / omega_t^2
            double omegaTrapRadPerS = 2.0 * Math.PI * state.TrapAxialFrequencyKhz * 1000.0;
            double accCompensationUm = (omegaTrapRadPerS > 100.0) 
                ? (state.TargetAccelerationMicronsPerSec2 / (omegaTrapRadPerS * omegaTrapRadPerS)) 
                : 0.0;

            double feedforwardPositionUm = state.TargetPositionMicrons - accCompensationUm;
            double pidCorrectionUm = 1.25 * error + 0.045 * errorDerivative;

            double commandFreqMhz = BaseRfCenterFreqMhz + (feedforwardPositionUm + pidCorrectionUm) * optScaleMhzPerUm;
            commandFreqMhz = Math.Clamp(commandFreqMhz, 60.0, 100.0);

            // 포논 잔여 들뜸 근사치 계측: residual jerking factor
            double residualJerk = Math.Abs(errorDerivative);
            double predictedPhonon = Math.Min(0.005 * residualJerk + 0.001 * Math.Abs(error), 0.5);

            // RF 진폭 보정 (광 파워 일정화)
            double rfPowerDbm = 24.0 + 0.05 * (state.LaserPowerMilliWatts - 50.0);
            rfPowerDbm = Math.Clamp(rfPowerDbm, 15.0, 30.0);

            bool withinTol = Math.Abs(error) < 0.02; // 20nm 이내 수렴

            return new TweezerServoCommand(commandFreqMhz, rfPowerDbm, predictedPhonon, withinTol);
        }
    }
}