mittens-engine 0.7.0

use crate::engine::ecs::ComponentId;
use crate::engine::ecs::World;
use crate::engine::ecs::component::{
    ComponentRef, ForwardAxis, InputComponent, InputTransformModeComponent, QueryRootMode,
    RollAxis, TransformComponent, resolve_component_ref,
};
use crate::engine::ecs::system::System;
use crate::engine::graphics::VisualWorld;
use crate::engine::user_input::InputState;
use crate::utils::math;
use std::collections::HashMap;
use winit::event::MouseButton;
use winit::keyboard::{Key, NamedKey};

/// System that processes input components and updates transforms based on WASD input.
///
/// Intended topology (simple one-way data flow):
/// InputComponent -> TransformComponent -> (Camera2DComponent, RenderableComponent, ...)
#[derive(Debug, Default)]
pub struct InputSystem {
    inputs: Vec<ComponentId>,

    // FPS mode needs stable yaw/pitch/bank without per-frame extraction.
    // Keyed by the controlled TransformComponent id.
    fps_yaw_pitch_roll: HashMap<ComponentId, (f32, f32, f32)>,
}

impl InputSystem {
    pub fn new() -> Self {
        Self {
            inputs: Vec::new(),
            fps_yaw_pitch_roll: HashMap::new(),
        }
    }

    /// Register an InputComponent.
    pub fn register_input(&mut self, component: ComponentId) {
        if !self.inputs.iter().any(|c| *c == component) {
            self.inputs.push(component);
        }
    }

    fn compute_rotation(
        &self,
        roll_axis: RollAxis,
        input: &InputState,
        dt_sec: f32,
        rotation: &mut [f32; 4],
    ) {
        // Roll keys.
        let q = input.key_down(&Key::Character("q".into()));
        let e = input.key_down(&Key::Character("e".into()));

        // Right-button drag rotates the rig (yaw + pitch).
        let (drag_dx, drag_dy) = input.mouse_drag_delta_button(MouseButton::Right);

        // Sensitivity is radians per pixel.
        const MOUSE_SENS_RAD_PER_PX: f32 = 0.003;
        let yaw_delta = drag_dx * MOUSE_SENS_RAD_PER_PX;
        let pitch_delta = drag_dy * MOUSE_SENS_RAD_PER_PX;

        // Relative/flight-style semantics: apply local incremental rotations.
        if yaw_delta != 0.0 {
            let q_yaw = math::quat_from_axis_angle([0.0, 1.0, 0.0], yaw_delta);
            *rotation = math::quat_mul(*rotation, q_yaw);
        }
        if pitch_delta != 0.0 {
            let q_pitch = math::quat_from_axis_angle([1.0, 0.0, 0.0], pitch_delta);
            *rotation = math::quat_mul(*rotation, q_pitch);
        }

        if q || e {
            const ROT_SPEED_RAD_PER_SEC: f32 = 1.5;
            let dir = (q as i32) as f32 - (e as i32) as f32;
            let dtheta = dir * ROT_SPEED_RAD_PER_SEC * dt_sec;
            let axis = match roll_axis {
                RollAxis::X => [1.0, 0.0, 0.0],
                RollAxis::Y => [0.0, 1.0, 0.0],
                RollAxis::Z => [0.0, 0.0, 1.0],
            };
            let q_roll = math::quat_from_axis_angle(axis, dtheta);
            *rotation = math::quat_mul(*rotation, q_roll);
        }
    }

