X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=ao-bringup%2Ftest-baro;h=ce5b7f80a24806b3507fe292f2d42d2a8a489d4a;hp=45d7ccac4e483fa5923683df05609e3ccb44d71f;hb=7e2b92ccb56b713fd18af5769156331ead8dc7ed;hpb=834cd051af1b80a98678de221d3c45cb30f8bb0d diff --git a/ao-bringup/test-baro b/ao-bringup/test-baro index 45d7ccac..ce5b7f80 100755 --- a/ao-bringup/test-baro +++ b/ao-bringup/test-baro @@ -36,28 +36,6 @@ void flush_input(file f) { } } -string[*] settings(file f) { - string[...] x = {}; - - flush_input(f); - fprintf (f, "c s\nv\n"); - flush(f); - for (;;) { - string l = File::fgets(f); - x[dim(x)] = l; - if (String::index(l, "software-version") == 0) - break; - } - return x; -} - -string[*] find_setting(string[*] s, string match) { - for (int i = 0; i < dim(s); i++) - if (String::index(s[i], match) == 0) - return String::wordsplit(s[i], " "); - return (string[*]) {}; -} - string[*] baro(file f) { string[...] x = {}; @@ -65,7 +43,11 @@ string[*] baro(file f) { fprintf (f, "B\n"); flush(f); for (;;) { - string l = File::fgets(f); + string l = timed_read(f, 1000); + if (l == "") { + File::fprintf(stderr, "read timedout\n"); + exit(1); + } x[dim(x)] = l; if (String::index(l, "Altitude:") == 0) break; @@ -89,7 +71,7 @@ do_baro(file f) { real temperature = string_to_integer(temp[2]) / 100.0; real altitude = string_to_integer(alt[1]); - if (altitude < 0 || 3000 < altitude) { + if (altitude < -50 || 3000 < altitude) { printf ("weird altitude %f\n", altitude); return false; }