"""Invariant Risk Minimization (IRM) fine-tune of stem_ms96 from SWA checkpoints.

Arjovsky et al.: treat each train dataset as an environment. Loss =
  mean_e ERM_BCE(e) + λ * mean_e ||∇_w|_{w=1} R^e(w · logit)||^2
Dummy classifier scale w=1; gradient should be small in every environment.

Init from models/stem_ms96_swa/{held-*,all5}.pt. Architecture unchanged.
Evaluate EMA weights (decay 0.995). HMM preset p_stay 0.994 scale 0.8.
Also report causal tau-30 high-pass of the IRM evidence (honest; corpus emissions).

usage:
  IRM_LAMBDA=1.0 STEPS=1000 python stem_ms96_irm.py
  SMOKE=1 IRM_LAMBDA=1.0 STEPS=40 python stem_ms96_irm.py   # no LODO/external score
"""
import copy
import json
import math
import os
import pickle
import time

import numpy as np
import torch
import torch.nn.functional as F

import ensemble_clf_nested as N
import ensemble_clf_transformer_v2 as V
import ensemble_clf_transformer_v4 as V4
import eval_external as E
from common import DS_KEYS

EXP = os.path.dirname(os.path.abspath(__file__))
SWA_DIR = os.path.join(EXP, "models", "stem_ms96_swa")
CKPT_DIR = os.path.join(EXP, "models", "stem_ms96_irm")
LOG = os.path.join(EXP, "experiments", "stem_ms96_irm.log")
OUT = os.path.join(EXP, "results", "research", "stem_ms96_irm.json")
EVID = "/root/disk_3tb/EEG-sAAD-Grand-Challenge-Training-Dataset/experiments/decoder_lodo/results/research"
TEST_NAMES = ("AASD", "Carta2026")

STEPS = int(os.environ.get("STEPS", "1000"))
BATCH = int(os.environ.get("BATCH", "512"))
IRM_LAMBDA = float(os.environ.get("IRM_LAMBDA", "1.0"))
SMOKE = os.environ.get("SMOKE", "0") == "1"
EMA_DECAY = 0.995
LR = 8e-4
P_STAY = 0.994
SCALE = 0.8
CFG = ("stem_ms96", "ms", 96, 64, 2, True, LR)
WINDOW = 96


def log_line(text):
    print(text, flush=True)
    os.makedirs(os.path.dirname(LOG), exist_ok=True)
    with open(LOG, "a") as fh:
        fh.write(text + "\n")


def load_swa(path, device):
    blob = torch.load(path, map_location="cpu", weights_only=False)
    name, family, window, d_model, nlayers, stem, _lr = blob["cfg"]
    if name != "stem_ms96" or not stem or window != WINDOW:
        raise RuntimeError(f"unexpected stem cfg {blob['cfg']}")
    c_in = int(np.asarray(blob["mu"]).shape[0])
    net = V.LogitTransformer(c_in, window, d_model=d_model, nlayers=nlayers, stem=True)
    # SWA equal-avg of buffers turns causal -inf mask entries into nan; keep weights,
    # then restore a fresh causal mask from the newly constructed module.
    good_mask = net.mask.detach().clone()
    net.load_state_dict(blob["state"])
    net.mask.copy_(good_mask)
    if torch.isnan(net.mask).any():
        raise RuntimeError(f"causal mask still has nan after restore from {path}")
    net = net.to(device)
    mu = np.asarray(blob["mu"], np.float32)
    sd = np.asarray(blob["sd"], np.float32)
    return net, mu, sd, list(blob["train"])


def weighted_bce(logit, y, m, pos_weight):
    sw = V.switch_weights(y, m)
    bce = F.binary_cross_entropy_with_logits(logit, y, pos_weight=pos_weight, reduction="none")
    denom = (sw * m).sum().clamp_min(1.0)
    loss = (bce * sw * m).sum() / denom
    dv = (logit[:, 1:] - logit[:, :-1]).abs()
    m2 = m[:, 1:] * m[:, :-1]
    loss = loss + 0.05 * (dv * m2).sum() / m2.sum().clamp_min(1.0)
    return loss