    fn compute_rotation_fps(
        &mut self,
        transform_cid: ComponentId,
        roll_axis: RollAxis,
        input: &InputState,
        dt_sec: f32,
        rotation: &mut [f32; 4],
    ) {
        // Roll keys.
        let q = input.key_down(&Key::Character("q".into()));
        let e = input.key_down(&Key::Character("e".into()));

        // Right-button drag rotates the rig (yaw + pitch).
        let (drag_dx, drag_dy) = input.mouse_drag_delta_button(MouseButton::Right);

        // Sensitivity is radians per pixel.
        const MOUSE_SENS_RAD_PER_PX: f32 = 0.003;
        let yaw_delta = drag_dx * MOUSE_SENS_RAD_PER_PX;
        let pitch_delta = drag_dy * MOUSE_SENS_RAD_PER_PX;

        // Allow Q/E rotation even without mouse drag.
        let qe_delta = if q || e {
            const ROT_SPEED_RAD_PER_SEC: f32 = 1.5;
            let dir = (q as i32) as f32 - (e as i32) as f32;
            dir * ROT_SPEED_RAD_PER_SEC * dt_sec
        } else {
            0.0
        };

        if yaw_delta == 0.0 && pitch_delta == 0.0 && qe_delta == 0.0 {
            return;
        }

        // Initialize once from current rotation.
        let (mut yaw, mut pitch, mut roll) = self
            .fps_yaw_pitch_roll
            .get(&transform_cid)
            .copied()
            .unwrap_or_else(|| {
                let right =
                    math::vec3_normalize(math::quat_rotate_vec3(*rotation, [1.0, 0.0, 0.0]));
                let fwd = math::vec3_normalize(math::quat_rotate_vec3(*rotation, [0.0, 0.0, -1.0]));

                // Yaw is global (world up): angle around +Y.
                let yaw = right[2].atan2(right[0]);
                // Pitch comes from forward Y.
                let pitch = fwd[1].clamp(-1.0, 1.0).asin();
                // Note: roll isn't extracted currently; it starts at 0 and is preserved
                // once the user rolls with Q/E.
                (yaw, pitch, 0.0)
            });

        // Apply deltas.
        yaw += yaw_delta;
        pitch += pitch_delta;

        // Q/E rotates around the configured axis.
        match roll_axis {
            RollAxis::Y => yaw += qe_delta,
            RollAxis::X => pitch += qe_delta,
            RollAxis::Z => roll += qe_delta,
        }

        const MAX_PITCH: f32 = 1.55; // ~88.8deg
        pitch = pitch.clamp(-MAX_PITCH, MAX_PITCH);

        // Persist state.
        self.fps_yaw_pitch_roll
            .insert(transform_cid, (yaw, pitch, roll));

        // Rebuild rotation from yaw/pitch/bank.
        // Yaw: global axis. Pitch: relative to yaw (around yaw-rotated right).
        // Bank (roll): around camera-forward axis.
        let q_yaw = math::quat_from_axis_angle([0.0, 1.0, 0.0], yaw);
        let right = math::quat_rotate_vec3(q_yaw, [1.0, 0.0, 0.0]);
        let q_pitch = math::quat_from_axis_angle(right, pitch);

        let q_base = math::quat_mul(q_pitch, q_yaw);
        let fwd_world = math::vec3_normalize(math::quat_rotate_vec3(q_base, [0.0, 0.0, -1.0]));
        let q_bank = math::quat_from_axis_angle(fwd_world, roll);

        *rotation = math::quat_mul(q_bank, q_base);
    }

