nx_geo_match_gate.nx source

1// nx_geo_match_gate.nx -- GATE for GEO-023 map-matching. Seeded road graph: edge0 = horizontal road 2// (lat 0, lon 0..10e6); edge1 = vertical road (lon 5e6, lat 0..10e6). Snap 3 noisy GPS fixes: 3// P0 (1e6, 3e6) -> edge 0, snapped (0, 3e6) [projects onto the horizontal road] 4// P1 (4e6, 6e6) -> edge 1, snapped (4e6, 5e6) [projects onto the vertical road] 5// P2 (0, -5e6) -> edge 0, snapped (0, 0) [before edge0's A endpoint -> clamp to A] 6// Snapped points lie exactly ON the chosen edge (deterministic integer snapping). 7// 8// Evidence -> knowledge/status/geo_match.log (GEOMATCHGATE authored=organ ... verdict=GREEN). 9// license_tier: ORIGINAL 10import "nx_geo_match.nx" 11import "nx_syscalls.nx" 12 13const GM_LOG: *u8 = "knowledge/status/geo_match.log" 14 15func gm_w(fd: i64, s: *u8) -> i64 { var n: i64 = 0; while s[n] != (0 as u8) { n = n + 1 } sys_write(fd, s, n); return 0 } 16func gm_wn(fd: i64, v: i64) -> i64 { let bb: *u8 = sys_mmap(28); var m: i64=v; if m<0 {m=0-m; sys_write(fd,"-" as *u8,1)}; let t: *u8 = sys_mmap(28); var k: i64=0; if m==0 {t[0]=48;k=1}; while m>0 {t[k]=(48+(m%10)) as u8; m=m/10; k=k+1}; var i: i64=0; while i<k {bb[i]=t[k-1-i]; i=i+1}; sys_write(fd, bb, k); return 0 } 17 18func gm_emit(fd: i64, e0: i64, s0lat: i64, s0lon: i64, e1: i64, s1lat: i64, s1lon: i64, e2: i64, s2lat: i64, s2lon: i64, ok: i64) -> i64 { 19 gm_w(fd, "GEOMATCHGATE authored=organ method=integer-point-to-segment p0_edge=" as *u8); gm_wn(fd, e0) 20 gm_w(fd, " p0_snap_lat=" as *u8); gm_wn(fd, s0lat); gm_w(fd, " p0_snap_lon=" as *u8); gm_wn(fd, s0lon) 21 gm_w(fd, " p1_edge=" as *u8); gm_wn(fd, e1) 22 gm_w(fd, " p1_snap_lat=" as *u8); gm_wn(fd, s1lat); gm_w(fd, " p1_snap_lon=" as *u8); gm_wn(fd, s1lon) 23 gm_w(fd, " p2_edge=" as *u8); gm_wn(fd, e2) 24 gm_w(fd, " p2_snap_lat=" as *u8); gm_wn(fd, s2lat); gm_w(fd, " p2_snap_lon=" as *u8); gm_wn(fd, s2lon) 25 if ok == 1 { gm_w(fd, " verdict=GREEN\n" as *u8) } else { gm_w(fd, " verdict=RED\n" as *u8) } 26 return 0 27} 28 29func main() -> i64 { 30 // edges: [alat,alon,blat,blon] x2 31 let edges: *i64 = sys_mmap(8 * 8) as *i64 32 edges[0] = 0; edges[1] = 0; edges[2] = 0; edges[3] = 10000000 // edge0 horizontal 33 edges[4] = 0; edges[5] = 5000000; edges[6] = 10000000; edges[7] = 5000000 // edge1 vertical 34 35 let s0: *i64 = sys_mmap(16) as *i64 36 let e0: i64 = geo_map_match(1000000, 3000000, edges, 2, s0) // -> edge0, (0, 3e6) 37 let s1: *i64 = sys_mmap(16) as *i64 38 let e1: i64 = geo_map_match(4000000, 6000000, edges, 2, s1) // -> edge1, (4e6, 5e6) 39 let s2: *i64 = sys_mmap(16) as *i64 40 let e2: i64 = geo_map_match(0, 0 - 5000000, edges, 2, s2) // -> edge0, (0,0) clamp 41 42 var ok: i64 = 1 43 if e0 != 0 { ok = 0 } 44 if s0[0] != 0 { ok = 0 } 45 if s0[1] != 3000000 { ok = 0 } 46 if e1 != 1 { ok = 0 } 47 if s1[0] != 4000000 { ok = 0 } 48 if s1[1] != 5000000 { ok = 0 } 49 if e2 != 0 { ok = 0 } 50 if s2[0] != 0 { ok = 0 } 51 if s2[1] != 0 { ok = 0 } 52 53 gm_emit(1, e0, s0[0], s0[1], e1, s1[0], s1[1], e2, s2[0], s2[1], ok) 54 let lf: i64 = sys_openat_append(GM_LOG, 420) 55 if lf >= 0 { gm_emit(lf, e0, s0[0], s0[1], e1, s1[0], s1[1], e2, s2[0], s2[1], ok); sys_close(lf) } 56 57 if ok == 1 { return 0 } 58 return 1 59}