def irm_env_penalty(logit, y, m, pos_weight):
    """||∇_w R(w · logit)||^2 at w=1 (IRMv1). create_graph so Φ is updated."""
    scale = logit.new_tensor(1.0, requires_grad=True)
    risk = weighted_bce(logit * scale, y, m, pos_weight)
    grad, = torch.autograd.grad(risk, scale, create_graph=True)
    return grad.pow(2)


def env_erm_and_penalty(logit, y, m, pos_weight, n_env):
    """Dataset-balanced batch: row i belongs to env i % n_env."""
    erms, pens = [], []
    for e in range(n_env):
        idx = torch.arange(e, logit.size(0), n_env, device=logit.device)
        if idx.numel() == 0:
            continue
        le, ye, me = logit[idx], y[idx], m[idx]
        if me.sum() < 1:
            continue
        erms.append(weighted_bce(le, ye, me, pos_weight))
        pens.append(irm_env_penalty(le, ye, me, pos_weight))
    if not erms:
        raise RuntimeError("no valid environments in batch")
    erm = torch.stack(erms).mean()
    pen = torch.stack(pens).mean()
    return erm, pen


def set_lr(opt, step, total, base):
    warm = min(40, max(total // 10, 1))
    if step < warm:
        lr = base * (step + 1) / warm
    else:
        p = (step - warm) / max(total - warm, 1)
        lr = 1e-5 + 0.5 * (base - 1e-5) * (1.0 + math.cos(math.pi * p))
    for group in opt.param_groups:
        group["lr"] = lr
    return lr


def train_irm(model, groups, y_all, mu, sd, device, steps, batch, tag, irm_lambda):
    n_env = len(groups)
    pos = float(y_all.mean())
    pos_weight = torch.tensor([(1.0 - pos) / max(pos, 1e-3)], device=device)
    opt = torch.optim.AdamW(model.parameters(), lr=LR, weight_decay=1e-4)
    rng = np.random.default_rng(V.TRAIN_SEED)
    ema = copy.deepcopy(model).eval()
    model.train()
    t0 = time.time()
    last = last_erm = last_pen = None
    for step in range(steps):
        set_lr(opt, step, steps, LR)
        xb, yb, mb = V.sample_batch(rng, groups, WINDOW, batch, mu, sd)
        x = torch.from_numpy(xb).to(device, non_blocking=True)
        y = torch.from_numpy(yb).to(device, non_blocking=True)
        m = torch.from_numpy(mb).to(device, non_blocking=True)
        x = V.augment(x)
        opt.zero_grad(set_to_none=True)
        logit = model(x)
        erm, pen = env_erm_and_penalty(logit, y, m, pos_weight, n_env)
        loss = erm + irm_lambda * pen
        if not torch.isfinite(loss):
            raise RuntimeError(
                f"non-finite loss at step {step} for {tag}: erm={erm.item()} pen={pen.item()}")
        loss.backward()
        torch.nn.utils.clip_grad_norm_(model.parameters(), 1.0)
        opt.step()
        V.ema_update(model, ema, EMA_DECAY)
        last = float(loss.item())
        last_erm = float(erm.item())
        last_pen = float(pen.item())
        if step == 0 or (step + 1) % 200 == 0 or step + 1 == steps:
            log_line(
                f"    {tag} step {step + 1}/{steps} loss {last:.4f} "
                f"erm {last_erm:.4f} pen {last_pen:.6f} λ {irm_lambda}")
    ema.eval()
    acc = V.train_frame_acc(ema, groups, WINDOW, mu, sd, device)
    log_line(
        f"  trained {tag} loss {last:.4f} erm {last_erm:.4f} pen {last_pen:.6f} "
        f"frame-acc {acc:.3f} n_env {n_env} ({time.time() - t0:.0f}s)")
    return ema, dict(loss=last, erm=last_erm, pen=last_pen, frame_acc=acc, n_env=n_env)


def fit_with_oom(swa_path, groups, y_all, device, steps, batch, tag, irm_lambda, halved=False):
    model, mu, sd, _train = load_swa(swa_path, device)
    try:
        ema, stats = train_irm(model, groups, y_all, mu, sd, device, steps, batch, tag, irm_lambda)
        return ema, mu, sd, batch, stats
    except torch.cuda.OutOfMemoryError:
        if halved:
            raise
        log_line(f"  OOM on {tag} at batch {batch}; halving once")
        del model
        if device.type == "cuda":
            torch.cuda.empty_cache()
        return fit_with_oom(
            swa_path, groups, y_all, device, steps, batch // 2, tag, irm_lambda, halved=True)


def hp30_stream(stream):
    out = {}
    for key, d in stream.items():
        out[key] = V4.highpass(np.asarray(d, np.float64)[:, None]).reshape(-1).astype(np.float64)
    return out


def score_lodo(model, feat, mu, sd, held, device):
    streams = V.infer_all(model, feat, mu, sd, WINDOW, device)
    ev = N.to_ev(streams)
    off = N.official(held, ev, P_STAY, SCALE)
    hp = {ds: hp30_stream(streams[ds]) for ds in streams}
    ev_hp = N.to_ev(hp)
    off_hp = N.official(held, ev_hp, P_STAY, SCALE)
    log_line(f"LODO {held} p {P_STAY} sc {SCALE}  H {off['H']:.4f} Acc {off['Acc']:.2f} "
             f"L {off['L']:.3f} SDT {off['SDT']:.2f}")
    log_line(f"LODO_hp30 {held} p {P_STAY} sc {SCALE}  H {off_hp['H']:.4f} Acc {off_hp['Acc']:.2f}")
    return dict(irm=off, hp30=off_hp), streams


def score_external(model, feat_ext, meta, mu_in, sd_in, corpus_streams, corpus_att, device):
    parts = []
    for ds, table in corpus_streams.items():
        labels = corpus_att[ds]
        for key, d in table.items():
            parts.append(np.asarray(d, np.float64) * np.where(labels[key] == 0, 1.0, -1.0))
    mu_e = float(np.concatenate(parts).mean())
    sd_e = float(np.concatenate(parts).std())
    log_line(f"  external emissions mu {mu_e:.4f} sd {sd_e:.4f} scale {SCALE}")

    hp_corpus = {ds: hp30_stream(corpus_streams[ds]) for ds in corpus_streams}
    parts_hp = []
    for ds, table in hp_corpus.items():
        labels = corpus_att[ds]
        for key, d in table.items():
            parts_hp.append(np.asarray(d, np.float64) * np.where(labels[key] == 0, 1.0, -1.0))
    mu_hp = float(np.concatenate(parts_hp).mean())
    sd_hp = float(np.concatenate(parts_hp).std())
    log_line(f"  external hp30 emissions mu {mu_hp:.4f} sd {sd_hp:.4f} scale {SCALE}")

    rows = {}
    for ds in TEST_NAMES:
        stream = V.infer_all(model, {ds: feat_ext[ds]}, mu_in, sd_in, WINDOW, device)[ds]
        ev = {}
        for key, d in stream.items():
            meta_k = meta[ds][key]
            d = np.asarray(d, np.float64)
            ev[key] = dict(r0=d, r1=np.zeros(len(d)), att=meta_k["att"], t_end=meta_k["t_end"],
                           att128=meta_k["att128"], n128=meta_k["n128"], subject=meta_k["subject"])
        r = E.score(ev, mu_e, sd_e * SCALE, P_STAY, 0.75)
        stream_hp = hp30_stream(stream)
        ev_hp = {}
        for key, d in stream_hp.items():
            meta_k = meta[ds][key]
            d = np.asarray(d, np.float64)
            ev_hp[key] = dict(r0=d, r1=np.zeros(len(d)), att=meta_k["att"], t_end=meta_k["t_end"],
                              att128=meta_k["att128"], n128=meta_k["n128"], subject=meta_k["subject"])
        r_hp = E.score(ev_hp, mu_hp, sd_hp * SCALE, P_STAY, 0.75)
        rows[ds] = dict(irm=r, hp30=r_hp)
        log_line(f"EXT {ds} p {P_STAY} sc {SCALE}  H {r['H']:.4f} Acc {r['Acc']:.2f} "
                 f"L {r['L']:.3f} SDT {r['SDT']:.2f}")
        log_line(f"EXT_hp30 {ds} p {P_STAY} sc {SCALE}  H {r_hp['H']:.4f} Acc {r_hp['Acc']:.2f}")
    return rows


def load_external():
    E.CONF.update(prep="eaP_n5_t60", targets=["env", "onset", "dom"])
    logits, meta = {}, {}
    for ds in TEST_NAMES:
        evs = []
        for i in range(4):
            path = os.path.join(EVID, f"ext_clf_{ds}_w10b3sw2P_evidence_s{i}.pkl")
            with open(path, "rb") as fh:
                evs.append(pickle.load(fh))
        logits[ds], meta[ds] = {}, {}
        for key in evs[0]:
            cols = [(ev[key]["r0"] - ev[key]["r1"]).astype(np.float32) for ev in evs]
            e0 = evs[0][key]
            logits[ds][key] = np.stack(cols, 1)
            meta[ds][key] = dict(
                att=np.asarray(e0["att"]), t_end=np.asarray(e0["t_end"], np.float64),
                att128=np.asarray(e0["att128"]), n128=int(e0["n128"]), subject=int(e0["subject"]))
        log_line(f"  external {ds}: {len(logits[ds])} trials")
    return logits, meta


def smoke_lambda(feat_all, device):
    """Short train on held-AVGC fold for a few λ; pick finite + pen not dominating."""
    held = "AVGC"
    path = os.path.join(SWA_DIR, f"held-{held}.pt")
    train_ds = [d for d in DS_KEYS if d != held]
    groups, y_all = V.trial_groups(feat_all, train_ds)
    candidates = [float(x) for x in os.environ.get("SMOKE_LAMBDAS", "0.1,1.0,10.0").split(",")]
    smoke_steps = int(os.environ.get("SMOKE_STEPS", "40"))
    results = []
    for lam in candidates:
        log_line(f"SMOKE λ={lam} steps={smoke_steps}")
        try:
            ema, mu, sd, used, stats = fit_with_oom(
                path, groups, y_all, device, smoke_steps, BATCH, f"smoke-λ{lam}", lam)
            del ema
            if device.type == "cuda":
                torch.cuda.empty_cache()
            ok = (stats["loss"] is not None and math.isfinite(stats["loss"])
                  and math.isfinite(stats["pen"]) and stats["frame_acc"] > 0.55)
            results.append(dict(lam=lam, ok=ok, **stats, batch=used))
            log_line(f"SMOKE λ={lam} ok={ok} erm={stats['erm']:.4f} pen={stats['pen']:.6f} "
                     f"frame={stats['frame_acc']:.3f}")
        except Exception as exc:
            log_line(f"SMOKE λ={lam} FAILED: {exc}")
            results.append(dict(lam=lam, ok=False, error=str(exc)))
            if device.type == "cuda":
                torch.cuda.empty_cache()
    # Prefer λ where pen*λ is not >> erm, and frame_acc highest among ok
    ok_rows = [r for r in results if r.get("ok")]
    if not ok_rows:
        raise RuntimeError(f"all smoke λ failed: {results}")
    def score_row(r):
        # Keep penalty contribution comparable to ERM (within ~10x), prefer higher frame acc
        ratio = (r["pen"] * r["lam"]) / max(r["erm"], 1e-6)
        return (r["frame_acc"], -abs(math.log10(max(ratio, 1e-6))))
    best = max(ok_rows, key=score_row)
    log_line(f"SMOKE chose λ={best['lam']} frame={best['frame_acc']:.3f} "
             f"erm={best['erm']:.4f} pen={best['pen']:.6f}")
    return float(best["lam"]), results


def main():
    os.makedirs(os.path.dirname(LOG), exist_ok=True)
    open(LOG, "w").close()
    device = torch.device("cuda" if torch.cuda.is_available() else "cpu")
    log_line(f"device {device} steps {STEPS} batch {BATCH} λ_env {IRM_LAMBDA} smoke={SMOKE}")
    torch.backends.cuda.matmul.allow_tf32 = True
    torch.backends.cudnn.allow_tf32 = True
    V.assert_causal(device)
    N.load_all()
    feat_all = V.build_features()["ms"]
    os.makedirs(CKPT_DIR, exist_ok=True)

    irm_lambda = IRM_LAMBDA
    smoke_info = None
    if SMOKE or os.environ.get("TUNE_LAMBDA", "0") == "1":
        irm_lambda, smoke_info = smoke_lambda(feat_all, device)
        if SMOKE:
            out = dict(smoke=smoke_info, chosen_lambda=irm_lambda)
            os.makedirs(os.path.dirname(OUT), exist_ok=True)
            with open(OUT.replace(".json", "_smoke.json"), "w") as fh:
                json.dump(out, fh, indent=1, default=float)
            log_line("SMOKE done; exiting without full score")
            return

    per = {}
    for held in DS_KEYS:
        path = os.path.join(SWA_DIR, f"held-{held}.pt")
        if not os.path.isfile(path):
            raise FileNotFoundError(path)
        train_ds = [d for d in DS_KEYS if d != held]
        groups, y_all = V.trial_groups(feat_all, train_ds)
        log_line(f"fold held-out={held} init {path} λ={irm_lambda}")
        ema, mu, sd, used, stats = fit_with_oom(
            path, groups, y_all, device, STEPS, BATCH, f"held-{held}", irm_lambda)
        torch.save({"state": ema.state_dict(), "mu": mu, "sd": sd, "swa": path,
                    "train": train_ds, "steps": STEPS, "batch": used,
                    "irm_lambda": irm_lambda, "stats": stats, "cfg": CFG},
                   os.path.join(CKPT_DIR, f"held-{held}.pt"))
        scores, _streams = score_lodo(ema, feat_all, mu, sd, held, device)
        per[held] = dict(scores=scores, stats=stats, batch=used)
        del ema
        if device.type == "cuda":
            torch.cuda.empty_cache()

    log_line(f"all-5 IRM fine-tune for AASD and Carta, init {SWA_DIR}/all5.pt λ={irm_lambda}")
    groups, y_all = V.trial_groups(feat_all, list(DS_KEYS))
    all_path = os.path.join(SWA_DIR, "all5.pt")
    ema, mu, sd, used, stats = fit_with_oom(
        all_path, groups, y_all, device, STEPS, BATCH, "all5", irm_lambda)
    torch.save({"state": ema.state_dict(), "mu": mu, "sd": sd, "swa": all_path,
                "train": list(DS_KEYS), "steps": STEPS, "batch": used,
                "irm_lambda": irm_lambda, "stats": stats, "cfg": CFG},
               os.path.join(CKPT_DIR, "all5.pt"))
    corpus_streams = V.infer_all(ema, feat_all, mu, sd, WINDOW, device)
    ext_logits, ext_meta = load_external()
    ext_feat = V4.build_features_from(ext_logits)["ms"]
    ext = score_external(ema, ext_feat, ext_meta, mu, sd, corpus_streams, N.G["att"], device)

    mean_h = float(np.mean([per[d]["scores"]["irm"]["H"] for d in DS_KEYS]))
    mean_acc = float(np.mean([per[d]["scores"]["irm"]["Acc"] for d in DS_KEYS]))
    log_line(f"LODO mean H {mean_h:.4f} Acc {mean_acc:.2f}")

    out = dict(
        p_stay=P_STAY, scale=SCALE, steps=STEPS, batch=BATCH,
        irm_lambda=irm_lambda, smoke=smoke_info,
        lodo={d: per[d]["scores"] for d in DS_KEYS},
        lodo_stats={d: per[d]["stats"] for d in DS_KEYS},
        lodo_mean=dict(H=mean_h, Acc=mean_acc),
        external=ext,
        all5_stats=stats,
    )
    os.makedirs(os.path.dirname(OUT), exist_ok=True)
    with open(OUT, "w") as fh:
        json.dump(out, fh, indent=1, default=float)
    log_line(f"wrote {OUT}")


if __name__ == "__main__":
    main()
