Also log the hdop/vdop info to the gpx file
[gps-tracker] / gps-tracker.c
1 #include <glib.h>
2 #include <glib/gstdio.h>
3
4 #include <hildon/hildon.h>
5 #include <hildon/hildon-file-chooser-dialog.h>
6 #include <location/location-gpsd-control.h>
7 #include <location/location-gps-device.h>
8 #include <location/location-misc.h>
9 #include <location/location-distance-utils.h>
10
11 typedef struct {
12     HildonProgram *program;
13     HildonWindow *window;
14     
15     GtkWidget * main_vbox, *btn_hbox;
16     GtkWidget *status_label;
17     GtkButton *start_stop_button, *save_button;
18     gboolean tracking_is_on;
19     FILE *outf_p;
20     gchar *working_dir;
21     gchar *intermediate_gpx_data_filename;
22 } AppData;
23
24 static gchar * interface_file_chooser (AppData * appdata, GtkFileChooserAction action)
25 {
26     GtkWidget *dialog;
27     gchar *filename = NULL;
28     gchar tmpname[PATH_MAX];
29     time_t t;
30     struct tm *tmp;
31     
32     t = time(NULL);
33     tmp = localtime(&t);
34     strftime(tmpname, sizeof(tmpname), "gps-tracker-%F-%H-%M.gpx", tmp);
35     dialog = hildon_file_chooser_dialog_new (GTK_WINDOW (appdata->window), action);
36     gtk_widget_show_all (GTK_WIDGET (dialog));
37     gtk_file_chooser_set_current_name(GTK_FILE_CHOOSER (dialog), tmpname);
38     gtk_file_chooser_set_current_folder(GTK_FILE_CHOOSER(dialog), appdata->working_dir);
39
40     if (gtk_dialog_run (GTK_DIALOG (dialog)) == GTK_RESPONSE_OK) {
41         filename = gtk_file_chooser_get_filename (GTK_FILE_CHOOSER (dialog));
42     }
43
44     gtk_widget_destroy(dialog);
45     return filename;
46 }
47
48 static void write_gpx_header(FILE *fp)
49 {
50   g_return_if_fail(fp);
51   g_fprintf(fp,
52       "<?xml version=\"1.0\" encoding=\"UTF-8\"?>\n"
53       "<gpx version=\"1.0\"\n"
54       "creator=\"GPS tracker for Maemo\"\n"
55       "xmlns:xsi=\"http://www.w3.org/2001/XMLSchema-instance\"\n"
56       "xmlns=\"http://www.topografix.com/GPX/1/0\"\n"
57       "xsi:schemaLocation=\"http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd\">\n"
58       "<trk>\n<trkseg>\n"
59       );
60 }
61
62 static void write_gpx_footer(FILE *fp)
63 {
64   g_return_if_fail(fp);
65   g_fprintf(fp, "</trkseg>\n</trk>\n</gpx>\n");
66 }
67
68 static void cb_start_stop (GtkWidget * w, AppData * data)
69 {
70   data->tracking_is_on = !data->tracking_is_on;
71   if(data->tracking_is_on) { /* START pressed */
72     data->outf_p = fopen(data->intermediate_gpx_data_filename, "w");
73     write_gpx_header(data->outf_p);
74     hildon_banner_show_information(GTK_WIDGET(data->window), NULL, "Tracking started");
75     gtk_button_set_label (data->start_stop_button, "Stop");
76     gtk_widget_set_sensitive(GTK_WIDGET(data->save_button), FALSE);
77   }
78   else { /* STOP pressed */
79     if(data->outf_p) {
80       write_gpx_footer(data->outf_p);
81       fclose(data->outf_p);
82       data->outf_p = NULL;
83     }
84     gtk_button_set_label (data->start_stop_button, "Start");
85     hildon_banner_show_information(GTK_WIDGET(data->window), NULL, "Tracking stopped");
86     gtk_widget_set_sensitive(GTK_WIDGET(data->save_button), TRUE);
87   }
88 }
89
90 static void cb_file_save (GtkWidget * w, AppData * data)
91 {
92     gchar *filename = NULL;
93     filename = interface_file_chooser (data, GTK_FILE_CHOOSER_ACTION_SAVE);
94
95     if (filename) {
96       if(g_file_test(data->intermediate_gpx_data_filename, G_FILE_TEST_IS_REGULAR | G_FILE_TEST_EXISTS)) {
97         g_rename(data->intermediate_gpx_data_filename, filename);
98         //g_print ("File saved as %s\n", filename);
99         hildon_banner_show_information(GTK_WIDGET(data->window), NULL, filename);
100       }
101       else {
102         hildon_banner_show_information(GTK_WIDGET(data->window), NULL, "Temp file not found");
103       }
104     }
105     g_free(filename);
106 }
107
108 static void
109 on_gps_device_changed (LocationGPSDevice *device, gpointer data)
110 {
111   AppData *app_data = data;
112   GtkLabel *info = (GtkLabel*)app_data->status_label;
113   GString *msg;
114   FILE *fp = app_data->outf_p;
115   gchar sbuf1[G_ASCII_DTOSTR_BUF_SIZE], sbuf2[G_ASCII_DTOSTR_BUF_SIZE];
116         if (!device)
117                 return;
118
119   msg = g_string_sized_new (512);
120   if (device->fix && device->status) {
121     if (device->fix->fields & LOCATION_GPS_DEVICE_LATLONG_SET) {
122       //g_print ("lat = %f, long = %f\n", device->fix->latitude, device->fix->longitude);
123       g_string_append_printf (msg, "lat = %f, long = %f\n",
124           device->fix->latitude,
125           device->fix->longitude);
126       if(fp)
127         g_fprintf(fp, "\n<trkpt lat=\"%s\" lon=\"%s\">\n",
128           g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->latitude),
129           g_ascii_formatd(sbuf2, sizeof(sbuf2), "%f", device->fix->longitude));
130
131       if (device->fix->fields & LOCATION_GPS_DEVICE_TIME_SET) {
132         //g_print ("time = %f\n", device->fix->time);
133         g_string_append_printf(msg, "time = %F\n", device->fix->time);
134         if(fp) {
135           gchar st[64];
136           struct tm *tmp;
137           time_t t = device->fix->time;
138           tmp = localtime(&t);
139           strftime(st, sizeof(st), "%FT%T%Z", tmp);
140           /* FIXME Is this really correct */
141           g_fprintf(fp, "<time>%s</time>\n", st);
142         }
143       }
144
145       if (device->fix->fields & LOCATION_GPS_DEVICE_ALTITUDE_SET) {
146         //g_print ("alt = %f\n", device->fix->altitude);
147         g_string_append_printf (msg, "alt = %f\n", device->fix->altitude);
148         if(fp)
149           g_fprintf(fp, "<ele>%s</ele>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->altitude));
150
151       }
152
153       if (device->fix->fields & LOCATION_GPS_DEVICE_SPEED_SET) {
154         //g_print ("speed = %f\n", device->fix->speed);
155         g_string_append_printf (msg, "speed = %f, ", device->fix->speed);
156         if(fp)
157           g_fprintf(fp, "<speed>%s</speed>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->speed));
158       }
159
160       if (device->fix->fields & LOCATION_GPS_DEVICE_TRACK_SET) {
161         //g_print ("track = %f\n", device->fix->track);
162         g_string_append_printf (msg, "track = %f, ", device->fix->track);
163         if(fp)
164           g_fprintf(fp, "<course>%s</course>\n", g_ascii_formatd(sbuf1, sizeof(sbuf1), "%f", device->fix->track));
165       }
166
167       if (device->fix->fields & LOCATION_GPS_DEVICE_CLIMB_SET) {
168         //g_print ("climb = %f\n", device->fix->climb);
169         g_string_append_printf (msg, "climb = %f\n", device->fix->climb);
170       }
171
172       //g_print ("Accuracy values:\n");
173       //g_print ("\tept = %e, eph = %e, epv = %e, epd = %e, "
174       //    "eps = %e, epc = %e\n",
175       //    device->fix->ept,
176       //    device->fix->eph,
177       //    device->fix->epv,
178       //    device->fix->epd,
179       //    device->fix->eps,
180       //    device->fix->epc);
181       if(fp) {
182         g_fprintf(fp, "<hdop>%.1f</hdop>\n<vdop>%.1f</vdop>\n", device->fix->eph / 100.0, device->fix->epv);
183         g_fprintf(fp, "</trkpt>\n");
184       }
185     }
186   }
187         
188         //g_print ("Satellites in view: %d\n", device->satellites_in_view);
189         //g_print ("Satellites in use: %d\n", device->satellites_in_use);
190   g_string_append_printf (msg, "Satellites = % 2d/% 2d\n", device->satellites_in_use, device->satellites_in_view);
191         //g_print ("GPS status: %d\n", device->status);
192         g_string_append_printf (msg, "GPS status: %d\n", device->status);
193
194   hildon_gtk_window_set_progress_indicator(GTK_WINDOW(app_data->window), device->status == LOCATION_GPS_DEVICE_STATUS_NO_FIX);
195
196
197         //if (device->cell_info) {
198         //      if (device->cell_info->flags & LOCATION_CELL_INFO_GSM_CELL_INFO_SET)
199         //              g_print ("Mobile Coutry Code GSM: %d\n", device->cell_info->gsm_cell_info.mcc);
200
201         //      if (device->cell_info->flags & LOCATION_CELL_INFO_WCDMA_CELL_INFO_SET)
202         //              g_print ("Mobile Coutry Code WCDMA: %d\n", device->cell_info->wcdma_cell_info.mcc);
203         //}
204
205   gtk_label_set_text(info, msg->str);
206   if(device->status != LOCATION_GPS_DEVICE_STATUS_NO_FIX)
207     gtk_widget_set_sensitive(GTK_WIDGET(app_data->start_stop_button), TRUE);
208   //gtk_widget_show(GTK_WIDGET(info));
209   g_string_free(msg, TRUE);
210 }
211
212 static void
213 on_gps_error (LocationGPSDevice *device, gpointer data)
214 {
215   //AppData *app_data = data;
216         g_error ("GPS error");
217 }
218
219 static void
220 on_gps_stop (LocationGPSDevice *device, gpointer data)
221 {
222   AppData *app_data = data;
223   const gchar *msg = "GPS stopped";
224   hildon_banner_show_information(GTK_WIDGET(app_data->window), NULL, msg);
225         g_warning (msg);
226 }
227
228 static void
229 on_gps_start (LocationGPSDevice *device, gpointer data)
230 {
231   AppData *app_data = data;
232   const gchar *msg = "GPS started";
233   hildon_banner_show_information(GTK_WIDGET(app_data->window), NULL, msg);
234         g_warning (msg);
235 }
236
237 int main (int argc, char **argv)
238 {
239   AppData * data = g_new0 (AppData, 1);
240
241         hildon_gtk_init (&argc, &argv);
242         LocationGPSDControl *control;
243         LocationGPSDevice *device;
244
245   data->working_dir = g_strdup_printf("%s" G_DIR_SEPARATOR_S "MyDocs", g_get_home_dir());
246   data->intermediate_gpx_data_filename = g_strdup_printf("%s" G_DIR_SEPARATOR_S ".gps-tracker.gpx", data->working_dir);
247         data->program = hildon_program_get_instance ();
248         g_set_application_name("GPS tracker");
249
250         data->window = HILDON_WINDOW(hildon_stackable_window_new ());
251         hildon_program_add_window (data->program, HILDON_WINDOW (data->window));
252
253   data->main_vbox = (void*)gtk_vbox_new(FALSE, 0);
254   data->btn_hbox = (void*)gtk_hbox_new(TRUE, 0);
255
256   data->start_stop_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
257   gtk_button_set_label (data->start_stop_button, "Start");
258   gtk_widget_set_sensitive(GTK_WIDGET(data->start_stop_button), FALSE);
259   data->save_button = GTK_BUTTON (hildon_gtk_button_new (HILDON_SIZE_THUMB_HEIGHT | HILDON_SIZE_HALFSCREEN_WIDTH));
260   gtk_button_set_label (data->save_button, "Save");
261   gtk_widget_set_sensitive(GTK_WIDGET(data->save_button), FALSE);
262   gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->start_stop_button), FALSE, FALSE, 8);
263   gtk_box_pack_start(GTK_BOX(data->btn_hbox), GTK_WIDGET(data->save_button), FALSE, FALSE, 8);
264   gtk_box_pack_start(GTK_BOX(data->main_vbox), GTK_WIDGET(data->btn_hbox), FALSE, FALSE, 0);
265   data->status_label = gtk_label_new("Waiting for GPS ...");
266   gtk_box_pack_start_defaults(GTK_BOX(data->main_vbox), data->status_label);
267         /* Add vbox to main window */
268         gtk_container_add (GTK_CONTAINER (data->window), GTK_WIDGET(data->main_vbox));
269
270   g_signal_connect (G_OBJECT (data->save_button), "clicked", G_CALLBACK (cb_file_save), data);
271   g_signal_connect (G_OBJECT (data->start_stop_button), "clicked", G_CALLBACK (cb_start_stop), data);
272         g_signal_connect (G_OBJECT (data->window), "destroy",
273                         G_CALLBACK (gtk_main_quit), NULL);
274
275         control = location_gpsd_control_get_default ();
276   location_gpsd_control_start (control);
277
278         /*
279          * Note that in real life one may want to use some other method and interval
280          * than LOCATION_METHOD_USER_SELECTED and LOCATION_INTERVAL_DEFAULT,
281          * respectively. For more information on possible values for these parameters
282          * please see liblocation online documentation.
283          */
284         g_object_set (G_OBJECT (control), 
285                         "preferred-method", LOCATION_METHOD_USER_SELECTED,
286                         "preferred-interval", LOCATION_INTERVAL_DEFAULT,
287                         NULL);
288
289         device  = g_object_new (LOCATION_TYPE_GPS_DEVICE, NULL);
290
291         g_signal_connect (control, "error",             G_CALLBACK (on_gps_error),              data);
292         g_signal_connect (control, "gpsd-running",      G_CALLBACK (on_gps_start),              data);
293         g_signal_connect (control, "gpsd-stopped",      G_CALLBACK (on_gps_stop),               data);
294         g_signal_connect (device,  "changed",           G_CALLBACK (on_gps_device_changed),     data);
295
296         gtk_widget_show_all (GTK_WIDGET (data->window));
297
298   hildon_gtk_window_set_progress_indicator(GTK_WINDOW(data->window), 1);
299         gtk_main ();
300
301   location_gpsd_control_stop (control);
302
303   if(data->outf_p)
304     fclose(data->outf_p);
305   g_unlink(data->intermediate_gpx_data_filename);
306   g_free(data->working_dir);
307   g_free(data->intermediate_gpx_data_filename);
308   g_free(data);
309         g_object_unref (device);
310         g_object_unref (control);
311
312         return 0;
313 }