    fn compute_translation(
        &self,
        forward_axis: ForwardAxis,
        fps_rotation: bool,
        fps_yaw: Option<f32>,
        speed_units_per_sec: f32,
        input: &InputState,
        dt_sec: f32,
        rotation: [f32; 4],
        translation: &mut [f32; 3],
    ) {
        // Read movement keys.
        let w = input.key_down(&Key::Character("w".into()));
        let a = input.key_down(&Key::Character("a".into()));
        let s = input.key_down(&Key::Character("s".into()));
        let d = input.key_down(&Key::Character("d".into()));
        let r: bool = input.key_down(&Key::Character("r".into()));
        let f: bool = input.key_down(&Key::Character("f".into()));

        // Holding Shift increases movement speed.
        let speed_multiplier = if input.key_down(&Key::Named(NamedKey::Shift)) {
            3.0
        } else {
            1.0
        };

        let speed = speed_units_per_sec * speed_multiplier * dt_sec;

        match forward_axis {
            ForwardAxis::Y => {
                // Legacy 2D-style translation delta (x/y).
                let mut dx = 0.0f32;
                let mut dy = 0.0f32;

                if w {
                    dy += 1.0;
                }
                if s {
                    dy -= 1.0;
                }
                if a {
                    dx -= 1.0;
                }
                if d {
                    dx += 1.0;
                }

                // Normalize diagonal movement.
                let len = (dx * dx + dy * dy).sqrt();
                if len > 0.0 {
                    dx /= len;
                    dy /= len;
                }

                // Translate in the transform's local (rotated) axes.
                let v = math::quat_rotate_vec3(rotation, [dx, dy, 0.0]);
                translation[0] += v[0] * speed;
                translation[1] += v[1] * speed;
            }

            ForwardAxis::Z => {
                let mut dx = 0.0f32;
                let mut dy: f32 = 0.0f32;
                let mut dz = 0.0f32;

                if a {
                    dx -= 1.0;
                }
                if d {
                    dx += 1.0;
                }
                if r {
                    dy += 1.0;
                }
                if f {
                    dy -= 1.0;
                }
                if w {
                    dz -= 1.0;
                }
                if s {
                    dz += 1.0;
                }

                // Normalize diagonal movement.
                let len = (dx * dx + dy * dy + dz * dz).sqrt();
                if len > 0.0 {
                    dx /= len;
                    dy /= len;
                    dz /= len;
                }

                if fps_rotation {
                    // FPS: yaw drives horizontal movement; pitch doesn't.
                    let yaw = fps_yaw.unwrap_or_else(|| {
                        let right = math::quat_rotate_vec3(rotation, [1.0, 0.0, 0.0]);
                        right[2].atan2(right[0])
                    });
                    let q_yaw = math::quat_from_axis_angle([0.0, 1.0, 0.0], yaw);
                    let v = math::quat_rotate_vec3(q_yaw, [dx, 0.0, dz]);
                    translation[0] += v[0] * speed;
                    translation[1] += dy * speed;
                    translation[2] += v[2] * speed;
                } else {
                    // Flight/relative: full rotation drives movement.
                    let v = math::quat_rotate_vec3(rotation, [dx, dy, dz]);
                    translation[0] += v[0] * speed;
                    translation[1] += v[1] * speed;
                    translation[2] += v[2] * speed;
                }
            }
        }
    }

    fn resolve_translation_basis_rotation(
        &self,
        world: &World,
        mode_component: Option<ComponentId>,
        source: Option<&ComponentRef>,
        fallback_rotation: [f32; 4],
    ) -> [f32; 4] {
        let Some(source) = source else {
            return fallback_rotation;
        };
        let Some(target) =
            resolve_component_ref(world, source, mode_component, QueryRootMode::SelfSubtree)
        else {
            return fallback_rotation;
        };
        self.nearest_transform_world_rotation(world, target)
            .unwrap_or(fallback_rotation)
    }

    fn nearest_transform_world_rotation(
        &self,
        world: &World,
        start: ComponentId,
    ) -> Option<[f32; 4]> {
        let mut current = Some(start);
        while let Some(component) = current {
            if let Some(transform) = world.get_component_by_id_as::<TransformComponent>(component) {
                return Some(math::mat_to_quat(transform.transform.matrix_world));
            }
            current = world.parent_of(component);
        }
        None
    }

