# -*- coding: utf-8 -*- """骨骼预处理和 glTF 节点树。 fix_facing 模型侧着 / 背对时绕 Y 轴转正(Unreal 的 psk / uemodel 常见) prepare_bones 付与骨合并、humanoid 映射与层级修正、拓扑排序(PMX 坐标) apply_tpose A-pose → T-pose:骨骼位置和顶点一起重摆 NodeTree 骨骼 → glTF 节点(先记父节点 + 世界坐标,最后统一换算 translation, 所以补占位骨、SpringBone 改挂父节点都可以随意改) """ import math from types import SimpleNamespace from .humanoid import (REQUIRED_0X, REQUIRED_1_0, _HIPS_Y, _SYNTH, _append_aliases, _bone_len, _clean_parents, _fix_humanoid_hierarchy, _is_ancestor, _map_humanoid, _pick_toes, _reparent, _topo_bones, _tpose_globals, _vrm_anchor) from .mathutil import _I3, _m3vec def fix_facing(model, log): """PMX 约定左手在 +X、脸朝 -Z。从 humanoid 的左右肩 / 胯算出左右方向,不在 X 轴上时 绕 Y 轴转最近的 90° 倍数(Unreal 的前方是另一根轴,psk / uemodel 转来的模型常常侧着; xps / FBX 偶尔背对)。侧着的模型做 T-pose 时会把向前伸的手臂当成下垂的再转 90°。 只在没有物理刚体时转(刚体的欧拉角不好跟着转,原生 PMX 本来就是正的)。返回转的角度。 """ bones = model["bones"] if model.get("rigid_bodies"): return 0 human = _map_humanoid(bones, True, {}) pairs = [(human[a], human[b]) for a, b in (("leftUpperArm", "rightUpperArm"), ("leftUpperLeg", "rightUpperLeg"), ("leftShoulder", "rightShoulder")) if a in human and b in human] if not pairs: return 0 sx = sum(bones[l]["pos"][0] - bones[r]["pos"][0] for l, r in pairs) sz = sum(bones[l]["pos"][2] - bones[r]["pos"][2] for l, r in pairs) if math.hypot(sx, sz) < 1e-6: return 0 quarter = round(math.atan2(sz, sx) / (math.pi / 2)) % 4 # 0 = 已经是正的 if quarter == 0: return 0 t = quarter * math.pi / 2 c, s = round(math.cos(t)), round(math.sin(t)) def rot(v): # 把「左」方向转到 +X:x' = x·c + z·s,z' = −x·s + z·c return (v[0] * c + v[2] * s, v[1], -v[0] * s + v[2] * c) for v in model.get("vertices") or []: v["pos"] = rot(v["pos"]) v["normal"] = rot(v["normal"]) if v.get("sdef"): v["sdef"] = [rot(p) for p in v["sdef"]] for b in bones: b["pos"] = rot(b["pos"]) if b.get("tail_kind") == 0 and b.get("tail") is not None and not isinstance(b["tail"], int): b["tail"] = rot(b["tail"]) if b.get("fixed_axis"): b["fixed_axis"] = rot(b["fixed_axis"]) if b.get("local_axis"): b["local_axis"] = tuple(rot(a) for a in b["local_axis"]) for mo in model.get("morphs") or []: if mo["kind"] == 1: mo["offsets"] = [(i, rot(o)) for i, o in mo["offsets"]] elif mo["kind"] == 2: mo["offsets"] = [(i, rot(t_), q_) for i, t_, q_ in mo["offsets"]] # 骨骼表情的平移 deg = quarter * 90 if log: log("朝向:模型%s,已绕 Y 轴旋转 %d° 校正(左右肩 / 胯不在 X 轴上)" % ("背向前方" if quarter == 2 else "朝向侧面", deg), "warn") return deg def prepare_bones(bones, is1, log, weighted=()): """→ SimpleNamespace(parents, alias, required, human_b, order, remap)。 1) 付与 100% 的骨(足D 等)并入付与親:权重与子骨都转过去 2) humanoid 映射 + 层级修正(上半身 挂到 下半身 下等);脚趾按 _pick_toes 选 weighted:挂了网格的骨(PMX 骨索引),选脚趾时用。 """ nb = len(bones) parents = _clean_parents(bones) alias = _append_aliases(bones, parents, eps=0.01) if alias: for i, dst in alias.items(): for c in range(nb): if parents[c] == i: _reparent(parents, c, dst) log("付与骨合并:%d 根(%s)→ 权重并入付与親" % (len(alias), "、".join(bones[i]["name"] for i in list(alias)[:6]) + ("…" if len(alias) > 6 else ""))) off = [bones[i]["name"] for i, s in alias.items() if math.dist(bones[i]["pos"], bones[s]["pos"]) > 0.01] if off: log("付与骨合并:%s 与付与親的位置略有偏差,合并后绕付与親的位置转动" % "、".join(off)) # 1.0 规范里 chest / neck 可选,但不少程序、动作数据默认有(比如按躯干关节生成布娃娃), # 缺的话和 0.x 一样补占位骨 required = REQUIRED_0X human_b = _map_humanoid(bones, is1, alias) _pick_toes(bones, human_b, alias, set(weighted)) _fix_humanoid_hierarchy(human_b, parents, bones, set(required), log) order, remap = _topo_bones(parents) return SimpleNamespace(parents=parents, alias=alias, required=required, human_b=human_b, order=order, remap=remap) def split_partial(bones, bs, vweights, rigid_bodies, log): """按比例跟随关节的付与骨(ひざ補助 跟 ひざ 转 0.5、尻 跟 足 转 0.5 之类)→ 新的逐顶点权重。 这些骨让关节弯曲时保持体积:MMD 里绕自己的位置转关节角度的一部分。VRM 没有付与,原样导出时它们 只跟父骨走,关节一弯这部分就瘪下去。这里把它(和它下面的骨)上的权重按付与率拆开:付与率那份给 关节骨,其余留在原骨上,线性混合出来约等于转了一部分角度(误差约为不拆的一半到四分之一)。 静止姿势不变,在 T-pose 之后做(T-pose 里这些骨已按付与率跟转)。 只拆:付与親(并入后)是 humanoid 骨、付与率在 0.05~1 之间、和关节骨跟着同一根 humanoid 骨移动 (见 humanoid._append_aliases)、自己和下面的骨都不带物理刚体的。付与率 1 却没能并入付与親的 (偏差超过半节骨长)在偏差不超过一节骨长时整份转过去;再远的不动——它的顶点要是都在自己的转动点 附近,改绕关节转反而比不动偏得多,留给自检在日志里提示。 """ n = len(bones) if not n: return vweights hum = set(bs.human_b.values()) phys = {rb.get("bone") for rb in rigid_bodies or () if rb.get("mode") in (1, 2)} kids = [[] for _ in range(n)] for c, p in enumerate(bs.parents): if 0 <= p < n and p != c: kids[p].append(c) def anchor(i): seen = set() while 0 <= i < n and i not in seen: if i in hum: return i seen.add(i) i = bs.parents[i] return -1 def subtree(i): # 到下一根 humanoid 骨为止 out, todo = {i}, [i] while todo: for c in kids[todo.pop()]: if c not in hum and c not in out: out.add(c) todo.append(c) return out plan, names = {}, [] for i, b in enumerate(bones): ir = b.get("inherit_rot") if not ir or i in hum or i in bs.alias or not (0 <= ir[0] < n) or not (0.05 <= ir[1] <= 1.0001): continue s = bs.alias.get(ir[0], ir[0]) if s not in hum or _is_ancestor(bs.parents, i, s) or _is_ancestor(bs.parents, s, i): continue if anchor(bs.parents[i]) != anchor(bs.parents[s]): continue if ir[1] >= 0.999 and math.dist(b["pos"], bones[s]["pos"]) > max( math.dist(bones[bs.parents[s]]["pos"], bones[s]["pos"]) if bs.parents[s] >= 0 else 0.0, _bone_len(bones, bs.parents, s)): continue # 100% 跟随却离关节一节骨长以上:绕关节转可能比不动还偏,留给自检提示 sub = subtree(i) if phys.intersection(sub): continue for k in sub: if k == i or not bones[k].get("inherit_rot"): plan.setdefault(k, (s, min(1.0, ir[1]))) names.append(bones[i]["name"]) if not plan: return vweights out, nv = list(vweights), 0 for vi, wl in enumerate(vweights): if not any(b in plan for b, _ in wl): continue acc = {} for b, w in wl: if b in plan: s, r = plan[b] acc[s] = acc.get(s, 0.0) + w * r if r < 1.0: acc[b] = acc.get(b, 0.0) + w * (1.0 - r) else: acc[b] = acc.get(b, 0.0) + w top = sorted(acc.items(), key=lambda t: -t[1])[:4] tot = sum(w for _, w in top) or 1.0 out[vi] = [(b, w / tot) for b, w in top] nv += 1 if nv: log("付与骨:%d 根按比例跟随关节的骨(%s)→ 权重按付与率分给关节骨,共 %d 个顶点" % (len(names), "、".join(names[:6]) + ("…" if len(names) > 6 else ""), nv)) return out def apply_tpose(verts, bones, bs, vweights, tpose, log): """A-pose → T-pose(线性混合蒙皮),返回 (glob, bpos, vpos, vnrm, vmat)。 glob:每根骨的 T-pose 全局变换(没做 T-pose 时为 None);vmat:每个顶点的混合旋转, 表情偏移要跟着转(没动的顶点为 None)。都是 PMX 坐标。 """ nb = len(bones) vpos = [v["pos"] for v in verts] vnrm = [v["normal"] for v in verts] vmat = None bpos = [b["pos"] for b in bones] glob = _tpose_globals(bones, bs.parents, bs.order, bs.human_b, log) \ if (tpose and nb) else None if glob: bpos = [] for i in range(nb): m, t = glob[i] q = _m3vec(m, bones[i]["pos"]) bpos.append((q[0] + t[0], q[1] + t[1], q[2] + t[2])) vpos, vnrm, vmat = [], [], [None] * len(verts) for vi, v in enumerate(verts): wl = vweights[vi] if all(glob[b_][0] is _I3 for b_, _ in wl): vpos.append(v["pos"]) vnrm.append(v["normal"]) continue m = [0.0] * 9 t = [0.0, 0.0, 0.0] for b_, w in wl: gm, gt = glob[b_] for k in range(9): m[k] += gm[k] * w for k in range(3): t[k] += gt[k] * w q = _m3vec(m, v["pos"]) vpos.append((q[0] + t[0], q[1] + t[1], q[2] + t[2])) vnrm.append(_m3vec(m, v["normal"])) vmat[vi] = m return glob, bpos, vpos, vnrm, vmat class NodeTree: """glTF 节点:名字、父节点、世界坐标(VRM 坐标)。骨骼按拓扑序排在最前面。""" def __init__(self, bones, bs, bpos, xf): self.names = [] self.parent = [] self.wpos = [] self._remap = bs.remap self._of_bone = [0] * len(bones) self._name_set = None for new_i, old_i in enumerate(bs.order): par = bs.parents[old_i] self._of_bone[new_i] = len(self.names) self.names.append(bones[old_i]["name"] or ("bone%d" % old_i)) self.parent.append(self._of_bone[bs.remap[par]] if (par >= 0 and bs.remap[par] < new_i) else None) self.wpos.append(xf(bpos[old_i])) if not bones: # 极端情况:没有骨骼 self.names.append("root_bone") self.parent.append(None) self.wpos.append((0.0, 0.0, 0.0)) def bone_node(self, pmx_index): """PMX 骨骼序号 → 节点序号。""" if 0 <= pmx_index < len(self._of_bone): return self._of_bone[self._remap[pmx_index]] return None def node_pos(self, n): return self.wpos[n] def is_ancestor(self, a, b): seen = set() while b is not None and b not in seen: if b == a: return True seen.add(b) b = self.parent[b] return False def add_node(self, name, parent, pos): """新增一个节点(重名时加 _2、_3 …),返回序号。""" if self._name_set is None: self._name_set = set(self.names) nm, k = name, 2 while nm in self._name_set: nm = "%s_%d" % (name, k) k += 1 self._name_set.add(nm) self.names.append(nm) self.parent.append(parent) self.wpos.append(pos) return len(self.names) - 1 def set_parent(self, node, parent): self.parent[node] = parent def humanoid(self, human_b, required, unit, log, roots=()): """humanoid 骨位 → 节点;缺失的必需骨位补占位骨(vrm_*)。 roots:另外要补的骨位(0.x 的两节拇指缺掌根那节 ThumbProximal 时补一个,插在手和第二节之间)。 unit(左, 上, 前) → 当前规范下的方向向量(1.0 左 +X 前 +Z;0.x 反过来)。 """ human = {k: self.bone_node(v) for k, v in human_b.items()} req = set(required) def ensure(name): if name in human: return human[name] pname = _vrm_anchor(name, set(human) | req) pnode = ensure(pname) if pname else None # 已有的、规范上应挂在本骨位下的 humanoid 骨(比如缺 spine 时的 chest) kids = [human[h] for h in list(human) if _vrm_anchor(h, set(human) | {name}) == name and not (pnode is not None and self.is_ancestor(human[h], pnode))] if kids: kc = [sum(self.wpos[k][j] for k in kids) / len(kids) for j in range(3)] if pnode is not None: pos = tuple((self.wpos[pnode][j] + kc[j]) * 0.5 for j in range(3)) else: pos = tuple(kc) else: off = _SYNTH.get(name, (0.0, 0.05, 0.0)) d = unit(off[0], off[1], off[2]) if pnode is None: pos = (0.0, _HIPS_Y, 0.0) if name == "hips" else d else: pos = tuple(self.wpos[pnode][j] + d[j] for j in range(3)) idx = len(self.names) self.names.append("vrm_" + name) self.parent.append(pnode) self.wpos.append(pos) for k in kids: self.parent[k] = idx human[name] = idx return idx for r in required: if r not in human: ensure(r) log("骨骼:模型缺少 %s,已生成占位骨骼" % r, "warn") added = [r for r in roots if r not in human] for r in added: ensure(r) if added: log("骨骼:拇指只有两节(%s),已在手腕和第二节之间补上掌根那节,0.x 和 1.0 的拇指各节对应一致" % "、".join(added)) return human def lower_hips(self, human, log): """hips 放到骨盆(大腿根往上一点),不和 spine 重合。 MMD 的「下半身」「上半身」从腰部同一点出发,映射成 hips / spine 后两者几乎重合(0~5 mm), hips 也比大腿根高出一截。按 hips → spine 的距离生成躯干碰撞体的程序(游戏布娃娃)会 得到长度为 0 的一段。VRoid 的 hips 在大腿根往上约 43%(到 spine 的高度差)处。 只改节点位置:子节点的局部偏移、逆绑定矩阵都按世界坐标算,网格和权重不受影响。 """ if not all(k in human for k in ("hips", "spine", "leftUpperLeg", "rightUpperLeg")): return h, s = human["hips"], human["spine"] leg_y = (self.wpos[human["leftUpperLeg"]][1] + self.wpos[human["rightUpperLeg"]][1]) * 0.5 gap = self.wpos[s][1] - leg_y # MMD 模型实测 0~5 mm(不到高度差的 5%);正常绑定的 FBX 等 hips 本来就在骨盆, # 离 spine 有高度差的 20% 以上,不动 if gap <= 0.02 or self.wpos[s][1] - self.wpos[h][1] >= 0.1 * gap: return old = self.wpos[h] self.wpos[h] = (old[0], leg_y + 0.43 * gap, old[2]) log("hips:已移至骨盆,下移 %.1f cm(原与 spine 相距 %.1f mm)" % ((old[1] - self.wpos[h][1]) * 100, abs(self.wpos[s][1] - old[1]) * 1000)) def prune(self, core, collapse=False): """只留 core 里的节点和连接它们所需的祖先,其余(IK、合并掉的付与骨、末端骨等)删掉。 collapse:祖先也不留——没有权重的中间节点(MMD 的 全ての親 / センター / グルーブ / 腰 / 肩P 之类) 一并去掉,子节点挂到最近的保留祖先上,层级像 VRoid(Root > Hips)。 节点位置是世界坐标,删掉中间节点不改变其余节点的位置。返回 旧序号 → 新序号(删掉的不在里面)。 """ keep = set(core) if not collapse: for n in core: p = self.parent[n] while p is not None and p not in keep: keep.add(p) p = self.parent[p] order = [i for i in range(len(self.names)) if i in keep] new = {o: k for k, o in enumerate(order)} def up(i): p = self.parent[i] while p is not None and p not in new: p = self.parent[p] return None if p is None else new[p] self.parent = [up(i) for i in order] self.names = [self.names[i] for i in order] self.wpos = [self.wpos[i] for i in order] self._of_bone = [new.get(n) for n in self._of_bone] self._name_set = None return new def gltf_nodes(self): """→ (glTF nodes 列表, 没有父节点的节点序号)。translation 按父节点换算成局部值。""" nodes = [] top = [] for i, nm in enumerate(self.names): p = self.parent[i] base = self.wpos[p] if p is not None else (0.0, 0.0, 0.0) nodes.append({"name": nm, "translation": [self.wpos[i][j] - base[j] for j in range(3)]}) for i, p in enumerate(self.parent): if p is not None: nodes[p].setdefault("children", []).append(i) else: top.append(i) return nodes, top