1
  2
  3
  4
  5
  6
  7
  8
  9
 10
 11
 12
 13
 14
 15
 16
 17
 18
 19
 20
 21
 22
 23
 24
 25
 26
 27
 28
 29
 30
 31
 32
 33
 34
 35
 36
 37
 38
 39
 40
 41
 42
 43
 44
 45
 46
 47
 48
 49
 50
 51
 52
 53
 54
 55
 56
 57
 58
 59
 60
 61
 62
 63
 64
 65
 66
 67
 68
 69
 70
 71
 72
 73
 74
 75
 76
 77
 78
 79
 80
 81
 82
 83
 84
 85
 86
 87
 88
 89
 90
 91
 92
 93
 94
 95
 96
 97
 98
 99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122

use crate::{
    engine::Engine,
    ecs::{ EntityHandle, TransformComponent, AudioListenerComponent, AudioSourceComponent, scene, AudioManagerComponent, SoundType }, 
};

use pill_core::Vector3f;

use anyhow::{Result, Context, Error};
use cgmath::{Vector3, Matrix3};
use std::f32::consts::PI;

fn get_rotation_matrix(angles: Vector3<f32>) -> Result<Matrix3<f32>> {
    
    // Get the angles from the vector and convert them to radians
    let alfa = angles[0].to_radians();
    let beta = angles[1].to_radians();
    let gamma = angles[2].to_radians();

    // Prepare rotation matrices
    let alfa_rotation_matrix = Matrix3::new(alfa.cos(), alfa.sin(), 0.0,
                                                        -alfa.sin(), alfa.cos(), 0.0,
                                                        0.0, 0.0, 1.0);

    let beta_rotation_matrix = Matrix3::new(beta.cos(), 0.0, -beta.sin(),
                                                        0.0, 1.0, 0.0,
                                                        beta.sin(), 0.0, beta.cos());

    let gamma_totation_matrix = Matrix3::new(1.0, 0.0, 0.0,
                                                        0.0, gamma.cos(), gamma.sin(),
                                                        0.0, -gamma.sin(), gamma.cos());

    // Get the final rotation matrix 
    let rotation_matrix = alfa_rotation_matrix * beta_rotation_matrix * gamma_totation_matrix;
    
    // Return rotation matrix
    Ok(rotation_matrix)
}

pub fn audio_system(engine: &mut Engine) -> Result<()> {

    // --- Update ear positions
    let mut left_ear_position = Vector3f::new(-1.0, 0.0, 0.0);
    let mut right_ear_position = Vector3f::new(1.0, 0.0, 0.0);

    // Update ear positions
    for (entity_handle, audio_listener_component, transform_component) in engine.iterate_two_components::<AudioListenerComponent, TransformComponent>()? {

        if audio_listener_component.enabled {
            
            // Get the retotation matrix
            let left_rotation_matrix = get_rotation_matrix(transform_component.rotation)?;
            let right_rotation_matrix = get_rotation_matrix(-transform_component.rotation)?;
            
            // Get two points for left and right ear relative to the origin multiplied to rotation matrix
            left_ear_position = left_rotation_matrix * left_ear_position;
            right_ear_position = right_rotation_matrix * right_ear_position;

            // Add the original position
            left_ear_position += transform_component.position;
            right_ear_position += transform_component.position;

            break;
        }
    }

    // Update the sinks with new positions for left and right ear 
    let audio_manager = engine.get_global_component_mut::<AudioManagerComponent>()?;
    for sink in audio_manager.spatial_sink_pool.iter_mut() {
        sink.set_left_ear_position(left_ear_position.into());
        sink.set_right_ear_position(right_ear_position.into());
    }

    // Update spatial sinks ear positions
    {
        let audio_manager = engine.get_global_component_mut::<AudioManagerComponent>()?;
        for sink in audio_manager.spatial_sink_pool.iter_mut() {
            sink.set_left_ear_position(left_ear_position.into());
            sink.set_right_ear_position(right_ear_position.into());
        }
    }
   
    // Update emitter position in all sinks based on transform components of entities to which audio source components are added
    let active_scene = engine.scene_manager.get_active_scene()?;
    for (entity_handle, audio_source_component, transform_component) in active_scene.get_two_component_iterator::<AudioSourceComponent, TransformComponent>()? {
        let audio_manager = engine.get_global_component::<AudioManagerComponent>()?;
        if let Some(index) = audio_source_component.sink_handle {
            audio_manager.get_spatial_sink(index).set_emitter_position(transform_component.position.clone().into());
        }
    } 

    // --- Return free sinks to AudioManager

    // Iterate over each audio source and find sinks that stopped playing
    let audio_manager = engine.global_components.get_mut::<AudioManagerComponent>().unwrap().data.as_mut().unwrap();
    let active_scene = engine.scene_manager.get_active_scene_mut()?;
    for (entity_handle, audio_source_component) in active_scene.get_one_component_iterator_mut::<AudioSourceComponent>()? {
        // Check if the audio source has sink handle assigned
        if let Some(sink_handle) = audio_source_component.sink_handle {
            // Check if is playing
            let sound_type = audio_source_component.sound_type.clone();
            let playing = match sound_type {
                SoundType::Sound2D => {
                    let sink = audio_manager.get_ambient_sink(sink_handle);
                    !sink.is_paused()
                },
                SoundType::Sound3D => {
                    let sink = audio_manager.get_spatial_sink(sink_handle);
                    !sink.is_paused()
                },
            };

            // Return sink to pool if stopped playing
            if !playing {
                
                let sink_handle = audio_source_component.return_sink().unwrap();
                audio_manager.return_sink(sink_handle, &sound_type);
            }
        }
    }

    Ok(())
}