godot-bevy 0.11.0

//! Collision detection for godot-bevy.
//!
//! This module bridges Godot's collision detection with Bevy's ECS patterns,
//! providing multiple ways to detect and respond to collisions.
//!
//! # Accessing Collisions
//!
//! godot-bevy provides a [`Collisions`] system parameter for querying collision state.
//! This is the primary way to check what entities are currently colliding.
//!
//! ```ignore
//! fn my_system(collisions: Collisions) {
//!     // Iterate all currently touching pairs
//!     for (entity_a, entity_b) in collisions.iter() {
//!         // Handle collision
//!     }
//!
//!     // Check if two specific entities are colliding
//!     if collisions.contains(player, enemy) {
//!         // Player is touching enemy
//!     }
//!
//!     // Get all entities colliding with a specific entity
//!     for other in collisions.colliding_with(player) {
//!         // other is colliding with player
//!     }
//! }
//! ```
//!
//! # Collision Events
//!
//! For reacting to collision start/end events, use [`CollisionStarted`] and
//! [`CollisionEnded`]. These can be read as Messages or observed as Events.
//!
//! ## Reading as Messages
//!
//! ```ignore
//! fn handle_hits(mut started: MessageReader<CollisionStarted>) {
//!     for event in started.read() {
//!         println!("{:?} started colliding with {:?}", event.0, event.1);
//!     }
//! }
//! ```
//!
//! ## Using Observers
//!
//! ```ignore
//! app.add_observer(|trigger: Trigger<CollisionStarted>| {
//!     let (a, b) = (trigger.event().0, trigger.event().1);
//!     println!("{a:?} started colliding with {b:?}");
//! });
//! ```

use crate::interop::GodotNodeHandle;
use crate::plugins::core::PrePhysicsUpdate;
use crate::plugins::scene_tree::NodeEntityIndex;
use bevy_app::{App, Plugin};
use bevy_ecs::{
    entity::Entity,
    event::Event,
    message::{Message, MessageReader, MessageWriter, message_update_system},
    prelude::Resource,
    schedule::IntoScheduleConfigs,
    system::{Commands, Res, ResMut, SystemParam},
};
use crossbeam_channel::Receiver;
use godot::prelude::*;
use parking_lot::Mutex;
use std::collections::{HashMap, HashSet};
use tracing::trace;

// Collision signal constants
pub const BODY_ENTERED: &str = "body_entered";
pub const BODY_EXITED: &str = "body_exited";
pub const AREA_ENTERED: &str = "area_entered";
pub const AREA_EXITED: &str = "area_exited";

/// All collision signals that indicate collision start
pub const COLLISION_START_SIGNALS: &[&str] = &[BODY_ENTERED, AREA_ENTERED];

/// Event-count cutoff for batch neighbor rebuild mode.
/// Batches at or above this size rebuild adjacency from `active_pairs`.
const COLLISION_NEIGHBOR_REBUILD_THRESHOLD: usize = 512;

// ============================================================================
// EVENTS
// ============================================================================

/// Event fired when two entities start colliding.
///
/// Can be read as a [`Message`] with [`MessageReader`] or observed with
/// Bevy's observer system.
///
/// # Example
///
/// ```ignore
/// // As a message
/// fn handle_collision_start(mut events: MessageReader<CollisionStarted>) {
///     for event in events.read() {
///         println!("{:?} hit {:?}", event.entity1, event.entity2);
///     }
/// }
///
/// // As an observer
/// app.add_observer(|trigger: Trigger<CollisionStarted>| {
///     let event = trigger.event();
///     println!("{:?} hit {:?}", event.entity1, event.entity2);
/// });
/// ```
#[derive(Debug, Clone, Copy, PartialEq, Eq, Message, Event)]
pub struct CollisionStarted {
    /// The first entity in the collision.
    pub entity1: Entity,
    /// The second entity in the collision.
    pub entity2: Entity,
}

/// Event fired when two entities stop colliding.
///
/// Can be read as a [`Message`] with [`MessageReader`] or observed with
/// Bevy's observer system.
///
/// # Example
///
/// ```ignore
/// // As a message
/// fn handle_collision_end(mut events: MessageReader<CollisionEnded>) {
///     for event in events.read() {
///         println!("{:?} separated from {:?}", event.entity1, event.entity2);
///     }
/// }
///
/// // As an observer
/// app.add_observer(|trigger: Trigger<CollisionEnded>| {
///     let event = trigger.event();
///     println!("{:?} separated from {:?}", event.entity1, event.entity2);
/// });
/// ```
#[derive(Debug, Clone, Copy, PartialEq, Eq, Message, Event)]
pub struct CollisionEnded {
    /// The first entity in the collision.
    pub entity1: Entity,
    /// The second entity in the collision.
    pub entity2: Entity,
}

