warp-lang 1.7.0__py3-none-manylinux_2_34_aarch64.whl

warp/examples/sim/example_cloth.py

@@ -0,0 +1,225 @@
+# SPDX-FileCopyrightText: Copyright (c) 2022 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
+# SPDX-License-Identifier: Apache-2.0
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+# http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+###########################################################################
+# Example Sim Cloth
+#
+# Shows a simulation of an FEM cloth model colliding against a static
+# rigid body mesh using the wp.sim.ModelBuilder().
+#
+###########################################################################
+
+import math
+import os
+from enum import Enum
+
+import numpy as np
+from pxr import Usd, UsdGeom
+
+import warp as wp
+import warp.examples
+import warp.sim
+import warp.sim.render
+
+
+class IntegratorType(Enum):
+    EULER = "euler"
+    XPBD = "xpbd"
+    VBD = "vbd"
+
+    def __str__(self):
+        return self.value
+
+
+class Example:
+    def __init__(
+        self, stage_path="example_cloth.usd", integrator: IntegratorType = IntegratorType.EULER, height=32, width=64
+    ):
+        self.integrator_type = integrator
+
+        self.sim_height = height
+        self.sim_width = width
+
+        fps = 60
+        self.sim_substeps = 32
+        self.frame_dt = 1.0 / fps
+        self.sim_dt = self.frame_dt / self.sim_substeps
+        self.sim_time = 0.0
+        self.profiler = {}
+
+        builder = wp.sim.ModelBuilder()
+
+        if self.integrator_type == IntegratorType.EULER:
+            builder.add_cloth_grid(
+                pos=wp.vec3(0.0, 4.0, 0.0),
+                rot=wp.quat_from_axis_angle(wp.vec3(1.0, 0.0, 0.0), math.pi * 0.5),
+                vel=wp.vec3(0.0, 0.0, 0.0),
+                dim_x=self.sim_width,
+                dim_y=self.sim_height,
+                cell_x=0.1,
+                cell_y=0.1,
+                mass=0.1,
+                fix_left=True,
+                tri_ke=1.0e3,
+                tri_ka=1.0e3,
+                tri_kd=1.0e1,
+            )
+        elif self.integrator_type == IntegratorType.XPBD:
+            builder.add_cloth_grid(
+                pos=wp.vec3(0.0, 4.0, 0.0),
+                rot=wp.quat_from_axis_angle(wp.vec3(1.0, 0.0, 0.0), math.pi * 0.5),
+                vel=wp.vec3(0.0, 0.0, 0.0),
+                dim_x=self.sim_width,
+                dim_y=self.sim_height,
+                cell_x=0.1,
+                cell_y=0.1,
+                mass=0.1,
+                fix_left=True,
+                edge_ke=1.0e2,
+                add_springs=True,
+                spring_ke=1.0e3,
+                spring_kd=0.0,
+            )
+        else:
+            # VBD
+            builder.add_cloth_grid(
+                pos=wp.vec3(0.0, 4.0, 0.0),
+                rot=wp.quat_from_axis_angle(wp.vec3(1.0, 0.0, 0.0), math.pi * 0.5),
+                vel=wp.vec3(0.0, 0.0, 0.0),
+                dim_x=self.sim_width,
+                dim_y=self.sim_height,
+                cell_x=0.1,
+                cell_y=0.1,
+                mass=0.1,
+                fix_left=True,
+                tri_ke=1e4,
+                tri_ka=1e4,
+                tri_kd=1e-5,
+                edge_ke=100,
+            )
+
+        usd_stage = Usd.Stage.Open(os.path.join(warp.examples.get_asset_directory(), "bunny.usd"))
+        usd_geom = UsdGeom.Mesh(usd_stage.GetPrimAtPath("/root/bunny"))
+
+        mesh_points = np.array(usd_geom.GetPointsAttr().Get())
+        mesh_indices = np.array(usd_geom.GetFaceVertexIndicesAttr().Get())
+
+        mesh = wp.sim.Mesh(mesh_points, mesh_indices)
+
+        builder.add_shape_mesh(
+            body=-1,
+            mesh=mesh,
+            pos=wp.vec3(1.0, 0.0, 1.0),
+            rot=wp.quat_from_axis_angle(wp.vec3(0.0, 1.0, 0.0), math.pi * 0.5),
+            scale=wp.vec3(2.0, 2.0, 2.0),
+            ke=1.0e2,
+            kd=1.0e2,
+            kf=1.0e1,
+        )
+
+        if self.integrator_type == IntegratorType.VBD:
+            builder.color()
+
+        self.model = builder.finalize()
+        self.model.ground = True
+        self.model.soft_contact_ke = 1.0e4
+        self.model.soft_contact_kd = 1.0e2
+
+        if self.integrator_type == IntegratorType.EULER:
+            self.integrator = wp.sim.SemiImplicitIntegrator()
+        elif self.integrator_type == IntegratorType.XPBD:
+            self.integrator = wp.sim.XPBDIntegrator(iterations=1)
+        else:
+            self.integrator = wp.sim.VBDIntegrator(self.model, iterations=1)
+
+        self.state_0 = self.model.state()
+        self.state_1 = self.model.state()
+
+        if stage_path:
+            self.renderer = wp.sim.render.SimRenderer(self.model, stage_path, scaling=40.0)
+        else:
+            self.renderer = None
+
+        self.use_cuda_graph = wp.get_device().is_cuda
+        if self.use_cuda_graph:
+            with wp.ScopedCapture() as capture:
+                self.simulate()
+            self.graph = capture.graph
+
+    def simulate(self):
+        wp.sim.collide(self.model, self.state_0)
+
+        for _ in range(self.sim_substeps):
+            self.state_0.clear_forces()
+
+            self.integrator.simulate(self.model, self.state_0, self.state_1, self.sim_dt)
+
+            # swap states
+            (self.state_0, self.state_1) = (self.state_1, self.state_0)
+
+    def step(self):
+        with wp.ScopedTimer("step", dict=self.profiler):
+            if self.use_cuda_graph:
+                wp.capture_launch(self.graph)
+            else:
+                self.simulate()
+        self.sim_time += self.frame_dt
+
+    def render(self):
+        if self.renderer is None:
+            return
+
+        with wp.ScopedTimer("render"):
+            self.renderer.begin_frame(self.sim_time)
+            self.renderer.render(self.state_0)
+            self.renderer.end_frame()
+
+
+if __name__ == "__main__":
+    import argparse
+
+    parser = argparse.ArgumentParser(formatter_class=argparse.ArgumentDefaultsHelpFormatter)
+    parser.add_argument("--device", type=str, default=None, help="Override the default Warp device.")
+    parser.add_argument(
+        "--stage_path",
+        type=lambda x: None if x == "None" else str(x),
+        default="example_cloth.usd",
+        help="Path to the output USD file.",
+    )
+    parser.add_argument("--num_frames", type=int, default=300, help="Total number of frames.")
+    parser.add_argument(
+        "--integrator",
+        help="Type of integrator",
+        type=IntegratorType,
+        choices=list(IntegratorType),
+        default=IntegratorType.EULER,
+    )
+    parser.add_argument("--width", type=int, default=64, help="Cloth resolution in x.")
+    parser.add_argument("--height", type=int, default=32, help="Cloth resolution in y.")
+
+    args = parser.parse_known_args()[0]
+
+    with wp.ScopedDevice(args.device):
+        example = Example(stage_path=args.stage_path, integrator=args.integrator, height=args.height, width=args.width)
+
+        for _i in range(args.num_frames):
+            example.step()
+            example.render()
+
+        frame_times = example.profiler["step"]
+        print("\nAverage frame sim time: {:.2f} ms".format(sum(frame_times) / len(frame_times)))
+
+        if example.renderer:
+            example.renderer.save()

