bherbruckandClaude Opus 5.5
296683229d
* WIP deep rename (not for push) * WIP2 * WIP3 * WIP4 wxs fix * rustfmt * Rename the remaining identifiers in merged crash-report code Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_01RjGw4gA5ZvKrU8MQP6sBgT --------- Co-authored-by: Claude Opus 5.5 <noreply@anthropic.com>
751 lines
37 KiB
Rust
751 lines
37 KiB
Rust
//! Exact radial embossing of orthogonal profiles on complete cylindrical walls.
|
|
use crate::body::{Body, Solid, from_p3, p3};
|
|
use crate::history::Change;
|
|
use crate::numbered::NumberedRegion;
|
|
use crate::offset::{Surf, surf_of};
|
|
use crate::record::Operand;
|
|
use crate::{KernelError, Result, guard};
|
|
use solidcraft_geom::{Loop2, Plane, Region2, Seg2, Vec2, Vec3};
|
|
use truck_modeling::{self as mt, Transformed, builder};
|
|
|
|
fn fail(s: &str) -> KernelError {
|
|
KernelError::Invalid(format!("cylinder emboss: {s}"))
|
|
}
|
|
fn angle(p: Vec3, o: Vec3, axis: Vec3, radial: Vec3, tangent: Vec3) -> f64 {
|
|
let w = p - o;
|
|
let w = w - axis * w.dot(axis);
|
|
w.dot(tangent).atan2(w.dot(radial))
|
|
}
|
|
fn unwrap(a: f64, around: f64) -> f64 {
|
|
around + (a - around + std::f64::consts::PI).rem_euclid(std::f64::consts::TAU) - std::f64::consts::PI
|
|
}
|
|
|
|
fn wall_angles(face: &mt::Face, o: Vec3, axis: Vec3, radial: Vec3, tangent: Vec3, tol: f64) -> Option<(f64, f64)> {
|
|
if face.boundaries().len() != 1 || face.edge_iter().count() != 4 {
|
|
return None;
|
|
}
|
|
for edge in face.edge_iter() {
|
|
if let Some(Some(mid)) = crate::offset::arc_mid(&edge, tol * 10.) {
|
|
let am = angle(mid, o, axis, radial, tangent);
|
|
let aa = unwrap(angle(from_p3(edge.front().point()), o, axis, radial, tangent), am);
|
|
let ab = unwrap(angle(from_p3(edge.back().point()), o, axis, radial, tangent), am);
|
|
return Some((aa.min(ab), aa.max(ab)));
|
|
}
|
|
}
|
|
None
|
|
}
|
|
|
|
/// Certify a tessellated pick and project it onto the cylinder used by emboss.
|
|
pub fn cylinder_emboss_anchor(body: &Body, face: usize, at: Vec3) -> Result<Vec3> {
|
|
if !at.is_finite() || at.len() > 1e9 {
|
|
return Err(fail("invalid selected face point"));
|
|
}
|
|
guard("cylinder emboss anchor", || {
|
|
let f = body.solid.face_iter().nth(face).ok_or_else(|| fail("selected face"))?;
|
|
let tol = (body.size() * 1e-8).max(1e-8);
|
|
let Some(Surf::Cylinder { o, a, r, convex: true }) = surf_of(f, tol) else {
|
|
return Err(fail("selected face is not an exterior cylinder"));
|
|
};
|
|
let w = at - o;
|
|
let radial = w - a * w.dot(a);
|
|
if (radial.len() - r).abs() > (body.size() * 1e-3).max(1e-3).min(r * 0.05) {
|
|
return Err(fail("selected point is too far from cylinder"));
|
|
}
|
|
Ok(o + a * w.dot(a) + radial.normalized().ok_or_else(|| fail("radial point"))? * r)
|
|
})
|
|
}
|
|
|
|
/// Wrap sketch arc length around an exterior cylinder, retaining exact radial depth.
|
|
/// Profiles must contain orthogonal lines and lie inside one uninterrupted wall face.
|
|
pub fn emboss_cylinder(body: &Body, plane: &Plane, regions: &[Region2], depth: f64) -> Result<Body> {
|
|
emboss_impl(body, None, plane, regions, depth, false).and_then(EmbossOutcome::body)
|
|
}
|
|
|
|
/// As [`emboss_cylinder`], requiring the saved selected point to identify that wall.
|
|
pub fn emboss_cylinder_at(body: &Body, at: Vec3, plane: &Plane, regions: &[Region2], depth: f64) -> Result<Body> {
|
|
if !at.is_finite() || at.len() > 1e9 {
|
|
return Err(fail("invalid selected face point"));
|
|
}
|
|
emboss_impl(body, Some(at), plane, regions, depth, false).and_then(EmbossOutcome::body)
|
|
}
|
|
|
|
enum EmbossOutcome {
|
|
Body(Body),
|
|
Anchor(usize, Vec3),
|
|
NoMatch,
|
|
}
|
|
impl EmbossOutcome {
|
|
fn body(self) -> Result<Body> {
|
|
match self {
|
|
Self::Body(body) => Ok(body),
|
|
Self::Anchor(..) | Self::NoMatch => Err(fail("unexpected qualification result")),
|
|
}
|
|
}
|
|
}
|
|
|
|
/// Qualify a tangent cylindrical target without changing it. A tangent exterior
|
|
/// cylinder with an unsupported profile or depth returns an explicit error;
|
|
/// a body without such a tangent wall returns `None` for planar compatibility.
|
|
/// The anchor lies on a validated profile boundary, clear of seams and endcaps.
|
|
pub fn infer_cylinder_emboss(body: &Body, plane: &Plane, regions: &[Region2], depth: f64) -> Result<Option<(usize, Vec3)>> {
|
|
if body.is_mesh() {
|
|
return Ok(None);
|
|
}
|
|
guard("cylinder emboss inference", || {
|
|
let tol = (body.size() * 1e-8).max(1e-8);
|
|
let mut tangent = false;
|
|
for (index, face) in body.solid.face_iter().enumerate() {
|
|
if index >= 50_000 {
|
|
return Err(fail("target search exceeds face work limit"));
|
|
}
|
|
if let Some(Surf::Cylinder { o, a, r, convex: true }) = surf_of(face, tol) {
|
|
let w = plane.origin - o;
|
|
let normal = plane.normal();
|
|
let signed = w.dot(normal);
|
|
if normal.dot(a).abs() < 1e-8 && (signed.abs() - r).abs() <= tol * 10.0 {
|
|
let radial = if signed < 0.0 { -normal } else { normal };
|
|
// Every supported uninterrupted wall uses one angle interval
|
|
// around this tangent normal, contained in (-pi,pi). A remote
|
|
// footprint entirely outside even that global interval cannot
|
|
// select this body, regardless of other unsupported faces.
|
|
if !profile_interval_overlaps(plane, regions, o, a.cross(radial), -std::f64::consts::PI * r, std::f64::consts::PI * r)? {
|
|
continue;
|
|
}
|
|
if let Some((lo, hi)) = wall_angles(face, o, a, radial, a.cross(radial), tol) {
|
|
if lo >= -tol / r || hi <= tol / r {
|
|
continue;
|
|
}
|
|
if !profile_interval_overlaps(plane, regions, o, a.cross(radial), lo * r, hi * r)? {
|
|
continue;
|
|
}
|
|
}
|
|
let relevant = match face_axial_bounds(face, o, a)? {
|
|
Some((lo, hi)) => profile_interval_overlaps(plane, regions, o, a, lo, hi)?,
|
|
None => true,
|
|
};
|
|
if relevant && signed < 0.0 {
|
|
return Err(fail("sketch normal must point outwards from the exterior wall"));
|
|
}
|
|
tangent |= relevant;
|
|
}
|
|
}
|
|
}
|
|
if !tangent {
|
|
return Ok(None);
|
|
}
|
|
match emboss_impl(body, None, plane, regions, depth, true)? {
|
|
EmbossOutcome::Anchor(index, at) => Ok(Some((index, at))),
|
|
EmbossOutcome::NoMatch => Ok(None),
|
|
EmbossOutcome::Body(_) => Err(fail("unexpected construction result")),
|
|
}
|
|
})
|
|
}
|
|
|
|
/// Whether a body contains an analytic exterior cylindrical wall. This bounded
|
|
/// preflight avoids resolving cylinder placement context for ordinary planar targets.
|
|
pub fn has_cylinder_emboss_wall(body: &Body) -> Result<bool> {
|
|
if body.is_mesh() {
|
|
return Ok(false);
|
|
}
|
|
guard("cylinder emboss target", || {
|
|
let tol = (body.size() * 1e-8).max(1e-8);
|
|
for (index, face) in body.solid.face_iter().enumerate() {
|
|
if index >= 50_000 {
|
|
return Err(fail("target search exceeds face work limit"));
|
|
}
|
|
if matches!(surf_of(face, tol), Some(Surf::Cylinder { convex: true, .. })) {
|
|
return Ok(true);
|
|
}
|
|
}
|
|
Ok(false)
|
|
})
|
|
}
|
|
fn emboss_impl(body: &Body, anchor: Option<Vec3>, plane: &Plane, regions: &[Region2], depth: f64, qualify: bool) -> Result<EmbossOutcome> {
|
|
body.require_brep("cylinder emboss")?;
|
|
if !depth.is_finite() || depth.abs() < 1e-6 || depth.abs() > 1e6 || regions.is_empty() || regions.len() > 64 {
|
|
return Err(fail("needs finite nonzero depth and 1..64 profiles"));
|
|
}
|
|
if !plane.origin.is_finite()
|
|
|| !plane.x.is_finite()
|
|
|| !plane.y.is_finite()
|
|
|| (plane.x.len() - 1.0).abs() > 1e-8
|
|
|| (plane.y.len() - 1.0).abs() > 1e-8
|
|
|| plane.x.dot(plane.y).abs() > 1e-8
|
|
{
|
|
return Err(fail("invalid sketch frame"));
|
|
}
|
|
guard("cylinder emboss", || {
|
|
if body.solid.boundaries().len() != 1 || body.solid.face_iter().take(17).count() > 16 || body.solid.edge_iter().take(257).count() > 256 {
|
|
return Err(fail("requires a complete cylinder or coaxial sleeve"));
|
|
}
|
|
let faces: Vec<_> = body.solid.face_iter().cloned().collect();
|
|
let tol = (body.size() * 1e-8).max(1e-8);
|
|
let surfaces: Vec<_> =
|
|
faces.iter().map(|f| surf_of(f, tol).ok_or_else(|| fail("requires only cylindrical walls and planar endcaps"))).collect::<Result<_>>()?;
|
|
let mut chosen = None;
|
|
for (fi, s) in surfaces.iter().enumerate() {
|
|
let Surf::Cylinder { o, a, r, convex: true } = *s else { continue };
|
|
let w = plane.origin - o;
|
|
let radial = plane.normal();
|
|
if radial.dot(a).abs() > 1e-8 || (w.dot(radial) - r).abs() > tol * 10.0 {
|
|
continue;
|
|
}
|
|
let radial = radial.normalized().ok_or_else(|| fail("radial frame"))?;
|
|
let tangent = a.cross(radial);
|
|
let f = faces.get(fi).ok_or_else(|| fail("face"))?;
|
|
if f.boundaries().len() != 1 || f.edge_iter().count() != 4 {
|
|
continue;
|
|
}
|
|
let Some((alo, ahi)) = wall_angles(f, o, a, radial, tangent, tol) else {
|
|
continue;
|
|
};
|
|
if alo >= -tol / r || ahi <= tol / r {
|
|
continue;
|
|
}
|
|
if chosen.is_some() {
|
|
return Err(fail("ambiguous cylindrical face"));
|
|
}
|
|
chosen = Some((fi, o, a, r, radial, tangent, alo, ahi));
|
|
}
|
|
let (fi, o, axis, r, radial, tangent, alo, ahi) =
|
|
chosen.ok_or_else(|| fail("sketch must be tangent to one complete exterior cylindrical wall, clear of its seam"))?;
|
|
if qualify && !profile_interval_overlaps(plane, regions, o, tangent, alo * r, ahi * r)? {
|
|
return Ok(EmbossOutcome::NoMatch);
|
|
}
|
|
let mut caps = Vec::new();
|
|
let mut inner: f64 = 0.0;
|
|
for s in &surfaces {
|
|
match *s {
|
|
Surf::Plane { n, d } if n.dot(axis).abs() > 1.0 - 1e-8 => caps.push((d - n.dot(o)) / n.dot(axis)),
|
|
Surf::Cylinder { o: co, a: ca, r: cr, convex }
|
|
if ca.dot(axis).abs() > 1.0 - 1e-8 && (co - o - axis * (co - o).dot(axis)).len() < tol * 10.0 =>
|
|
{
|
|
if convex && (cr - r).abs() > tol * 10.0 {
|
|
return Err(fail("interrupted or stepped cylinder"));
|
|
}
|
|
if !convex {
|
|
inner = inner.max(cr);
|
|
}
|
|
}
|
|
_ => return Err(fail("requires a complete cylinder or coaxial sleeve")),
|
|
}
|
|
}
|
|
if caps.len() != 2 {
|
|
return Err(fail("requires two planar endcaps"));
|
|
}
|
|
let lo = caps.iter().copied().fold(f64::INFINITY, f64::min);
|
|
let hi = caps.iter().copied().fold(f64::NEG_INFINITY, f64::max);
|
|
// An infinite cylinder can be tangent while its finite wall is far from
|
|
// the selected footprint. Conservative analytic/control-polygon bounds
|
|
// exclude that body before unsupported-profile or depth diagnostics.
|
|
if qualify && !profile_interval_overlaps(plane, regions, o, axis, lo, hi)? {
|
|
return Ok(EmbossOutcome::NoMatch);
|
|
}
|
|
let rr = r + depth;
|
|
if rr <= inner + tol * 10.0 {
|
|
return Err(fail("depth reaches the axis or inner wall"));
|
|
}
|
|
if let Some(at) = anchor {
|
|
let h = (at - o).dot(axis);
|
|
let v = at - o - axis * h;
|
|
let theta = angle(at, o, axis, radial, tangent);
|
|
if (v.len() - r).abs() > tol * 10.0 || theta <= alo + tol / r || theta >= ahi - tol / r || h <= lo + tol || h >= hi - tol {
|
|
return Err(fail("saved selection no longer identifies the sketch's cylindrical face"));
|
|
}
|
|
}
|
|
let z0 = (plane.origin - o).dot(axis);
|
|
let s0 = (plane.origin - o).dot(tangent);
|
|
let map2 = |p: Vec2| Vec2::new(s0 + plane.dir_to_world(p).dot(tangent), z0 + plane.dir_to_world(p).dot(axis));
|
|
let mut count = 0usize;
|
|
// The regions mapped onto the wall as given (their loops' turning may differ from the
|
|
// sketch's): profile numbering follows them.
|
|
let mut unoriented = Vec::new();
|
|
for reg in regions {
|
|
let mut loops = Vec::new();
|
|
for lp in std::iter::once(®.outer).chain(®.holes) {
|
|
count = count.saturating_add(lp.segs.len());
|
|
if count > 4096 {
|
|
return Err(fail("profile geometry budget"));
|
|
}
|
|
if lp.segs.iter().any(|segment| !matches!(segment, Seg2::Line { .. })) {
|
|
return Err(fail("only orthogonal line profiles are supported on cylinders"));
|
|
}
|
|
if lp.segs.len() < 4 || !lp.is_closed(tol) {
|
|
return Err(fail("profile geometry budget or open loop"));
|
|
}
|
|
let mut segs = Vec::new();
|
|
for s in &lp.segs {
|
|
let Seg2::Line { a, b } = *s else {
|
|
return Err(fail("only orthogonal line profiles are supported on cylinders"));
|
|
};
|
|
if !a.is_finite() || !b.is_finite() || a.len() > 1e7 || b.len() > 1e7 {
|
|
return Err(fail("nonfinite or excessive profile coordinates"));
|
|
}
|
|
let (a, b) = (map2(a), map2(b));
|
|
let d = b - a;
|
|
if d.len() < tol || (d.x.abs() > tol && d.y.abs() > tol) {
|
|
return Err(fail("profile edges must follow the cylinder axis or circumference"));
|
|
}
|
|
for p in [a, b] {
|
|
if p.x / r <= alo + tol / r || p.x / r >= ahi - tol / r || p.y <= lo + tol || p.y >= hi - tol {
|
|
return Err(fail("profile crosses a cylinder seam or endcap boundary"));
|
|
}
|
|
}
|
|
segs.push(Seg2::Line { a, b });
|
|
}
|
|
loops.push(Loop2 { segs });
|
|
}
|
|
let mut given = loops.into_iter();
|
|
unoriented.push(Region2 { outer: given.next().ok_or_else(|| fail("profile"))?, holes: given.collect() });
|
|
}
|
|
let numbered: Vec<NumberedRegion> = crate::numbered::number_regions(&unoriented).iter().map(NumberedRegion::oriented).collect();
|
|
let mapped: Vec<Region2> = numbered.iter().map(NumberedRegion::region).collect();
|
|
validate_profiles(&mapped, tol)?;
|
|
if qualify {
|
|
let segment = mapped.first().and_then(|region| region.outer.segs.first()).ok_or_else(|| fail("empty profile"))?;
|
|
let p = (segment.start() + segment.end()) * 0.5;
|
|
let at = o + axis * p.y + (radial * (p.x / r).cos() + tangent * (p.x / r).sin()) * r;
|
|
return Ok(EmbossOutcome::Anchor(fi, at));
|
|
}
|
|
let at = |p: Vec2, radius: f64| o + axis * p.y + (radial * (p.x / r).cos() + tangent * (p.x / r).sin()) * radius;
|
|
let selected = faces.get(fi).ok_or_else(|| fail("face"))?;
|
|
let mut base_patches = vec![selected.absolute_boundaries().clone()];
|
|
let mut hole_patches = Vec::new();
|
|
let mut footprints = Vec::new();
|
|
let mut added = Vec::new();
|
|
let k = rr / r;
|
|
let coord = |v: Vec3| [v.x, v.y, v.z];
|
|
let av = coord(axis);
|
|
let ov = coord(o);
|
|
let mut m = [[0.0; 4]; 4];
|
|
for (j, col) in m.iter_mut().take(3).enumerate() {
|
|
for (i, slot) in col.iter_mut().take(3).enumerate() {
|
|
*slot = if i == j { k } else { 0.0 } + (1.0 - k) * av.get(i).copied().unwrap_or(0.0) * av.get(j).copied().unwrap_or(0.0);
|
|
}
|
|
}
|
|
for (i, oi) in ov.iter().enumerate() {
|
|
let translation =
|
|
*oi - (0..3).map(|j| m.get(j).and_then(|row| row.get(i)).copied().unwrap_or(0.0) * ov.get(j).copied().unwrap_or(0.0)).sum::<f64>();
|
|
if let Some(slot) = m.get_mut(3).and_then(|row| row.get_mut(i)) {
|
|
*slot = translation;
|
|
}
|
|
}
|
|
if let Some(slot) = m.get_mut(3).and_then(|row| row.get_mut(3)) {
|
|
*slot = 1.0;
|
|
}
|
|
let [c0, c1, c2, c3] = m;
|
|
let [a, b, c, d] = c0;
|
|
let [e, f, g, h] = c1;
|
|
let [i, j, l, n] = c2;
|
|
let [p, q, s, t] = c3;
|
|
let mat = mt::Matrix4::new(a, b, c, d, e, f, g, h, i, j, l, n, p, q, s, t);
|
|
let raised = selected.oriented_surface().transformed(mat);
|
|
// History of the faces added (walls from their profile segments, the raised or sunk
|
|
// region the profile's end cap), in the order added.
|
|
let mut added_history = Vec::new();
|
|
for reg in &numbered {
|
|
let mut cap = Vec::new();
|
|
for (li, numbered_loop) in reg.loops().enumerate() {
|
|
let lp = &numbered_loop.lp;
|
|
let (base, top, walls) = wrapped_loop(lp, r, rr, &at)?;
|
|
// One wall per segment, in order.
|
|
added_history.extend((0..walls.len()).map(|j| crate::record::profile(numbered_loop.numbers(j))));
|
|
if li == 0 {
|
|
footprints.push((lp, base.inverse()));
|
|
} else {
|
|
let index = base_patches.len();
|
|
base_patches.push(vec![base.inverse()]);
|
|
hole_patches.push((lp, index));
|
|
}
|
|
cap.push(top);
|
|
added.extend(walls);
|
|
}
|
|
added.push(mt::Face::try_new(cap, raised.clone()).map_err(|e| fail(&e.to_string()))?);
|
|
added_history.push(crate::record::cap(true));
|
|
}
|
|
// An island inside a profile hole cuts that hole's original-radius patch,
|
|
// rather than adding another hole to the already-cut exterior patch.
|
|
for (lp, wire) in footprints {
|
|
let probe = lp.segs.first().ok_or_else(|| fail("empty profile"))?.start();
|
|
let owner = hole_patches
|
|
.iter()
|
|
.filter(|(hole, _)| hole.contains(probe))
|
|
.min_by(|(a, _), (b, _)| a.signed_area().abs().total_cmp(&b.signed_area().abs()))
|
|
.map(|(_, index)| *index)
|
|
.unwrap_or(0);
|
|
base_patches.get_mut(owner).ok_or_else(|| fail("profile ownership"))?.push(wire);
|
|
}
|
|
let mut all: Vec<_> = faces.iter().enumerate().filter(|(i, _)| *i != fi).map(|(_, f)| f.clone()).collect();
|
|
// History (one operand, the body; profile numbering over `regions`), face by face as
|
|
// gathered: the other faces kept, the wall's pieces left around the footprints (split
|
|
// when the profile's holes leave more than one), then the faces added.
|
|
let pieces = if base_patches.len() > 1 { Change::Split } else { Change::Modified };
|
|
let mut history: Vec<_> = crate::record::kept_except(faces.len(), fi).collect();
|
|
history.extend(std::iter::repeat_n(crate::record::from_face(0, fi, pieces), base_patches.len()));
|
|
history.extend(added_history);
|
|
for patch in base_patches {
|
|
all.push(mt::Face::try_new(patch, selected.oriented_surface()).map_err(|e| fail(&e.to_string()))?);
|
|
}
|
|
all.extend(added);
|
|
let solid = Solid::try_new(vec![all.into()]).map_err(|e| fail(&e.to_string()))?;
|
|
let result = Body::new(solid)?;
|
|
if !result.validity().is_empty() {
|
|
return Err(fail("rebuilt cylinder is not a closed manifold"));
|
|
}
|
|
Ok(EmbossOutcome::Body(crate::record::attach(result, &[Operand::new(body)], Some(history), Default::default())?))
|
|
})
|
|
}
|
|
|
|
fn profile_interval_overlaps(plane: &Plane, regions: &[Region2], o: Vec3, axis: Vec3, lo: f64, hi: f64) -> Result<bool> {
|
|
let z0 = (plane.origin - o).dot(axis);
|
|
let direction = Vec2::new(plane.x.dot(axis), plane.y.dot(axis));
|
|
let mut count = 0usize;
|
|
let mut overlaps = false;
|
|
for region in regions {
|
|
let mut min = f64::INFINITY;
|
|
let mut max = f64::NEG_INFINITY;
|
|
for segment in ®ion.outer.segs {
|
|
count = count.saturating_add(1);
|
|
if count > 4096 {
|
|
return Err(fail("profile geometry budget"));
|
|
}
|
|
let mut add = |p: Vec2| -> Result<()> {
|
|
if !p.is_finite() || p.len() > 1e7 {
|
|
return Err(fail("nonfinite or excessive profile coordinates"));
|
|
}
|
|
let z = z0 + p.dot(direction);
|
|
min = min.min(z);
|
|
max = max.max(z);
|
|
Ok(())
|
|
};
|
|
match *segment {
|
|
Seg2::Line { a, b } => {
|
|
add(a)?;
|
|
add(b)?;
|
|
}
|
|
Seg2::Arc { center, radius, .. } => {
|
|
add(center)?;
|
|
if !radius.is_finite() || radius <= 0.0 || radius > 1e7 {
|
|
return Err(fail("invalid profile radius"));
|
|
}
|
|
let z = z0 + center.dot(direction);
|
|
min = min.min(z - radius * direction.len());
|
|
max = max.max(z + radius * direction.len());
|
|
}
|
|
Seg2::Cubic { p0, p1, p2, p3 } => {
|
|
for p in [p0, p1, p2, p3] {
|
|
add(p)?;
|
|
}
|
|
}
|
|
Seg2::Conic { a, apex, b, w } if w.is_finite() && w > 0.0 => {
|
|
for p in [a, apex, b] {
|
|
add(p)?;
|
|
}
|
|
}
|
|
Seg2::Bezier { n, p } if (1..=7).contains(&n) => {
|
|
for p in p.iter().take(usize::from(n) + 1) {
|
|
add(*p)?;
|
|
}
|
|
}
|
|
_ => return Err(fail("unsupported profile geometry")),
|
|
}
|
|
}
|
|
overlaps |= min < hi && max > lo;
|
|
}
|
|
Ok(overlaps)
|
|
}
|
|
|
|
fn face_axial_bounds(face: &mt::Face, o: Vec3, axis: Vec3) -> Result<Option<(f64, f64)>> {
|
|
let mut lo = f64::INFINITY;
|
|
let mut hi = f64::NEG_INFINITY;
|
|
let mut count = 0usize;
|
|
let mut add = |point: Vec3| -> Result<()> {
|
|
count = count.saturating_add(1);
|
|
if count > 100_000 || !point.is_finite() {
|
|
return Err(fail("target boundary work limit or nonfinite geometry"));
|
|
}
|
|
let z = (point - o).dot(axis);
|
|
lo = lo.min(z);
|
|
hi = hi.max(z);
|
|
Ok(())
|
|
};
|
|
for edge in face.edge_iter() {
|
|
match edge.curve() {
|
|
mt::Curve::Line(_) => {
|
|
add(from_p3(edge.front().point()))?;
|
|
add(from_p3(edge.back().point()))?;
|
|
}
|
|
mt::Curve::BSplineCurve(curve) => {
|
|
for point in curve.control_points() {
|
|
add(from_p3(*point))?;
|
|
}
|
|
}
|
|
mt::Curve::NurbsCurve(curve) => {
|
|
for point in curve.control_points() {
|
|
if !point.w.is_finite() || point.w <= 0.0 {
|
|
return Ok(None);
|
|
}
|
|
add(Vec3::new(point.x / point.w, point.y / point.w, point.z / point.w))?;
|
|
}
|
|
}
|
|
mt::Curve::IntersectionCurve(_) => return Ok(None),
|
|
}
|
|
}
|
|
Ok((lo.is_finite() && hi.is_finite()).then_some((lo, hi)))
|
|
}
|
|
|
|
fn wrapped_loop(lp: &Loop2, r: f64, rr: f64, at: &impl Fn(Vec2, f64) -> Vec3) -> Result<(mt::Wire, mt::Wire, Vec<mt::Face>)> {
|
|
let base: Vec<_> = lp.segs.iter().map(|s| builder::vertex(p3(at(s.start(), r)))).collect();
|
|
let top: Vec<_> = lp.segs.iter().map(|s| builder::vertex(p3(at(s.start(), rr)))).collect();
|
|
let radial: Vec<_> = base.iter().zip(&top).map(|(a, b)| builder::line(a, b)).collect();
|
|
let mut be = Vec::new();
|
|
let mut te = Vec::new();
|
|
let mut walls = Vec::new();
|
|
for (i, s) in lp.segs.iter().enumerate() {
|
|
let next = (i + 1) % lp.segs.len();
|
|
let (Some(a), Some(b), Some(c), Some(d), Some(ra), Some(rb)) =
|
|
(base.get(i), base.get(next), top.get(i), top.get(next), radial.get(i), radial.get(next))
|
|
else {
|
|
return Err(fail("loop topology"));
|
|
};
|
|
let circular = (s.end().x - s.start().x).abs() > 1e-10;
|
|
let eb = if circular { builder::circle_arc(a, b, p3(at(s.mid(), r))) } else { builder::line(a, b) };
|
|
let et = if circular { builder::circle_arc(c, d, p3(at(s.mid(), rr))) } else { builder::line(c, d) };
|
|
let w: mt::Wire = vec![eb.clone(), rb.clone(), et.inverse(), ra.inverse()].into();
|
|
walls.push(builder::try_attach_plane(&[w]).map_err(|e| fail(&e.to_string()))?);
|
|
be.push(eb);
|
|
te.push(et);
|
|
}
|
|
Ok((be.into(), te.into(), walls))
|
|
}
|
|
|
|
fn validate_profiles(regions: &[Region2], tol: f64) -> Result<()> {
|
|
let loops: Vec<_> = regions.iter().flat_map(|r| std::iter::once(&r.outer).chain(&r.holes)).collect();
|
|
let edges: Vec<_> = loops.iter().enumerate().flat_map(|(l, lp)| lp.segs.iter().enumerate().map(move |(i, s)| (l, i, *s))).collect();
|
|
for (k, (l, i, s)) in edges.iter().enumerate() {
|
|
for (ll, j, t) in edges.iter().skip(k + 1) {
|
|
let len = loops.get(*l).map(|lp| lp.segs.len()).unwrap_or(0);
|
|
if l == ll && ((*i + 1) % len == *j || (*j + 1) % len == *i) {
|
|
continue;
|
|
}
|
|
let (a, b, c, d) = (s.start(), s.end(), t.start(), t.end());
|
|
let ab = b - a;
|
|
let cd = d - c;
|
|
let cross = ab.cross(cd);
|
|
let intersects = if cross.abs() > tol * tol {
|
|
let u = (c - a).cross(cd) / cross;
|
|
let v = (c - a).cross(ab) / cross;
|
|
(0.0..=1.0).contains(&u) && (0.0..=1.0).contains(&v)
|
|
} else {
|
|
false
|
|
};
|
|
if intersects
|
|
|| [a, b].iter().any(|p| t.point_at(t.closest_param(*p)).dist(*p) < tol)
|
|
|| [c, d].iter().any(|p| s.point_at(s.closest_param(*p)).dist(*p) < tol)
|
|
{
|
|
return Err(fail("profile boundaries intersect or touch"));
|
|
}
|
|
}
|
|
}
|
|
for (i, r) in regions.iter().enumerate() {
|
|
if r.area() <= tol * tol {
|
|
return Err(fail("profile has no area"));
|
|
}
|
|
for (h, lp) in r.holes.iter().enumerate() {
|
|
if !r.outer.contains(lp.segs.first().ok_or_else(|| fail("empty hole"))?.start()) {
|
|
return Err(fail("hole outside profile"));
|
|
}
|
|
for other in r.holes.iter().skip(h + 1) {
|
|
if lp.contains(other.segs.first().ok_or_else(|| fail("empty hole"))?.start())
|
|
|| other.contains(lp.segs.first().ok_or_else(|| fail("empty hole"))?.start())
|
|
{
|
|
return Err(fail("nested profile holes"));
|
|
}
|
|
}
|
|
}
|
|
for other in regions.iter().skip(i + 1) {
|
|
if r.contains(other.outer.segs.first().ok_or_else(|| fail("empty profile"))?.start())
|
|
|| other.contains(r.outer.segs.first().ok_or_else(|| fail("empty profile"))?.start())
|
|
{
|
|
return Err(fail("overlapping profiles"));
|
|
}
|
|
}
|
|
}
|
|
Ok(())
|
|
}
|
|
|
|
#[cfg(test)]
|
|
mod tests {
|
|
use super::*;
|
|
fn profile() -> Region2 {
|
|
Region2 { outer: Loop2::polygon(&[Vec2::new(-2., 5.), Vec2::new(2., 5.), Vec2::new(2., 10.), Vec2::new(-2., 10.)]), holes: vec![] }
|
|
}
|
|
fn plane() -> Plane {
|
|
Plane::new(Vec3::Y * 10., -Vec3::X, Vec3::Z).unwrap()
|
|
}
|
|
#[test]
|
|
fn inference_uses_finite_wall_footprint_and_an_interior_profile_anchor() {
|
|
let near = crate::cylinder(Vec3::ZERO, Vec3::Z, 10., 20.).unwrap();
|
|
let far = crate::cylinder(Vec3::Z * 100., Vec3::Z, 10., 20.).unwrap();
|
|
let other = crate::cylinder(Vec3::Z * 120., Vec3::Z, 8., 10.).unwrap();
|
|
let unsupported = crate::ops::join_pieces(vec![far.clone(), other]).unwrap().unwrap();
|
|
let regions = [profile()];
|
|
for body in [&far, &unsupported] {
|
|
assert!(infer_cylinder_emboss(body, &plane(), ®ions, 1.).unwrap().is_none());
|
|
}
|
|
for x in [20., 80.] {
|
|
let base = crate::cylinder(Vec3::X * x, Vec3::Z, 10., 20.).unwrap();
|
|
let step = crate::cylinder(Vec3::X * x + Vec3::Z * 20., Vec3::Z, 8., 10.).unwrap();
|
|
let remote = crate::ops::join_pieces(vec![base, step]).unwrap().unwrap();
|
|
let inferred = infer_cylinder_emboss(&remote, &plane(), ®ions, 1.);
|
|
if x == 20. {
|
|
// The offset maps this footprint across the remote wall's seam;
|
|
// partial relevance must retain conservative unsupported refusal.
|
|
assert!(inferred.is_err());
|
|
} else {
|
|
assert!(inferred.unwrap().is_none());
|
|
}
|
|
}
|
|
let (index, anchor) = infer_cylinder_emboss(&near, &plane(), ®ions, 1.).unwrap().unwrap();
|
|
assert!(anchor.z > 0. && anchor.z < 20.);
|
|
assert!((anchor.x.hypot(anchor.y) - 10.).abs() < 1e-9);
|
|
assert!(cylinder_emboss_anchor(&near, index, anchor).unwrap().dist(anchor) < 1e-10);
|
|
let shifted = Plane::new(Vec3::new(-3., 10., 0.), -Vec3::X, Vec3::Z).unwrap();
|
|
let shifted_profile =
|
|
Region2 { outer: Loop2::polygon(&[Vec2::new(-5., 5.), Vec2::new(-1., 5.), Vec2::new(-1., 10.), Vec2::new(-5., 10.)]), holes: vec![] };
|
|
let (_, other_anchor) = infer_cylinder_emboss(&near, &shifted, std::slice::from_ref(&shifted_profile), 1.).unwrap().unwrap();
|
|
assert!(other_anchor.dist(anchor) < 1e-10);
|
|
let before = near.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let result = emboss_cylinder_at(&near, other_anchor, &shifted, &[shifted_profile], 1.).unwrap();
|
|
assert!((result.tessellate_with(1e-4, true).unwrap().measure().volume - before - 21.).abs() < 0.02);
|
|
assert!(infer_cylinder_emboss(&near, &plane(), ®ions, -10.).is_err());
|
|
let inward = Plane::new(Vec3::Y * 10., Vec3::X, Vec3::Z).unwrap();
|
|
assert!(infer_cylinder_emboss(&near, &inward, ®ions, 1.).unwrap_err().to_string().contains("outwards"));
|
|
}
|
|
#[test]
|
|
fn wrapped_nested_island_uses_its_enclosing_hole_patch() {
|
|
let body = crate::cylinder(Vec3::ZERO, Vec3::Z, 10., 20.).unwrap();
|
|
let mut ring = profile();
|
|
ring.holes.push(Loop2::polygon(&[Vec2::new(-1., 6.), Vec2::new(1., 6.), Vec2::new(1., 9.), Vec2::new(-1., 9.)]));
|
|
let island =
|
|
Region2 { outer: Loop2::polygon(&[Vec2::new(-0.5, 6.5), Vec2::new(0.5, 6.5), Vec2::new(0.5, 8.5), Vec2::new(-0.5, 8.5)]), holes: vec![] };
|
|
let before = body.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
for depth in [1., -1.] {
|
|
for regions in [vec![ring.clone(), island.clone()], vec![island.clone(), ring.clone()]] {
|
|
let result = emboss_cylinder(&body, &plane(), ®ions, depth).unwrap();
|
|
assert_eq!(result.shell_count(), 1);
|
|
assert!(result.validity().is_empty());
|
|
let after = result.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let expected = 16. * (depth + depth * depth / 20.);
|
|
assert!((after - before - expected).abs() < 0.02, "{} vs {expected}", after - before);
|
|
let mesh = result.tessellate_with(0.001, true).unwrap();
|
|
for (s, raised) in [(0., true), (0.75, false), (1.5, true)] {
|
|
let radial = -Vec3::X * (s / 10.0_f64).sin() + Vec3::Y * (s / 10.0_f64).cos();
|
|
let radius = if depth > 0. { 10.5 } else { 9.5 };
|
|
assert_eq!(mesh.contains(radial * radius + Vec3::Z * 7.5), if depth > 0. { raised } else { !raised });
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
#[test]
|
|
fn exact_wrapped_rectangle_is_connected_and_has_radial_depth() {
|
|
let body = crate::cylinder(Vec3::ZERO, Vec3::Z, 10., 20.).unwrap();
|
|
for depth in [1., -1.] {
|
|
let result = emboss_cylinder(&body, &plane(), &[profile()], depth).unwrap();
|
|
assert_eq!(result.shell_count(), 1);
|
|
assert!(result.validity().is_empty());
|
|
let before = body.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let after = result.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let expected = if depth > 0. { 21. } else { -19. };
|
|
assert!((after - before - expected).abs() < 0.02, "{} vs {expected}", after - before);
|
|
let mesh = result.tessellate_with(0.001, true).unwrap();
|
|
for s in [-1.5, 0., 1.5] {
|
|
let radial = -Vec3::X * (s / 10.0_f64).sin() + Vec3::Y * (s / 10.0_f64).cos();
|
|
assert_eq!(mesh.contains(radial * (if depth > 0. { 10.5 } else { 9.5 }) + Vec3::Z * 7.5), depth > 0.);
|
|
}
|
|
}
|
|
}
|
|
|
|
#[test]
|
|
fn wrapped_holes_and_concave_profiles_preserve_material_on_rotated_axes() {
|
|
let origin = Vec3::new(123.0, -456.0, 789.0);
|
|
let axis = Vec3::X;
|
|
let radial = Vec3::Y;
|
|
let tangent = Vec3::Z;
|
|
let body = crate::cylinder(origin, axis, 10.0, 20.0).unwrap();
|
|
let plane = Plane::new(origin + radial * 10.0, tangent, axis).unwrap();
|
|
let mut holed = profile();
|
|
holed.holes.push(Loop2::polygon(&[Vec2::new(-1., 6.), Vec2::new(1., 6.), Vec2::new(1., 9.), Vec2::new(-1., 9.)]));
|
|
let concave = Region2 {
|
|
outer: Loop2::polygon(&[
|
|
Vec2::new(-2., 5.),
|
|
Vec2::new(2., 5.),
|
|
Vec2::new(2., 7.),
|
|
Vec2::new(0., 7.),
|
|
Vec2::new(0., 10.),
|
|
Vec2::new(-2., 10.),
|
|
]),
|
|
holes: vec![],
|
|
};
|
|
for profile in [holed, concave] {
|
|
for depth in [1., -1.] {
|
|
let result = emboss_cylinder_at(&body, origin + radial * 10.0 + axis * 7.5, &plane, std::slice::from_ref(&profile), depth).unwrap();
|
|
assert_eq!(result.shell_count(), 1);
|
|
let before = body.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let after = result.tessellate_with(1e-4, true).unwrap().measure().volume;
|
|
let want = profile.area().abs() * (depth + depth * depth / 20.0);
|
|
assert!((after - before - want).abs() < 0.02, "{} vs {want}", after - before);
|
|
let point = |s: f64, z: f64, r: f64| origin + axis * z + (radial * (s / 10.0).cos() + tangent * (s / 10.0).sin()) * r;
|
|
let mesh = result.tessellate_with(0.001, true).unwrap();
|
|
for (s, z) in [(-1.5, 7.5), (1.5, 7.5), (0.5, 6.5)] {
|
|
let material = profile.contains(Vec2::new(s, z));
|
|
assert_eq!(mesh.contains(point(s, z, if depth > 0. { 10.5 } else { 9.5 })), if depth > 0. { material } else { !material });
|
|
}
|
|
let imported = crate::step_import(&crate::step_export(&[&result], "wrapped cylinder").unwrap()).unwrap();
|
|
assert!(imported.warnings.is_empty(), "{:?}", imported.warnings);
|
|
assert_eq!(imported.bodies.len(), 1);
|
|
let round = imported.bodies.first().unwrap();
|
|
assert!(round.body.validity().is_empty());
|
|
let roundmesh = round.body.tessellate_with(0.001, true).unwrap();
|
|
assert_eq!(roundmesh.contains(point(-1.5, 7.5, if depth > 0. { 10.5 } else { 9.5 })), depth > 0.);
|
|
let cut = crate::boolean(
|
|
&round.body,
|
|
&crate::box_solid(origin + Vec3::new(5., -20., -20.), origin + Vec3::new(10., 20., 20.)).unwrap(),
|
|
crate::BoolOp::Cut,
|
|
)
|
|
.unwrap()
|
|
.unwrap();
|
|
assert!(!cut.tessellate(0.01).unwrap().contains(point(-1.5, 7.5, 9.0)));
|
|
}
|
|
}
|
|
}
|
|
|
|
#[test]
|
|
fn sleeve_depth_and_hostile_profiles_refuse_changes_atomically() {
|
|
let outer = crate::cylinder(Vec3::ZERO, Vec3::Z, 10., 20.).unwrap();
|
|
let inner = crate::cylinder(-Vec3::Z, Vec3::Z, 8., 22.).unwrap();
|
|
let sleeve = crate::boolean(&outer, &inner, crate::BoolOp::Cut).unwrap().unwrap();
|
|
let good = emboss_cylinder(&sleeve, &plane(), &[profile()], -1.).unwrap();
|
|
assert_eq!(good.shell_count(), 1);
|
|
let before = crate::step_export(&[&sleeve], "unchanged").unwrap();
|
|
let mut cap = profile();
|
|
cap.outer = Loop2::polygon(&[Vec2::new(-2., 19.), Vec2::new(2., 19.), Vec2::new(2., 21.), Vec2::new(-2., 21.)]);
|
|
let circle = Region2 { outer: Loop2::circle(Vec2::new(0., 7.5), 1.), holes: vec![] };
|
|
let mut crossing = profile();
|
|
crossing.outer = Loop2::polygon(&[Vec2::new(-2., 5.), Vec2::new(2., 10.), Vec2::new(-2., 10.), Vec2::new(2., 5.)]);
|
|
for (profiles, d) in [
|
|
(vec![profile()], -2.),
|
|
(vec![cap], 1.),
|
|
(vec![circle], 1.),
|
|
(vec![crossing], 1.),
|
|
(vec![profile()], f64::NAN),
|
|
(vec![profile(); 65], 1.),
|
|
] {
|
|
assert!(emboss_cylinder(&sleeve, &plane(), &profiles, d).is_err());
|
|
}
|
|
assert!(emboss_cylinder_at(&sleeve, -Vec3::Y * 10. + Vec3::Z * 7.5, &plane(), &[profile()], 1.).is_err());
|
|
assert_eq!(crate::step_export(&[&sleeve], "unchanged").unwrap(), before);
|
|
}
|
|
}
|