From bb099f0fd084c3a2f84532e76928a4f548bf188e Mon Sep 17 00:00:00 2001 From: Mike Turvey Date: Wed, 15 Feb 2017 22:55:23 -0700 Subject: Eliminate unnecessary pow calls. --- tools/lighthousefind_tori/main.c | 13 ++++++++++++- 1 file changed, 12 insertions(+), 1 deletion(-) (limited to 'tools/lighthousefind_tori/main.c') diff --git a/tools/lighthousefind_tori/main.c b/tools/lighthousefind_tori/main.c index ee56b37..e94268c 100644 --- a/tools/lighthousefind_tori/main.c +++ b/tools/lighthousefind_tori/main.c @@ -64,7 +64,18 @@ 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++) + { + 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(lh.x > 0); + assert(lh.y < 0); + assert(lh.z > 0); + } printf("(%f, %f, %f)\n", lh.x, lh.y, lh.z); -- cgit v1.2.3