use super::*;
#[derive(Default, Clone, Copy, PartialEq, Eq, Debug)]
pub enum GizmoMode {
#[default]
None,
Transform,
Dimension,
}
#[derive(Default)]
pub struct TransformArm {
pub(super) feature_id: Option<String>,
pub(super) mode: GizmoMode,
pub(super) drag: Option<TransformDrag>,
}
#[derive(Clone, Copy)]
pub(super) struct TransformDrag {
handle: u32,
sx: f32,
sy: f32,
start: TransformPose,
}
#[derive(Clone, Copy, PartialEq, Debug)]
struct TransformPose {
position: [f64; 3],
rotation_deg: [f64; 3],
scale: [f64; 3],
}
#[derive(Clone, Copy, PartialEq, Debug)]
enum TransformDelta {
Translate([f64; 3]),
Rotate { axis: [f64; 3], radians: f64 },
None,
}
impl EngineState {
pub fn transform_armed(&self) -> bool {
matches!(self.transform_gizmo.mode, GizmoMode::Transform)
}
pub fn transform_armed_feature(&self) -> String {
if self.transform_armed() {
self.transform_gizmo.feature_id.clone().unwrap_or_default()
} else {
String::new()
}
}
pub fn transform_armed_for(&self, feature_id: &str) -> bool {
self.transform_armed() && self.transform_gizmo.feature_id.as_deref() == Some(feature_id)
}
pub fn arm_transform(&mut self, feature_id: &str) {
self.transform_gizmo.feature_id = Some(feature_id.to_string());
self.transform_gizmo.mode = GizmoMode::Transform;
self.transform_gizmo.drag = None;
self.clear_feature_dimension_overlay();
self.sync_transform_gizmo();
}
pub fn disarm_transform(&mut self) {
self.transform_gizmo.feature_id = None;
self.transform_gizmo.mode = GizmoMode::None;
self.transform_gizmo.drag = None;
let _ = self.widgets.set_transform_json("null");
self.clear_feature_dimension_overlay();
self.dirty = true;
}
fn armed_pose(&self) -> Option<TransformPose> {
let id = self.transform_gizmo.feature_id.as_deref()?;
let index = self.history.index_of(id)?;
let params = self.history.feature_params(index)?;
let transform = params.get("transform");
Some(TransformPose {
position: read_pose_vec3(transform, "position", [0.0, 0.0, 0.0]),
rotation_deg: read_pose_vec3(transform, "rotationEuler", [0.0, 0.0, 0.0]),
scale: read_pose_vec3(transform, "scale", [1.0, 1.0, 1.0]),
})
}
pub fn sync_transform_gizmo(&mut self) {
if !matches!(self.transform_gizmo.mode, GizmoMode::Transform) {
return;
}
let Some(pose) = self.armed_pose() else {
self.disarm_transform();
return;
};
let _ = self.widgets.set_transform_json(&transform_frame_json(&pose));
self.dirty = true;
}
pub fn feature_has_transform(&self, feature_id: &str) -> bool {
self.history
.index_of(feature_id)
.and_then(|i| self.history.feature_params(i))
.map(|params| params.get("transform").is_some())
.unwrap_or(false)
}
pub fn transform_gizmo_anchor(&self) -> Option<(f64, f64)> {
let pose = self.armed_pose()?;
let (sx, sy, depth) = self.camera.project(pose.position);
(depth > 0.0).then_some((sx, sy))
}
pub fn transform_axis_labels_json(&self) -> String {
if !matches!(self.transform_gizmo.mode, GizmoMode::Transform) {
return "[]".to_string();
}
let Some(pose) = self.armed_pose() else {
return "[]".to_string();
};
let euler = [
pose.rotation_deg[0].to_radians(),
pose.rotation_deg[1].to_radians(),
pose.rotation_deg[2].to_radians(),
];
let axes = [
normalize3(rotate_euler_xyz_f64([1.0, 0.0, 0.0], euler)),
normalize3(rotate_euler_xyz_f64([0.0, 1.0, 0.0], euler)),
normalize3(rotate_euler_xyz_f64([0.0, 0.0, 1.0], euler)),
];
let gap_px = 12.0_f64;
let dist = (brep_gizmos::transform::PX_AXIS_LEN as f64 + gap_px) * self.camera.world_per_pixel();
let labels: [(&str, [f32; 3]); 3] = [
("XC", [0.92, 0.26, 0.28]), ("YC", [0.30, 0.78, 0.36]), ("ZC", [0.30, 0.52, 0.98]), ];
let out: Vec<serde_json::Value> = (0..3)
.map(|i| {
let o = pose.position;
let a = axes[i];
serde_json::json!({
"text": labels[i].0,
"rgb": labels[i].1,
"world": [o[0] + a[0] * dist, o[1] + a[1] * dist, o[2] + a[2] * dist],
})
})
.collect();
serde_json::to_string(&out).unwrap_or_else(|_| "[]".to_string())
}
pub fn transform_press(&mut self, x: f64, y: f64) -> bool {
if !matches!(self.transform_gizmo.mode, GizmoMode::Transform) {
return false;
}
let handle = self.transform_pick(x, y);
if handle == 0 {
return false;
}
let Some(pose) = self.armed_pose() else {
return false;
};
self.widgets.set_transform_active(handle);
self.transform_gizmo.drag = Some(TransformDrag {
handle,
sx: x as f32,
sy: y as f32,
start: pose,
});
self.dirty = true;
true
}
pub fn transform_dragging(&self) -> bool {
self.transform_gizmo.drag.is_some()
}
pub fn transform_drag_to(&mut self, cx: f64, cy: f64) {
let Some(drag) = self.transform_gizmo.drag else {
return;
};
let delta = self.resolve_transform_delta(&drag, cx, cy);
if matches!(delta, TransformDelta::None) {
return;
}
let pose = apply_transform_delta(&drag.start, &delta);
self.write_armed_pose(&pose);
self.sync_transform_gizmo();
}
pub fn transform_release(&mut self) {
if self.transform_gizmo.drag.take().is_some() {
self.widgets.set_transform_active(0);
self.sync_transform_gizmo();
}
}
fn resolve_transform_delta(&self, drag: &TransformDrag, cx: f64, cy: f64) -> TransformDelta {
let cam = gizmo_camera(&self.camera);
let frame_json = transform_frame_json(&drag.start);
let json = self.widgets.transform_drag_json_with_frame(
&cam,
&frame_json,
drag.handle,
drag.sx,
drag.sy,
cx as f32,
cy as f32,
);
let value: serde_json::Value =
serde_json::from_str(&json).unwrap_or(serde_json::Value::Null);
match value.get("kind").and_then(|k| k.as_str()) {
Some("translate") => {
TransformDelta::Translate(json_vec3(value.get("world").and_then(|a| a.as_array())))
}
Some("rotate") => TransformDelta::Rotate {
axis: json_vec3(value.get("axisWorld").and_then(|a| a.as_array())),
radians: value.get("radians").and_then(|n| n.as_f64()).unwrap_or(0.0),
},
_ => TransformDelta::None,
}
}
fn write_armed_pose(&mut self, pose: &TransformPose) {
let Some(id) = self.transform_gizmo.feature_id.clone() else {
return;
};
let Some(index) = self.history.index_of(&id) else {
return;
};
let mut params = self
.history
.feature_params(index)
.unwrap_or_else(|| serde_json::json!({}));
if !params.get("transform").map(|t| t.is_object()).unwrap_or(false) {
if let Some(object) = params.as_object_mut() {
object.insert("transform".into(), serde_json::json!({}));
}
}
if let Some(transform) = params.get_mut("transform").and_then(|t| t.as_object_mut()) {
transform.insert("position".into(), serde_json::json!(pose.position));
transform.insert("rotationEuler".into(), serde_json::json!(pose.rotation_deg));
}
let _ = self.update_feature_params(&id, ¶ms.to_string());
}
}
fn apply_transform_delta(start: &TransformPose, delta: &TransformDelta) -> TransformPose {
match delta {
TransformDelta::Translate(world) => TransformPose {
position: [
start.position[0] + world[0],
start.position[1] + world[1],
start.position[2] + world[2],
],
..*start
},
TransformDelta::Rotate { axis, radians } => {
let q0 = quat_from_euler_xyz_deg(start.rotation_deg);
let dq = quat_from_axis_angle(*axis, *radians);
let nq = quat_mul(dq, q0);
TransformPose {
rotation_deg: euler_xyz_deg_from_quat(nq),
..*start
}
}
TransformDelta::None => *start,
}
}
fn read_pose_vec3(transform: Option<&serde_json::Value>, key: &str, default: [f64; 3]) -> [f64; 3] {
let array = transform.and_then(|t| t.get(key)).and_then(|v| v.as_array());
let mut out = default;
if let Some(array) = array {
for (index, slot) in out.iter_mut().enumerate() {
if let Some(number) = array.get(index).and_then(|v| v.as_f64()) {
*slot = number;
}
}
}
out
}
fn json_vec3(array: Option<&Vec<serde_json::Value>>) -> [f64; 3] {
let mut out = [0.0; 3];
if let Some(array) = array {
for (index, slot) in out.iter_mut().enumerate() {
if let Some(number) = array.get(index).and_then(|v| v.as_f64()) {
*slot = number;
}
}
}
out
}
fn transform_frame_json(pose: &TransformPose) -> String {
let euler = [
pose.rotation_deg[0].to_radians(),
pose.rotation_deg[1].to_radians(),
pose.rotation_deg[2].to_radians(),
];
let x = normalize3(rotate_euler_xyz_f64([1.0, 0.0, 0.0], euler));
let y = normalize3(rotate_euler_xyz_f64([0.0, 1.0, 0.0], euler));
let z = normalize3(rotate_euler_xyz_f64([0.0, 0.0, 1.0], euler));
serde_json::json!({
"origin": pose.position,
"x": x,
"y": y,
"z": z,
"showCenter": true,
})
.to_string()
}
fn normalize3(v: [f64; 3]) -> [f64; 3] {
let length = (v[0] * v[0] + v[1] * v[1] + v[2] * v[2]).sqrt();
if length < 1e-12 {
[0.0, 0.0, 1.0]
} else {
[v[0] / length, v[1] / length, v[2] / length]
}
}
pub(crate) fn rotate_euler_xyz_f64(v: [f64; 3], euler: [f64; 3]) -> [f64; 3] {
let (c1, s1) = (euler[0].cos(), euler[0].sin());
let (c2, s2) = (euler[1].cos(), euler[1].sin());
let (c3, s3) = (euler[2].cos(), euler[2].sin());
let m00 = c2 * c3;
let m01 = -c2 * s3;
let m02 = s2;
let m10 = c1 * s3 + c3 * s1 * s2;
let m11 = c1 * c3 - s1 * s2 * s3;
let m12 = -c2 * s1;
let m20 = s1 * s3 - c1 * c3 * s2;
let m21 = c3 * s1 + c1 * s2 * s3;
let m22 = c1 * c2;
[
m00 * v[0] + m01 * v[1] + m02 * v[2],
m10 * v[0] + m11 * v[1] + m12 * v[2],
m20 * v[0] + m21 * v[1] + m22 * v[2],
]
}
type Quat = [f64; 4];
fn quat_from_axis_angle(axis: [f64; 3], angle: f64) -> Quat {
let n = normalize3(axis);
let half = angle * 0.5;
let s = half.sin();
[n[0] * s, n[1] * s, n[2] * s, half.cos()]
}
fn quat_from_euler_xyz_deg(deg: [f64; 3]) -> Quat {
let (c1, s1) = ((deg[0].to_radians() * 0.5).cos(), (deg[0].to_radians() * 0.5).sin());
let (c2, s2) = ((deg[1].to_radians() * 0.5).cos(), (deg[1].to_radians() * 0.5).sin());
let (c3, s3) = ((deg[2].to_radians() * 0.5).cos(), (deg[2].to_radians() * 0.5).sin());
[
s1 * c2 * c3 + c1 * s2 * s3,
c1 * s2 * c3 - s1 * c2 * s3,
c1 * c2 * s3 + s1 * s2 * c3,
c1 * c2 * c3 - s1 * s2 * s3,
]
}
fn quat_mul(a: Quat, b: Quat) -> Quat {
[
a[3] * b[0] + a[0] * b[3] + a[1] * b[2] - a[2] * b[1],
a[3] * b[1] - a[0] * b[2] + a[1] * b[3] + a[2] * b[0],
a[3] * b[2] + a[0] * b[1] - a[1] * b[0] + a[2] * b[3],
a[3] * b[3] - a[0] * b[0] - a[1] * b[1] - a[2] * b[2],
]
}
fn euler_xyz_deg_from_quat(q: Quat) -> [f64; 3] {
let [x, y, z, w] = q;
let (x2, y2, z2) = (x + x, y + y, z + z);
let (xx, xy, xz) = (x * x2, x * y2, x * z2);
let (yy, yz, zz) = (y * y2, y * z2, z * z2);
let (wx, wy, wz) = (w * x2, w * y2, w * z2);
let m11 = 1.0 - (yy + zz);
let m12 = xy - wz;
let m13 = xz + wy;
let m22 = 1.0 - (xx + zz);
let m23 = yz - wx;
let m32 = yz + wx;
let m33 = 1.0 - (xx + yy);
let ey = m13.clamp(-1.0, 1.0).asin();
let (ex, ez) = if m13.abs() < 0.9999999 {
((-m23).atan2(m33), (-m12).atan2(m11))
} else {
(m32.atan2(m22), 0.0)
};
[ex.to_degrees(), ey.to_degrees(), ez.to_degrees()]
}
#[cfg(test)]
mod transform_gizmo_tests {
use super::*;
fn cube_request(name: &str, size: f64) -> String {
serde_json::json!({
"expressions": "",
"configurator": {},
"features": [{
"type": "P.CU",
"inputParams": {
"id": name,
"sizeX": size, "sizeY": size, "sizeZ": size,
"transform": {
"position": [0.0, 0.0, 0.0],
"rotationEuler": [0.0, 0.0, 0.0],
"scale": [1.0, 1.0, 1.0]
},
"boolean": { "targets": [], "operation": "NONE" }
},
"persistentData": {}
}]
})
.to_string()
}
fn ident() -> TransformPose {
TransformPose {
position: [1.0, 2.0, 3.0],
rotation_deg: [0.0, 0.0, 0.0],
scale: [1.0, 1.0, 1.0],
}
}
#[test]
fn translate_delta_adds_world_to_position() {
let pose = apply_transform_delta(&ident(), &TransformDelta::Translate([4.0, -1.0, 0.5]));
assert_eq!(pose.position, [5.0, 1.0, 3.5]);
assert_eq!(pose.rotation_deg, [0.0, 0.0, 0.0]);
assert_eq!(pose.scale, [1.0, 1.0, 1.0]);
}
#[test]
fn rotate_delta_about_z_yields_z_euler() {
let pose = apply_transform_delta(
&ident(),
&TransformDelta::Rotate {
axis: [0.0, 0.0, 1.0],
radians: std::f64::consts::FRAC_PI_2,
},
);
assert!((pose.rotation_deg[0]).abs() < 1e-6, "{:?}", pose.rotation_deg);
assert!((pose.rotation_deg[1]).abs() < 1e-6, "{:?}", pose.rotation_deg);
assert!((pose.rotation_deg[2] - 90.0).abs() < 1e-4, "{:?}", pose.rotation_deg);
assert_eq!(pose.position, [1.0, 2.0, 3.0]);
}
#[test]
fn euler_quat_roundtrip_is_identity() {
let deg = [30.0, 45.0, 60.0];
let back = euler_xyz_deg_from_quat(quat_from_euler_xyz_deg(deg));
for k in 0..3 {
assert!((back[k] - deg[k]).abs() < 1e-4, "axis {k}: {back:?} vs {deg:?}");
}
}
#[test]
fn rotate_about_local_axis_composes_onto_existing_orientation() {
let start = TransformPose {
rotation_deg: [0.0, 0.0, 90.0],
..ident()
};
let pose = apply_transform_delta(
&start,
&TransformDelta::Rotate {
axis: [0.0, 0.0, 1.0],
radians: std::f64::consts::FRAC_PI_2,
},
);
let got = quat_from_euler_xyz_deg(pose.rotation_deg);
let want = quat_from_euler_xyz_deg([0.0, 0.0, 180.0]);
let dot = got[0] * want[0] + got[1] * want[1] + got[2] * want[2] + got[3] * want[3];
assert!(dot.abs() > 0.9999, "orientation mismatch: {got:?} vs {want:?}");
}
#[test]
fn arm_press_drag_moves_the_feature_then_disarms() {
let mut engine = EngineState::new();
engine.set_history_json(&cube_request("Pin", 10.0)).unwrap();
engine.resize(800.0, 600.0);
engine.camera.eye = [0.0, 0.0, 40.0];
engine.camera.target = [0.0, 0.0, 0.0];
engine.camera.up = [0.0, 1.0, 0.0];
engine.camera.projection = crate::view::Projection::Orthographic { half_height: 20.0 };
assert!(!engine.transform_armed());
engine.arm_transform("Pin");
assert!(engine.transform_armed() && engine.transform_armed_for("Pin"));
assert!(engine.widgets.has_transform(), "arming feeds the widget gizmo");
let (ax, ay) = engine.transform_gizmo_anchor().expect("armed anchor");
assert!((ax - 400.0).abs() < 1.0 && (ay - 300.0).abs() < 1.0, "anchor {ax},{ay}");
let origin_before = engine.widgets.transform_origin().expect("gizmo shown");
assert!(origin_before[0].abs() < 1e-4, "gizmo starts at x=0: {origin_before:?}");
assert!(engine.transform_press(ax, ay), "press grabs a handle");
assert!(engine.transform_dragging());
engine.transform_drag_to(ax + 60.0, ay);
let index = engine.history.index_of("Pin").unwrap();
let params = engine.history.feature_params(index).unwrap();
let moved_x = params["transform"]["position"][0].as_f64().unwrap();
assert!(moved_x > 0.0, "Pin moved +X, got {:?}", params["transform"]["position"]);
let origin_mid = engine.widgets.transform_origin().expect("gizmo still shown");
assert!(
origin_mid[0] > 0.0 && (origin_mid[0] as f64 - moved_x).abs() < 1e-3,
"gizmo should follow to x={moved_x} mid-drag, got {origin_mid:?}"
);
assert!(engine.transform_dragging(), "still dragging after the live re-sync");
engine.transform_release();
assert!(!engine.transform_dragging());
engine.disarm_transform();
assert!(!engine.transform_armed());
assert!(!engine.widgets.has_transform(), "disarm hides the gizmo");
}
#[test]
fn deleting_the_armed_feature_auto_disarms() {
let mut engine = EngineState::new();
engine.set_history_json(&cube_request("Pin", 10.0)).unwrap();
engine.arm_transform("Pin");
assert!(engine.transform_armed());
engine.delete_feature("Pin");
assert!(!engine.transform_armed(), "armed feature gone → auto-disarm");
assert!(!engine.widgets.has_transform());
}
}