// ============================================================================
// COLLISION STATE RESOURCE
// ============================================================================

/// Resource that tracks all current collision pairs.
///
/// This is automatically updated each frame based on Godot's collision events.
/// Use the [`Collisions`] system parameter for convenient access.
#[derive(Resource, Default, Debug)]
pub struct CollisionState {
    /// Currently active collision pairs (origin_entity, target_entity)
    /// We store both directions for O(1) lookup
    active_pairs: HashSet<(Entity, Entity)>,

    /// Collisions that started this frame
    started_this_frame: Vec<(Entity, Entity)>,

    /// Collisions that ended this frame
    ended_this_frame: Vec<(Entity, Entity)>,

    /// Map from entity to all entities it's currently colliding with
    entity_collisions: HashMap<Entity, Vec<Entity>>,
}

impl CollisionState {
    /// Clear per-frame data (called at start of update)
    fn begin_frame(&mut self) {
        self.started_this_frame.clear();
        self.ended_this_frame.clear();
    }

    /// Record a collision start
    fn add_collision(&mut self, origin: Entity, target: Entity) -> bool {
        self.add_collision_internal(origin, target, true)
    }

    fn add_collision_without_neighbors(&mut self, origin: Entity, target: Entity) -> bool {
        self.add_collision_internal(origin, target, false)
    }

    fn add_collision_internal(
        &mut self,
        origin: Entity,
        target: Entity,
        update_neighbors: bool,
    ) -> bool {
        // Normalize pair order for consistent storage
        let pair = normalize_pair(origin, target);

        if self.active_pairs.insert(pair) {
            self.started_this_frame.push(pair);

            if update_neighbors {
                self.entity_collisions
                    .entry(origin)
                    .or_default()
                    .push(target);
                self.entity_collisions
                    .entry(target)
                    .or_default()
                    .push(origin);
            }
            true
        } else {
            false
        }
    }

    /// Record a collision end
    fn remove_collision(&mut self, origin: Entity, target: Entity) -> bool {
        self.remove_collision_internal(origin, target, true)
    }

    fn remove_collision_without_neighbors(&mut self, origin: Entity, target: Entity) -> bool {
        self.remove_collision_internal(origin, target, false)
    }

    fn remove_collision_internal(
        &mut self,
        origin: Entity,
        target: Entity,
        update_neighbors: bool,
    ) -> bool {
        let pair = normalize_pair(origin, target);

        if self.active_pairs.remove(&pair) {
            self.ended_this_frame.push(pair);

            if update_neighbors {
                if let Some(collisions) = self.entity_collisions.get_mut(&origin) {
                    collisions.retain(|&e| e != target);
                }
                if let Some(collisions) = self.entity_collisions.get_mut(&target) {
                    collisions.retain(|&e| e != origin);
                }
            }
            true
        } else {
            false
        }
    }

    fn rebuild_entity_collisions(&mut self) {
        self.entity_collisions.clear();
        self.entity_collisions.reserve(self.active_pairs.len() * 2);
        for &(entity1, entity2) in &self.active_pairs {
            self.entity_collisions
                .entry(entity1)
                .or_default()
                .push(entity2);
            self.entity_collisions
                .entry(entity2)
                .or_default()
                .push(entity1);
        }
    }

    /// Check if two entities are currently colliding
    pub fn contains(&self, a: Entity, b: Entity) -> bool {
        self.active_pairs.contains(&normalize_pair(a, b))
    }

    /// Get all entities currently colliding with the given entity
    pub fn colliding_with(&self, entity: Entity) -> &[Entity] {
        self.entity_collisions
            .get(&entity)
            .map(|v| v.as_slice())
            .unwrap_or(&[])
    }

    /// Iterate over all currently active collision pairs
    pub fn iter(&self) -> impl Iterator<Item = (Entity, Entity)> + '_ {
        self.active_pairs.iter().copied()
    }

    /// Iterate over collision pairs that started this frame
    pub fn started(&self) -> impl Iterator<Item = (Entity, Entity)> + '_ {
        self.started_this_frame.iter().copied()
    }

    /// Iterate over collision pairs that ended this frame
    pub fn ended(&self) -> impl Iterator<Item = (Entity, Entity)> + '_ {
        self.ended_this_frame.iter().copied()
    }

    /// Returns true if there are no active collisions
    pub fn is_empty(&self) -> bool {
        self.active_pairs.is_empty()
    }

    /// Returns the number of active collision pairs
    pub fn len(&self) -> usize {
        self.active_pairs.len()
    }
}

/// Normalize a pair of entities to a consistent order for storage
#[inline]
fn normalize_pair(a: Entity, b: Entity) -> (Entity, Entity) {
    if a < b { (a, b) } else { (b, a) }
}

