57 lines
1.6 KiB
Python
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))
|