Files
2026-11-03 19:46:08 +08:00

57 lines
1.6 KiB
Python

from typing import Any
import mujoco_warp as mjwarp
import warp as wp
# Ref: https://github.com/newton-physics/newton/blob/640095cbe1914d43e9158ec71264a0eb7272fc15/newton/_src/solvers/mujoco/solver_mujoco.py#L2587-L2612
@wp.kernel(module="unique")
def repeat_array_kernel(
src: wp.array(dtype=Any), # type: ignore
nelems_per_world: int,
dst: wp.array(dtype=Any), # type: ignore
):
tid = wp.tid()
src_idx = tid % nelems_per_world # type: ignore[operator]
dst[tid] = src[src_idx]
def expand_model_fields(
model: mjwarp.Model,
nworld: int,
fields_to_expand: list[str],
) -> None:
if nworld == 1:
return
def tile(x: wp.array) -> wp.array | wp.array2d | wp.array3d | wp.array4d:
# Create new array with same shape but first dim multiplied by nworld.
new_shape = list(x.shape)
new_shape[0] = nworld
wp_array = {1: wp.array, 2: wp.array2d, 3: wp.array3d, 4: wp.array4d}[
len(new_shape)
]
dst = wp_array(shape=new_shape, dtype=x.dtype, device=x.device)
src_flat = x.flatten()
dst_flat = dst.flatten() # type: ignore[possibly-missing-attribute]
# Launch kernel to repeat data, one thread per destination element.
n_elems_per_world = dst_flat.shape[0] // nworld
wp.launch(
repeat_array_kernel,
dim=dst_flat.shape[0],
inputs=[src_flat, n_elems_per_world],
outputs=[dst_flat],
device=x.device,
)
return dst
for field in model.__dataclass_fields__:
if field in fields_to_expand:
array = getattr(model, field)
if array.shape[0] != 1:
continue # Already per-world (e.g., variant compilation).
setattr(model, field, tile(array))