fix gps message when position is not correct

diff --git a/i2c_protocol.c b/i2c_protocol.c
index 319da9e1fed0b15a41a5cad905319406320a4223..cdb739923f95b139cfa8ae61e0c66017e3a7baad 100644 (file)
--- a/i2c_protocol.c
+++ b/i2c_protocol.c
@@ -82,6 +82,7 @@ static void i2c_send_status(void)
        gps_get_pos(&gps_pos);
        IRQ_UNLOCK(irq_flags);
 
        gps_get_pos(&gps_pos);
        IRQ_UNLOCK(irq_flags);
 

+       ans.flags = 0;

        if (gps_pos_valid(&gps_pos)) {
                ans.flags |= IMUBOARD_STATUS_GPS_OK;
                ans.latitude = gps_pos.latitude;
        if (gps_pos_valid(&gps_pos)) {
                ans.flags |= IMUBOARD_STATUS_GPS_OK;
                ans.latitude = gps_pos.latitude;