File size: 2,113 Bytes
fb0074a | 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 | """HFD adapters; metric definitions remain in the read-only OmniHM evaluator."""
from pathlib import Path
import hashlib
import json
import os
import numpy as np
from scipy.spatial.transform import Rotation, Slerp
ROOT = Path(__file__).resolve().parents[1]
WORK = Path(__file__).resolve().parent
WORKSPACE = ROOT.parents[2]
PEER = WORKSPACE / "buwendong/user/code"
OMNI = WORK / "vendor/OmniHM_bench"
OMG = WORK / "vendor/OMG"
EVALUATOR = WORK / "vendor/evaluator_v13.pt"
DEFAULT_RUN = ROOT / "runs/posttrain_full_duplex/hfd.gpus4.2610100010-thirdparty"
# Identical to HFD's SONIC renderer: IsaacLab breadth-first -> MuJoCo tree order.
ISAAC_TO_MUJOCO = [0,3,6,9,13,17,1,4,7,10,14,18,2,5,8,11,15,19,21,23,25,27,12,16,20,22,24,26,28]
def sha256(path):
h = hashlib.sha256()
with Path(path).open('rb') as f:
for chunk in iter(lambda: f.read(8*1024*1024), b''):
h.update(chunk)
return h.hexdigest()
def write_json(path, value):
path = Path(path)
path.parent.mkdir(parents=True, exist_ok=True)
tmp = path.with_suffix(path.suffix + f'.{os.getpid()}.tmp')
tmp.write_text(json.dumps(value, ensure_ascii=False, indent=2, allow_nan=False)+'\n')
tmp.replace(path)
def qpos_from_absolute(motion, source_fps=50., target_fps=30.):
"""No heading/height correction, smoothing, temporal warp or GT alignment."""
motion = np.asarray(motion, np.float64)
if motion.ndim != 2 or motion.shape[1] != 36 or len(motion) < 4 or not np.isfinite(motion).all():
raise ValueError('Expected finite HFD physical absolute [T,36]')
quat = motion[:, 32:36]
if not np.allclose(np.linalg.norm(quat, axis=1), 1., atol=5e-3):
raise ValueError('Non-unit wxyz quaternion')
old = np.arange(len(motion)) / source_fps
new = np.arange(int(np.floor(old[-1]*target_fps))+1) / target_fps
linear = np.stack([np.interp(new, old, motion[:, i]) for i in range(32)], -1)
rot = Slerp(old, Rotation.from_quat(quat[:, [1,2,3,0]]))(new).as_quat()[:, [3,0,1,2]]
return np.concatenate([linear[:,29:32], rot, linear[:, ISAAC_TO_MUJOCO]], -1).astype(np.float32)
|