phys-collision 2.0.1-beta.0

// Copyright (C) 2020-2025 phys-collision authors. All Rights Reserved.
//
// 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.

use glam_det::nums::num_traits::*;
use glam_det::nums::{f32x4, u32x4};
use glam_det::{UnitQuat, UnitQuatx4, Vec3, Vec3x4};

use crate::collision_tasks::{ShapeTester, ShapeWideTester};
use crate::convex_contact_manifold::{Convex4ContactManifoldWide, ConvexContactManifold};
use crate::shapes::{InfinitePlane, InfinitePlaneWide, Sphere, SphereWide};
use crate::traits::{ContactContext, ContactManifoldWide, CreateShapeWide, PairTest, PairWideTest};
use crate::ShapeContainer;

impl PairWideTest<SphereWide, InfinitePlaneWide> for ShapeWideTester {
    #[inline]
    fn should_reset_manifold_before_test() -> bool {
        false
    }

    // 1 manifold in Convex4ContactManifoldWide
    #[inline]
    fn test(
        a: &SphereWide,
        _b: &InfinitePlaneWide,
        contact_context: &ContactContext,
        manifold: &mut Convex4ContactManifoldWide,
    ) {
        // sphere's offset in infinite plane local space
        let sphere_in_plane =
            contact_context.orientation_b.inverse() * (-*contact_context.offset_b);

        // hit normal in world space
        manifold.normal = contact_context.orientation_b * InfinitePlaneWide::NORMAL;

        manifold.depth[0] = a.radius - sphere_in_plane.y;

        manifold.offset_a[0] = -manifold.normal * a.radius;
        manifold.contact_exists[0] = manifold.depth[0].gt(-contact_context.speculative_margin);
        manifold.feature_id[0] = u32x4::ZERO;
    }
}

impl_pair_narrowphase!(Sphere, InfinitePlane, SphereWide, InfinitePlaneWide, 1);