"""PCGrad multi-dataset gradient surgery fine-tune of stem_ms96 from SWA.

Yu et al. (NeurIPS 2020): treat each train dataset as a task/environment.
Per minibatch: compute per-env ERM BCE grads, project conflicting grads
(g_i ← g_i − proj_{g_j} g_i when g_i·g_j < 0), then step on the sum.

Distinct from IRMv1 (which adds a dummy-scale penalty λ‖∇_w R^e‖²).
Architecture unchanged. Init models/stem_ms96_swa/{held-*,all5}.pt with
causal -inf mask restored. EMA 0.995 eval. HMM p_stay 0.994 scale 0.8.
Also report causal tau-30 high-pass of the PCGrad evidence (hp30).

usage:
  STEPS=1000 BATCH=512 python stem_ms96_pcgrad.py
  SMOKE=1 STEPS=40 python stem_ms96_pcgrad.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_pcgrad")
LOG = os.path.join(EXP, "experiments", "stem_ms96_pcgrad.log")
OUT = os.path.join(EXP, "results", "research", "stem_ms96_pcgrad.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"))
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 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 _flatten_grads(grads_list):
    return torch.cat([g.reshape(-1) for g in grads_list])


def pcgrad_project(env_grads, rng):
    """Yu et al. PCGrad on a list of flat gradient vectors.

    Random permutation of other tasks; project out conflicting components.
    Returns mean of projected grads (same scale as mean ERM grad).
    """
    n = len(env_grads)
    if n == 1:
        return env_grads[0]
    order = list(range(n))
    projected = []
    for i in range(n):
        g_i = env_grads[i].clone()
        others = [j for j in order if j != i]
        rng.shuffle(others)
        for j in others:
            g_j = env_grads[j]
            dot = torch.dot(g_i, g_j)
            if dot < 0:
                g_i = g_i - (dot / (g_j.norm().pow(2).clamp_min(1e-12))) * g_j
        projected.append(g_i)
    return torch.stack(projected).mean(0)


def env_losses(logit, y, m, pos_weight, n_env):
    """Dataset-balanced batch: row i belongs to env i % n_env."""
    losses = []
    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
        losses.append(weighted_bce(le, ye, me, pos_weight))
    if not losses:
        raise RuntimeError("no valid environments in batch")
    return losses


def collect_env_grads(model, losses):
    """Backward each env loss; return flat grads + conflict count helper data."""
    params = [p for p in model.parameters() if p.requires_grad]
    env_grads = []
    for i, loss in enumerate(losses):
        model.zero_grad(set_to_none=True)
        loss.backward(retain_graph=(i < len(losses) - 1))
        grads = []
        for p in params:
            if p.grad is None:
                grads.append(torch.zeros_like(p).reshape(-1))
            else:
                grads.append(p.grad.detach().reshape(-1).clone())
        env_grads.append(torch.cat(grads))
    return env_grads, params


def count_conflicts(env_grads):
    n = len(env_grads)
    n_pairs = 0
    n_conf = 0
    for i in range(n):
        for j in range(i + 1, n):
            n_pairs += 1
            if torch.dot(env_grads[i], env_grads[j]) < 0:
                n_conf += 1
    return n_conf, n_pairs


def assign_flat_grad(params, flat):
    offset = 0
    for p in params:
        n = p.numel()
        p.grad = flat[offset:offset + n].view_as(p).clone()
        offset += n


def train_pcgrad(model, groups, y_all, mu, sd, device, steps, batch, tag):
    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)
    torch_rng = np.random.default_rng(V.TRAIN_SEED + 17)
    ema = copy.deepcopy(model).eval()
    model.train()
    t0 = time.time()
    last = last_erm = None
    conf_sum = pairs_sum = 0
    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)
        logit = model(x)
        losses = env_losses(logit, y, m, pos_weight, n_env)
        erm = torch.stack(losses).mean()
        if not torch.isfinite(erm):
            raise RuntimeError(f"non-finite erm at step {step} for {tag}: {erm.item()}")
        env_grads, params = collect_env_grads(model, losses)
        n_conf, n_pairs = count_conflicts(env_grads)
        conf_sum += n_conf
        pairs_sum += n_pairs
        flat = pcgrad_project(env_grads, torch_rng)
        opt.zero_grad(set_to_none=True)
        assign_flat_grad(params, flat)
        torch.nn.utils.clip_grad_norm_(model.parameters(), 1.0)
        opt.step()
        V.ema_update(model, ema, EMA_DECAY)
        last = float(erm.item())
        last_erm = last
        if step == 0 or (step + 1) % 200 == 0 or step + 1 == steps:
            frac = conf_sum / max(pairs_sum, 1)
            log_line(
                f"    {tag} step {step + 1}/{steps} erm {last:.4f} "
                f"conflict_frac {frac:.3f} n_env {n_env}")
    ema.eval()
    acc = V.train_frame_acc(ema, groups, WINDOW, mu, sd, device)
    frac = conf_sum / max(pairs_sum, 1)
    log_line(
        f"  trained {tag} erm {last_erm:.4f} conflict_frac {frac:.3f} "
        f"frame-acc {acc:.3f} n_env {n_env} ({time.time() - t0:.0f}s)")
    return ema, dict(
        loss=last, erm=last_erm, conflict_frac=frac,
        frame_acc=acc, n_env=n_env)


def fit_with_oom(swa_path, groups, y_all, device, steps, batch, tag, halved=False):
    model, mu, sd, _train = load_swa(swa_path, device)
    try:
        ema, stats = train_pcgrad(model, groups, y_all, mu, sd, device, steps, batch, tag)
        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, 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(pcgrad=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(pcgrad=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 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} method=PCGrad 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)

    if SMOKE:
        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)
        smoke_steps = int(os.environ.get("SMOKE_STEPS", "40"))
        log_line(f"SMOKE held-{held} steps={smoke_steps}")
        ema, mu, sd, used, stats = fit_with_oom(
            path, groups, y_all, device, smoke_steps, BATCH, f"smoke-held-{held}")
        out = dict(smoke=stats, batch=used)
        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(f"SMOKE done frame={stats['frame_acc']:.3f} conflict={stats['conflict_frac']:.3f}")
        del ema
        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}")
        ema, mu, sd, used, stats = fit_with_oom(
            path, groups, y_all, device, STEPS, BATCH, f"held-{held}")
        torch.save({"state": ema.state_dict(), "mu": mu, "sd": sd, "swa": path,
                    "train": train_ds, "steps": STEPS, "batch": used,
                    "method": "pcgrad", "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 PCGrad fine-tune for AASD and Carta, init {SWA_DIR}/all5.pt")
    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")
    torch.save({"state": ema.state_dict(), "mu": mu, "sd": sd, "swa": all_path,
                "train": list(DS_KEYS), "steps": STEPS, "batch": used,
                "method": "pcgrad", "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"]["pcgrad"]["H"] for d in DS_KEYS]))
    mean_acc = float(np.mean([per[d]["scores"]["pcgrad"]["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,
        method="pcgrad",
        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()
