warp-lang 1.9.1__py3-none-manylinux_2_34_aarch64.whl → 1.10.0rc2__py3-none-manylinux_2_34_aarch64.whl

warp/examples/sim/example_cloth_self_contact.py

@@ -1,316 +0,0 @@
-# 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
-        # the BVH used by VBDIntegrator will be rebuilt every self.bvh_rebuild_frames
-        # When the simulated object deforms significantly, simply refitting the BVH can lead to deterioration of the BVH's
-        # quality, in this case we need to completely rebuild the tree to achieve better query efficiency.
-        self.bvh_rebuild_frames = 10
-
-        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:
-                self.integrate_frame_substeps()
-
-            self.cuda_graph = capture.graph
-
-    def integrate_frame_substeps(self):
-        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)
-
-    def advance_frame(self):
-        with wp.ScopedTimer("step", print=False, dict=self.profiler):
-            if self.use_cuda_graph:
-                wp.capture_launch(self.cuda_graph)
-            else:
-                self.integrate_frame_substeps()
-
-            self.sim_time += self.dt
-
-    def run(self):
-        for i in range(self.num_frames):
-            self.advance_frame()
-            self.render()
-            print(f"[{i:4d}/{self.num_frames}]")
-
-            if i != 0 and not i % self.bvh_rebuild_frames and self.use_cuda_graph:
-                self.integrator.rebuild_bvh(self.state0)
-                with wp.ScopedCapture() as capture:
-                    self.integrate_frame_substeps()
-                self.cuda_graph = capture.graph
-
-    def render(self):
-        if self.renderer is None:
-            return
-
-        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)
-
-        example.run()
-
-        frame_times = example.profiler["step"]
-        print(f"\nAverage frame sim time: {sum(frame_times) / len(frame_times):.2f} ms")
-
-        if example.renderer:
-            example.renderer.save()

warp/examples/sim/example_granular.py

@@ -1,130 +0,0 @@
-# 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()

warp/examples/sim/example_granular_collision_sdf.py

@@ -1,202 +0,0 @@
-# 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 Collision SDF
-#
-# Shows how to set up a particle-based granular material model using the
-# wp.sim.ModelBuilder(). This version shows how to create collision geometry
-# objects from SDFs.
-#
-# Note: requires a CUDA-capable device
-###########################################################################
-
-import os
-
-import numpy as np
-
-import warp as wp
-import warp.examples
-import warp.sim
-import warp.sim.render
-
-
-class Example:
-    def __init__(self, stage_path="example_granular_collision_sdf.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, 20.0, 0.0),
-            rot=wp.quat_identity(),
-            vel=wp.vec3(2.0, 0.0, 0.0),
-            mass=0.1,
-            jitter=self.radius * 0.1,
-        )
-        with open(os.path.join(warp.examples.get_asset_directory(), "rocks.nvdb"), "rb") as rock_file:
-            rock_vdb = wp.Volume.load_from_nvdb(rock_file.read())
-
-        rock_sdf = wp.sim.SDF(rock_vdb)
-
-        builder.add_shape_sdf(
-            ke=1.0e4,
-            kd=1000.0,
-            kf=1000.0,
-            mu=0.5,
-            sdf=rock_sdf,
-            body=-1,
-            pos=wp.vec3(0.0, 0.0, 0.0),
-            rot=wp.quat(0.0, 0.0, 0.0, 1.0),
-            scale=wp.vec3(1.0, 1.0, 1.0),
-        )
-
-        mins = np.array([-3.0, -3.0, -3.0])
-        voxel_size = 0.2
-        maxs = np.array([3.0, 3.0, 3.0])
-        nums = np.ceil((maxs - mins) / (voxel_size)).astype(dtype=int)
-        center = np.array([0.0, 0.0, 0.0])
-        rad = 2.5
-        sphere_sdf_np = np.zeros(tuple(nums))
-        for x in range(nums[0]):
-            for y in range(nums[1]):
-                for z in range(nums[2]):
-                    pos = mins + voxel_size * np.array([x, y, z])
-                    dis = np.linalg.norm(pos - center)
-                    sphere_sdf_np[x, y, z] = dis - rad
-
-        sphere_vdb = wp.Volume.load_from_numpy(sphere_sdf_np, mins, voxel_size, rad + 3.0 * voxel_size)
-        sphere_sdf = wp.sim.SDF(sphere_vdb)
-
-        self.sphere_pos = wp.vec3(3.0, 15.0, 0.0)
-        self.sphere_scale = 1.0
-        self.sphere_radius = rad
-        builder.add_shape_sdf(
-            ke=1.0e4,
-            kd=1000.0,
-            kf=1000.0,
-            mu=0.5,
-            sdf=sphere_sdf,
-            body=-1,
-            pos=self.sphere_pos,
-            scale=wp.vec3(self.sphere_scale, self.sphere_scale, self.sphere_scale),
-        )
-
-        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()
-            wp.sim.collide(self.model, self.state_0)
-            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_ref(
-                name="collision",
-                path=os.path.join(warp.examples.get_asset_directory(), "rocks.usd"),
-                pos=wp.vec3(0.0, 0.0, 0.0),
-                rot=wp.quat(0.0, 0.0, 0.0, 1.0),
-                scale=wp.vec3(1.0, 1.0, 1.0),
-                color=(0.35, 0.55, 0.9),
-            )
-
-            self.renderer.render_sphere(
-                name="sphere",
-                pos=self.sphere_pos,
-                radius=self.sphere_scale * self.sphere_radius,
-                rot=wp.quat(0.0, 0.0, 0.0, 1.0),
-            )
-
-            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_collision_sdf.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()