diff options
| author | mwturvey <michael.w.turvey@intel.com> | 2017-02-16 16:02:02 -0700 |
|---|---|---|
| committer | mwturvey <michael.w.turvey@intel.com> | 2017-02-21 13:29:40 -0700 |
| commit | 2927962bd7f9dcb6054d4bf642bb02b946379e25 (patch) | |
| tree | 2aa30ddd41ad2755d6d935f31d9e276ade23d689 /tools/lighthousefind_tori/main.c | |
| parent | bb099f0fd084c3a2f84532e76928a4f548bf188e (diff) | |
| download | libsurvive-2927962bd7f9dcb6054d4bf642bb02b946379e25.tar.gz libsurvive-2927962bd7f9dcb6054d4bf642bb02b946379e25.tar.bz2 | |
Optimizing find_tori, replace 3 trigs with 1 sqrt
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); } |