warp/examples/sim/example_cloth_self_contact.py

@@ -0,0 +1,322 @@
+# SPDX-FileCopyrightText: Copyright (c) 2024 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
+# SPDX-License-Identifier: Apache-2.0
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+# http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+###########################################################################
+# Example Sim Cloth Self Contact
+#
+# This simulation demonstrates twisting an FEM cloth model using the VBD
+# integrator, showcasing its ability to handle complex self-contacts while
+# ensuring it remains intersection-free.
+#
+###########################################################################
+
+import math
+import os
+
+import numpy as np
+from pxr import Usd, UsdGeom
+
+import warp as wp
+import warp.examples
+import warp.sim
+import warp.sim.render
+from warp.sim.model import PARTICLE_FLAG_ACTIVE
+
+
+@wp.kernel
+def initialize_rotation(
+    # input
+    vertex_indices_to_rot: wp.array(dtype=wp.int32),
+    pos: wp.array(dtype=wp.vec3),
+    rot_centers: wp.array(dtype=wp.vec3),
+    rot_axes: wp.array(dtype=wp.vec3),
+    t: wp.array(dtype=float),
+    # output
+    roots: wp.array(dtype=wp.vec3),
+    roots_to_ps: wp.array(dtype=wp.vec3),
+):
+    tid = wp.tid()
+    v_index = vertex_indices_to_rot[wp.tid()]
+
+    p = pos[v_index]
+    rot_center = rot_centers[tid]
+    rot_axis = rot_axes[tid]
+    op = p - rot_center
+
+    root = wp.dot(op, rot_axis) * rot_axis
+
+    root_to_p = p - root
+
+    roots[tid] = root
+    roots_to_ps[tid] = root_to_p
+
+    if tid == 0:
+        t[0] = 0.0
+
+
+@wp.kernel
+def apply_rotation(
+    # input
+    vertex_indices_to_rot: wp.array(dtype=wp.int32),
+    rot_axes: wp.array(dtype=wp.vec3),
+    roots: wp.array(dtype=wp.vec3),
+    roots_to_ps: wp.array(dtype=wp.vec3),
+    t: wp.array(dtype=float),
+    angular_velocity: float,
+    dt: float,
+    end_time: float,
+    # output
+    pos_0: wp.array(dtype=wp.vec3),
+    pos_1: wp.array(dtype=wp.vec3),
+):
+    cur_t = t[0]
+    if cur_t > end_time:
+        return
+
+    tid = wp.tid()
+    v_index = vertex_indices_to_rot[wp.tid()]
+
+    rot_axis = rot_axes[tid]
+
+    ux = rot_axis[0]
+    uy = rot_axis[1]
+    uz = rot_axis[2]
+
+    theta = cur_t * angular_velocity
+
+    R = wp.mat33(
+        wp.cos(theta) + ux * ux * (1.0 - wp.cos(theta)),
+        ux * uy * (1.0 - wp.cos(theta)) - uz * wp.sin(theta),
+        ux * uz * (1.0 - wp.cos(theta)) + uy * wp.sin(theta),
+        uy * ux * (1.0 - wp.cos(theta)) + uz * wp.sin(theta),
+        wp.cos(theta) + uy * uy * (1.0 - wp.cos(theta)),
+        uy * uz * (1.0 - wp.cos(theta)) - ux * wp.sin(theta),
+        uz * ux * (1.0 - wp.cos(theta)) - uy * wp.sin(theta),
+        uz * uy * (1.0 - wp.cos(theta)) + ux * wp.sin(theta),
+        wp.cos(theta) + uz * uz * (1.0 - wp.cos(theta)),
+    )
+
+    root = roots[tid]
+    root_to_p = roots_to_ps[tid]
+    root_to_p_rot = R * root_to_p
+    p_rot = root + root_to_p_rot
+
+    pos_0[v_index] = p_rot
+    pos_1[v_index] = p_rot
+
+    if tid == 0:
+        t[0] = cur_t + dt
+
+
+class Example:
+    def __init__(self, stage_path="example_cloth_self_contact.usd", num_frames=600):
+        fps = 60
+        self.frame_dt = 1.0 / fps
+        # must be an even number when using CUDA Graph
+        self.num_substeps = 10
+        self.iterations = 4
+        self.dt = self.frame_dt / self.num_substeps
+
+        self.num_frames = num_frames
+        self.sim_time = 0.0
+        self.profiler = {}
+
+        self.rot_angular_velocity = math.pi / 3
+        self.rot_end_time = 10
+        self.use_cuda_graph = wp.get_device().is_cuda
+
+        usd_stage = Usd.Stage.Open(os.path.join(warp.examples.get_asset_directory(), "square_cloth.usd"))
+        usd_geom = UsdGeom.Mesh(usd_stage.GetPrimAtPath("/root/cloth/cloth"))
+
+        mesh_points = np.array(usd_geom.GetPointsAttr().Get())
+        mesh_indices = np.array(usd_geom.GetFaceVertexIndicesAttr().Get())
+
+        self.input_scale_factor = 1.0
+        self.renderer_scale_factor = 0.01
+
+        vertices = [wp.vec3(v) * self.input_scale_factor for v in mesh_points]
+        self.faces = mesh_indices.reshape(-1, 3)
+
+        builder = wp.sim.ModelBuilder()
+        builder.add_cloth_mesh(
+            pos=wp.vec3(0.0, 0.0, 0.0),
+            rot=wp.quat_identity(),
+            scale=1.0,
+            vertices=vertices,
+            indices=mesh_indices,
+            vel=wp.vec3(0.0, 0.0, 0.0),
+            density=0.02,
+            tri_ke=1.0e5,
+            tri_ka=1.0e5,
+            tri_kd=2.0e-6,
+            edge_ke=10,
+        )
+        builder.color()
+        self.model = builder.finalize()
+        self.model.ground = False
+        self.model.soft_contact_ke = 1.0e5
+        self.model.soft_contact_kd = 1.0e-6
+        self.model.soft_contact_mu = 0.2
+
+        # set up contact query and contact detection distances
+        self.model.soft_contact_radius = 0.2
+        self.model.soft_contact_margin = 0.35
+
+        cloth_size = 50
+        left_side = [cloth_size - 1 + i * cloth_size for i in range(cloth_size)]
+        right_side = [i * cloth_size for i in range(cloth_size)]
+        rot_point_indices = left_side + right_side
+
+        if len(rot_point_indices):
+            flags = self.model.particle_flags.numpy()
+            for fixed_vertex_id in rot_point_indices:
+                flags[fixed_vertex_id] = wp.uint32(int(flags[fixed_vertex_id]) & ~int(PARTICLE_FLAG_ACTIVE))
+
+            self.model.particle_flags = wp.array(flags)
+
+        self.integrator = wp.sim.VBDIntegrator(
+            self.model,
+            self.iterations,
+            handle_self_contact=True,
+        )
+        self.state0 = self.model.state()
+        self.state1 = self.model.state()
+
+        rot_axes = [[1, 0, 0]] * len(right_side) + [[-1, 0, 0]] * len(left_side)
+
+        self.rot_point_indices = wp.array(rot_point_indices, dtype=int)
+        self.t = wp.zeros((1,), dtype=float)
+        self.rot_centers = wp.zeros(len(rot_point_indices), dtype=wp.vec3)
+        self.rot_axes = wp.array(rot_axes, dtype=wp.vec3)
+
+        self.roots = wp.zeros_like(self.rot_centers)
+        self.roots_to_ps = wp.zeros_like(self.rot_centers)
+
+        wp.launch(
+            kernel=initialize_rotation,
+            dim=self.rot_point_indices.shape[0],
+            inputs=[
+                self.rot_point_indices,
+                self.state0.particle_q,
+                self.rot_centers,
+                self.rot_axes,
+                self.t,
+            ],
+            outputs=[
+                self.roots,
+                self.roots_to_ps,
+            ],
+        )
+
+        if stage_path:
+            self.renderer = wp.sim.render.SimRenderer(self.model, stage_path, scaling=1)
+        else:
+            self.renderer = None
+        self.cuda_graph = None
+        if self.use_cuda_graph:
+            with wp.ScopedCapture() as capture:
+                for _ in range(self.num_substeps):
+                    wp.launch(
+                        kernel=apply_rotation,
+                        dim=self.rot_point_indices.shape[0],
+                        inputs=[
+                            self.rot_point_indices,
+                            self.rot_axes,
+                            self.roots,
+                            self.roots_to_ps,
+                            self.t,
+                            self.rot_angular_velocity,
+                            self.dt,
+                            self.rot_end_time,
+                        ],
+                        outputs=[
+                            self.state0.particle_q,
+                            self.state1.particle_q,
+                        ],
+                    )
+
+                    self.integrator.simulate(self.model, self.state0, self.state1, self.dt, None)
+                    (self.state0, self.state1) = (self.state1, self.state0)
+
+            self.cuda_graph = capture.graph
+
+    def step(self):
+        with wp.ScopedTimer("step", print=False, dict=self.profiler):
+            if self.use_cuda_graph:
+                wp.capture_launch(self.cuda_graph)
+            else:
+                for _ in range(self.num_substeps):
+                    wp.launch(
+                        kernel=apply_rotation,
+                        dim=self.rot_point_indices.shape[0],
+                        inputs=[
+                            self.rot_point_indices,
+                            self.rot_axes,
+                            self.roots,
+                            self.roots_to_ps,
+                            self.t,
+                            self.rot_angular_velocity,
+                            self.dt,
+                            self.rot_end_time,
+                        ],
+                        outputs=[
+                            self.state0.particle_q,
+                            self.state1.particle_q,
+                        ],
+                    )
+                    self.integrator.simulate(self.model, self.state0, self.state1, self.dt)
+
+                    (self.state0, self.state1) = (self.state1, self.state0)
+
+            self.sim_time += self.dt
+
+    def render(self):
+        if self.renderer is None:
+            return
+
+        with wp.ScopedTimer("render", print=False):
+            self.renderer.begin_frame(self.sim_time)
+            self.renderer.render(self.state0)
+            self.renderer.end_frame()
+
+
+if __name__ == "__main__":
+    import argparse
+
+    parser = argparse.ArgumentParser(formatter_class=argparse.ArgumentDefaultsHelpFormatter)
+    parser.add_argument("--device", type=str, default=None, help="Override the default Warp device.")
+    parser.add_argument(
+        "--stage_path",
+        type=lambda x: None if x == "None" else str(x),
+        default="example_cloth_self_contact.usd",
+        help="Path to the output USD file.",
+    )
+    parser.add_argument("--num_frames", type=int, default=300, help="Total number of frames.")
+
+    args = parser.parse_known_args()[0]
+
+    with wp.ScopedDevice(args.device):
+        example = Example(stage_path=args.stage_path, num_frames=args.num_frames)
+
+        for i in range(example.num_frames):
+            example.step()
+            example.render()
+            print(f"[{i:4d}/{example.num_frames}]")
+
+        frame_times = example.profiler["step"]
+        print("\nAverage frame sim time: {:.2f} ms".format(sum(frame_times) / len(frame_times)))
+
+        if example.renderer:
+            example.renderer.save()