// ============================================================================
// COLLISIONS SYSTEM PARAM
// ============================================================================

/// System parameter for querying collision state.
///
/// This provides a convenient API for checking collisions in systems.
///
/// # Example
///
/// ```ignore
/// fn my_system(collisions: Collisions) {
///     // Check all active collisions
///     for (a, b) in collisions.iter() {
///         println!("{a:?} is colliding with {b:?}");
///     }
///
///     // Check if specific entities are colliding
///     if collisions.contains(player, enemy) {
///         // Take damage!
///     }
///
///     // Get everything colliding with player
///     for &other in collisions.colliding_with(player) {
///         // Process each collision
///     }
/// }
/// ```
#[derive(SystemParam)]
pub struct Collisions<'w> {
    state: Res<'w, CollisionState>,
}

impl Collisions<'_> {
    /// Check if two entities are currently colliding.
    #[inline]
    pub fn contains(&self, a: Entity, b: Entity) -> bool {
        self.state.contains(a, b)
    }

    /// Get all entities currently colliding with the given entity.
    #[inline]
    pub fn colliding_with(&self, entity: Entity) -> &[Entity] {
        self.state.colliding_with(entity)
    }

    /// Iterate over all currently active collision pairs.
    #[inline]
    pub fn iter(&self) -> impl Iterator<Item = (Entity, Entity)> + '_ {
        self.state.iter()
    }

    /// Returns true if there are no active collisions.
    #[inline]
    pub fn is_empty(&self) -> bool {
        self.state.is_empty()
    }

    /// Returns the number of active collision pairs.
    #[inline]
    pub fn len(&self) -> usize {
        self.state.len()
    }
}

// ============================================================================
// INTERNAL: GODOT MESSAGE BRIDGE
// ============================================================================

/// Internal message type for receiving collision events from Godot.
/// This is not part of the public API - use CollisionStarted/CollisionEnded instead.
#[doc(hidden)]
#[derive(Debug)]
pub struct RawCollisionMessage {
    pub event_type: CollisionMessageType,
    pub origin: GodotNodeHandle,
    pub target: GodotNodeHandle,
}

/// Resource for receiving collision messages from Godot.
/// Wrapped in Mutex to be Send+Sync, allowing it to be a regular Bevy Resource.
#[derive(Resource)]
pub struct CollisionMessageReader(pub Mutex<Receiver<RawCollisionMessage>>);

impl CollisionMessageReader {
    pub fn new(receiver: Receiver<RawCollisionMessage>) -> Self {
        Self(Mutex::new(receiver))
    }
}

#[doc(hidden)]
#[derive(Debug, GodotConvert)]
#[godot(via = GString)]
pub enum CollisionMessageType {
    Started,
    Ended,
}

// ============================================================================
// PLUGIN
// ============================================================================

/// Plugin that enables collision detection between Godot physics bodies and Bevy entities.
///
/// This plugin automatically tracks collisions for entities that have collision
/// signals (Area2D, Area3D, RigidBody2D, RigidBody3D, etc.).
///
/// # Usage
///
/// Add the plugin to your app:
///
/// ```ignore
/// app.add_plugins(GodotCollisionsPlugin);
/// ```
///
/// Then use the [`Collisions`] system parameter or collision events:
///
/// ```ignore
/// fn detect_hits(
///     collisions: Collisions,
///     mut started: MessageReader<CollisionStarted>,
/// ) {
///     // Query current state
///     if collisions.contains(player, enemy) {
///         // Currently colliding
///     }
///
///     // React to events
///     for event in started.read() {
///         // Just started colliding
///     }
/// }
/// ```
#[derive(Default)]
pub struct GodotCollisionsPlugin;

impl Plugin for GodotCollisionsPlugin {
    fn build(&self, app: &mut App) {
        app.init_resource::<CollisionState>()
            .add_message::<CollisionStarted>()
            .add_message::<CollisionEnded>()
            .add_systems(
                PrePhysicsUpdate,
                (
                    process_godot_collisions.before(message_update_system),
                    trigger_collision_observers.after(process_godot_collisions),
                ),
            );
    }
}

