56 lines
2.1 KiB
JavaScript
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);
|
|
}
|