diff options
Diffstat (limited to 'tools/lighthousefind_tori/main.c')
-rw-r--r-- | tools/lighthousefind_tori/main.c | 11 |
1 files changed, 6 insertions, 5 deletions
diff --git a/tools/lighthousefind_tori/main.c b/tools/lighthousefind_tori/main.c index e94268c..bf10820 100644 --- a/tools/lighthousefind_tori/main.c +++ b/tools/lighthousefind_tori/main.c @@ -65,15 +65,16 @@ static void runTheNumbers() printf("Using %d sensors to find lighthouse.\n", sensorCount); Point lh; + //for (int i = 0; i < 200; i++) for (int i = 0; i < 200; i++) - { + { lh = SolveForLighthouse(to, 0); //(0.156754, -2.403268, 2.280167) - assert(fabs((lh.x / 0.156754) - 1) < 0.00001); - assert(fabs((lh.y / -2.403268) - 1) < 0.00001); - assert(fabs((lh.z / 2.280167) - 1) < 0.00001); + assert(fabs((lh.x / 0.1419305302702402) - 1) < 0.00001); + assert(fabs((lh.y / 2.5574949720325431) - 1) < 0.00001); + assert(fabs((lh.z / 2.2451193935772080) - 1) < 0.00001); assert(lh.x > 0); - assert(lh.y < 0); + assert(lh.y > 0); assert(lh.z > 0); } |