refactor(drawing/drawing): Move infringement and collision detection to drawing/query

This commit is contained in:
Mikolaj Wielgus 2025-08-25 02:23:02 +02:00
parent ca4a2d1cbf
commit 310e983b1d
8 changed files with 184 additions and 168 deletions

View File

@ -188,7 +188,7 @@ impl<M: AccessMesadata> Step<Autorouter<M>, Option<BoardEdit>, AutorouteContinue
.board .board
.layout() .layout()
.drawing() .drawing()
.loose_band_uid(band_termseg.into()) .find_loose_band_uid(band_termseg.into())
.expect("a completely routed band should've Seg's as ends"); .expect("a completely routed band should've Seg's as ends");
autorouter.ratsnest.assign_band_termseg_to_ratline( autorouter.ratsnest.assign_band_termseg_to_ratline(

View File

@ -122,7 +122,10 @@ impl BandSelector {
_ => return None, _ => return None,
}; };
Self::try_from_uid(board, &board.layout().drawing().loose_band_uid(loose).ok()?) Self::try_from_uid(
board,
&board.layout().drawing().find_loose_band_uid(loose).ok()?,
)
} }
pub fn try_from_uid( pub fn try_from_uid(

View File

@ -65,7 +65,7 @@ impl<'a> ResolvedSelector<'a> {
} else { } else {
loose.and_then(|loose| { loose.and_then(|loose| {
Some(ResolvedSelector::Band { Some(ResolvedSelector::Band {
band_uid: board.layout().drawing().loose_band_uid(loose).ok()?, band_uid: board.layout().drawing().find_loose_band_uid(loose).ok()?,
}) })
}) })
} }

View File

@ -23,7 +23,7 @@ use crate::{
primitive::{ primitive::{
GenericPrimitive, GetCore, GetJoints, GetLimbs, GetOtherJoint, MakePrimitiveShape, GenericPrimitive, GetCore, GetJoints, GetLimbs, GetOtherJoint, MakePrimitiveShape,
}, },
rules::{AccessRules, GetConditions}, rules::AccessRules,
seg::{ seg::{
FixedSegIndex, FixedSegWeight, LoneLooseSegIndex, LoneLooseSegWeight, SegIndex, FixedSegIndex, FixedSegWeight, LoneLooseSegIndex, LoneLooseSegWeight, SegIndex,
SegWeight, SeqLooseSegIndex, SeqLooseSegWeight, SegWeight, SeqLooseSegIndex, SeqLooseSegWeight,
@ -31,7 +31,7 @@ use crate::{
}, },
geometry::{ geometry::{
edit::{ApplyGeometryEdit, GeometryEdit}, edit::{ApplyGeometryEdit, GeometryEdit},
primitive::{AccessPrimitiveShape, PrimitiveShape}, primitive::PrimitiveShape,
recording_with_rtree::RecordingGeometryWithRtree, recording_with_rtree::RecordingGeometryWithRtree,
with_rtree::BboxedIndex, with_rtree::BboxedIndex,
AccessBendWeight, AccessDotWeight, AccessSegWeight, GenericNode, Geometry, GeometryLabel, AccessBendWeight, AccessDotWeight, AccessSegWeight, GenericNode, Geometry, GeometryLabel,
@ -751,7 +751,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
(from, to, offset) (from, to, offset)
}; };
let rail_outer_bows = self.bend_outward_bows(rail); let rail_outer_bows = self.collect_bend_outward_bows(rail);
// Commenting out these two makes the crash go away. // Commenting out these two makes the crash go away.
self.move_dot_with_infringement_filtering( self.move_dot_with_infringement_filtering(
@ -950,7 +950,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
.move_dot(recorder, dot, to); .move_dot(recorder, dot, to);
for limb in dot.primitive(self).limbs() { for limb in dot.primitive(self).limbs() {
if let Some(infringement) = self.detect_infringement_except(limb, predicate) { if let Some(infringement) = self.find_infringement_except(limb, predicate) {
// Restore previous state. // Restore previous state.
self.recording_geometry_with_rtree self.recording_geometry_with_rtree
.move_dot(recorder, dot, old_pos); .move_dot(recorder, dot, old_pos);
@ -958,7 +958,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
} }
} }
if let Some(infringement) = self.detect_infringement_except(dot.into(), predicate) { if let Some(infringement) = self.find_infringement_except(dot.into(), predicate) {
// Restore previous state. // Restore previous state.
self.recording_geometry_with_rtree self.recording_geometry_with_rtree
.move_dot(recorder, dot, old_pos); .move_dot(recorder, dot, old_pos);
@ -985,7 +985,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
self.recording_geometry_with_rtree self.recording_geometry_with_rtree
.shift_bend(recorder, bend, offset); .shift_bend(recorder, bend, offset);
if let Some(infringement) = self.detect_infringement_except(bend.into(), predicate) { if let Some(infringement) = self.find_infringement_except(bend.into(), predicate) {
// Restore previous state. // Restore previous state.
self.recording_geometry_with_rtree self.recording_geometry_with_rtree
.shift_bend(recorder, bend, old_offset); .shift_bend(recorder, bend, old_offset);
@ -1068,7 +1068,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
node: PrimitiveIndex, node: PrimitiveIndex,
predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool, predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool,
) -> Result<(), Infringement> { ) -> Result<(), Infringement> {
if let Some(infringement) = self.detect_infringement_except(node, predicate) { if let Some(infringement) = self.find_infringement_except(node, predicate) {
if let Ok(dot) = node.try_into() { if let Ok(dot) = node.try_into() {
self.recording_geometry_with_rtree.remove_dot(recorder, dot); self.recording_geometry_with_rtree.remove_dot(recorder, dot);
} else if let Ok(seg) = node.try_into() { } else if let Ok(seg) = node.try_into() {
@ -1082,114 +1082,6 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
Ok(()) Ok(())
} }
fn detect_infringement_except(
&self,
infringer: PrimitiveIndex,
predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool,
) -> Option<Infringement> {
self.find_infringement(
infringer,
self.locate_possible_infringees(infringer)
.filter_map(|infringee_node| {
if let GenericNode::Primitive(primitive_node) = infringee_node {
Some(primitive_node)
} else {
None
}
})
.filter(|infringee| predicate(&self, infringer, *infringee)),
)
}
fn locate_possible_infringees(
&self,
node: PrimitiveIndex,
) -> impl Iterator<Item = GenericNode<PrimitiveIndex, GenericIndex<CW>>> + '_ {
let limiting_shape = node.primitive(self).shape().inflate(
node.primitive(self)
.maybe_net()
.map(|net| self.rules.largest_clearance(Some(net)))
.unwrap_or(0.0),
);
self.recording_geometry_with_rtree
.rtree()
.locate_in_envelope_intersecting(
&limiting_shape.envelope_3d(0.0, node.primitive(self).layer()),
)
.map(|wrapper| wrapper.data)
}
fn find_infringement(
&self,
infringer: PrimitiveIndex,
it: impl Iterator<Item = PrimitiveIndex>,
) -> Option<Infringement> {
let mut inflated_shape = infringer.primitive(self).shape(); // Unused temporary value just for initialization.
let conditions = infringer.primitive(self).conditions();
it.filter(|infringee| {
// Infringement with loose dots resulted in false positives for
// line-of-sight paths.
!matches!(infringer, PrimitiveIndex::LooseDot(..))
&& !matches!(infringee, PrimitiveIndex::LooseDot(..))
})
.filter(|infringee| !self.are_connectable(infringer, *infringee))
.find_map(|primitive_node| {
let infringee_conditions = primitive_node.primitive(self).conditions();
let epsilon = 1.0;
inflated_shape = infringer.primitive(self).shape().inflate(
match (&conditions, infringee_conditions) {
(None, _) | (_, None) => 0.0,
(Some(lhs), Some(rhs)) => {
// Note the epsilon comparison.
// XXX: Epsilon is probably too large. But what should
// it be exactly then?
(self.rules.clearance(lhs, &rhs) - epsilon).clamp(0.0, f64::INFINITY)
}
},
);
inflated_shape
.intersects(&primitive_node.primitive(self).shape())
.then_some(Infringement(inflated_shape, primitive_node))
})
}
fn detect_collision_except(
&self,
collider: PrimitiveIndex,
predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool,
) -> Option<Collision> {
let shape = collider.primitive(self).shape();
self.recording_geometry_with_rtree
.rtree()
.locate_in_envelope_intersecting(&shape.full_height_envelope_3d(0.0, 2))
.filter_map(|wrapper| {
if let GenericNode::Primitive(collidee) = wrapper.data {
Some(collidee)
} else {
None
}
})
// NOTE: Collisions can happen between two same-net loose
// segs, so these cases in particular are not filtered out
// here, unlike what is done in infringement code.
.filter(|&collidee| collider != collidee)
.filter(|&collidee| {
!self.are_connectable(collider, collidee)
|| ((matches!(collider, PrimitiveIndex::LoneLooseSeg(..))
|| matches!(collider, PrimitiveIndex::SeqLooseSeg(..)))
&& (matches!(collidee, PrimitiveIndex::LoneLooseSeg(..))
|| matches!(collidee, PrimitiveIndex::SeqLooseSeg(..))))
})
.filter(|collidee| predicate(&self, collider, *collidee))
.find(|collidee| shape.intersects(&collidee.primitive(self).shape()))
.map(|collidee| Collision(shape, collidee))
}
pub fn primitive_nodes(&self) -> impl Iterator<Item = PrimitiveIndex> + '_ { pub fn primitive_nodes(&self) -> impl Iterator<Item = PrimitiveIndex> + '_ {
self.recording_geometry_with_rtree self.recording_geometry_with_rtree
.rtree() .rtree()
@ -1253,17 +1145,6 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
} }
} }
fn are_connectable(&self, node1: PrimitiveIndex, node2: PrimitiveIndex) -> bool {
if let (Some(node1_net), Some(node2_net)) = (
node1.primitive(self).maybe_net(),
node2.primitive(self).maybe_net(),
) {
node1_net == node2_net
} else {
true
}
}
fn test_if_looses_dont_infringe_each_other(&self) -> bool { fn test_if_looses_dont_infringe_each_other(&self) -> bool {
!self !self
.primitive_nodes() .primitive_nodes()
@ -1277,7 +1158,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
) )
}) })
.any(|node| { .any(|node| {
self.find_infringement( self.infringements_among(
node, node,
self.locate_possible_infringees(node) self.locate_possible_infringees(node)
.filter_map(|n| { .filter_map(|n| {
@ -1297,6 +1178,7 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
) )
}), }),
) )
.next()
.is_some() .is_some()
}) })
} }