/// System that processes raw Godot collision events and updates state + messages
fn process_godot_collisions(
    events: Option<Res<CollisionMessageReader>>,
    mut collision_state: ResMut<CollisionState>,
    mut started_writer: MessageWriter<CollisionStarted>,
    mut ended_writer: MessageWriter<CollisionEnded>,
    node_index: Res<NodeEntityIndex>,
) {
    // Clear per-frame data
    collision_state.begin_frame();

    let Some(events) = events else {
        return;
    };

    let receiver = events.0.lock();
    let use_rebuild_path = receiver.len() >= COLLISION_NEIGHBOR_REBUILD_THRESHOLD;

    for event in receiver.try_iter() {
        trace!(target: "godot_collisions", event = ?event);

        // Look up entities for both nodes
        let origin_entity = node_index.get(event.origin.instance_id());
        let target_entity = node_index.get(event.target.instance_id());

        let (origin, target) = match (origin_entity, target_entity) {
            (Some(o), Some(t)) => (o, t),
            _ => continue,
        };

        match event.event_type {
            CollisionMessageType::Started => {
                let changed = if use_rebuild_path {
                    collision_state.add_collision_without_neighbors(origin, target)
                } else {
                    collision_state.add_collision(origin, target)
                };
                if changed {
                    started_writer.write(CollisionStarted {
                        entity1: origin,
                        entity2: target,
                    });
                }
            }
            CollisionMessageType::Ended => {
                let changed = if use_rebuild_path {
                    collision_state.remove_collision_without_neighbors(origin, target)
                } else {
                    collision_state.remove_collision(origin, target)
                };
                if changed {
                    ended_writer.write(CollisionEnded {
                        entity1: origin,
                        entity2: target,
                    });
                }
            }
        }
    }

    if use_rebuild_path {
        collision_state.rebuild_entity_collisions();
    }
}

/// System that triggers observers for collision events.
fn trigger_collision_observers(
    mut commands: Commands,
    mut started_reader: MessageReader<CollisionStarted>,
    mut ended_reader: MessageReader<CollisionEnded>,
) {
    for &event in started_reader.read() {
        commands.trigger(event);
    }
    for &event in ended_reader.read() {
        commands.trigger(event);
    }
}

// ============================================================================
// TESTS
// ============================================================================

#[cfg(test)]
mod tests {
    use super::*;

    #[test]
    fn test_collision_state_add_remove() {
        let mut state = CollisionState::default();
        let e1 = Entity::from_bits(1);
        let e2 = Entity::from_bits(2);
        let e3 = Entity::from_bits(3);

        // Add collision
        state.add_collision(e1, e2);
        assert!(state.contains(e1, e2));
        assert!(state.contains(e2, e1)); // Symmetric
        assert!(!state.contains(e1, e3));

        // Check colliding_with
        assert_eq!(state.colliding_with(e1), &[e2]);
        assert_eq!(state.colliding_with(e2), &[e1]);
        assert!(state.colliding_with(e3).is_empty());

        // Check started
        assert_eq!(state.started_this_frame.len(), 1);

        // Remove collision
        state.remove_collision(e1, e2);
        assert!(!state.contains(e1, e2));
        assert!(state.colliding_with(e1).is_empty());

        // Check ended
        assert_eq!(state.ended_this_frame.len(), 1);
    }

    #[test]
    fn test_collision_state_begin_frame() {
        let mut state = CollisionState::default();
        let e1 = Entity::from_bits(1);
        let e2 = Entity::from_bits(2);

        state.add_collision(e1, e2);
        assert_eq!(state.started_this_frame.len(), 1);

        // Begin new frame
        state.begin_frame();
        assert!(state.started_this_frame.is_empty());
        assert!(state.ended_this_frame.is_empty());

        // But collision should still be active
        assert!(state.contains(e1, e2));
    }

    #[test]
    fn test_normalize_pair() {
        let e1 = Entity::from_bits(1);
        let e2 = Entity::from_bits(2);

        // Should always return same order regardless of input order
        assert_eq!(normalize_pair(e1, e2), normalize_pair(e2, e1));
    }

    #[test]
    fn test_collision_state_multiple_collisions() {
        let mut state = CollisionState::default();
        let e1 = Entity::from_bits(1);
        let e2 = Entity::from_bits(2);
        let e3 = Entity::from_bits(3);

        state.add_collision(e1, e2);
        state.add_collision(e1, e3);

        // e1 collides with both
        let colliding = state.colliding_with(e1);
        assert_eq!(colliding.len(), 2);
        assert!(colliding.contains(&e2));
        assert!(colliding.contains(&e3));

        // e2 only collides with e1
        assert_eq!(state.colliding_with(e2), &[e1]);

        // e3 only collides with e1
        assert_eq!(state.colliding_with(e3), &[e1]);
    }

    #[test]
    fn test_duplicate_collision_ignored() {
        let mut state = CollisionState::default();
        let e1 = Entity::from_bits(1);
        let e2 = Entity::from_bits(2);

        state.add_collision(e1, e2);
        state.add_collision(e1, e2); // Duplicate
        state.add_collision(e2, e1); // Same pair, different order

        // Should only have one collision
        assert_eq!(state.len(), 1);
        assert_eq!(state.started_this_frame.len(), 1);
    }
}