Improved the detection when a fix is really usable
[gps-tracker] / gps-tracker.c
index f80ed4f..392ff79 100644 (file)
@@ -22,8 +22,10 @@ typedef struct {
     //GtkWidget *wp_label;
     GtkButton *wp_set_btn;
     GString *wp_marker_str;
-    gboolean tracking_is_on;
+    gboolean tracking_is_on, has_fix;
     FILE *outf_p;
+    guint points_recorded_in_current_segment;
+    LocationGPSDeviceStatus last_device_status;
     gchar *working_dir;
     gchar *intermediate_gpx_data_filename;
 } AppData;
@@ -58,11 +60,14 @@ static void write_gpx_header(FILE *fp)
   g_fprintf(fp,
       "<?xml version=\"1.0\" encoding=\"UTF-8\"?>\n"
       "<gpx version=\"1.0\"\n"
-      "creator=\"GPS tracker for Maemo\"\n"
+      "creator=\"GPS Træcker for Maemo\"\n"
       "xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"\n"
       "xmlns=\"http://www.topografix.com/GPX/1/0\"\n"
       "xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">\n"
-      "<trk>\n<trkseg>\n"
+      "<trk>\n"
+      "<name>gps-tracker</name>\n"
+      "<desc>This is a track recorded by 'GPS Træcker' on Maemo</desc>\n"
+      "<trkseg>\n"
       );
 }
 
