altos/test: Display MPU6000 values in ao_flight_test_mm output

[fw/altos] / src / test / ao_gps_test.c

diff --git a/src/test/ao_gps_test.c b/src/test/ao_gps_test.c
index 93d7a9abc6ee5e3371cf72f33fda50d19dd9ad50..d75a12ecbfad77bf5a4f75d65a02a4200fd217f0 100644 (file)
--- a/src/test/ao_gps_test.c
+++ b/src/test/ao_gps_test.c
@@ -21,6 +21,7 @@
 #include <errno.h>
 #include <sys/types.h>
 #include <sys/stat.h>
+#include <unistd.h>
 #include <fcntl.h>
 #define AO_GPS_NUM_SAT_MASK    (0xf << 0)
 #define AO_GPS_NUM_SAT_SHIFT   (0)
@@ -220,6 +221,8 @@ check_sirf_message(char *from, uint8_t *msg, int len)
                get_u16(h_v_error);
 
 
+               (void) mag_var;
+               (void) id;
                printf ("Geodetic Navigation Data (41):\n");
                printf ("\tNav valid %04x\n", nav_valid);
                printf ("\tNav type %04x\n", nav_type);
@@ -257,6 +260,7 @@ check_sirf_message(char *from, uint8_t *msg, int len)
                get_u32(gps_tow);
                get_u8(channels);
 
+               (void) id;
                printf ("Measured Tracker Data (4):\n");
                printf ("GPS week: %d\n", gps_week);
                printf ("GPS time of week: %d\n", gps_tow);
@@ -317,7 +321,7 @@ static uint8_t      sirf_in_message[4096];
 static int     sirf_in_len;
 
 char
-ao_serial_getchar(void)
+ao_serial1_getchar(void)
 {
        char    c;
        uint8_t uc;
@@ -351,7 +355,7 @@ ao_serial_getchar(void)
 
 
 void
-ao_serial_putchar(char c)
+ao_serial1_putchar(char c)
 {
        int     i;
        uint8_t uc = (uint8_t) c;
@@ -368,10 +372,11 @@ ao_serial_putchar(char c)
                i = write(ao_gps_fd, &c, 1);
                if (i == 1) {
                        if ((uint8_t) c == 0xb3 || c == '\r') {
-                               static const struct timespec delay = {
+/*                             static const struct timespec delay = {
                                        .tv_sec = 0,
                                        .tv_nsec = 100 * 1000 * 1000
                                };
+*/
                                tcdrain(ao_gps_fd);
 //                             nanosleep(&delay, NULL);
                        }
@@ -388,7 +393,7 @@ ao_serial_putchar(char c)
 #define AO_SERIAL_SPEED_57600  1
 
 static void
-ao_serial_set_speed(uint8_t speed)
+ao_serial1_set_speed(uint8_t speed)
 {
        int     fd = ao_gps_fd;
        struct termios  termios;