//! 三维向量与角度工具(不用第三方数学库,保持依赖精简) use serde::Deserialize; #[derive(Clone, Copy, Debug, Default, PartialEq)] pub struct V3 { pub x: f32, pub y: f32, pub z: f32, } #[inline] pub const fn v3(x: f32, y: f32, z: f32) -> V3 { V3 { x, y, z } } impl V3 { pub const ZERO: V3 = v3(0.0, 0.0, 0.0); #[inline] pub fn add(self, o: V3) -> V3 { v3(self.x + o.x, self.y + o.y, self.z + o.z) } #[inline] pub fn sub(self, o: V3) -> V3 { v3(self.x - o.x, self.y - o.y, self.z - o.z) } #[inline] pub fn scale(self, k: f32) -> V3 { v3(self.x * k, self.y * k, self.z * k) } #[inline] pub fn dot(self, o: V3) -> f32 { self.x * o.x + self.y * o.y + self.z * o.z } #[inline] pub fn len(self) -> f32 { self.dot(self).sqrt() } #[inline] pub fn flat_len(self) -> f32 { (self.x * self.x + self.z * self.z).sqrt() } #[inline] pub fn norm(self) -> V3 { let l = self.len(); if l < 1e-8 { V3::ZERO } else { self.scale(1.0 / l) } } #[inline] pub fn arr(self) -> [f32; 3] { [self.x, self.y, self.z] } #[inline] pub fn axis(self, i: usize) -> f32 { match i { 0 => self.x, 1 => self.y, _ => self.z, } } #[inline] pub fn set_axis(&mut self, i: usize, v: f32) { match i { 0 => self.x = v, 1 => self.y = v, _ => self.z = v, } } } impl From<[f32; 3]> for V3 { fn from(a: [f32; 3]) -> V3 { v3(a[0], a[1], a[2]) } } /// 视线方向:yaw=0 看向 -z,yaw 增大向右转(+x),pitch 上正下负 pub fn forward(yaw: f32, pitch: f32) -> V3 { let cp = pitch.cos(); v3(cp * yaw.sin(), pitch.sin(), -cp * yaw.cos()) } /// 水平前方(移动用) pub fn flat_forward(yaw: f32) -> V3 { v3(yaw.sin(), 0.0, -yaw.cos()) } /// 水平右方 pub fn right(yaw: f32) -> V3 { v3(yaw.cos(), 0.0, yaw.sin()) } /// 把角度收进 [-PI, PI] pub fn wrap_angle(mut a: f32) -> f32 { use std::f32::consts::PI; while a > PI { a -= 2.0 * PI; } while a < -PI { a += 2.0 * PI; } a } /// 反序列化辅助:JSON 里的 [x,y,z] pub fn de_arr<'de, D>(d: D) -> Result where D: serde::Deserializer<'de>, { let a = <[f32; 3]>::deserialize(d)?; Ok(V3::from(a)) }