forked from 1b-agent/fieldcraft-upstream
simplify: joining in modelcraft-mesh::join, shared label helper, run_script returns step outputs
Weld and face-to-face check move from the mesh.block command to modelcraft_mesh::join (bounding-box-limited weld, grid-binned hanging-node test), for node merging and imports to reuse. mesh.block and mesh.tet.generate share fresh_labels. The block map evaluates each edge curve once per lattice parameter; vector helpers come from vec3; tet10 and hex20 mid-side nodes follow ElementKind::edges. Session::run_script returns each step's output, which the oracle reads instead of its own loop. Co-Authored-By: Claude Opus 5.5 <noreply@anthropic.com> Claude-Session: https://claude.ai/code/session_01NmAttHhUZTokgPeEJia8sm
This commit is contained in:
1 parent
cbff230734
commit
6dda34e837
11 files changed
+369
-359
No files matched your search
+36
-196
@@ -4,11 +4,13 @@
|
||||
|
||||
use std::collections::{BTreeMap, BTreeSet};
|
||||
|
||||
use modelcraft_mesh::block::{Block, BlockMesh, Curve, block};
|
||||
use modelcraft_model::{ElementKind, Entity, GeometryRef, MAX_LABEL, Model};
|
||||
use modelcraft_mesh::block::{Block, Curve, block};
|
||||
use modelcraft_mesh::join::{check_conforming, weld};
|
||||
use modelcraft_model::{ElementKind, Entity, GeometryRef, Model};
|
||||
use serde::Deserialize;
|
||||
use serde_json::{Value, json};
|
||||
|
||||
use super::fresh_labels;
|
||||
use crate::{CommandKind, CommandSpec, EngineError, Result, Session};
|
||||
|
||||
pub const BLOCK: CommandSpec = CommandSpec {
|
||||
@@ -97,16 +99,15 @@ fn block_mesh(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
return Err(EngineError::Params(format!("edge {:?} gives neither a curve nor a name", e.corners)));
|
||||
}
|
||||
}
|
||||
let faces: Vec<(usize, String)> = p.faces.iter().map(|(k, n)| Ok((numbered(k, 6, "face")?, n.clone()))).collect::<Result<_>>()?;
|
||||
let vertices: Vec<(usize, String)> = p.vertices.iter().map(|(k, n)| Ok((numbered(k, 8, "vertex")?, n.clone()))).collect::<Result<_>>()?;
|
||||
// Check every name before meshing.
|
||||
let body = GeometryRef::body(p.body.clone())?;
|
||||
let face_refs: Vec<(usize, GeometryRef)> =
|
||||
faces.iter().map(|(k, n)| Ok((*k, GeometryRef::face(p.body.clone(), n.clone())?))).collect::<Result<_>>()?;
|
||||
let named = |entries: &BTreeMap<String, String>, n: usize, what: &str, entity: fn(String) -> Entity| -> Result<Vec<(usize, GeometryRef)>> {
|
||||
entries.iter().map(|(k, name)| Ok((numbered(k, n, what)?, GeometryRef::new(p.body.clone(), entity(name.clone()))?))).collect()
|
||||
};
|
||||
let face_refs = named(&p.faces, 6, "face", Entity::Face)?;
|
||||
let vertex_refs = named(&p.vertices, 8, "vertex", Entity::Vertex)?;
|
||||
let edge_refs: Vec<(usize, GeometryRef)> =
|
||||
edge_names.iter().map(|(k, n)| Ok((*k, GeometryRef::new(p.body.clone(), Entity::Edge(n.clone()))?))).collect::<Result<_>>()?;
|
||||
let vertex_refs: Vec<(usize, GeometryRef)> =
|
||||
vertices.iter().map(|(k, n)| Ok((*k, GeometryRef::new(p.body.clone(), Entity::Vertex(n.clone()))?))).collect::<Result<_>>()?;
|
||||
edge_names.into_iter().map(|(k, n)| Ok((k, GeometryRef::new(p.body.clone(), Entity::Edge(n))?))).collect::<Result<_>>()?;
|
||||
|
||||
let mesh = block(&Block { kind, corners: p.corners, divisions: p.divisions, bias: p.bias, curves })?;
|
||||
let diagonal = {
|
||||
@@ -118,62 +119,49 @@ fn block_mesh(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
if !(merge.is_finite() && merge >= 0.0 && merge <= 1e-2 * diagonal) {
|
||||
return Err(EngineError::Params(format!("`merge` must be from 0 to 1/100 of the block's diagonal ({diagonal})")));
|
||||
}
|
||||
|
||||
let next = |last: Option<u32>| last.map_or(Some(1), |l| l.checked_add(1));
|
||||
let first_node = next(s.model.nodes().keys().next_back().copied());
|
||||
let first_element = next(s.model.elements().keys().next_back().copied());
|
||||
let fits = |first: Option<u32>, count: usize| first.filter(|&f| u64::from(f) + count as u64 <= u64::from(MAX_LABEL) + 1);
|
||||
let (Some(first_node), Some(first_element)) = (fits(first_node, mesh.points.len()), fits(first_element, mesh.elements.len())) else {
|
||||
return Err(EngineError::Params(format!("the block needs labels beyond {MAX_LABEL}")));
|
||||
};
|
||||
let (first_node, first_element) = fresh_labels(&s.model, mesh.points.len(), mesh.elements.len())?;
|
||||
|
||||
// Each block point: an existing node within `merge`, or a new label.
|
||||
let existing = joined(&s.model, &mesh.points, merge)?;
|
||||
let welded = weld(&s.model, &mesh.points, merge)?;
|
||||
let mut labels = Vec::with_capacity(mesh.points.len());
|
||||
let mut added = 0u32;
|
||||
for (i, xyz) in mesh.points.iter().enumerate() {
|
||||
match existing.get(i).copied().flatten() {
|
||||
Some(label) => labels.push(label),
|
||||
for (xyz, existing) in mesh.points.iter().zip(&welded) {
|
||||
let label = match existing {
|
||||
Some(label) => *label,
|
||||
None => {
|
||||
let label = first_node + added;
|
||||
s.model.set_node(label, *xyz)?;
|
||||
labels.push(label);
|
||||
added += 1;
|
||||
s.model.set_node(first_node + added - 1, *xyz)?;
|
||||
first_node + added - 1
|
||||
}
|
||||
}
|
||||
}
|
||||
let merged: BTreeSet<u32> = existing.iter().flatten().copied().collect();
|
||||
let elements: Vec<Vec<u32>> = mesh.elements.iter().map(|e| e.iter().map(|&i| labels.get(i as usize).copied().unwrap_or(0)).collect()).collect();
|
||||
if !merged.is_empty() {
|
||||
check_conforming(&s.model, kind, &mesh, &elements, &merged, merge)?;
|
||||
};
|
||||
labels.push(label);
|
||||
}
|
||||
let joined: BTreeSet<u32> = welded.iter().flatten().copied().collect();
|
||||
let label_of = |i: u32| labels.get(i as usize).copied().ok_or_else(|| EngineError::Params(format!("block point {i} has no node")));
|
||||
let elements: Vec<(ElementKind, Vec<u32>)> =
|
||||
mesh.elements.iter().map(|e| Ok((kind, e.iter().map(|&i| label_of(i)).collect::<Result<_>>()?))).collect::<Result<_>>()?;
|
||||
check_conforming(&s.model, &elements, &joined, merge)?;
|
||||
|
||||
let body_tag = s.model.geometry_tag(&body)?;
|
||||
for (i, nodes) in elements.into_iter().enumerate() {
|
||||
let label = first_element + i as u32;
|
||||
for (label, (_, nodes)) in (first_element..).zip(elements) {
|
||||
s.model.set_element(label, kind, nodes)?;
|
||||
s.model.tag_element(label, body_tag)?;
|
||||
}
|
||||
for (k, r) in &face_refs {
|
||||
let t = s.model.geometry_tag(r)?;
|
||||
for &(e, f, bf) in &mesh.faces {
|
||||
if usize::from(bf) == *k {
|
||||
s.model.tag_element_face(first_element + e, f, t)?;
|
||||
}
|
||||
}
|
||||
}
|
||||
for (k, r) in &edge_refs {
|
||||
let t = s.model.geometry_tag(r)?;
|
||||
for &(e, edge, be) in &mesh.edges {
|
||||
if usize::from(be) == *k {
|
||||
s.model.tag_element_edge(first_element + e, edge, t)?;
|
||||
for (refs, pieces, tag) in [
|
||||
(&face_refs, &mesh.faces, Model::tag_element_face as fn(&mut Model, u32, u8, u32) -> modelcraft_model::Result<()>),
|
||||
(&edge_refs, &mesh.edges, Model::tag_element_edge),
|
||||
] {
|
||||
for (k, r) in refs {
|
||||
let t = s.model.geometry_tag(r)?;
|
||||
for &(e, local, _) in pieces.iter().filter(|piece| usize::from(piece.2) == *k) {
|
||||
tag(&mut s.model, first_element + e, local, t)?;
|
||||
}
|
||||
}
|
||||
}
|
||||
for (k, r) in &vertex_refs {
|
||||
let t = s.model.geometry_tag(r)?;
|
||||
let node = mesh.corners.get(*k).and_then(|&i| labels.get(i as usize)).copied().unwrap_or(0);
|
||||
s.model.tag_node(node, t)?;
|
||||
let corner = mesh.corners.get(*k).copied().unwrap_or(u32::MAX);
|
||||
s.model.tag_node(label_of(corner)?, t)?;
|
||||
}
|
||||
Ok(json!({
|
||||
"body": p.body,
|
||||
@@ -182,158 +170,10 @@ fn block_mesh(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
"first_element": first_element,
|
||||
"nodes": added,
|
||||
"first_node": first_node,
|
||||
"joined": merged.len(),
|
||||
"joined": joined.len(),
|
||||
}))
|
||||
}
|
||||
|
||||
/// For each block point, the existing node within `merge` of it (the nearest; the lowest label
|
||||
/// on a tie). Two points may not join the same node.
|
||||
fn joined(model: &Model, points: &[[f64; 3]], merge: f64) -> Result<Vec<Option<u32>>> {
|
||||
if merge == 0.0 || model.nodes().is_empty() {
|
||||
return Ok(vec![None; points.len()]);
|
||||
}
|
||||
let cell = |x: f64| (x / merge).floor() as i64;
|
||||
let mut grid: BTreeMap<[i64; 3], Vec<(u32, [f64; 3])>> = BTreeMap::new();
|
||||
for (&label, node) in model.nodes() {
|
||||
grid.entry(node.xyz.map(cell)).or_default().push((label, node.xyz));
|
||||
}
|
||||
let mut out = Vec::with_capacity(points.len());
|
||||
let mut taken: BTreeMap<u32, usize> = BTreeMap::new();
|
||||
for (i, p) in points.iter().enumerate() {
|
||||
let c = p.map(cell);
|
||||
let mut best: Option<(f64, u32)> = None;
|
||||
for dx in -1..=1 {
|
||||
for dy in -1..=1 {
|
||||
for dz in -1..=1 {
|
||||
for &(label, xyz) in grid.get(&[c[0] + dx, c[1] + dy, c[2] + dz]).into_iter().flatten() {
|
||||
let d = ((xyz[0] - p[0]).powi(2) + (xyz[1] - p[1]).powi(2) + (xyz[2] - p[2]).powi(2)).sqrt();
|
||||
if d <= merge && best.is_none_or(|(bd, bl)| d < bd || (d == bd && label < bl)) {
|
||||
best = Some((d, label));
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if let Some((_, label)) = best
|
||||
&& let Some(other) = taken.insert(label, i)
|
||||
{
|
||||
return Err(EngineError::Params(format!(
|
||||
"block points {other} and {i} both lie within `merge` of node {label}: lower `merge` or refine the block"
|
||||
)));
|
||||
}
|
||||
out.push(best.map(|(_, l)| l));
|
||||
}
|
||||
Ok(out)
|
||||
}
|
||||
|
||||
/// Faces as sorted node lists.
|
||||
fn key(nodes: impl Iterator<Item = u32>) -> Vec<u32> {
|
||||
let mut k: Vec<u32> = nodes.collect();
|
||||
k.sort_unstable();
|
||||
k
|
||||
}
|
||||
|
||||
/// Where the block joins existing nodes it must meet the mesh face to face: an element face
|
||||
/// (of the block, or of the mesh) whose corners all landed on shared nodes must be a face of
|
||||
/// the other side too, with the same nodes (no mixed linear and quadratic sides); and no node on
|
||||
/// the block's boundary may lie on an edge of the mesh between two of its nodes, nor the other
|
||||
/// way round (no hanging nodes where the divisions differ). Edges are tested as straight
|
||||
/// segments, so a mismatch along a curved shared edge is caught only through its faces.
|
||||
fn check_conforming(model: &Model, kind: ElementKind, mesh: &BlockMesh, elements: &[Vec<u32>], merged: &BTreeSet<u32>, merge: f64) -> Result<()> {
|
||||
let refuse = |what: String| {
|
||||
Err(EngineError::Params(format!("{what}: the block must meet the mesh face to face, with the same divisions and element kind")))
|
||||
};
|
||||
let corners_of = |k: ElementKind, nodes: &[u32], local: &[usize]| -> Vec<u32> {
|
||||
key(local.iter().filter(|&&i| i < k.corner_count()).filter_map(|&i| nodes.get(i).copied()))
|
||||
};
|
||||
// The block's boundary faces, by sorted corners, with their full node lists.
|
||||
let mut new_faces: BTreeMap<Vec<u32>, Vec<u32>> = BTreeMap::new();
|
||||
for &(e, f, _) in &mesh.faces {
|
||||
let (Some(nodes), Some(local)) = (elements.get(e as usize), usize::from(f).checked_sub(1).and_then(|i| kind.faces().get(i))) else {
|
||||
continue;
|
||||
};
|
||||
new_faces.insert(corners_of(kind, nodes, local), key(local.iter().filter_map(|&i| nodes.get(i).copied())));
|
||||
}
|
||||
let mut old_faces: BTreeMap<Vec<u32>, Vec<u32>> = BTreeMap::new();
|
||||
let mut old_edges: BTreeSet<[u32; 2]> = BTreeSet::new();
|
||||
for e in model.elements().values().filter(|e| e.nodes.iter().any(|n| merged.contains(n))) {
|
||||
for local in e.kind.faces() {
|
||||
old_faces.insert(corners_of(e.kind, &e.nodes, local), key(local.iter().filter_map(|&i| e.nodes.get(i).copied())));
|
||||
}
|
||||
}
|
||||
for (corners, nodes) in &new_faces {
|
||||
if corners.iter().all(|n| merged.contains(n)) && old_faces.get(corners) != Some(nodes) {
|
||||
return refuse(format!("the block face on nodes {corners:?} lies on existing nodes but is no element face there"));
|
||||
}
|
||||
}
|
||||
for (corners, nodes) in &old_faces {
|
||||
if corners.iter().all(|n| merged.contains(n)) && new_faces.get(corners) != Some(nodes) {
|
||||
return refuse(format!("the element face on nodes {corners:?} lies on the block but no block element shares it"));
|
||||
}
|
||||
}
|
||||
// Hanging nodes: boundary nodes of either side on the other side's element edges.
|
||||
let xyz = |label: u32| model.node(label).map(|n| n.xyz);
|
||||
let block_points: BTreeMap<u32, [f64; 3]> = mesh
|
||||
.elements
|
||||
.iter()
|
||||
.zip(elements)
|
||||
.flat_map(|(pts, labels)| pts.iter().zip(labels).filter_map(|(&p, &l)| Some((l, *mesh.points.get(p as usize)?))))
|
||||
.collect();
|
||||
let mut new_edges: BTreeSet<[u32; 2]> = BTreeSet::new();
|
||||
for &(e, f, _) in &mesh.faces {
|
||||
let (Some(nodes), Some(local)) = (elements.get(e as usize), usize::from(f).checked_sub(1).and_then(|i| kind.faces().get(i))) else {
|
||||
continue;
|
||||
};
|
||||
let cs: Vec<u32> = local.iter().filter(|&&i| i < kind.corner_count()).filter_map(|&i| nodes.get(i).copied()).collect();
|
||||
for (i, &a) in cs.iter().enumerate() {
|
||||
let b = cs.get((i + 1) % cs.len()).copied().unwrap_or(a);
|
||||
new_edges.insert(if a < b { [a, b] } else { [b, a] });
|
||||
}
|
||||
}
|
||||
for e in model.elements().values().filter(|e| e.nodes.iter().any(|n| merged.contains(n))) {
|
||||
for local in e.kind.edges() {
|
||||
if let (Some(&a), Some(&b)) = (local.first().and_then(|&i| e.nodes.get(i)), local.get(1).and_then(|&i| e.nodes.get(i))) {
|
||||
old_edges.insert(if a < b { [a, b] } else { [b, a] });
|
||||
}
|
||||
}
|
||||
}
|
||||
let new_boundary: BTreeSet<u32> = new_faces.values().flatten().copied().filter(|n| !merged.contains(n)).collect();
|
||||
let on_segment = |p: [f64; 3], a: [f64; 3], b: [f64; 3]| {
|
||||
let ab = [b[0] - a[0], b[1] - a[1], b[2] - a[2]];
|
||||
let ap = [p[0] - a[0], p[1] - a[1], p[2] - a[2]];
|
||||
let len2 = ab[0] * ab[0] + ab[1] * ab[1] + ab[2] * ab[2];
|
||||
if !(len2 > 0.0) {
|
||||
return false;
|
||||
}
|
||||
let t = (ap[0] * ab[0] + ap[1] * ab[1] + ap[2] * ab[2]) / len2;
|
||||
let d = [ap[0] - t * ab[0], ap[1] - t * ab[1], ap[2] - t * ab[2]];
|
||||
let tol = merge / len2.sqrt();
|
||||
t > tol && t < 1.0 - tol && (d[0] * d[0] + d[1] * d[1] + d[2] * d[2]).sqrt() <= merge
|
||||
};
|
||||
for &n in &new_boundary {
|
||||
let Some(&p) = block_points.get(&n) else { continue };
|
||||
for [a, b] in &old_edges {
|
||||
if let (Some(xa), Some(xb)) = (xyz(*a), xyz(*b))
|
||||
&& on_segment(p, xa, xb)
|
||||
{
|
||||
return refuse(format!("a block node at {p:?} lies on the edge between nodes {a} and {b}"));
|
||||
}
|
||||
}
|
||||
}
|
||||
let old_nodes: BTreeSet<u32> = old_faces.values().flatten().copied().filter(|n| !merged.contains(n)).collect();
|
||||
for n in old_nodes {
|
||||
let Some(p) = xyz(n) else { continue };
|
||||
for [a, b] in &new_edges {
|
||||
if let (Some(&xa), Some(&xb)) = (block_points.get(a), block_points.get(b))
|
||||
&& on_segment(p, xa, xb)
|
||||
{
|
||||
return refuse(format!("node {n} at {p:?} lies on a block edge"));
|
||||
}
|
||||
}
|
||||
}
|
||||
Ok(())
|
||||
}
|
||||
|
||||
#[cfg(test)]
|
||||
mod tests {
|
||||
use serde_json::json;
|
||||
|
||||
@@ -6,7 +6,7 @@ use modelcraft_mesh::cdt::{CdtOptions, tetrahedralize};
|
||||
use modelcraft_mesh::delaunay::Triangulation;
|
||||
use modelcraft_mesh::quality::{self, QualityReport};
|
||||
use modelcraft_mesh::surface::{BoundarySurface, Defect, FeatureKind, SurfaceOptions};
|
||||
use modelcraft_model::{ElementKind, GeometryRef, MAX_ELEMENTS, MAX_LABEL};
|
||||
use modelcraft_model::{ElementKind, GeometryRef, MAX_ELEMENTS};
|
||||
use serde_json::{Value, json};
|
||||
|
||||
use super::{label, labels, listed, optional_number, points, xyz};
|
||||
@@ -88,17 +88,6 @@ pub const TET_GENERATE: CommandSpec = CommandSpec {
|
||||
run: tet_generate,
|
||||
};
|
||||
|
||||
/// The first node and element labels of a mesh of `nodes` nodes and `elements` elements added
|
||||
/// after the model's largest labels, or an error when the labels would pass [`MAX_LABEL`].
|
||||
fn next_labels(s: &Session, nodes: usize, elements: usize) -> Result<(u32, u32)> {
|
||||
let next = |last: Option<u32>| last.map_or(Some(1), |l| l.checked_add(1));
|
||||
let fits = |first: Option<u32>, count: usize| first.filter(|&f| u64::from(f) + count as u64 - 1 <= u64::from(MAX_LABEL));
|
||||
match (fits(next(s.model.nodes().keys().next_back().copied()), nodes), fits(next(s.model.elements().keys().next_back().copied()), elements)) {
|
||||
(Some(n), Some(e)) => Ok((n, e)),
|
||||
_ => Err(EngineError::Params(format!("the mesh needs labels beyond {MAX_LABEL}"))),
|
||||
}
|
||||
}
|
||||
|
||||
/// The most Steiner points and tetrahedra `mesh.tet.generate` may be asked for.
|
||||
const TET_MAX_STEINER: u64 = 10_000_000;
|
||||
const TET_MAX_TETS: u64 = 50_000_000;
|
||||
@@ -138,7 +127,7 @@ fn tet_generate(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
let cdt = tetrahedralize(&surface, &cdt_options)?;
|
||||
let gate = cdt.gate(surface.volume())?.into_result()?;
|
||||
|
||||
let (first_node, first_element) = next_labels(s, cdt.points.len(), cdt.tets.len())?;
|
||||
let (first_node, first_element) = super::fresh_labels(&s.model, cdt.points.len(), cdt.tets.len())?;
|
||||
for (i, xyz) in cdt.points.iter().enumerate() {
|
||||
s.model.set_node(first_node + i as u32, *xyz)?;
|
||||
}
|
||||
@@ -274,7 +263,7 @@ fn planar(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
};
|
||||
let m = mesh_region(&loops, kind, size, &opts)?;
|
||||
|
||||
let (first_node, first_element) = next_labels(s, m.nodes.len(), m.elements.len())?;
|
||||
let (first_node, first_element) = super::fresh_labels(&s.model, m.nodes.len(), m.elements.len())?;
|
||||
for (i, xy) in m.nodes.iter().enumerate() {
|
||||
s.model.set_node(first_node + i as u32, [xy[0], xy[1], 0.0])?;
|
||||
}
|
||||
|
||||
@@ -109,6 +109,19 @@ pub(crate) fn label(p: &Value, key: &str) -> Result<u32> {
|
||||
.ok_or_else(|| EngineError::Params(format!("`{key}` must be a positive whole number")))
|
||||
}
|
||||
|
||||
/// The first node and element labels after the model's largest, for `nodes` new nodes and
|
||||
/// `elements` new elements, all within [`MAX_LABEL`].
|
||||
pub(crate) fn fresh_labels(model: &modelcraft_model::Model, nodes: usize, elements: usize) -> Result<(u32, u32)> {
|
||||
let first = |last: Option<&u32>, count: usize| {
|
||||
let first = last.map_or(Some(1), |l| l.checked_add(1))?;
|
||||
(u64::from(first) + count as u64 <= u64::from(MAX_LABEL) + 1).then_some(first)
|
||||
};
|
||||
match (first(model.nodes().keys().next_back(), nodes), first(model.elements().keys().next_back(), elements)) {
|
||||
(Some(n), Some(e)) => Ok((n, e)),
|
||||
_ => Err(EngineError::Params(format!("the mesh needs labels beyond {MAX_LABEL}"))),
|
||||
}
|
||||
}
|
||||
|
||||
/// A required `[x, y, z]` parameter.
|
||||
pub(crate) fn xyz(p: &Value, key: &str) -> Result<[f64; 3]> {
|
||||
p.get(key).and_then(xyz_value).ok_or_else(|| EngineError::Params(format!("`{key}` must be [x, y, z]")))
|
||||
|
||||
@@ -353,7 +353,7 @@ fn probe(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
(None, Some(_)) => {
|
||||
let at = points(p, "at", MAX_PROBE)?;
|
||||
let found = nearest_nodes(&s.model, result.nodes(), &at)?;
|
||||
(found.iter().map(|(l, _)| *l).collect(), Some(found))
|
||||
(found.iter().map(|(l, _, _)| *l).collect(), Some(found))
|
||||
}
|
||||
(None, None) if matches!(result.as_ref(), StepResult::Explicit(_)) => (Vec::new(), None),
|
||||
_ => return Err(EngineError::Params("give either `nodes` or `at`".into())),
|
||||
@@ -367,9 +367,9 @@ fn probe(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
StepResult::Fluid(r) => probe_fluid(r, p)?,
|
||||
};
|
||||
if let (Some(found), Some(entries)) = (located, out.get_mut("nodes").and_then(Value::as_array_mut)) {
|
||||
for (entry, (label, distance)) in entries.iter_mut().zip(found) {
|
||||
for (entry, (_, xyz, distance)) in entries.iter_mut().zip(found) {
|
||||
if let Some(obj) = entry.as_object_mut() {
|
||||
obj.insert("xyz".into(), json!(s.model.node(label).map(|n| n.xyz)));
|
||||
obj.insert("xyz".into(), json!(xyz));
|
||||
obj.insert("distance".into(), json!(distance));
|
||||
}
|
||||
}
|
||||
@@ -377,16 +377,15 @@ fn probe(s: &mut Session, p: &Value) -> Result<Value> {
|
||||
Ok(out)
|
||||
}
|
||||
|
||||
/// The node with a result nearest to each point (lowest label on a tie), and its distance.
|
||||
fn nearest_nodes(model: &modelcraft_model::Model, with_result: &[u32], at: &[[f64; 3]]) -> Result<Vec<(u32, f64)>> {
|
||||
/// The node with a result nearest to each point (lowest label on a tie), where it is and how far.
|
||||
fn nearest_nodes(model: &modelcraft_model::Model, with_result: &[u32], at: &[[f64; 3]]) -> Result<Vec<(u32, [f64; 3], f64)>> {
|
||||
let candidates: Vec<(u32, [f64; 3])> = with_result.iter().filter_map(|&l| Some((l, model.node(l)?.xyz))).collect();
|
||||
at.iter()
|
||||
.map(|p| {
|
||||
with_result
|
||||
candidates
|
||||
.iter()
|
||||
.filter_map(|&l| {
|
||||
model.node(l).map(|n| (l, ((n.xyz[0] - p[0]).powi(2) + (n.xyz[1] - p[1]).powi(2) + (n.xyz[2] - p[2]).powi(2)).sqrt()))
|
||||
})
|
||||
.fold(None, |best: Option<(u32, f64)>, (l, d)| if best.is_none_or(|(_, bd)| d < bd) { Some((l, d)) } else { best })
|
||||
.map(|&(l, x)| (l, x, ((x[0] - p[0]).powi(2) + (x[1] - p[1]).powi(2) + (x[2] - p[2]).powi(2)).sqrt()))
|
||||
.min_by(|a, b| a.2.total_cmp(&b.2))
|
||||
.ok_or_else(|| EngineError::Params("the result has no nodes to probe".into()))
|
||||
})
|
||||
.collect()
|
||||
|
||||
Reference in new issue
Block a user