1pub(super) use crate::curve::interior_knots;
2use super::*;
3
4pub(crate) fn curve_breaks(curve: &NurbsCurve) -> Result<Vec<f64>, String> {
5 let [start, end] = curve.domain()?;
6 let mut result = vec![start];
7 result.extend(interior_knots(&curve.knots, curve.degree));
8 result.push(end);
9 Ok(result)
10}
11
12pub fn parameter_space_area(face: &FaceRecord) -> Result<f64, String> {
13 let mut area = 0.0;
14 for loop_record in &face.loops {
15 for coedge in &loop_record.coedges {
16 for pair in curve_breaks(&coedge.pcurve)?.windows(2) {
17 for panel in rule::curve_panels(&coedge.pcurve, pair[0], pair[1])? {
18 for (parameter, weight) in panel.stations() {
19 let (point, tangent) = coedge.pcurve.deriv1(parameter)?;
20 area += weight * 0.5 * (point.x * tangent.y - point.y * tangent.x);
21 }
22 }
23 }
24 }
25 }
26 Ok(area)
27}
28
29fn open_planar_loops() -> bool {
33 debug_flag!("BREP_OPEN_PLANAR_LOOPS")
34}
35
36pub(super) fn loop_closing_chords(face: &FaceRecord) -> Result<Vec<(Vec3, Vec3)>, String> {
40 let mut chords = Vec::new();
41 if open_planar_loops() {
42 return Ok(chords);
43 }
44 for loop_record in &face.loops {
45 let count = loop_record.coedges.len();
46 for index in 0..count {
47 let [_, end] = loop_record.coedges[index].pcurve.domain()?;
48 let [start, _] = loop_record.coedges[(index + 1) % count].pcurve.domain()?;
49 chords.push((
50 loop_record.coedges[index].pcurve.evaluate(end)?,
51 loop_record.coedges[(index + 1) % count].pcurve.evaluate(start)?,
52 ));
53 }
54 }
55 Ok(chords)
56}
57
58pub(crate) fn closed_parameter_space_area(face: &FaceRecord) -> Result<f64, String> {
78 let mut area = parameter_space_area(face)?;
79 for (end, start) in loop_closing_chords(face)? {
80 area += 0.5 * (crate::polygon::area_term([end.x, end.y], [start.x, start.y]));
81 }
82 Ok(area)
83}
84
85const SEAM_COINCIDENCE_REL: f64 = 1e-12;
95
96pub(crate) fn closed_parameter_space_area_on_carrier(face: &FaceRecord) -> Result<f64, String> {
112 let mut area = parameter_space_area(face)?;
113 let mut coincidence: Option<f64> = None;
114 for loop_record in &face.loops {
115 let count = loop_record.coedges.len();
116 for index in 0..count {
117 let [_, end] = loop_record.coedges[index].pcurve.domain()?;
118 let [start, _] = loop_record.coedges[(index + 1) % count].pcurve.domain()?;
119 let here = loop_record.coedges[index].pcurve.evaluate(end)?;
120 let next = loop_record.coedges[(index + 1) % count].pcurve.evaluate(start)?;
121 if here.x == next.x && here.y == next.y {
122 continue;
123 }
124 let bar = *coincidence.get_or_insert_with(|| {
125 SEAM_COINCIDENCE_REL
126 * crate::tolerance::model_scale(
127 face.surface
128 .control_points
129 .iter()
130 .flatten()
131 .filter_map(|control| control.point().ok()),
132 )
133 });
134 let (image_here, image_next) = (
135 face.surface.evaluate_extended(here.x, here.y)?,
136 face.surface.evaluate_extended(next.x, next.y)?,
137 );
138 if image_here.sub(image_next).length() <= bar {
139 continue;
140 }
141 area += 0.5 * (crate::polygon::area_term([here.x, here.y], [next.x, next.y]));
142 }
143 }
144 Ok(area)
145}
146
147pub(super) fn is_affine(surface: &NurbsSurface) -> Result<bool, String> {
148 surface.is_affine()
150}
151
152pub(crate) fn surface_breaks(surface: &NurbsSurface) -> Result<(Vec<f64>, Vec<f64>), String> {
153 let ku = crate::KnotVector::new(surface.knots_u.clone(), surface.degree_u)?;
154 let kv = crate::KnotVector::new(surface.knots_v.clone(), surface.degree_v)?;
155 let [u0, u1] = ku.domain();
156 let [v0, v1] = kv.domain();
157 let mut u = vec![u0];
158 u.extend(interior_knots(&surface.knots_u, surface.degree_u));
159 u.push(u1);
160 let mut v = vec![v0];
161 v.extend(interior_knots(&surface.knots_v, surface.degree_v));
162 v.push(v1);
163 Ok((u, v))
164}
165
166pub(super) fn integrand_value(kind: Integrand, point: Vec3, weighted_normal: Vec3) -> f64 {
167 let (x, y, z) = (point.x, point.y, point.z);
168 match kind {
169 Integrand::Area => weighted_normal.length(),
170 Integrand::Volume => point.dot(weighted_normal),
171 Integrand::VolumeAbout(reference) => point.sub(reference).dot(weighted_normal),
172 Integrand::NormalX => weighted_normal.x,
173 Integrand::NormalY => weighted_normal.y,
174 Integrand::NormalZ => weighted_normal.z,
175 Integrand::MomentX => 0.5 * x * x * weighted_normal.x,
176 Integrand::MomentY => 0.5 * y * y * weighted_normal.y,
177 Integrand::MomentZ => 0.5 * z * z * weighted_normal.z,
178 Integrand::SecondXX => x * x * x / 3.0 * weighted_normal.x,
179 Integrand::SecondYY => y * y * y / 3.0 * weighted_normal.y,
180 Integrand::SecondZZ => z * z * z / 3.0 * weighted_normal.z,
181 Integrand::ProductXY => 0.5 * x * x * y * weighted_normal.x,
182 Integrand::ProductXZ => 0.5 * x * x * z * weighted_normal.x,
183 Integrand::ProductYZ => 0.5 * y * y * z * weighted_normal.y,
184 }
185}
186
187
188pub(super) const GAUSS_COUNT: usize = GAUSS_X.len();
190
191pub(super) fn tensor_blocks_on() -> bool {
197 switch!("BREP_MASS_TENSOR_BLOCK", true)
198}
199
200pub(super) fn integrate_cell_scaled(
214 face: &FaceRecord,
215 cell: [f64; 4],
216 scale: f64,
217 kinds: &[Integrand],
218 totals: &mut [f64],
219 rules: &mut rule::SurfaceRules,
220) -> Result<usize, String> {
221 let (u_panels, v_panels) = rules.panels(&face.surface, cell)?;
225 let mut stations = 0;
226 for u_panel in &u_panels {
227 for v_panel in &v_panels {
228 integrate_block(face, *u_panel, *v_panel, scale, kinds, totals)?;
229 stations += u_panel.order * v_panel.order;
230 }
231 }
232 Ok(stations)
233}
234
235fn integrate_block(
237 face: &FaceRecord,
238 u_panel: rule::Panel,
239 v_panel: rule::Panel,
240 scale: f64,
241 kinds: &[Integrand],
242 totals: &mut [f64],
243) -> Result<(), String> {
244 let half_u = (u_panel.hi - u_panel.lo) * 0.5;
245 let middle_u = (u_panel.hi + u_panel.lo) * 0.5;
246 let half_v = (v_panel.hi - v_panel.lo) * 0.5;
247 let middle_v = (v_panel.hi + v_panel.lo) * 0.5;
248 let (u_x, u_w) = u_panel.nodes();
249 let (v_x, v_w) = v_panel.nodes();
250 let sign = if face.same_sense { 1.0 } else { -1.0 };
251 let base_rule = u_x.len() == GAUSS_COUNT && v_x.len() == GAUSS_COUNT;
257 if base_rule && tensor_blocks_on() && face.surface.deriv1_tensor_supported() {
258 let mut u_stations = [0.0f64; GAUSS_COUNT];
259 let mut v_stations = [0.0f64; GAUSS_COUNT];
260 for index in 0..GAUSS_COUNT {
261 u_stations[index] = middle_u + half_u * GAUSS_X[index];
262 v_stations[index] = middle_v + half_v * GAUSS_X[index];
263 }
264 return face
265 .surface
266 .deriv1_tensor_each(&u_stations, &v_stations, |i, j, point, su, sv| {
267 let weighted_normal = su.cross(sv).scale(sign);
268 for (slot, kind) in kinds.iter().enumerate() {
269 totals[slot] += scale
270 * GAUSS_W[i]
271 * GAUSS_W[j]
272 * half_u
273 * half_v
274 * integrand_value(*kind, point, weighted_normal);
275 }
276 Ok(())
277 });
278 }
279 if base_rule && !face.surface.deriv1_tensor_supported() {
280 for i in 0..GAUSS_COUNT {
281 for j in 0..GAUSS_COUNT {
282 let (point, su, sv) = face
283 .surface
284 .deriv1(middle_u + half_u * GAUSS_X[i], middle_v + half_v * GAUSS_X[j])?;
285 let weighted_normal = su.cross(sv).scale(sign);
286 for (slot, kind) in kinds.iter().enumerate() {
287 totals[slot] += scale
288 * GAUSS_W[i]
289 * GAUSS_W[j]
290 * half_u
291 * half_v
292 * integrand_value(*kind, point, weighted_normal);
293 }
294 }
295 }
296 return Ok(());
297 }
298 if tensor_blocks_on() && face.surface.deriv1_tensor_supported() {
299 let mut u_stations = [0.0f64; rule::MAX_ORDER];
300 let mut v_stations = [0.0f64; rule::MAX_ORDER];
301 for index in 0..u_x.len() {
302 u_stations[index] = middle_u + half_u * u_x[index];
303 }
304 for index in 0..v_x.len() {
305 v_stations[index] = middle_v + half_v * v_x[index];
306 }
307 return face.surface.deriv1_tensor_each(
308 &u_stations[..u_x.len()],
309 &v_stations[..v_x.len()],
310 |i, j, point, su, sv| {
311 let weighted_normal = su.cross(sv).scale(sign);
312 for (slot, kind) in kinds.iter().enumerate() {
313 totals[slot] += scale
314 * u_w[i]
315 * v_w[j]
316 * half_u
317 * half_v
318 * integrand_value(*kind, point, weighted_normal);
319 }
320 Ok(())
321 },
322 );
323 }
324 for i in 0..u_x.len() {
325 for j in 0..v_x.len() {
326 let (point, su, sv) = face
327 .surface
328 .deriv1(middle_u + half_u * u_x[i], middle_v + half_v * v_x[j])?;
329 let weighted_normal = su.cross(sv).scale(sign);
330 for (slot, kind) in kinds.iter().enumerate() {
331 totals[slot] += scale
332 * u_w[i]
333 * v_w[j]
334 * half_u
335 * half_v
336 * integrand_value(*kind, point, weighted_normal);
337 }
338 }
339 }
340 Ok(())
341}
342
343pub(super) fn integrate_untrimmed_multi(
348 face: &FaceRecord,
349 kinds: &[Integrand],
350) -> Result<Vec<f64>, String> {
351 let (u_breaks, v_breaks) = surface_breaks(&face.surface)?;
352 let mut totals = vec![0.0f64; kinds.len()];
353 let mut rules = rule::SurfaceRules::new(&face.surface)?;
354 for upair in u_breaks.windows(2) {
355 for vpair in v_breaks.windows(2) {
356 integrate_cell_scaled(
357 face,
358 [upair[0], upair[1], vpair[0], vpair[1]],
359 1.0,
360 kinds,
361 &mut totals,
362 &mut rules,
363 )?;
364 }
365 }
366 Ok(totals)
367}
368
369pub(super) fn integrate_iso_rectangle_multi(
380 face: &FaceRecord,
381 rectangle: [f64; 4],
382 kinds: &[Integrand],
383) -> Result<Vec<f64>, String> {
384 let (u_breaks, v_breaks) = surface_breaks(&face.surface)?;
385 let mut totals = vec![0.0f64; kinds.len()];
386 let mut rules = rule::SurfaceRules::new(&face.surface)?;
387 for upair in u_breaks.windows(2) {
388 let (u_lo, u_hi) = (upair[0].max(rectangle[0]), upair[1].min(rectangle[1]));
389 if u_hi <= u_lo {
390 continue;
391 }
392 for vpair in v_breaks.windows(2) {
393 let (v_lo, v_hi) = (vpair[0].max(rectangle[2]), vpair[1].min(rectangle[3]));
394 if v_hi <= v_lo {
395 continue;
396 }
397 integrate_cell_scaled(face, [u_lo, u_hi, v_lo, v_hi], 1.0, kinds, &mut totals, &mut rules)?;
398 }
399 }
400 Ok(totals)
401}
402
403pub(super) fn integrate_untrimmed(face: &FaceRecord, kind: Integrand) -> Result<f64, String> {
404 Ok(integrate_untrimmed_multi(face, &[kind])?[0])
405}
406
407#[derive(Clone, Copy)]
414pub(super) struct BiBand {
415 pub(super) p_is_u: bool,
417 pub(super) q_lo: f64,
419 pub(super) q_hi: f64,
420 pub(super) complement: bool,
424 pub(super) rim_wobble: f64,
431}
432
433pub(super) const BAND_RIM_LEVEL_TOLERANCE_REL: f64 = 1e-9;
447
448pub(super) fn biperiodic_band_range(face: &FaceRecord) -> Result<Option<BiBand>, String> {
455 let surface = &face.surface;
456 let (closed_u, closed_v) = surface.closed_directions()?;
457 if !(closed_u && closed_v) {
458 return Ok(None);
459 }
460 let [u0, u1] = surface.domain_u()?;
461 let [v0, v1] = surface.domain_v()?;
462 let u_span = (u1 - u0).abs().max(1e-30);
463 let v_span = (v1 - v0).abs().max(1e-30);
464 let mut loop_points: Vec<Vec<[f64; 2]>> = Vec::with_capacity(2);
470 for loop_record in &face.loops {
471 let mut points = Vec::new();
472 for coedge in &loop_record.coedges {
473 let [d0, d1] = coedge.pcurve.domain()?;
474 let samples = 32;
477 for k in 0..=samples {
478 let t = d0 + (d1 - d0) * k as f64 / samples as f64;
479 let p = coedge.pcurve.evaluate(t)?;
480 points.push([p.x, p.y]);
481 }
482 }
483 if points.len() < 2 {
484 return Ok(None);
485 }
486 let (mut umin, mut umax, mut vmin, mut vmax) = (
487 f64::INFINITY,
488 f64::NEG_INFINITY,
489 f64::INFINITY,
490 f64::NEG_INFINITY,
491 );
492 for pt in &points {
493 umin = umin.min(pt[0]);
494 umax = umax.max(pt[0]);
495 vmin = vmin.min(pt[1]);
496 vmax = vmax.max(pt[1]);
497 }
498 if (umax - umin) <= 1e-3 * u_span && (vmax - vmin) <= 1e-3 * v_span {
499 continue; }
501 loop_points.push(points);
502 }
503 if loop_points.len() != 2 {
504 return Ok(None);
505 }
506 for p_is_u in [true, false] {
507 let (period, _p0, _p1) = if p_is_u {
508 (u1 - u0, u0, u1)
509 } else {
510 (v1 - v0, v0, v1)
511 };
512 let (q_dom_lo, q_dom_hi) = if p_is_u { (v0, v1) } else { (u0, u1) };
513 let q_extent = (q_dom_hi - q_dom_lo).abs().max(1e-30);
514 if !(period > 0.0) {
515 continue;
516 }
517 let coord = |pt: &[f64; 2]| -> (f64, f64) {
518 if p_is_u {
519 (pt[0], pt[1])
520 } else {
521 (pt[1], pt[0])
522 }
523 };
524 let mut rings: Vec<(f64, i32)> = Vec::with_capacity(2);
527 let mut clean = true;
528 let mut rim_wobble = 0.0f64;
529 for points in &loop_points {
530 let (mut pmin, mut pmax, mut qmin, mut qmax) = (
531 f64::INFINITY,
532 f64::NEG_INFINITY,
533 f64::INFINITY,
534 f64::NEG_INFINITY,
535 );
536 for pt in points {
537 let (p, q) = coord(pt);
538 pmin = pmin.min(p);
539 pmax = pmax.max(p);
540 qmin = qmin.min(q);
541 qmax = qmax.max(q);
542 }
543 if (pmax - pmin) < 0.6 * period || (qmax - qmin) > 0.05 * q_extent {
544 clean = false;
545 break;
546 }
547 rim_wobble = rim_wobble.max((qmax - qmin) / q_extent);
548 let mut net = 0.0;
549 for pair in points.windows(2) {
550 let mut delta = coord(&pair[1]).0 - coord(&pair[0]).0;
551 if delta > 0.5 * period {
552 delta -= period;
553 } else if delta < -0.5 * period {
554 delta += period;
555 }
556 net += delta;
557 }
558 let direction = if net > 0.25 * period {
559 1
560 } else if net < -0.25 * period {
561 -1
562 } else {
563 0
564 };
565 rings.push((0.5 * (qmin + qmax), direction));
566 }
567 if !clean || rings.len() != 2 {
568 continue;
569 }
570 rings.sort_by(|a, b| a.0.total_cmp(&b.0));
571 let (q_lo, lower_dir) = rings[0];
572 let (q_hi, upper_dir) = rings[1];
573 let inconclusive = lower_dir == 0 || upper_dir == 0 || lower_dir == upper_dir;
574 let between_rims_is_ccw_uv = if p_is_u { lower_dir > 0 } else { lower_dir < 0 };
575 let complement = !inconclusive && between_rims_is_ccw_uv != face.same_sense;
576 return Ok(Some(BiBand {
577 p_is_u,
578 q_lo,
579 q_hi,
580 complement,
581 rim_wobble,
582 }));
583 }
584 Ok(None)
585}
586
587pub(super) fn integrate_rectangle(
590 face: &FaceRecord,
591 u_lo: f64,
592 u_hi: f64,
593 v_lo: f64,
594 v_hi: f64,
595 kind: Integrand,
596) -> Result<f64, String> {
597 let (u_full, v_full) = surface_breaks(&face.surface)?;
598 let clamp = |breaks: &[f64], lo: f64, hi: f64| -> Vec<f64> {
599 let eps = 1e-9 * (hi - lo).abs().max(1e-30);
600 let mut out = vec![lo];
601 for &b in breaks {
602 if b > lo + eps && b < hi - eps {
603 out.push(b);
604 }
605 }
606 out.push(hi);
607 out
608 };
609 let u_breaks = clamp(&u_full, u_lo, u_hi);
610 let v_breaks = clamp(&v_full, v_lo, v_hi);
611 let mut totals = [0.0f64];
612 let mut rules = rule::SurfaceRules::new(&face.surface)?;
613 for upair in u_breaks.windows(2) {
614 for vpair in v_breaks.windows(2) {
615 integrate_cell_scaled(
616 face,
617 [upair[0], upair[1], vpair[0], vpair[1]],
618 1.0,
619 &[kind],
620 &mut totals,
621 &mut rules,
622 )?;
623 }
624 }
625 Ok(totals[0])
626}
627
628pub(super) fn biperiodic_band_integral(
645 face: &FaceRecord,
646 kinds: &[Integrand],
647) -> Result<Option<Vec<f64>>, String> {
648 let Some(band) = biperiodic_band_range(face)? else {
649 return Ok(None);
650 };
651 let [u0, u1] = face.surface.domain_u()?;
652 let [v0, v1] = face.surface.domain_v()?;
653 let (u_lo, u_hi, v_lo, v_hi) = if band.p_is_u {
654 (u0, u1, band.q_lo, band.q_hi)
655 } else {
656 (band.q_lo, band.q_hi, v0, v1)
657 };
658 let strips: Vec<f64> = if band.rim_wobble <= BAND_RIM_LEVEL_TOLERANCE_REL {
659 kinds
660 .iter()
661 .map(|&kind| integrate_rectangle(face, u_lo, u_hi, v_lo, v_hi, kind))
662 .collect::<Result<_, _>>()?
663 } else {
664 super::winding::winding_loops_integral(face, kinds, band.p_is_u, 1)?
665 };
666 let mut out = Vec::with_capacity(kinds.len());
667 for (&kind, strip) in kinds.iter().zip(strips) {
668 let value = if band.complement {
669 integrate_untrimmed(face, kind)? - strip
670 } else {
671 strip
672 };
673 out.push(value);
674 }
675 Ok(Some(out))
676}