Function project_swing_twist_cone
pub fn project_swing_twist_cone(
q: [f32; 4],
twist_axis: [f32; 3],
max_swing_y_rad: f32,
max_swing_z_rad: f32,
min_twist_rad: f32,
max_twist_rad: f32,
laxity_scale: f32,
) -> [f32; 4]Expand description
Projects quaternion q ([w, x, y, z]) onto an elliptical swing-twist reach cone
around twist_axis, scaled by laxity_scale.