Files
vibemake/sandbox/src/platform/sim/SceneComposer.js
T

56 lines
2.1 KiB
JavaScript

import { arenaWalls } from "../worlds/arena.js";
import { appendInteractivePhysics } from "../../game/worlds/arena/session-environment.js";
export function composeScene(xml, config, world, interactiveProps = []) {
const doc = new DOMParser().parseFromString(xml, "text/xml");
if (
doc.querySelector("parsererror") ||
doc.documentElement.tagName !== "mujoco"
)
throw new Error("model: invalid MJCF XML");
const option =
doc.querySelector("mujoco > option") ?? doc.createElement("option");
option.setAttribute("timestep", String(config.sim.timestep));
if (interactiveProps.length) option.setAttribute("jacobian", "dense");
if (!option.parentNode) doc.documentElement.append(option);
if (world.type !== "flat")
throw new Error(`World ${world.id}: generic composer requires flat World`);
const worldbody = doc.querySelector("mujoco > worldbody");
if (!worldbody) throw new Error("model: worldbody missing");
if (doc.querySelector('[name="platform_floor"]'))
throw new Error("World name collision: platform_floor");
const floor = doc.createElement("geom");
for (const [key, value] of Object.entries({
name: "platform_floor",
type: "plane",
size: "0 0 0.05",
// Uploaded models may make geoms visual-only by default (e.g. Apollo).
contype: "1",
conaffinity: "1",
group: "0",
rgba: world.floor.rgba.join(" "),
friction: world.floor.friction.join(" "),
}))
floor.setAttribute(key, value);
worldbody.append(floor);
if (world.boundary) {
for (const wall of arenaWalls(world.boundary)) {
if (doc.querySelector(`[name="${wall.name}"]`))
throw new Error(`World name collision: ${wall.name}`);
const geom = doc.createElement("geom");
for (const [key, value] of Object.entries({
name: wall.name,
type: "box",
pos: wall.pos.join(" "),
size: wall.size.join(" "),
contype: "1",
conaffinity: "1",
group: "0",
}))
geom.setAttribute(key, value);
worldbody.append(geom);
}
}
appendInteractivePhysics(doc, interactiveProps);
return new XMLSerializer().serializeToString(doc);
}