View File

@ -3,6 +3,17 @@
// SPDX-License-Identifier: MIT // SPDX-License-Identifier: MIT
use petgraph::visit::Walker; use petgraph::visit::Walker;
use specctra_core::rules::GetConditions;
use crate::{
drawing::{
graph::{GetMaybeNet, MakePrimitive},
primitive::MakePrimitiveShape,
Collision, Infringement,
},
geometry::{primitive::AccessPrimitiveShape, GenericNode, GetLayer},
graph::GenericIndex,
};
use super::{ use super::{
band::{BandTermsegIndex, BandUid}, band::{BandTermsegIndex, BandUid},
@ -24,10 +35,10 @@ pub struct BandUidError {
/// Routines implementing various queries on drawing. A query is a routine that /// Routines implementing various queries on drawing. A query is a routine that
/// returns indices of one or more primitives. /// returns indices of one or more primitives.
impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> { impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
pub fn loose_band_uid(&self, start_loose: LooseIndex) -> Result<BandUid, BandUidError> { pub fn find_loose_band_uid(&self, start_loose: LooseIndex) -> Result<BandUid, BandUidError> {
match ( match (
self.loose_band_first_seg(start_loose), self.find_loose_band_first_seg(start_loose),
self.loose_band_last_seg(start_loose), self.find_loose_band_last_seg(start_loose),
) { ) {
(Some(first), Some(last)) => Ok(BandUid::from((first, last))), (Some(first), Some(last)) => Ok(BandUid::from((first, last))),
(Some(x), None) | (None, Some(x)) => Err(BandUidError { maybe_end: Some(x) }), (Some(x), None) | (None, Some(x)) => Err(BandUidError { maybe_end: Some(x) }),
@ -35,18 +46,54 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
} }
} }
pub fn bend_outward_bows(&self, bend: LooseBendIndex) -> Vec<PrimitiveIndex> { fn find_loose_band_first_seg(&self, start_loose: LooseIndex) -> Option<BandTermsegIndex> {
if let LooseIndex::LoneSeg(seg) = start_loose {
return Some(BandTermsegIndex::Lone(seg));
}
let mut loose = start_loose;
let mut prev = None;
loop {
if let Some(next_loose) = self.loose(loose).prev_loose(prev) {
prev = Some(loose);
loose = next_loose;
} else {
return loose.try_into().ok();
}
}
}
fn find_loose_band_last_seg(&self, start_loose: LooseIndex) -> Option<BandTermsegIndex> {
if let LooseIndex::LoneSeg(seg) = start_loose {
return Some(BandTermsegIndex::Lone(seg));
}
let mut loose = start_loose;
let mut next = None;
loop {
if let Some(prev_loose) = self.loose(loose).next_loose(next) {
next = Some(loose);
loose = prev_loose;
} else {
return loose.try_into().ok();
}
}
}
pub fn collect_bend_outward_bows(&self, bend: LooseBendIndex) -> Vec<PrimitiveIndex> {
let mut v = vec![]; let mut v = vec![];
let mut outwards = self.primitive(bend).outwards(); let mut outwards = self.primitive(bend).outwards();
while let Some(next) = outwards.walk_next(self) { while let Some(next) = outwards.walk_next(self) {
v.append(&mut self.bend_bow(next)); v.append(&mut self.collect_bend_bow(next));
} }
v v
} }
fn bend_bow(&self, bend: LooseBendIndex) -> Vec<PrimitiveIndex> { fn collect_bend_bow(&self, bend: LooseBendIndex) -> Vec<PrimitiveIndex> {
let mut v: Vec<PrimitiveIndex> = vec![]; let mut v: Vec<PrimitiveIndex> = vec![];
v.push(bend.into()); v.push(bend.into());
@ -65,39 +112,123 @@ impl<CW: Clone, Cel: Copy, R: AccessRules> Drawing<CW, Cel, R> {
v v
} }
fn loose_band_first_seg(&self, start_loose: LooseIndex) -> Option<BandTermsegIndex> { pub(super) fn find_infringement_except(
if let LooseIndex::LoneSeg(seg) = start_loose { &self,
return Some(BandTermsegIndex::Lone(seg)); infringer: PrimitiveIndex,
} predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool,
) -> Option<Infringement> {
let mut loose = start_loose; self.infringements_among(
let mut prev = None; infringer,
self.locate_possible_infringees(infringer)
loop { .filter_map(|infringee_node| {
if let Some(next_loose) = self.loose(loose).prev_loose(prev) { if let GenericNode::Primitive(primitive_node) = infringee_node {
prev = Some(loose); Some(primitive_node)
loose = next_loose; } else {
} else { None
return loose.try_into().ok(); }
} })
} .filter(|infringee| predicate(&self, infringer, *infringee)),
)
.next()
} }
fn loose_band_last_seg(&self, start_loose: LooseIndex) -> Option<BandTermsegIndex> { pub(super) fn infringements_among<'a>(
if let LooseIndex::LoneSeg(seg) = start_loose { &'a self,
return Some(BandTermsegIndex::Lone(seg)); infringer: PrimitiveIndex,
} it: impl Iterator<Item = PrimitiveIndex> + 'a,
) -> impl Iterator<Item = Infringement> + 'a {
let mut inflated_shape = infringer.primitive(self).shape(); // Unused temporary value just for initialization.
let conditions = infringer.primitive(self).conditions();
let mut loose = start_loose; it.filter(move |infringee| {
let mut next = None; // Infringement with loose dots resulted in false positives for
// line-of-sight paths.
!matches!(infringer, PrimitiveIndex::LooseDot(..))
&& !matches!(infringee, PrimitiveIndex::LooseDot(..))
})
.filter(move |infringee| !self.are_connectable(infringer, *infringee))
.filter_map(move |primitive_node| {
let infringee_conditions = primitive_node.primitive(self).conditions();
loop { let epsilon = 1.0;
if let Some(prev_loose) = self.loose(loose).next_loose(next) { inflated_shape = infringer.primitive(self).shape().inflate(
next = Some(loose); match (&conditions, infringee_conditions) {
loose = prev_loose; (None, _) | (_, None) => 0.0,
} else { (Some(lhs), Some(rhs)) => {
return loose.try_into().ok(); // Note the epsilon comparison.
} // XXX: Epsilon is probably too large. But what should
// it be exactly then?
(self.rules().clearance(lhs, &rhs) - epsilon).clamp(0.0, f64::INFINITY)
}
},
);
inflated_shape
.intersects(&primitive_node.primitive(self).shape())
.then_some(Infringement(inflated_shape, primitive_node))
})
}
pub(super) fn locate_possible_infringees(
&self,
node: PrimitiveIndex,
) -> impl Iterator<Item = GenericNode<PrimitiveIndex, GenericIndex<CW>>> + '_ {
let limiting_shape = node.primitive(self).shape().inflate(
node.primitive(self)
.maybe_net()
.map(|net| self.rules().largest_clearance(Some(net)))
.unwrap_or(0.0),
);
self.recording_geometry_with_rtree()
.rtree()
.locate_in_envelope_intersecting(
&limiting_shape.envelope_3d(0.0, node.primitive(self).layer()),
)
.map(|wrapper| wrapper.data)
}
pub(super) fn detect_collision_except(
&self,
collider: PrimitiveIndex,
predicate: &impl Fn(&Self, PrimitiveIndex, PrimitiveIndex) -> bool,
) -> Option<Collision> {
let shape = collider.primitive(self).shape();
self.recording_geometry_with_rtree()
.rtree()
.locate_in_envelope_intersecting(&shape.full_height_envelope_3d(0.0, 2))
.filter_map(|wrapper| {
if let GenericNode::Primitive(collidee) = wrapper.data {
Some(collidee)
} else {
None
}
})
// NOTE: Collisions can happen between two same-net loose
// segs, so these cases in particular are not filtered out
// here, unlike what is done in infringement code.
.filter(|&collidee| collider != collidee)
.filter(|&collidee| {
!self.are_connectable(collider, collidee)
|| ((matches!(collider, PrimitiveIndex::LoneLooseSeg(..))
|| matches!(collider, PrimitiveIndex::SeqLooseSeg(..)))
&& (matches!(collidee, PrimitiveIndex::LoneLooseSeg(..))
|| matches!(collidee, PrimitiveIndex::SeqLooseSeg(..))))
})
.filter(|collidee| predicate(&self, collider, *collidee))
.find(|collidee| shape.intersects(&collidee.primitive(self).shape()))
.map(|collidee| Collision(shape, collidee))
}
fn are_connectable(&self, node1: PrimitiveIndex, node2: PrimitiveIndex) -> bool {
if let (Some(node1_net), Some(node2_net)) = (
node1.primitive(self).maybe_net(),
node2.primitive(self).maybe_net(),
) {
node1_net == node2_net
} else {
true
} }
} }
} }