@@ -92,6 +97,8 @@ static void cb_start_stop (GtkWidget * w, AppData * data)
   data->tracking_is_on = !data->tracking_is_on;
   if(data->tracking_is_on) { /* START pressed */
     data->outf_p = fopen(data->intermediate_gpx_data_filename, "w");
+    data->points_recorded_in_current_segment = 0;
+    data->last_device_status = LOCATION_GPS_DEVICE_STATUS_NO_FIX;
     write_gpx_header(data->outf_p);
     //hildon_banner_show_information(GTK_WIDGET(data->window), NULL, "Tracking started");
     gtk_button_set_label (data->start_stop_button, "Stop");
@@ -99,6 +106,8 @@ static void cb_start_stop (GtkWidget * w, AppData * data)
     gtk_widget_set_sensitive(GTK_WIDGET(data->wp_set_btn), TRUE);
   }
   else { /* STOP pressed */
+    data->points_recorded_in_current_segment = 0;
+    data->last_device_status = LOCATION_GPS_DEVICE_STATUS_NO_FIX;
     if(data->outf_p) {
       write_gpx_footer(data->outf_p);
       fclose(data->outf_p);
@@ -130,24 +139,57 @@ static void cb_file_save (GtkWidget * w, AppData * data)
     g_free(filename);
 }
 
-static void
-on_gps_device_changed (LocationGPSDevice *device, gpointer data)
+#define SPAN_PREFIX "<span font_family=\"monospace\" size=\"large\" weight=\"bold\">"
+#define SPAN_POST   "</span>"
+#define LABEL_FMT(s) SPAN_PREFIX s SPAN_POST
+#define CHANGE_LABEL(w,fmt,val) change_label_text(w, SPAN_PREFIX fmt SPAN_POST, val)
+#define CHANGE_LABEL2(w,fmt,val1, val2) change_label_text(w, SPAN_PREFIX fmt SPAN_POST, val1, val2)
+
+static void change_label_text(GtkWidget *l, gchar *format, ...)
+{
+  va_list args;
+  gchar buf[512];
+  va_start(args, format);
+  g_vsnprintf(buf, sizeof(buf), format, args);
+  va_end(args);
+  gtk_label_set_markup(GTK_LABEL(l), buf);
+}
+
+static void on_gps_device_changed (LocationGPSDevice *device, gpointer data)
 {
   AppData *app_data = data;
   FILE *fp = app_data->outf_p;
-  gchar sbuf1[30*G_ASCII_DTOSTR_BUF_SIZE], sbuf2[2*G_ASCII_DTOSTR_BUF_SIZE];
+  gchar sbuf1[G_ASCII_DTOSTR_BUF_SIZE], sbuf2[G_ASCII_DTOSTR_BUF_SIZE];
        if (!device)
                return;
 
-  if (device->fix && device->status) {
+  /* if there is no fix, or we are recording (fp != NULL), but the fix is so
+   * bad that it is a 2D fix only, with no time set then do not
+   * record any longer */
+  if ((device->status == LOCATION_GPS_DEVICE_STATUS_NO_FIX) ||
+      (device->fix && fp &&
+       (! device->fix->fields & LOCATION_GPS_DEVICE_TIME_SET) &&
+       (device->fix->mode == LOCATION_GPS_DEVICE_MODE_2D))) {
+    app_data->has_fix = FALSE;
+    hildon_banner_show_information(GTK_WIDGET(app_data->window), NULL, "WARNING: Lost fix");
+    app_data->last_device_status = LOCATION_GPS_DEVICE_STATUS_NO_FIX;
+  }
+  else if (device->fix) {
+    //g_print("mode=%d stat=%d\n", device->fix->mode, device->status);
     if (device->fix->fields & LOCATION_GPS_DEVICE_LATLONG_SET) {
+      app_data->has_fix = TRUE; /* fix found again */
       //g_print ("lat = %f, long = %f\n", device->fix->latitude, device->fix->longitude);
-      gtk_label_set_text(GTK_LABEL(app_data->lat_val_label), g_ascii_formatd(sbuf1, sizeof(sbuf1), "% 9.6f", device->fix->latitude));
-      gtk_label_set_text(GTK_LABEL(app_data->lon_val_label), g_ascii_formatd(sbuf1, sizeof(sbuf1), "% 9.6f", device->fix->longitude));
+      CHANGE_LABEL(app_data->lat_val_label, "% 9.6f", device->fix->latitude);
+      CHANGE_LABEL(app_data->lon_val_label, "% 9.6f", device->fix->longitude);
       if(fp) {
+        if(app_data->last_device_status != device->status) {
+          if(app_data->points_recorded_in_current_segment)
+            g_fprintf(fp, "\n</trkseg>\n<trkseg>\n");
+          app_data->last_device_status = device->status;
+        }
         g_fprintf(fp, "\n<trkpt lat=\"%s\" lon=\"%s\">\n",
-          g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->latitude),
-          g_ascii_formatd(sbuf2, sizeof(sbuf2), "%f", device->fix->longitude));
+            g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->latitude),
+            g_ascii_formatd(sbuf2, sizeof(sbuf2), "%f", device->fix->longitude));
         if(app_data->wp_marker_str->len) {
           g_fprintf(fp, "<name>%s</name>\n", app_data->wp_marker_str->str);
           hildon_banner_show_information(GTK_WIDGET(app_data->window), NULL, app_data->wp_marker_str->str);
@@ -155,6 +197,8 @@ on_gps_device_changed (LocationGPSDevice *device, gpointer data)
         }
       }
 
+      app_data->points_recorded_in_current_segment++;
+
       if (device->fix->fields & LOCATION_GPS_DEVICE_TIME_SET) {
         //g_print ("time = %f\n", device->fix->time);
         if(fp) {
@@ -177,33 +221,38 @@ on_gps_device_changed (LocationGPSDevice *device, gpointer data)
 
       if (device->fix->fields & LOCATION_GPS_DEVICE_ALTITUDE_SET) {
         //g_print ("alt = %f\n", device->fix->altitude);
-        gtk_label_set_text(GTK_LABEL(app_data->alt_val_label), g_ascii_formatd(sbuf1, sizeof(sbuf1), "% 5.0f", device->fix->altitude));
+        CHANGE_LABEL(app_data->alt_val_label, "% 5.0fm", device->fix->altitude);
         if(fp)
-          g_fprintf(fp, "<ele>%s</ele>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->altitude));
+          g_fprintf(fp, "<ele>%s</ele>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%.1f", device->fix->altitude));
 
       }
+      else
+        CHANGE_LABEL(app_data->alt_val_label, " ?", NULL);
 
       if (device->fix->fields & LOCATION_GPS_DEVICE_SPEED_SET) {
         //g_print ("speed = %f\n", device->fix->speed);
-        g_snprintf(sbuf1, sizeof(sbuf1), "% 5.1fkm/h", device->fix->speed);
-        gtk_label_set_text(GTK_LABEL(app_data->speed_val_label), sbuf1);
+        CHANGE_LABEL(app_data->speed_val_label, "% 5.1fkm/h", device->fix->speed);
         if(fp)
-          g_fprintf(fp, "<speed>%s</speed>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->speed));
+          g_fprintf(fp, "<speed>%s</speed>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%.1f", device->fix->speed));
       }
+      else
+        CHANGE_LABEL(app_data->speed_val_label, " ?", NULL);
 
       if (device->fix->fields & LOCATION_GPS_DEVICE_TRACK_SET) {
         //g_print ("track = %f\n", device->fix->track);
-        g_snprintf(sbuf1, sizeof(sbuf1), "%4.0f°", device->fix->track);
-        gtk_label_set_text(GTK_LABEL(app_data->track_val_label), sbuf1);
+        CHANGE_LABEL(app_data->track_val_label, "%4.0f°", device->fix->track);
         if(fp)
-          g_fprintf(fp, "<course>%s</course>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->track));
+          g_fprintf(fp, "<course>%s</course>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%.1f", device->fix->track));
       }
+      else
+        CHANGE_LABEL(app_data->track_val_label, " ?", NULL);
 
       if (device->fix->fields & LOCATION_GPS_DEVICE_CLIMB_SET) {
         //g_print ("climb = %f\n", device->fix->climb);
-        g_snprintf(sbuf1, sizeof(sbuf1), "%+4.0f°", device->fix->climb);
-        gtk_label_set_text(GTK_LABEL(app_data->climb_val_label), sbuf1);
+        CHANGE_LABEL(app_data->climb_val_label, "%+6.2fm/s", device->fix->climb);
       }
+      else
+        CHANGE_LABEL(app_data->climb_val_label, " ?", NULL);
 
       //g_print ("Accuracy values:\n");
       //g_print ("\tept = %e, eph = %e, epv = %e, epd = %e, "
@@ -225,13 +274,9 @@ on_gps_device_changed (LocationGPSDevice *device, gpointer data)
        
        //g_print ("Satellites in view: %d\n", device->satellites_in_view);
        //g_print ("Satellites in use: %d\n", device->satellites_in_use);
-  g_snprintf(sbuf1, sizeof(sbuf1), "%3d/%2d", device->satellites_in_use, device->satellites_in_view);
-  gtk_label_set_text(GTK_LABEL(app_data->sat_val_label), sbuf1);
+  CHANGE_LABEL2(app_data->sat_val_label, "%3d/%2d", device->satellites_in_use, device->satellites_in_view);
        //g_print ("GPS status: %d\n", device->status);
 
-  hildon_gtk_window_set_progress_indicator(GTK_WINDOW(app_data->window), device->status == LOCATION_GPS_DEVICE_STATUS_NO_FIX);
-
-
        //if (device->cell_info) {
        //      if (device->cell_info->flags & LOCATION_CELL_INFO_GSM_CELL_INFO_SET)
        //              g_print ("Mobile Coutry Code GSM: %d\n", device->cell_info->gsm_cell_info.mcc);
@@ -240,8 +285,18 @@ on_gps_device_changed (LocationGPSDevice *device, gpointer data)
        //              g_print ("Mobile Coutry Code WCDMA: %d\n", device->cell_info->wcdma_cell_info.mcc);
        //}
 
-  if(device->status != LOCATION_GPS_DEVICE_STATUS_NO_FIX)
+  if(app_data->has_fix) {
+    hildon_gtk_window_set_progress_indicator(GTK_WINDOW(app_data->window), 0);
     gtk_widget_set_sensitive(GTK_WIDGET(app_data->start_stop_button), TRUE);
+  }
+  else {
+    hildon_gtk_window_set_progress_indicator(GTK_WINDOW(app_data->window), 1);
+    CHANGE_LABEL(app_data->lat_val_label, " ?", NULL);
+    CHANGE_LABEL(app_data->lon_val_label, " ?", NULL);
+    CHANGE_LABEL(app_data->alt_val_label, " ?", NULL);
+    CHANGE_LABEL(app_data->speed_val_label, " ?", NULL);
+    CHANGE_LABEL(app_data->track_val_label, " ?", NULL);
+  }
 }
 
 static void
@@ -280,25 +335,13 @@ int main (int argc, char **argv)
   data->working_dir = g_strdup_printf("%s" G_DIR_SEPARATOR_S "MyDocs", g_get_home_dir());
   data->intermediate_gpx_data_filename = g_strdup_printf("%s" G_DIR_SEPARATOR_S ".gps-tracker.gpx", data->working_dir);
        data->program = hildon_program_get_instance ();
-       g_set_application_name("GPS tracker");
+       g_set_application_name("GPS Træcker");
 
        data->window = HILDON_WINDOW(hildon_stackable_window_new());
        hildon_program_add_window (data->program, HILDON_WINDOW (data->window));
 
   data->wp_marker_str = g_string_sized_new(64);
   data->main_vbox = (gpointer)gtk_vbox_new(FALSE, 0);
-  data->btn_hbox = (gpointer)gtk_hbox_new(TRUE, 0);
-
-  data->start_stop_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
-  gtk_button_set_label (data->start_stop_button, "Start");
-  gtk_widget_set_sensitive(GTK_WIDGET(data->start_stop_button), FALSE);
-  data->save_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
-  gtk_button_set_label (data->save_button, "Save");
-  gtk_widget_set_sensitive(GTK_WIDGET(data->save_button), FALSE);
-  gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->start_stop_button), FALSE, FALSE, 8);
-  gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->save_button), FALSE, FALSE, 8);
-  gtk_box_pack_start(GTK_BOX(data->main_vbox), GTK_WIDGET(data->btn_hbox), FALSE, FALSE, 0);
-
   data->loc_hbox = (gpointer)gtk_hbox_new(FALSE, 0);
   data->loc_gps_data_table = (gpointer)gtk_table_new(4, 2, FALSE);
   {
@@ -317,9 +360,9 @@ int main (int argc, char **argv)
     gtk_table_attach_defaults(data->loc_gps_data_table, lon_label, 0, 1, 1, 2);
     gtk_table_attach_defaults(data->loc_gps_data_table, alt_label, 0, 1, 2, 3);
     gtk_table_attach_defaults(data->loc_gps_data_table, sat_label, 0, 1, 3, 4);
-    data->lat_val_label = gtk_label_new(" ?");
-    data->lon_val_label = gtk_label_new(" ?");
-    data->alt_val_label = gtk_label_new(" ?");
+    data->lat_val_label = gtk_label_new(NULL);
+    data->lon_val_label = gtk_label_new(NULL);
+    data->alt_val_label = gtk_label_new(NULL);
     data->sat_val_label = gtk_label_new(" 0/ 0");
     gtk_misc_set_alignment (GTK_MISC (data->lat_val_label), 0, 0.5);
     gtk_misc_set_alignment (GTK_MISC (data->lon_val_label), 0, 0.5);
@@ -337,13 +380,13 @@ int main (int argc, char **argv)
     gtk_box_pack_start(GTK_BOX(data->loc_hbox), alignment_gps, TRUE, FALSE, 0);
   }
 