    /// Process input and queue at most one transform update per InputComponent.
    ///
    /// This only supports the intended topology:
    /// InputComponent -> TransformComponent (child)
    pub fn process_input(
        &mut self,
        world: &mut World,
        input: &InputState,
        emit: &mut dyn crate::engine::ecs::SignalEmitter,
        dt_sec: f32,
    ) {
        // We gate early to avoid scanning inputs if nothing relevant is pressed.
        let any_move = input.key_down(&Key::Character("w".into()))
            || input.key_down(&Key::Character("a".into()))
            || input.key_down(&Key::Character("s".into()))
            || input.key_down(&Key::Character("d".into()))
            || input.key_down(&Key::Character("r".into()))
            || input.key_down(&Key::Character("f".into()))
            || input.key_down(&Key::Character("q".into()))
            || input.key_down(&Key::Character("e".into()));

        let any_drag = input.mouse_dragging_button(MouseButton::Right);

        if !any_move && !any_drag {
            return;
        }

        let inputs = self.inputs.clone();
        for input_cid in inputs {
            let speed_units_per_sec =
                match world.get_component_by_id_as::<InputComponent>(input_cid) {
                    Some(input_comp) => input_comp.speed,
                    None => continue,
                };

            // Find TransformComponent child. If absent, we don't compute.
            let transform_child = world.children_of(input_cid).iter().copied().find(|&cid| {
                world
                    .get_component_by_id_as::<TransformComponent>(cid)
                    .is_some()
            });

            // Optional mode child.
            let (
                mode_component,
                forward_axis,
                roll_axis,
                rotation_enabled,
                fps_rotation,
                translation_basis_source,
            ) = world
                .children_of(input_cid)
                .iter()
                .copied()
                .find_map(|cid| {
                    world
                        .get_component_by_id_as::<InputTransformModeComponent>(cid)
                        .map(|m| {
                            (
                                Some(cid),
                                m.forward_axis,
                                m.roll_axis,
                                m.rotation_enabled,
                                m.fps_rotation,
                                m.translation_basis_source.clone(),
                            )
                        })
                })
                .unwrap_or((None, ForwardAxis::Y, RollAxis::Z, true, false, None));

            let Some(transform_cid) = transform_child else {
                continue;
            };

            let external_basis_rotation = translation_basis_source.as_ref().map(|source| {
                self.resolve_translation_basis_rotation(
                    world,
                    mode_component,
                    Some(source),
                    [0.0, 0.0, 0.0, 1.0],
                )
            });

            if let Some(transform_comp_mut) =
                world.get_component_by_id_as_mut::<TransformComponent>(transform_cid)
            {
                if rotation_enabled && fps_rotation {
                    self.compute_rotation_fps(
                        transform_cid,
                        roll_axis,
                        input,
                        dt_sec,
                        &mut transform_comp_mut.transform.rotation,
                    );
                } else if rotation_enabled {
                    self.compute_rotation(
                        roll_axis,
                        input,
                        dt_sec,
                        &mut transform_comp_mut.transform.rotation,
                    );
                }
                let fps_yaw = if fps_rotation {
                    self.fps_yaw_pitch_roll
                        .get(&transform_cid)
                        .map(|(y, _, _)| *y)
                } else {
                    None
                };
                let translation_basis_rotation =
                    external_basis_rotation.unwrap_or(transform_comp_mut.transform.rotation);
                self.compute_translation(
                    forward_axis,
                    fps_rotation,
                    fps_yaw,
                    speed_units_per_sec,
                    input,
                    dt_sec,
                    translation_basis_rotation,
                    &mut transform_comp_mut.transform.translation,
                );

                transform_comp_mut.transform.recompute_model();
                emit.push_intent_now(
                    transform_cid,
                    crate::engine::ecs::IntentValue::UpdateTransform {
                        component_id: transform_cid,
                        translation: transform_comp_mut.transform.translation,
                        rotation_quat_xyzw: transform_comp_mut.transform.rotation,
                        scale: transform_comp_mut.transform.scale,
                    },
                );
            }
        }
    }
}

impl System for InputSystem {
    fn tick(
        &mut self,
        _world: &mut World,
        _visuals: &mut VisualWorld,
        _input: &InputState,
        _dt_sec: f32,
    ) {
        // InputSystem is driven by SystemWorld::tick calling process_input with a CommandQueue.
    }
}