View File

@ -74,7 +74,7 @@ impl<R: AccessRules> Layout<R> {
(loose, shape) (loose, shape)
}) })
.filter_map(move |(loose, shape)| { .filter_map(move |(loose, shape)| {
let band_uid = self.drawing.loose_band_uid(loose).ok()?; let band_uid = self.drawing.find_loose_band_uid(loose).ok()?;
let loose_hline = orig_hline.orthogonal_through(&match shape { let loose_hline = orig_hline.orthogonal_through(&match shape {
PrimitiveShape::Seg(seg) => { PrimitiveShape::Seg(seg) => {
let seg_hline = LineInGeneralForm::from(seg.middle_line()); let seg_hline = LineInGeneralForm::from(seg.middle_line());

View File

@ -167,7 +167,7 @@ impl AstarContext {
sub.label.clone(), sub.label.clone(),
layout layout
.drawing() .drawing()
.loose_band_uid(fin.into()) .find_loose_band_uid(fin.into())
.expect("a completely routed band should've Seg's as ends"), .expect("a completely routed band should've Seg's as ends"),
); );
Ok(( Ok((

View File

@ -583,7 +583,7 @@ fn cane_around<R: AccessRules>(
.all_rails(core.petgraph_index()) .all_rails(core.petgraph_index())
.filter_map(|bi| { .filter_map(|bi| {
if let BendIndex::Loose(lbi) = bi { if let BendIndex::Loose(lbi) = bi {
if layout.drawing().loose_band_uid(lbi.into()).ok() == Some(inner) { if layout.drawing().find_loose_band_uid(lbi.into()).ok() == Some(inner) {
Some(lbi) Some(lbi)
} else { } else {
None None