-  //gtk_box_pack_start(GTK_BOX(data->loc_hbox), gtk_vseparator_new(), TRUE, FALSE, 0);
+  gtk_box_pack_start(GTK_BOX(data->loc_hbox), gtk_vseparator_new(), TRUE, FALSE, 0);
 
   data->loc_track_data_table = (gpointer)gtk_table_new(4, 2, TRUE);
   {
     GtkWidget *alignment_track = gtk_alignment_new (0.5, 0.5, 1, 1);
     GtkWidget *speed_label = gtk_label_new("Speed:");
-    GtkWidget *track_label = gtk_label_new("Heading:");
+    GtkWidget *track_label = gtk_label_new("Orientation:");
     GtkWidget *climb_label = gtk_label_new("Climb:");
     gtk_alignment_set_padding(GTK_ALIGNMENT(alignment_track), 0,0,0,0);
     gtk_misc_set_alignment (GTK_MISC (speed_label), 1, 0.5);
@@ -352,9 +395,10 @@ int main (int argc, char **argv)
     gtk_table_attach_defaults(data->loc_track_data_table, speed_label, 0, 1, 0, 1);
     gtk_table_attach_defaults(data->loc_track_data_table, track_label, 0, 1, 1, 2);
     gtk_table_attach_defaults(data->loc_track_data_table, climb_label, 0, 1, 2, 3);
-    data->speed_val_label = gtk_label_new(" ?");
-    data->track_val_label = gtk_label_new(" ?");
-    data->climb_val_label = gtk_label_new(" ?");
+    data->speed_val_label = gtk_label_new(NULL);
+    CHANGE_LABEL(data->speed_val_label, "% 5.1fkm/h", 0.);
+    data->track_val_label = gtk_label_new(NULL);
+    data->climb_val_label = gtk_label_new(NULL);
     gtk_misc_set_alignment (GTK_MISC (data->speed_val_label), 0, 0.5);
     gtk_misc_set_alignment (GTK_MISC (data->track_val_label), 0, 0.5);
     gtk_misc_set_alignment (GTK_MISC (data->climb_val_label), 0, 0.5);
@@ -374,13 +418,25 @@ int main (int argc, char **argv)
   //data->wp_label = gtk_label_new("Marker:");
   data->wp_name_entry = hildon_entry_new (HILDON_SIZE_HALFSCREEN_WIDTH);
   //hildon_entry_set_placeholder (HILDON_ENTRY (data->wp_name_entry), "First name");
-  data->wp_set_btn = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_FINGER_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
+  data->wp_set_btn = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_HALFSCREEN_WIDTH));
   gtk_button_set_label (data->wp_set_btn, "Set marker");
   gtk_widget_set_sensitive(GTK_WIDGET(data->wp_set_btn), FALSE);
   //gtk_box_pack_start(GTK_BOX(data->wp_hbox), GTK_WIDGET(data->wp_label), TRUE, FALSE, 0);
   gtk_box_pack_start(GTK_BOX(data->wp_hbox), GTK_WIDGET(data->wp_name_entry), TRUE, FALSE, 0);
   gtk_box_pack_start(GTK_BOX(data->wp_hbox), GTK_WIDGET(data->wp_set_btn), TRUE, FALSE, 0);
-  gtk_box_pack_end(GTK_BOX(data->main_vbox), GTK_WIDGET(data->wp_hbox), FALSE, FALSE, 0);
+  gtk_box_pack_start(GTK_BOX(data->main_vbox), GTK_WIDGET(data->wp_hbox), FALSE, FALSE, 0);
+
+  data->btn_hbox = (gpointer)gtk_hbox_new(TRUE, 0);
+
+  data->start_stop_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
+  gtk_button_set_label (data->start_stop_button, "Start");
+  gtk_widget_set_sensitive(GTK_WIDGET(data->start_stop_button), FALSE);
+  data->save_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
+  gtk_button_set_label (data->save_button, "Save");
+  gtk_widget_set_sensitive(GTK_WIDGET(data->save_button), FALSE);
+  gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->start_stop_button), FALSE, FALSE, 8);
+  gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->save_button), FALSE, FALSE, 8);
+  gtk_box_pack_start(GTK_BOX(data->main_vbox), GTK_WIDGET(data->btn_hbox), FALSE, FALSE, 4);
 
        /* Add vbox to main window */
        gtk_container_add (GTK_CONTAINER (data->window), GTK_WIDGET(data->main_vbox));