diff options
Diffstat (limited to 'tools/lighthousefind_tori/main.c')
-rw-r--r-- | tools/lighthousefind_tori/main.c | 14 |
1 files changed, 13 insertions, 1 deletions
diff --git a/tools/lighthousefind_tori/main.c b/tools/lighthousefind_tori/main.c index ee56b37..d3a9f27 100644 --- a/tools/lighthousefind_tori/main.c +++ b/tools/lighthousefind_tori/main.c @@ -64,7 +64,19 @@ static void runTheNumbers() printf("Using %d sensors to find lighthouse.\n", sensorCount); - Point lh = SolveForLighthouse(to, 1); + Point lh; + //for (int i = 0; i < 200; i++) + for (int i = 0; i < 1; i++) + { + lh = SolveForLighthouse(to, 0); + //(0.156754, -2.403268, 2.280167) + //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.z > 0); + } printf("(%f, %f, %f)\n", lh.x, lh.y, lh.z); |