From 2927962bd7f9dcb6054d4bf642bb02b946379e25 Mon Sep 17 00:00:00 2001 From: mwturvey Date: Thu, 16 Feb 2017 16:02:02 -0700 Subject: Optimizing find_tori, replace 3 trigs with 1 sqrt --- tools/lighthousefind_tori/main.c | 11 ++++++----- 1 file changed, 6 insertions(+), 5 deletions(-) (limited to 'tools/lighthousefind_tori/main.c') 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); } -- cgit v1.2.3