aboutsummaryrefslogtreecommitdiff
path: root/tools/lighthousefind_tori/main.c
diff options
context:
space:
mode:
authormwturvey <michael.w.turvey@intel.com>2017-02-27 11:26:05 -0700
committermwturvey <michael.w.turvey@intel.com>2017-02-27 11:26:05 -0700
commit321749a4b8e3e8b3f4b03863200fbf86e36a0bbe (patch)
treeb7d81c89b3a4ccb72d46e5194929b47df88345b7 /tools/lighthousefind_tori/main.c
parentd1a02d649c034f43a11548a04d8d2a58786ff8ff (diff)
parent51751d4a9f407f526de2b626d44e14690fbef004 (diff)
downloadlibsurvive-321749a4b8e3e8b3f4b03863200fbf86e36a0bbe.tar.gz
libsurvive-321749a4b8e3e8b3f4b03863200fbf86e36a0bbe.tar.bz2
Merge branch 'master' of https://github.com/cnlohr/libsurvive
Diffstat (limited to 'tools/lighthousefind_tori/main.c')
-rw-r--r--tools/lighthousefind_tori/main.c14
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);