1use crate::interaction::clip_plane::ray_plane_intersection;
4use crate::renderer::{GlyphItem, GlyphType, PolylineItem};
5use crate::scene::aabb::Aabb;
6use parry3d::math::{Pose, Vector};
7use parry3d::query::{Ray, RayCast};
8
9use super::{WidgetContext, WidgetResult, any_perpendicular_pair, ctx_ray, handle_world_radius};
10
11#[derive(Clone, Copy, PartialEq, Eq, Debug)]
13enum BoxHandle {
14 Center,
16 Face(usize),
18 RotArc(usize),
20}
21
22pub struct BoxWidget {
42 pub center: glam::Vec3,
44 pub half_extents: glam::Vec3,
46 pub rotation: glam::Quat,
48 pub colour: [f32; 4],
50 pub handle_colour: [f32; 4],
52
53 hovered_handle: Option<BoxHandle>,
54 active_handle: Option<BoxHandle>,
55 drag_plane_normal: glam::Vec3,
56 drag_plane_d: f32,
57 drag_anchor_world: glam::Vec3,
58}
59
60impl BoxWidget {
61 pub fn new(center: glam::Vec3, half_extents: glam::Vec3) -> Self {
63 Self {
64 center,
65 half_extents: half_extents.max(glam::Vec3::splat(0.01)),
66 rotation: glam::Quat::IDENTITY,
67 colour: [0.3, 0.8, 0.4, 1.0],
68 handle_colour: [0.0; 4],
69 hovered_handle: None,
70 active_handle: None,
71 drag_plane_normal: glam::Vec3::Z,
72 drag_plane_d: 0.0,
73 drag_anchor_world: glam::Vec3::ZERO,
74 }
75 }
76
77 pub fn is_active(&self) -> bool {
79 self.active_handle.is_some()
80 }
81
82 pub fn obb(&self) -> (glam::Vec3, glam::Vec3, glam::Quat) {
84 (self.center, self.half_extents, self.rotation)
85 }
86
87 pub fn aabb(&self) -> Aabb {
92 let mut min = glam::Vec3::splat(f32::MAX);
93 let mut max = glam::Vec3::splat(f32::MIN);
94 let h = self.half_extents;
95 for sx in [-1.0_f32, 1.0] {
96 for sy in [-1.0_f32, 1.0] {
97 for sz in [-1.0_f32, 1.0] {
98 let p =
99 self.center + self.rotation * glam::Vec3::new(sx * h.x, sy * h.y, sz * h.z);
100 min = min.min(p);
101 max = max.max(p);
102 }
103 }
104 }
105 Aabb { min, max }
106 }
107
108 pub fn contains_point(&self, point: glam::Vec3) -> bool {
110 let local = self.rotation.inverse() * (point - self.center);
111 local.x.abs() <= self.half_extents.x
112 && local.y.abs() <= self.half_extents.y
113 && local.z.abs() <= self.half_extents.z
114 }
115
116 pub fn update(&mut self, ctx: &WidgetContext) -> WidgetResult {
118 let (ro, rd) = ctx_ray(ctx);
119 let mut updated = false;
120
121 if self.active_handle.is_none() {
122 let hit = self.hit_test(ro, rd, ctx);
123 if hit.is_some() || !ctx.drag_started {
127 self.hovered_handle = hit;
128 }
129 }
130
131 if ctx.drag_started {
132 if let Some(handle) = self.hovered_handle {
133 let anchor = self.handle_pos(handle);
134 let n = -glam::Vec3::from(ctx.camera.forward);
138 self.drag_plane_normal = n;
139 self.drag_plane_d = -n.dot(anchor);
140 self.drag_anchor_world = anchor;
141 self.active_handle = Some(handle);
142 }
143 }
144
145 if let Some(handle) = self.active_handle {
146 if ctx.released || (!ctx.dragging && !ctx.drag_started) {
147 self.active_handle = None;
148 self.hovered_handle = None;
149 } else {
150 match handle {
151 BoxHandle::Center => {
152 if let Some(hit) = ray_plane_intersection(
153 ro,
154 rd,
155 self.drag_plane_normal,
156 self.drag_plane_d,
157 ) {
158 let delta = hit - self.drag_anchor_world;
159 if delta.length_squared() > 1e-10 {
160 self.center += delta;
161 self.drag_anchor_world = hit;
162 updated = true;
163 }
164 }
165 }
166 BoxHandle::Face(i) => {
167 if let Some(hit) = ray_plane_intersection(
168 ro,
169 rd,
170 self.drag_plane_normal,
171 self.drag_plane_d,
172 ) {
173 let world_normal = self.rotation * Self::local_face_normal(i);
175 let proj = (hit - self.drag_anchor_world).dot(world_normal);
176 if proj.abs() > 1e-5 {
177 let axis = i / 2; let new_he = (self.half_extents[axis] + proj).max(0.01);
179 let he_delta = new_he - self.half_extents[axis];
180 self.half_extents[axis] = new_he;
181 self.center += world_normal * (he_delta * 0.5);
183 self.drag_anchor_world = hit;
184 updated = true;
185 }
186 }
187 }
188 BoxHandle::RotArc(axis_idx) => {
189 let axis = Self::world_rotation_axis(axis_idx);
193 let plane_d = -axis.dot(self.center);
194 if let Some(plane_hit) = ray_plane_intersection(ro, rd, axis, plane_d) {
195 let start_dir =
196 (self.drag_anchor_world - self.center).normalize_or_zero();
197 let new_dir = (plane_hit - self.center).normalize_or_zero();
198 if start_dir.length_squared() > 0.5 && new_dir.length_squared() > 0.5 {
199 let cos_a = start_dir.dot(new_dir).clamp(-1.0, 1.0);
200 let cross = start_dir.cross(new_dir);
201 let sign = cross.dot(axis).signum();
202 let angle = cos_a.acos() * sign;
203 if angle.abs() > 1e-5 {
204 let delta_rot = glam::Quat::from_axis_angle(axis, angle);
205 self.rotation = (delta_rot * self.rotation).normalize();
206 self.drag_anchor_world =
208 self.center + new_dir * self.arc_radius();
209 updated = true;
210 }
211 }
212 }
213 }
214 }
215 }
216 }
217
218 if updated {
219 WidgetResult::Updated
220 } else {
221 WidgetResult::None
222 }
223 }
224
225 pub fn wireframe_item(&self, id: u64) -> PolylineItem {
229 let c = self.center;
230 let h = self.half_extents;
231 let r = self.rotation;
232
233 let p =
234 |x: f32, y: f32, z: f32| -> [f32; 3] { (c + r * glam::Vec3::new(x, y, z)).to_array() };
235
236 PolylineItem {
237 positions: vec![
238 p(-h.x, -h.y, -h.z),
240 p(h.x, -h.y, -h.z),
241 p(h.x, h.y, -h.z),
242 p(-h.x, h.y, -h.z),
243 p(-h.x, -h.y, -h.z),
244 p(-h.x, -h.y, h.z),
246 p(h.x, -h.y, h.z),
247 p(h.x, h.y, h.z),
248 p(-h.x, h.y, h.z),
249 p(-h.x, -h.y, h.z),
250 p(-h.x, -h.y, -h.z),
252 p(-h.x, -h.y, h.z),
253 p(h.x, -h.y, -h.z),
254 p(h.x, -h.y, h.z),
255 p(h.x, h.y, -h.z),
256 p(h.x, h.y, h.z),
257 p(-h.x, h.y, -h.z),
258 p(-h.x, h.y, h.z),
259 ],
260 strip_lengths: vec![5, 5, 2, 2, 2, 2],
261 default_colour: self.colour,
262 id,
263 ..PolylineItem::default()
264 }
265 }
266
267 pub fn rotation_arcs_item(&self, id: u64) -> PolylineItem {
272 const STEPS: usize = 48;
273 let c = self.center;
274 let r = self.arc_radius();
275 let arc_colours = [
276 [0.9_f32, 0.2, 0.2, 0.7], [0.2, 0.9, 0.2, 0.7], [0.2, 0.4, 1.0, 0.7], ];
280
281 let mut positions: Vec<[f32; 3]> = Vec::with_capacity((STEPS + 1) * 3);
284 let mut strip_lengths: Vec<u32> = Vec::new();
285 let _ = arc_colours; for axis_idx in 0..3_usize {
288 let axis = Self::world_rotation_axis(axis_idx);
289 let (u, v) = any_perpendicular_pair(axis);
290 for i in 0..=STEPS {
291 let a = i as f32 * std::f32::consts::TAU / STEPS as f32;
292 let (s, co) = a.sin_cos();
293 positions.push((c + u * (co * r) + v * (s * r)).to_array());
294 }
295 strip_lengths.push((STEPS + 1) as u32);
296 }
297
298 PolylineItem {
299 positions,
300 strip_lengths,
301 default_colour: self.colour,
302 line_width: 1.2,
303 id,
304 ..PolylineItem::default()
305 }
306 }
307
308 pub fn handle_glyphs(&self, id_base: u64, ctx: &WidgetContext) -> GlyphItem {
313 let all_handles = [
314 BoxHandle::Center,
315 BoxHandle::Face(0),
316 BoxHandle::Face(1),
317 BoxHandle::Face(2),
318 BoxHandle::Face(3),
319 BoxHandle::Face(4),
320 BoxHandle::Face(5),
321 BoxHandle::RotArc(0),
322 BoxHandle::RotArc(1),
323 BoxHandle::RotArc(2),
324 ];
325
326 let mut positions = Vec::with_capacity(10);
327 let mut vectors = Vec::with_capacity(10);
328 let mut scalars = Vec::with_capacity(10);
329
330 for handle in all_handles {
331 let pos = self.handle_pos(handle);
332 let target_px = if matches!(handle, BoxHandle::RotArc(_)) {
333 7.0
334 } else {
335 9.0
336 };
337 let r = handle_world_radius(pos, &ctx.camera, ctx.viewport_size.y, target_px);
338 let s = if self.hovered_handle == Some(handle) || self.active_handle == Some(handle) {
339 1.0_f32
340 } else {
341 0.2
342 };
343 positions.push(pos.to_array());
344 vectors.push([r, 0.0, 0.0]);
345 scalars.push(s);
346 }
347
348 GlyphItem {
349 positions,
350 vectors,
351 scale: 1.0,
352 scale_by_magnitude: true,
353 scalars,
354 scalar_range: Some((0.0, 1.0)),
355 glyph_type: GlyphType::Sphere,
356 id: id_base,
357 default_colour: self.handle_colour,
358 use_default_colour: self.handle_colour[3] > 0.0,
359 ..GlyphItem::default()
360 }
361 }
362
363 fn handle_pos(&self, handle: BoxHandle) -> glam::Vec3 {
369 match handle {
370 BoxHandle::Center => self.center,
371 BoxHandle::Face(i) => {
372 self.center
373 + self.rotation * (Self::local_face_normal(i) * self.half_extents[i / 2])
374 }
375 BoxHandle::RotArc(i) => self.center + self.arc_grip_offset(i),
376 }
377 }
378
379 fn local_face_normal(i: usize) -> glam::Vec3 {
381 match i {
382 0 => glam::Vec3::X,
383 1 => glam::Vec3::NEG_X,
384 2 => glam::Vec3::Y,
385 3 => glam::Vec3::NEG_Y,
386 4 => glam::Vec3::Z,
387 _ => glam::Vec3::NEG_Z,
388 }
389 }
390
391 fn world_rotation_axis(i: usize) -> glam::Vec3 {
393 match i {
394 0 => glam::Vec3::X,
395 1 => glam::Vec3::Y,
396 _ => glam::Vec3::Z,
397 }
398 }
399
400 fn arc_radius(&self) -> f32 {
402 self.half_extents.length() * 1.4 + 0.1
403 }
404
405 fn arc_grip_offset(&self, i: usize) -> glam::Vec3 {
407 let r = self.arc_radius();
408 match i {
411 0 => glam::Vec3::new(0.0, r, 0.0), 1 => glam::Vec3::new(0.0, 0.0, r), _ => glam::Vec3::new(r, 0.0, 0.0), }
415 }
416
417 fn hit_test(
418 &self,
419 ray_origin: glam::Vec3,
420 ray_dir: glam::Vec3,
421 ctx: &WidgetContext,
422 ) -> Option<BoxHandle> {
423 let ray = Ray::new(
424 Vector::new(ray_origin.x, ray_origin.y, ray_origin.z),
425 Vector::new(ray_dir.x, ray_dir.y, ray_dir.z),
426 );
427
428 let all_handles = [
429 BoxHandle::Center,
430 BoxHandle::Face(0),
431 BoxHandle::Face(1),
432 BoxHandle::Face(2),
433 BoxHandle::Face(3),
434 BoxHandle::Face(4),
435 BoxHandle::Face(5),
436 BoxHandle::RotArc(0),
437 BoxHandle::RotArc(1),
438 BoxHandle::RotArc(2),
439 ];
440
441 let mut best: Option<(f32, BoxHandle)> = None;
442
443 for handle in all_handles {
444 let pos = self.handle_pos(handle);
445 let target_px = if matches!(handle, BoxHandle::RotArc(_)) {
446 7.0
447 } else {
448 9.0
449 };
450 let r = handle_world_radius(pos, &ctx.camera, ctx.viewport_size.y, target_px);
451 let ball = parry3d::shape::Ball::new(r);
452 let pose = Pose::from_parts([pos.x, pos.y, pos.z].into(), glam::Quat::IDENTITY);
453 if let Some(t) = ball.cast_ray(&pose, &ray, f32::MAX, true) {
454 if best.is_none() || t < best.unwrap().0 {
455 best = Some((t, handle));
456 }
457 }
458 }
459
460 best.map(|(_, h)| h)
461 }
462}