Skip to main content

tess2_rust/mesh/
mod.rs

1// Copyright 2025 Lars Brubaker
2// License: SGI Free Software License B (MIT-compatible)
3//
4// Port of libtess2 mesh.c/h
5//
6// The mesh is a half-edge data structure (similar to Guibas/Stolfi quad-edge).
7// All pointers from the C code are replaced with u32 indices into Vec arenas.
8//
9// Design:
10//   - INVALID: u32::MAX  (null pointer equivalent)
11//   - Half-edges allocated in pairs: edges[i] and edges[i^1] are always a pair.
12//     sym(e) = e ^ 1.  Even index = e, odd index = eSym.
13//   - Sentinel/dummy nodes:
14//     - verts[0] = vHead (dummy vertex)
15//     - faces[0] = fHead (dummy face)
16//     - edges[0] = eHead, edges[1] = eHeadSym (dummy edge pair)
17
18mod delaunay;
19
20use crate::geom::{vert_ccw, Real};
21
22pub const INVALID: u32 = u32::MAX;
23
24/// Index into Mesh::verts
25pub type VertIdx = u32;
26/// Index into Mesh::faces
27pub type FaceIdx = u32;
28/// Index into Mesh::edges
29pub type EdgeIdx = u32;
30
31/// Compute the symmetric half-edge index (always the other half of the pair).
32#[inline(always)]
33pub fn sym(e: EdgeIdx) -> EdgeIdx {
34    e ^ 1
35}
36
37#[derive(Clone, Debug)]
38pub struct Vertex {
39    pub next: VertIdx,
40    pub prev: VertIdx,
41    pub an_edge: EdgeIdx,
42    pub coords: [Real; 3],
43    pub s: Real,
44    pub t: Real,
45    pub pq_handle: i32,
46    pub n: u32,
47    pub idx: u32,
48}
49
50impl Default for Vertex {
51    fn default() -> Self {
52        Self {
53            next: INVALID,
54            prev: INVALID,
55            an_edge: INVALID,
56            coords: [0.0; 3],
57            s: 0.0,
58            t: 0.0,
59            pq_handle: 0,
60            n: INVALID,
61            idx: INVALID,
62        }
63    }
64}
65
66#[derive(Clone, Debug)]
67pub struct Face {
68    pub next: FaceIdx,
69    pub prev: FaceIdx,
70    pub an_edge: EdgeIdx,
71    pub trail: FaceIdx,
72    pub n: u32,
73    pub marked: bool,
74    pub inside: bool,
75}
76
77impl Default for Face {
78    fn default() -> Self {
79        Self {
80            next: INVALID,
81            prev: INVALID,
82            an_edge: INVALID,
83            trail: INVALID,
84            n: INVALID,
85            marked: false,
86            inside: false,
87        }
88    }
89}
90
91#[derive(Clone, Debug)]
92pub struct HalfEdge {
93    /// Next in the global edge list (even-indexed edges link to even-indexed edges,
94    /// odd-indexed edges link to odd-indexed edges).
95    pub next: EdgeIdx,
96    /// Next edge CCW around the origin vertex.
97    pub onext: EdgeIdx,
98    /// Next edge CCW around the left face.
99    pub lnext: EdgeIdx,
100    /// Origin vertex index.
101    pub org: VertIdx,
102    /// Left face index.
103    pub lface: FaceIdx,
104    /// Active region index (INVALID if not in the edge dictionary).
105    pub active_region: u32,
106    /// Winding number change when crossing this edge.
107    pub winding: i32,
108    /// Used by edge flip (Delaunay refinement).
109    pub mark: bool,
110}
111
112impl Default for HalfEdge {
113    fn default() -> Self {
114        Self {
115            next: INVALID,
116            onext: INVALID,
117            lnext: INVALID,
118            org: INVALID,
119            lface: INVALID,
120            active_region: INVALID,
121            winding: 0,
122            mark: false,
123        }
124    }
125}
126
127/// The half-edge mesh.
128pub struct Mesh {
129    pub verts: Vec<Vertex>,
130    pub faces: Vec<Face>,
131    pub edges: Vec<HalfEdge>,
132}
133
134// ──────────────────────────────── Sentinel indices ────────────────────────────
135pub const V_HEAD: VertIdx = 0;
136pub const F_HEAD: FaceIdx = 0;
137pub const E_HEAD: EdgeIdx = 0;
138pub const E_HEAD_SYM: EdgeIdx = 1;
139
140impl Mesh {
141    /// Create a new empty mesh with dummy sentinel nodes.
142    pub fn new() -> Self {
143        let mut m = Mesh {
144            verts: Vec::new(),
145            faces: Vec::new(),
146            edges: Vec::new(),
147        };
148
149        // vHead (index 0) -- dummy vertex
150        let mut v_head = Vertex::default();
151        v_head.next = V_HEAD;
152        v_head.prev = V_HEAD;
153        v_head.an_edge = INVALID;
154        m.verts.push(v_head);
155
156        // fHead (index 0) -- dummy face
157        let mut f_head = Face::default();
158        f_head.next = F_HEAD;
159        f_head.prev = F_HEAD;
160        f_head.an_edge = INVALID;
161        f_head.trail = INVALID;
162        f_head.marked = false;
163        f_head.inside = false;
164        m.faces.push(f_head);
165
166        // eHead (index 0), eHeadSym (index 1) -- dummy edge pair
167        let mut e_head = HalfEdge::default();
168        e_head.next = E_HEAD;
169        e_head.onext = INVALID;
170        e_head.lnext = INVALID;
171        e_head.org = INVALID;
172        e_head.lface = INVALID;
173        e_head.winding = 0;
174        e_head.active_region = INVALID;
175
176        let mut e_head_sym = HalfEdge::default();
177        e_head_sym.next = E_HEAD_SYM;
178        e_head_sym.onext = INVALID;
179        e_head_sym.lnext = INVALID;
180        e_head_sym.org = INVALID;
181        e_head_sym.lface = INVALID;
182        e_head_sym.winding = 0;
183        e_head_sym.active_region = INVALID;
184
185        m.edges.push(e_head);
186        m.edges.push(e_head_sym);
187
188        m
189    }
190
191    // ──────────────── Navigation helpers (C macro translations) ────────────────
192
193    /// Symmetric half-edge (always the other element of the pair).
194    #[inline(always)]
195    pub fn esym(&self, e: EdgeIdx) -> EdgeIdx {
196        e ^ 1
197    }
198
199    /// Right face of e (= lface of Sym).
200    #[inline]
201    pub fn rface(&self, e: EdgeIdx) -> FaceIdx {
202        self.edges[(e ^ 1) as usize].lface
203    }
204
205    /// Destination vertex of e (= org of Sym).
206    #[inline]
207    pub fn dst(&self, e: EdgeIdx) -> VertIdx {
208        self.edges[(e ^ 1) as usize].org
209    }
210
211    /// Oprev: Sym->Lnext
212    #[inline]
213    pub fn oprev(&self, e: EdgeIdx) -> EdgeIdx {
214        self.edges[(e ^ 1) as usize].lnext
215    }
216
217    /// Lprev: Onext->Sym
218    #[inline]
219    pub fn lprev(&self, e: EdgeIdx) -> EdgeIdx {
220        self.edges[e as usize].onext ^ 1
221    }
222
223    /// Dprev: Lnext->Sym
224    #[inline]
225    pub fn dprev(&self, e: EdgeIdx) -> EdgeIdx {
226        self.edges[e as usize].lnext ^ 1
227    }
228
229    /// Rprev: Sym->Onext
230    #[inline]
231    pub fn rprev(&self, e: EdgeIdx) -> EdgeIdx {
232        self.edges[(e ^ 1) as usize].onext
233    }
234
235    /// Dnext: Rprev->Sym = (Sym->Onext)->Sym
236    #[inline]
237    pub fn dnext(&self, e: EdgeIdx) -> EdgeIdx {
238        self.edges[(e ^ 1) as usize].onext ^ 1
239    }
240
241    /// Rnext: Oprev->Sym = (Sym->Lnext)->Sym
242    #[inline]
243    pub fn rnext(&self, e: EdgeIdx) -> EdgeIdx {
244        self.edges[(e ^ 1) as usize].lnext ^ 1
245    }
246
247    /// EdgeGoesLeft: VertLeq(Dst, Org)
248    #[inline]
249    pub fn edge_goes_left(&self, e: EdgeIdx) -> bool {
250        let dst = self.dst(e);
251        let org = self.edges[e as usize].org;
252        let ds = self.verts[dst as usize].s;
253        let dt = self.verts[dst as usize].t;
254        let os = self.verts[org as usize].s;
255        let ot = self.verts[org as usize].t;
256        crate::geom::vert_leq(ds, dt, os, ot)
257    }
258
259    /// EdgeGoesRight: VertLeq(Org, Dst)
260    #[inline]
261    pub fn edge_goes_right(&self, e: EdgeIdx) -> bool {
262        let org = self.edges[e as usize].org;
263        let dst = self.dst(e);
264        let os = self.verts[org as usize].s;
265        let ot = self.verts[org as usize].t;
266        let ds = self.verts[dst as usize].s;
267        let dt = self.verts[dst as usize].t;
268        crate::geom::vert_leq(os, ot, ds, dt)
269    }
270
271    /// EdgeIsInternal: e->Rface && e->Rface->inside
272    #[inline]
273    pub fn edge_is_internal(&self, e: EdgeIdx) -> bool {
274        let rf = self.rface(e);
275        rf != INVALID && self.faces[rf as usize].inside
276    }
277
278    // ──────────────────────── Private allocation helpers ─────────────────────
279
280    /// Allocate a new half-edge pair.  Returns the index of `e` (even); sym is `e ^ 1`.
281    /// The new pair is inserted in the global edge list before `e_next`.
282    fn make_edge_pair(&mut self, e_next: EdgeIdx) -> EdgeIdx {
283        // Normalize: e_next must be the even half (e, not eSym)
284        let e_next = if e_next & 1 != 0 { e_next ^ 1 } else { e_next };
285
286        // Validate e_next
287        let e_next_sym = e_next ^ 1;
288        if (e_next as usize) >= self.edges.len() || (e_next_sym as usize) >= self.edges.len() {
289            return INVALID;
290        }
291
292        let e_new = self.edges.len() as EdgeIdx;
293        let e_sym = e_new ^ 1;
294
295        // ePrev = eNext->Sym->next
296        let e_prev = self.edges[(e_next ^ 1) as usize].next;
297        if e_prev == INVALID {
298            return INVALID;
299        }
300
301        // Insert new pair between ePrev and eNext in the global edge list.
302        // List A (even edges): ePrev ← e_new → e_next (forward)
303        // List B (odd edges): ePrev^1 ← e_sym → e_next^1
304        let mut e = HalfEdge::default();
305        e.next = e_next;
306        let mut e_s = HalfEdge::default();
307        e_s.next = e_prev;
308
309        self.edges.push(e); // index e_new
310        self.edges.push(e_s); // index e_sym
311
312        // ePrev->Sym->next = e_new  →  edges[e_prev^1].next = e_new
313        self.edges[(e_prev ^ 1) as usize].next = e_new;
314        // eNext->Sym->next = e_sym  →  edges[e_next^1].next = e_sym
315        self.edges[(e_next ^ 1) as usize].next = e_sym;
316
317        // Initialize edge fields
318        self.edges[e_new as usize].onext = e_new;
319        self.edges[e_new as usize].lnext = e_sym;
320        self.edges[e_new as usize].org = INVALID;
321        self.edges[e_new as usize].lface = INVALID;
322        self.edges[e_new as usize].winding = 0;
323        self.edges[e_new as usize].active_region = INVALID;
324        self.edges[e_new as usize].mark = false;
325
326        self.edges[e_sym as usize].onext = e_sym;
327        self.edges[e_sym as usize].lnext = e_new;
328        self.edges[e_sym as usize].org = INVALID;
329        self.edges[e_sym as usize].lface = INVALID;
330        self.edges[e_sym as usize].winding = 0;
331        self.edges[e_sym as usize].active_region = INVALID;
332        self.edges[e_sym as usize].mark = false;
333
334        e_new
335    }
336
337    /// Allocate a new vertex and insert it before `v_next` in the vertex list.
338    ///
339    /// Returns `INVALID` if `v_next` itself is `INVALID` (or out of bounds),
340    /// which happens when a caller hands us an edge whose sym-side origin
341    /// has been killed.  We propagate `INVALID` rather than crash so the
342    /// caller can decide whether to abort or continue.
343    fn make_vertex(&mut self, e_orig: EdgeIdx, v_next: VertIdx) -> VertIdx {
344        if v_next == INVALID || (v_next as usize) >= self.verts.len() {
345            return INVALID;
346        }
347        let v_new = self.verts.len() as VertIdx;
348        let v_prev = self.verts[v_next as usize].prev;
349        if v_prev == INVALID || (v_prev as usize) >= self.verts.len() {
350            return INVALID;
351        }
352
353        let mut v = Vertex::default();
354        v.prev = v_prev;
355        v.next = v_next;
356        v.an_edge = e_orig;
357        self.verts.push(v);
358
359        self.verts[v_prev as usize].next = v_new;
360        self.verts[v_next as usize].prev = v_new;
361
362        // Set all edges in the origin ring to point to v_new
363        let mut e = e_orig;
364        loop {
365            self.edges[e as usize].org = v_new;
366            e = self.edges[e as usize].onext;
367            if e == e_orig {
368                break;
369            }
370        }
371
372        v_new
373    }
374
375    /// Allocate a new face and insert it before `f_next` in the face list.
376    fn make_face(&mut self, e_orig: EdgeIdx, f_next: FaceIdx) -> FaceIdx {
377        if f_next == INVALID || (f_next as usize) >= self.faces.len() {
378            return INVALID;
379        }
380        let f_new = self.faces.len() as FaceIdx;
381        let f_prev = self.faces[f_next as usize].prev;
382        if f_prev == INVALID || (f_prev as usize) >= self.faces.len() {
383            return INVALID;
384        }
385
386        let inside_val = self.faces[f_next as usize].inside;
387
388        let mut f = Face::default();
389        f.prev = f_prev;
390        f.next = f_next;
391        f.an_edge = e_orig;
392        f.trail = INVALID;
393        f.marked = false;
394        f.inside = inside_val;
395        self.faces.push(f);
396
397        self.faces[f_prev as usize].next = f_new;
398        self.faces[f_next as usize].prev = f_new;
399
400        // Set all edges in the face loop to point to f_new
401        let mut e = e_orig;
402        loop {
403            self.edges[e as usize].lface = f_new;
404            e = self.edges[e as usize].lnext;
405            if e == e_orig {
406                break;
407            }
408        }
409
410        f_new
411    }
412
413    /// Kill (remove) a vertex from the global vertex list and update its edges to point to `new_org`.
414    fn kill_vertex(&mut self, v_del: VertIdx, new_org: VertIdx) {
415        // Re-point all edges in the vertex ring
416        let e_start = self.verts[v_del as usize].an_edge;
417        if e_start != INVALID {
418            let mut e = e_start;
419            loop {
420                self.edges[e as usize].org = new_org;
421                e = self.edges[e as usize].onext;
422                if e == e_start {
423                    break;
424                }
425            }
426        }
427
428        // Remove from doubly-linked vertex list
429        let v_prev = self.verts[v_del as usize].prev;
430        let v_next = self.verts[v_del as usize].next;
431        if v_prev != INVALID && v_prev < self.verts.len() as u32 {
432            self.verts[v_prev as usize].next = v_next;
433        }
434        if v_next != INVALID && v_next < self.verts.len() as u32 {
435            self.verts[v_next as usize].prev = v_prev;
436        }
437
438        // Mark as deleted (we don't actually reclaim the Vec slot)
439        self.verts[v_del as usize].next = INVALID;
440        self.verts[v_del as usize].prev = INVALID;
441        self.verts[v_del as usize].an_edge = INVALID;
442    }
443
444    /// Kill (remove) a face from the global face list and update its edges to point to `new_lface`.
445    fn kill_face(&mut self, f_del: FaceIdx, new_lface: FaceIdx) {
446        let e_start = self.faces[f_del as usize].an_edge;
447        if e_start != INVALID {
448            let mut e = e_start;
449            loop {
450                self.edges[e as usize].lface = new_lface;
451                e = self.edges[e as usize].lnext;
452                if e == e_start {
453                    break;
454                }
455            }
456        }
457
458        let f_prev = self.faces[f_del as usize].prev;
459        let f_next = self.faces[f_del as usize].next;
460        if f_prev != INVALID && f_prev < self.faces.len() as u32 {
461            self.faces[f_prev as usize].next = f_next;
462        }
463        if f_next != INVALID && f_next < self.faces.len() as u32 {
464            self.faces[f_next as usize].prev = f_prev;
465        }
466
467        self.faces[f_del as usize].next = INVALID;
468        self.faces[f_del as usize].prev = INVALID;
469        self.faces[f_del as usize].an_edge = INVALID;
470    }
471
472    /// Kill (remove) an edge pair from the global edge list.
473    fn kill_edge(&mut self, e_del: EdgeIdx) {
474        let e_del = if e_del & 1 != 0 { e_del ^ 1 } else { e_del };
475        let e_next = self.edges[e_del as usize].next;
476        let e_prev = self.edges[(e_del ^ 1) as usize].next;
477
478        let nlen = self.edges.len() as u32;
479        if e_next != INVALID && (e_next ^ 1) < nlen {
480            self.edges[(e_next ^ 1) as usize].next = e_prev;
481        }
482        if e_prev != INVALID && (e_prev ^ 1) < nlen {
483            self.edges[(e_prev ^ 1) as usize].next = e_next;
484        }
485
486        // Mark edge as deleted
487        self.edges[e_del as usize].next = INVALID;
488        self.edges[(e_del ^ 1) as usize].next = INVALID;
489    }
490
491    // ──────────────────────── Public mesh operations ──────────────────────────
492
493    /// tessMeshMakeEdge: creates one edge, two vertices, and a loop (face).
494    pub fn make_edge(&mut self) -> Option<EdgeIdx> {
495        let e = self.make_edge_pair(E_HEAD);
496        let e_sym = e ^ 1;
497
498        let v1 = self.make_vertex(e, V_HEAD);
499        let v2 = self.make_vertex(e_sym, V_HEAD);
500        let _f = self.make_face(e, F_HEAD);
501
502        self.edges[e as usize].org = v1;
503        self.edges[e_sym as usize].org = v2;
504
505        Some(e)
506    }
507
508    /// tessMeshSplice: the fundamental connectivity-changing operation.
509    /// Exchanges eOrg->Onext and eDst->Onext.
510    pub fn splice(&mut self, e_org: EdgeIdx, e_dst: EdgeIdx) -> bool {
511        if e_org == e_dst {
512            return true;
513        }
514
515        let org_org = self.edges[e_org as usize].org;
516        let dst_org = self.edges[e_dst as usize].org;
517        let org_lface = self.edges[e_org as usize].lface;
518        let dst_lface = self.edges[e_dst as usize].lface;
519
520        let joining_vertices = dst_org != org_org;
521        let joining_loops = dst_lface != org_lface;
522
523        if joining_vertices {
524            self.kill_vertex(dst_org, org_org);
525        }
526        if joining_loops {
527            self.kill_face(dst_lface, org_lface);
528        }
529
530        Mesh::do_splice(&mut self.edges, e_org, e_dst);
531
532        if !joining_vertices {
533            let new_v = self.make_vertex(e_dst, org_org);
534            // make sure old vertex still has a valid half-edge
535            self.edges[e_org as usize].org = org_org; // org unchanged
536            self.verts[org_org as usize].an_edge = e_org;
537            let _ = new_v;
538        }
539        if !joining_loops {
540            let new_f = self.make_face(e_dst, org_lface);
541            self.verts[org_org as usize].an_edge = e_org; // leave org alone
542            self.faces[org_lface as usize].an_edge = e_org;
543            let _ = new_f;
544        }
545
546        true
547    }
548
549    fn do_splice(edges: &mut Vec<HalfEdge>, a: EdgeIdx, b: EdgeIdx) {
550        let a_onext = edges[a as usize].onext;
551        let b_onext = edges[b as usize].onext;
552        edges[(a_onext ^ 1) as usize].lnext = b;
553        edges[(b_onext ^ 1) as usize].lnext = a;
554        edges[a as usize].onext = b_onext;
555        edges[b as usize].onext = a_onext;
556    }
557
558    /// tessMeshDelete: remove edge eDel.
559    pub fn delete_edge(&mut self, e_del: EdgeIdx) -> bool {
560        let e_del_sym = e_del ^ 1;
561
562        let e_del_lface = self.edges[e_del as usize].lface;
563        let e_del_rface = self.rface(e_del);
564        let joining_loops = e_del_lface != e_del_rface;
565
566        if joining_loops {
567            self.kill_face(e_del_lface, e_del_rface);
568        }
569
570        let e_del_onext = self.edges[e_del as usize].onext;
571        if e_del_onext == e_del {
572            let e_del_org = self.edges[e_del as usize].org;
573            self.kill_vertex(e_del_org, INVALID);
574        } else {
575            // Make sure eDel->Org and eDel->Rface point to valid half-edges
576            let e_del_oprev = self.oprev(e_del);
577            let e_del_rface2 = self.rface(e_del);
578            self.faces[e_del_rface2 as usize].an_edge = e_del_oprev;
579            let e_del_org2 = self.edges[e_del as usize].org;
580            self.verts[e_del_org2 as usize].an_edge = e_del_onext;
581
582            Mesh::do_splice(&mut self.edges, e_del, e_del_oprev);
583
584            if !joining_loops {
585                let new_f = self.make_face(e_del, e_del_lface);
586                let _ = new_f;
587            }
588        }
589
590        let e_del_sym_onext = self.edges[e_del_sym as usize].onext;
591        if e_del_sym_onext == e_del_sym {
592            let e_del_sym_org = self.edges[e_del_sym as usize].org;
593            self.kill_vertex(e_del_sym_org, INVALID);
594            let e_del_lface2 = self.edges[e_del as usize].lface;
595            self.kill_face(e_del_lface2, INVALID);
596        } else {
597            let e_del_lface3 = self.edges[e_del as usize].lface;
598            let e_del_sym_oprev = self.oprev(e_del_sym);
599            self.faces[e_del_lface3 as usize].an_edge = e_del_sym_oprev;
600            let e_del_sym_org2 = self.edges[e_del_sym as usize].org;
601            self.verts[e_del_sym_org2 as usize].an_edge = e_del_sym_onext;
602            Mesh::do_splice(&mut self.edges, e_del_sym, e_del_sym_oprev);
603        }
604
605        self.kill_edge(e_del);
606        true
607    }
608
609    /// tessMeshAddEdgeVertex: create a new edge eNew = eOrg->Lnext,
610    /// and eNew->Dst is a new vertex. eOrg and eNew share the same left face.
611    pub fn add_edge_vertex(&mut self, e_org: EdgeIdx) -> Option<EdgeIdx> {
612        let e_new = self.make_edge_pair(e_org);
613        if e_new == INVALID {
614            return None;
615        }
616        let e_new_sym = e_new ^ 1;
617
618        // Connect: eNew is inserted after eOrg in the Lnext ring
619        let e_org_lnext = self.edges[e_org as usize].lnext;
620        Mesh::do_splice(&mut self.edges, e_new, e_org_lnext);
621
622        // Set origin of eNew to eOrg->Dst
623        let e_org_dst = self.dst(e_org);
624        self.edges[e_new as usize].org = e_org_dst;
625
626        // Create new vertex at the other end.  If `e_org`'s Dst has been
627        // killed upstream (`dst(e_org)` == INVALID) we can't build a valid
628        // vertex for the new edge — bail instead of indexing INVALID into
629        // `self.verts`.  This can occur when the sweep deletes edges in a
630        // different order than libtess2 expects for some self-intersecting
631        // inputs.
632        let v_new = self.make_vertex(e_new_sym, e_org_dst);
633        if v_new == INVALID {
634            return None;
635        }
636
637        // Both eNew and eNewSym share the same left face as eOrg
638        let e_org_lface = self.edges[e_org as usize].lface;
639        self.edges[e_new as usize].lface = e_org_lface;
640        self.edges[e_new_sym as usize].lface = e_org_lface;
641
642        Some(e_new)
643    }
644
645    /// tessMeshSplitEdge: split eOrg into eOrg and eNew, with eNew = eOrg->Lnext.
646    pub fn split_edge(&mut self, e_org: EdgeIdx) -> Option<EdgeIdx> {
647        let temp = self.add_edge_vertex(e_org)?;
648        let e_new = temp ^ 1;
649
650        // Disconnect eOrg from eOrg->Dst and reconnect to eNew->Org
651        let e_org_sym = e_org ^ 1;
652        let e_org_sym_oprev = self.oprev(e_org_sym);
653        Mesh::do_splice(&mut self.edges, e_org_sym, e_org_sym_oprev);
654        Mesh::do_splice(&mut self.edges, e_org_sym, e_new);
655
656        // Update vertex/face pointers
657        let e_new_org = self.edges[e_new as usize].org;
658        let e_org_dst_idx = e_org ^ 1; // sym
659        self.edges[e_org_dst_idx as usize].org = e_new_org;
660        let e_new_dst = self.dst(e_new);
661        self.verts[e_new_dst as usize].an_edge = e_new ^ 1;
662
663        let e_org_rface = self.rface(e_org);
664        self.edges[(e_new ^ 1) as usize].lface = e_org_rface; // eNew->Rface = eOrg->Rface (Rface = Sym->Lface)
665        let e_org_winding = self.edges[e_org as usize].winding;
666        let e_org_sym_winding = self.edges[e_org_sym as usize].winding;
667        self.edges[e_new as usize].winding = e_org_winding;
668        self.edges[(e_new ^ 1) as usize].winding = e_org_sym_winding;
669
670        Some(e_new)
671    }
672
673    /// tessMeshConnect: create a new edge from eOrg->Dst to eDst->Org.
674    /// Returns the new half-edge.
675    pub fn connect(&mut self, e_org: EdgeIdx, e_dst: EdgeIdx) -> Option<EdgeIdx> {
676        let e_new = self.make_edge_pair(e_org);
677        // If `make_edge_pair` couldn't allocate (out-of-bounds seed, broken
678        // `next` chain on the sym side), bail.  Forwarding the `INVALID`
679        // into the subsequent `do_splice`/`kill_face` was the root cause of
680        // the lion-polygon `INVALID do_splice` panic.  Returning `None`
681        // lets `tessellate_mono_region` skip this triangulation step; the
682        // face is then marked non-inside so no degenerate output slips
683        // through (see `tessellate_interior`'s fallback).
684        if e_new == INVALID { return None; }
685        let e_new_sym = e_new ^ 1;
686
687        let e_dst_lface = self.edges[e_dst as usize].lface;
688        let e_org_lface = self.edges[e_org as usize].lface;
689        let joining_loops = e_dst_lface != e_org_lface;
690
691        if joining_loops {
692            self.kill_face(e_dst_lface, e_org_lface);
693        }
694
695        // Connect: Splice(eNew, eOrg->Lnext); Splice(eNewSym, eDst)
696        let e_org_lnext = self.edges[e_org as usize].lnext;
697        Mesh::do_splice(&mut self.edges, e_new, e_org_lnext);
698        Mesh::do_splice(&mut self.edges, e_new_sym, e_dst);
699
700        // Set vertex/face
701        let e_org_dst = self.dst(e_org);
702        self.edges[e_new as usize].org = e_org_dst;
703        let e_dst_org = self.edges[e_dst as usize].org;
704        self.edges[e_new_sym as usize].org = e_dst_org;
705        self.edges[e_new as usize].lface = e_org_lface;
706        self.edges[e_new_sym as usize].lface = e_org_lface;
707
708        // Make sure the old face points to a valid half-edge
709        self.faces[e_org_lface as usize].an_edge = e_new_sym;
710
711        if !joining_loops {
712            let new_f = self.make_face(e_new, e_org_lface);
713            let _ = new_f;
714        }
715
716        Some(e_new)
717    }
718
719    /// tessMeshZapFace: destroy a face and remove it from the global face list.
720    /// All edges of fZap get lface = INVALID. Edges whose rface is also INVALID
721    /// are deleted entirely.
722    pub fn zap_face(&mut self, f_zap: FaceIdx) {
723        let e_start = self.faces[f_zap as usize].an_edge;
724        let mut e_next = self.edges[e_start as usize].lnext;
725
726        loop {
727            let e = e_next;
728            e_next = self.edges[e as usize].lnext;
729
730            self.edges[e as usize].lface = INVALID;
731
732            let e_rface = self.rface(e);
733            if e_rface == INVALID {
734                // Delete the edge
735                let e_onext = self.edges[e as usize].onext;
736                if e_onext == e {
737                    let e_org = self.edges[e as usize].org;
738                    if e_org != INVALID {
739                        self.kill_vertex(e_org, INVALID);
740                    }
741                } else {
742                    let e_org = self.edges[e as usize].org;
743                    if e_org != INVALID {
744                        self.verts[e_org as usize].an_edge = e_onext;
745                    }
746                    let e_oprev = self.oprev(e);
747                    Mesh::do_splice(&mut self.edges, e, e_oprev);
748                }
749
750                let e_sym = e ^ 1;
751                let e_sym_onext = self.edges[e_sym as usize].onext;
752                if e_sym_onext == e_sym {
753                    let e_sym_org = self.edges[e_sym as usize].org;
754                    if e_sym_org != INVALID {
755                        self.kill_vertex(e_sym_org, INVALID);
756                    }
757                } else {
758                    let e_sym_org = self.edges[e_sym as usize].org;
759                    if e_sym_org != INVALID {
760                        self.verts[e_sym_org as usize].an_edge = e_sym_onext;
761                    }
762                    let e_sym_oprev = self.oprev(e_sym);
763                    Mesh::do_splice(&mut self.edges, e_sym, e_sym_oprev);
764                }
765
766                self.kill_edge(e);
767            }
768
769            if e == e_start {
770                break;
771            }
772        }
773
774        // Delete from face list
775        let f_prev = self.faces[f_zap as usize].prev;
776        let f_next = self.faces[f_zap as usize].next;
777        self.faces[f_prev as usize].next = f_next;
778        self.faces[f_next as usize].prev = f_prev;
779        self.faces[f_zap as usize].next = INVALID;
780        self.faces[f_zap as usize].prev = INVALID;
781        self.faces[f_zap as usize].an_edge = INVALID;
782    }
783
784    /// Count vertices in a face loop.
785    pub fn count_face_verts(&self, f: FaceIdx) -> usize {
786        let e_start = self.faces[f as usize].an_edge;
787        let mut e = e_start;
788        let mut n = 0;
789        loop {
790            n += 1;
791            e = self.edges[e as usize].lnext;
792            if e == e_start {
793                break;
794            }
795        }
796        n
797    }
798
799    /// tessMeshMergeConvexFaces: merge convex adjacent faces if the result
800    /// would have <= maxVertsPerFace vertices.
801    pub fn merge_convex_faces(&mut self, max_verts_per_face: usize) -> bool {
802        let mut e = self.edges[E_HEAD as usize].next;
803        while e != E_HEAD {
804            let e_next = self.edges[e as usize].next;
805            let e_sym = e ^ 1;
806
807            let e_lface = self.edges[e as usize].lface;
808            let e_sym_lface = self.edges[e_sym as usize].lface;
809
810            if e_lface == INVALID
811                || !self.faces[e_lface as usize].inside
812                || e_sym_lface == INVALID
813                || !self.faces[e_sym_lface as usize].inside
814            {
815                e = e_next;
816                continue;
817            }
818
819            let left_nv = self.count_face_verts(e_lface);
820            let right_nv = self.count_face_verts(e_sym_lface);
821            if left_nv + right_nv - 2 > max_verts_per_face {
822                e = e_next;
823                continue;
824            }
825
826            // Check convexity: va--vb--vc and vd--ve--vf must be CCW
827            let va = self.edges[self.lprev(e) as usize].org;
828            let vb = self.edges[e as usize].org;
829            let vc_edge = self.edges[e_sym as usize].lnext;
830            let vc = self.dst(vc_edge);
831
832            let vd = self.edges[self.lprev(e_sym) as usize].org;
833            let ve = self.edges[e_sym as usize].org;
834            let vf_edge = self.edges[e as usize].lnext;
835            let vf = self.dst(vf_edge);
836
837            let convex = vert_ccw(
838                self.verts[va as usize].s,
839                self.verts[va as usize].t,
840                self.verts[vb as usize].s,
841                self.verts[vb as usize].t,
842                self.verts[vc as usize].s,
843                self.verts[vc as usize].t,
844            ) && vert_ccw(
845                self.verts[vd as usize].s,
846                self.verts[vd as usize].t,
847                self.verts[ve as usize].s,
848                self.verts[ve as usize].t,
849                self.verts[vf as usize].s,
850                self.verts[vf as usize].t,
851            );
852
853            if convex {
854                let actual_next = if e == e_next || e == e_next ^ 1 {
855                    self.edges[e_next as usize].next
856                } else {
857                    e_next
858                };
859                if !self.delete_edge(e) {
860                    return false;
861                }
862                e = actual_next;
863                continue;
864            }
865
866            e = e_next;
867        }
868        true
869    }
870
871    /// tessMeshFlipEdge: flip an internal edge (used for Delaunay refinement).
872    pub fn flip_edge(&mut self, edge: EdgeIdx) {
873        let a0 = edge;
874        let a1 = self.edges[a0 as usize].lnext;
875        let a2 = self.edges[a1 as usize].lnext;
876        let b0 = edge ^ 1;
877        let b1 = self.edges[b0 as usize].lnext;
878        let b2 = self.edges[b1 as usize].lnext;
879
880        let a_org = self.edges[a0 as usize].org;
881        let a_opp = self.edges[a2 as usize].org;
882        let b_org = self.edges[b0 as usize].org;
883        let b_opp = self.edges[b2 as usize].org;
884
885        let fa = self.edges[a0 as usize].lface;
886        let fb = self.edges[b0 as usize].lface;
887
888        self.edges[a0 as usize].org = b_opp;
889        self.edges[a0 as usize].onext = self.edges[b1 as usize].onext ^ 1; // b1->Sym
890        self.edges[b0 as usize].org = a_opp;
891        self.edges[b0 as usize].onext = self.edges[a1 as usize].onext ^ 1; // a1->Sym
892        self.edges[a2 as usize].onext = b0;
893        self.edges[b2 as usize].onext = a0;
894        self.edges[b1 as usize].onext = self.edges[a2 as usize].onext ^ 1; // a2->Sym... wait
895
896        // Redo using correct flip logic from C code:
897        self.edges[a0 as usize].lnext = a2;
898        self.edges[a2 as usize].lnext = b1;
899        self.edges[b1 as usize].lnext = a0;
900
901        self.edges[b0 as usize].lnext = b2;
902        self.edges[b2 as usize].lnext = a1;
903        self.edges[a1 as usize].lnext = b0;
904
905        self.edges[a1 as usize].lface = fb;
906        self.edges[b1 as usize].lface = fa;
907
908        self.faces[fa as usize].an_edge = a0;
909        self.faces[fb as usize].an_edge = b0;
910
911        if self.verts[a_org as usize].an_edge == a0 {
912            self.verts[a_org as usize].an_edge = b1;
913        }
914        if self.verts[b_org as usize].an_edge == b0 {
915            self.verts[b_org as usize].an_edge = a1;
916        }
917    }
918
919    /// tessMeshSetWindingNumber: reset winding numbers.
920    pub fn set_winding_number(&mut self, value: i32, keep_only_boundary: bool) -> bool {
921        let mut e = self.edges[E_HEAD as usize].next;
922        while e != E_HEAD {
923            let e_next = self.edges[e as usize].next;
924            let e_lface = self.edges[e as usize].lface;
925            let e_rface = self.rface(e);
926
927            let lf_inside = if e_lface != INVALID {
928                self.faces[e_lface as usize].inside
929            } else {
930                false
931            };
932            let rf_inside = if e_rface != INVALID {
933                self.faces[e_rface as usize].inside
934            } else {
935                false
936            };
937
938            if rf_inside != lf_inside {
939                self.edges[e as usize].winding = if lf_inside { value } else { -value };
940            } else if !keep_only_boundary {
941                self.edges[e as usize].winding = 0;
942            } else if !self.delete_edge(e) {
943                return false;
944            }
945
946            e = e_next;
947        }
948        true
949    }
950
951    /// Discard all exterior faces (zap them).
952    pub fn discard_exterior(&mut self) {
953        let mut f = self.faces[F_HEAD as usize].next;
954        while f != F_HEAD {
955            let next = self.faces[f as usize].next;
956            if !self.faces[f as usize].inside {
957                self.zap_face(f);
958            }
959            f = next;
960        }
961    }
962
963}
964
965mod tessellate;
966
967impl Default for Mesh {
968    fn default() -> Self {
969        Self::new()
970    }
971}
972
973#[cfg(test)]
974mod tests {
975    use super::*;
976
977    #[test]
978    fn make_edge_creates_single_edge() {
979        let mut mesh = Mesh::new();
980        let e = mesh.make_edge().unwrap();
981        // Should have 3 vertices (vHead + 2 new), 2 faces (fHead + 1 new), 4 edges (eHead pair + 1 pair)
982        assert_eq!(mesh.verts.len(), 3);
983        assert_eq!(mesh.faces.len(), 2);
984        assert_eq!(mesh.edges.len(), 4);
985        // Edge and its sym should have different orgs
986        let org1 = mesh.edges[e as usize].org;
987        let org2 = mesh.edges[(e ^ 1) as usize].org;
988        assert_ne!(org1, org2);
989        assert_ne!(org1, INVALID);
990        assert_ne!(org2, INVALID);
991    }
992
993    #[test]
994    fn sym_involution() {
995        // sym(sym(e)) == e
996        for e in 0u32..16 {
997            assert_eq!(sym(sym(e)), e);
998        }
999    }
1000
1001    #[test]
1002    fn vertex_list_circular() {
1003        let mut mesh = Mesh::new();
1004        mesh.make_edge().unwrap();
1005        // vHead.next.next should eventually circle back
1006        let first = mesh.verts[V_HEAD as usize].next;
1007        assert_ne!(first, V_HEAD);
1008        let second = mesh.verts[first as usize].next;
1009        assert_ne!(second, INVALID);
1010    }
1011}