use crate::{ core::{client::Client, registry::Registry}, nodes::{ spatial::{find_spatial_parent, parse_transform, Spatial}, Node, }, }; use color_eyre::eyre::{bail, ensure, Result}; use glam::Vec3A; use mint::Vector3; use parking_lot::Mutex; use portable_atomic::{AtomicBool, Ordering}; use prisma::{Flatten, Lerp, Rgba}; use serde::Deserialize; use stardust_xr::{schemas::flex::deserialize, values::Transform}; use std::{collections::VecDeque, sync::Arc}; use stereokit::{bounds_grow_to_fit_pt, Bounds, Color128, LinePoint as SkLinePoint, StereoKitDraw}; use super::Drawable; static LINES_REGISTRY: Registry = Registry::new(); #[derive(Debug, Clone, Deserialize)] struct LinePointRaw { point: Vector3, thickness: f32, color: [f32; 4], } #[derive(Debug, Clone)] struct LineData { points: Vec, cyclic: bool, } pub struct Lines { enabled: Arc, space: Arc, data: Mutex, } impl Lines { fn add_to(node: &Arc, points: Vec, cyclic: bool) -> Result> { ensure!( node.drawable.get().is_none(), "Internal: Node already has a drawable attached!" ); let _ = node.spatial.get().unwrap().bounding_box_calc.set(|node| { let mut bounds = Bounds::default(); let Some(Drawable::Lines(lines)) = node.drawable.get() else {return bounds}; for point in &lines.data.lock().points { bounds = bounds_grow_to_fit_pt(bounds, point.point); } bounds }); let lines = LINES_REGISTRY.add(Lines { enabled: node.enabled.clone(), space: node.get_aspect("Lines", "spatial", |n| &n.spatial)?.clone(), data: Mutex::new(LineData { points, cyclic }), }); node.add_local_signal("set_points", Lines::set_points_flex); node.add_local_signal("set_cyclic", Lines::set_cyclic_flex); let _ = node.drawable.set(Drawable::Lines(lines.clone())); Ok(lines) } fn draw(&self, draw_ctx: &impl StereoKitDraw) { let transform_mat = self.space.global_transform(); let data = self.data.lock().clone(); let mut points: VecDeque = data .points .iter() .map(|p| SkLinePoint { pt: transform_mat.transform_point3a(Vec3A::from(p.point)).into(), thickness: p.thickness, color: p.color.map(|c| (c * 255.0) as u8).into(), }) .collect(); if data.cyclic && !points.is_empty() { let first = data.points.first().unwrap(); let last = data.points.last().unwrap(); let color = Rgba::from_slice(&first.color).lerp(&Rgba::from_slice(&last.color), 0.5); let connect_point = SkLinePoint { pt: transform_mat .transform_point3a(Vec3A::from(first.point).lerp(Vec3A::from(last.point), 0.5)) .into(), thickness: (first.thickness + last.thickness) * 0.5, color: Color128::from([color.red(), color.green(), color.blue(), color.alpha()]) .into(), }; points.push_front(connect_point.clone()); points.push_back(connect_point); } draw_ctx.line_add_listv(points.make_contiguous()); } pub fn set_points_flex(node: &Node, _calling_client: Arc, data: &[u8]) -> Result<()> { let Some(Drawable::Lines(lines)) = node.drawable.get() else {bail!("Not a drawable??")}; let mut points: Vec = deserialize(data)?; for p in &mut points { p.color[0] = p.color[0].powf(2.2); p.color[1] = p.color[1].powf(2.2); p.color[2] = p.color[2].powf(2.2); } lines.data.lock().points = points; Ok(()) } pub fn set_cyclic_flex(node: &Node, _calling_client: Arc, data: &[u8]) -> Result<()> { let Some(Drawable::Lines(lines)) = node.drawable.get() else {bail!("Not a drawable??")}; lines.data.lock().cyclic = deserialize(data)?; Ok(()) } } impl Drop for Lines { fn drop(&mut self) { LINES_REGISTRY.remove(self); } } pub fn draw_all(draw_ctx: &impl StereoKitDraw) { for lines in LINES_REGISTRY.get_valid_contents() { if lines.enabled.load(Ordering::Relaxed) { lines.draw(draw_ctx); } } } pub fn create_flex(_node: &Node, calling_client: Arc, data: &[u8]) -> Result<()> { #[derive(Deserialize)] struct CreateTextInfo<'a> { name: &'a str, parent_path: &'a str, transform: Transform, points: Vec, cyclic: bool, } let mut info: CreateTextInfo = deserialize(data)?; let node = Node::create(&calling_client, "/drawable/lines", info.name, true); let parent = find_spatial_parent(&calling_client, info.parent_path)?; let transform = parse_transform(info.transform, true, true, true); for p in &mut info.points { p.color[0] = p.color[0].powf(2.2); p.color[1] = p.color[1].powf(2.2); p.color[2] = p.color[2].powf(2.2); } let node = node.add_to_scenegraph()?; Spatial::add_to(&node, Some(parent), transform, false)?; Lines::add_to(&node, info.points, info.cyclic)?; Ok(()) }