warp/examples/sim/example_granular.py

@@ -0,0 +1,130 @@
+# SPDX-FileCopyrightText: Copyright (c) 2022 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
+# SPDX-License-Identifier: Apache-2.0
+#
+# Licensed under the Apache License, Version 2.0 (the "License");
+# you may not use this file except in compliance with the License.
+# You may obtain a copy of the License at
+#
+# http://www.apache.org/licenses/LICENSE-2.0
+#
+# Unless required by applicable law or agreed to in writing, software
+# distributed under the License is distributed on an "AS IS" BASIS,
+# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+# See the License for the specific language governing permissions and
+# limitations under the License.
+
+###########################################################################
+# Example Sim Granular
+#
+# Shows how to set up a particle-based granular material model using the
+# wp.sim.ModelBuilder().
+#
+###########################################################################
+
+import warp as wp
+import warp.sim
+import warp.sim.render
+
+
+class Example:
+    def __init__(self, stage_path="example_granular.usd"):
+        fps = 60
+        self.frame_dt = 1.0 / fps
+
+        self.sim_substeps = 64
+        self.sim_dt = self.frame_dt / self.sim_substeps
+        self.sim_time = 0.0
+
+        self.radius = 0.1
+
+        builder = wp.sim.ModelBuilder()
+        builder.default_particle_radius = self.radius
+
+        builder.add_particle_grid(
+            dim_x=16,
+            dim_y=32,
+            dim_z=16,
+            cell_x=self.radius * 2.0,
+            cell_y=self.radius * 2.0,
+            cell_z=self.radius * 2.0,
+            pos=wp.vec3(0.0, 1.0, 0.0),
+            rot=wp.quat_identity(),
+            vel=wp.vec3(5.0, 0.0, 0.0),
+            mass=0.1,
+            jitter=self.radius * 0.1,
+        )
+
+        self.model = builder.finalize()
+        self.model.particle_kf = 25.0
+
+        self.model.soft_contact_kd = 100.0
+        self.model.soft_contact_kf *= 2.0
+
+        self.state_0 = self.model.state()
+        self.state_1 = self.model.state()
+
+        self.integrator = wp.sim.SemiImplicitIntegrator()
+
+        if stage_path:
+            self.renderer = wp.sim.render.SimRenderer(self.model, stage_path, scaling=20.0)
+        else:
+            self.renderer = None
+
+        self.use_cuda_graph = wp.get_device().is_cuda
+        if self.use_cuda_graph:
+            with wp.ScopedCapture() as capture:
+                self.simulate()
+            self.graph = capture.graph
+
+    def simulate(self):
+        for _ in range(self.sim_substeps):
+            self.state_0.clear_forces()
+            self.integrator.simulate(self.model, self.state_0, self.state_1, self.sim_dt)
+
+            # swap states
+            (self.state_0, self.state_1) = (self.state_1, self.state_0)
+
+    def step(self):
+        with wp.ScopedTimer("step"):
+            self.model.particle_grid.build(self.state_0.particle_q, self.radius * 2.0)
+            if self.use_cuda_graph:
+                wp.capture_launch(self.graph)
+            else:
+                self.simulate()
+
+        self.sim_time += self.frame_dt
+
+    def render(self):
+        if self.renderer is None:
+            return
+
+        with wp.ScopedTimer("render"):
+            self.renderer.begin_frame(self.sim_time)
+            self.renderer.render(self.state_0)
+            self.renderer.end_frame()
+
+
+if __name__ == "__main__":
+    import argparse
+
+    parser = argparse.ArgumentParser(formatter_class=argparse.ArgumentDefaultsHelpFormatter)
+    parser.add_argument("--device", type=str, default=None, help="Override the default Warp device.")
+    parser.add_argument(
+        "--stage_path",
+        type=lambda x: None if x == "None" else str(x),
+        default="example_granular.usd",
+        help="Path to the output USD file.",
+    )
+    parser.add_argument("--num_frames", type=int, default=400, help="Total number of frames.")
+
+    args = parser.parse_known_args()[0]
+
+    with wp.ScopedDevice(args.device):
+        example = Example(stage_path=args.stage_path)
+
+        for _ in range(args.num_frames):
+            example.step()
+            example.render()
+
+        if example.renderer:
+            example.renderer.save()