src/vikgpslayer.c

   1 /*
   2  * viking -- GPS Data and Topo Analyzer, Explorer, and Manager
   3  *
   4  * Copyright (C) 2003-2005, Evan Battaglia <gtoevan@gmx.net>
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation; either version 2 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program; if not, write to the Free Software
  18  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  *
  20  */
  21
  22 #include "viking.h"
  23 #include "vikgpslayer_pixmap.h"
  24 #include "babel.h"
  25
  26 #include <string.h>
  27 #include <glib.h>
  28 #include <glib/gprintf.h>
  29
  30 #define DISCONNECT_UPDATE_SIGNAL(vl, val) g_signal_handlers_disconnect_matched(vl, G_SIGNAL_MATCH_DATA, 0, 0, 0, 0, val)
  31 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp);
  32 static void vik_gps_layer_realize ( VikGpsLayer *val, VikTreeview *vt, GtkTreeIter *layer_iter );
  33 static void vik_gps_layer_free ( VikGpsLayer *val );
  34 static void vik_gps_layer_draw ( VikGpsLayer *val, gpointer data );
  35 VikGpsLayer *vik_gps_layer_new ();
  36
  37 static VikGpsLayer *gps_layer_copy ( VikGpsLayer *val, gpointer vp );
  38 static void gps_layer_marshall( VikGpsLayer *val, guint8 **data, gint *len );
  39 static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp );
  40 static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp );
  41 static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id );
  42
  43 static void gps_layer_change_coord_mode ( VikGpsLayer *val, VikCoordMode mode );
  44 static void gps_layer_add_menu_items( VikGpsLayer *vtl, GtkMenu *menu, gpointer vlp );
  45 static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path );
  46
  47
  48 static void gps_upload_cb( gpointer layer_and_vlp[2] );
  49 static void gps_download_cb( gpointer layer_and_vlp[2] );
  50
  51 typedef enum {GARMIN_P = 0, MAGELLAN_P, NUM_PROTOCOLS} vik_gps_proto;
  52 static gchar * params_protocols[] = {"Garmin", "Magellan", NULL};
  53 static gchar * protocols_args[]   = {"garmin", "magellan"};
  54 /*#define NUM_PROTOCOLS (sizeof(params_protocols)/sizeof(params_protocols[0]) - 1) */
  55 static gchar * params_ports[] = {"/dev/ttyS0", "/dev/ttyS1", "/dev/ttyUSB0", "/dev/ttyUSB1", NULL};
  56 #define NUM_PORTS (sizeof(params_ports)/sizeof(params_ports[0]) - 1)
  57 typedef enum {GPS_DOWN=0, GPS_UP} gps_dir;
  58
  59 typedef struct {
  60   GMutex *mutex;
  61   gps_dir direction;
  62   gchar *port;
  63   gboolean ok;
  64   gint total_count;
  65   gint count;
  66   VikTrwLayer *vtl;
  67   gchar *cmd_args;
  68   gchar * window_title;
  69   GtkWidget *dialog;
  70   GtkWidget *status_label;
  71   GtkWidget *gps_label;
  72   GtkWidget *ver_label;
  73   GtkWidget *id_label;
  74   GtkWidget *wp_label;
  75   GtkWidget *progress_label;
  76   GtkWidget *trk_label;
  77 } GpsSession;
  78 static void gps_session_delete(GpsSession *sess);
  79
  80 static VikLayerParam gps_layer_params[] = {
  81   { "gps_protocol", VIK_LAYER_PARAM_UINT, VIK_LAYER_GROUP_NONE, "GPS Protocol:", VIK_LAYER_WIDGET_COMBOBOX, params_protocols, NULL},
  82   { "gps_port", VIK_LAYER_PARAM_UINT, VIK_LAYER_GROUP_NONE, "Serial Port:", VIK_LAYER_WIDGET_COMBOBOX, params_ports, NULL},
  83 };
  84 enum {PARAM_PROTOCOL=0, PARAM_PORT, NUM_PARAMS};
  85
  86 VikLayerInterface vik_gps_layer_interface = {
  87   "GPS",
  88   &gpslayer_pixbuf,
  89
  90   NULL,
  91   0,
  92
  93   gps_layer_params,
  94   NUM_PARAMS,
  95   NULL,
  96   0,
  97
  98   VIK_MENU_ITEM_ALL & ~(VIK_MENU_ITEM_CUT|VIK_MENU_ITEM_COPY),
  99
 100   (VikLayerFuncCreate)                  vik_gps_layer_create,
 101   (VikLayerFuncRealize)                 vik_gps_layer_realize,
 102   (VikLayerFuncPostRead)                NULL,
 103   (VikLayerFuncFree)                    vik_gps_layer_free,
 104
 105   (VikLayerFuncProperties)              NULL,
 106   (VikLayerFuncDraw)                    vik_gps_layer_draw,
 107   (VikLayerFuncChangeCoordMode)         gps_layer_change_coord_mode,
 108
 109   (VikLayerFuncAddMenuItems)            gps_layer_add_menu_items,
 110   (VikLayerFuncSublayerAddMenuItems)    NULL,
 111
 112   (VikLayerFuncSublayerRenameRequest)   NULL,
 113   (VikLayerFuncSublayerToggleVisible)   NULL,
 114
 115   (VikLayerFuncCopy)                    gps_layer_copy,
 116   (VikLayerFuncMarshall)                gps_layer_marshall,
 117   (VikLayerFuncUnmarshall)              gps_layer_unmarshall,
 118
 119   (VikLayerFuncSetParam)                gps_layer_set_param,
 120   (VikLayerFuncGetParam)                gps_layer_get_param,
 121
 122   (VikLayerFuncReadFileData)            NULL,
 123   (VikLayerFuncWriteFileData)           NULL,
 124
 125   (VikLayerFuncDeleteItem)              NULL,
 126   (VikLayerFuncCopyItem)                NULL,
 127   (VikLayerFuncPasteItem)               NULL,
 128   (VikLayerFuncFreeCopiedItem)          NULL,
 129   (VikLayerFuncDragDropRequest)         gps_layer_drag_drop_request,
 130 };
 131
 132 enum {TRW_DOWNLOAD, TRW_UPLOAD, NUM_TRW};
 133 static gchar * trw_names[] = {"GPS Download", "GPS Upload"};
 134 struct _VikGpsLayer {
 135   VikLayer vl;
 136   VikTrwLayer * trw_children[NUM_TRW];
 137   /* params */
 138   guint protocol_id;
 139   guint serial_port_id;
 140 };
 141
 142 GType vik_gps_layer_get_type ()
 143 {
 144   static GType val_type = 0;
 145
 146   if (!val_type)
 147   {
 148     static const GTypeInfo val_info =
 149     {
 150       sizeof (VikGpsLayerClass),
 151       NULL, /* base_init */
 152       NULL, /* base_finalize */
 153       NULL, /* class init */
 154       NULL, /* class_finalize */
 155       NULL, /* class_data */
 156       sizeof (VikGpsLayer),
 157       0,
 158       NULL /* instance init */
 159     };
 160     val_type = g_type_register_static ( VIK_LAYER_TYPE, "VikGpsLayer", &val_info, 0 );
 161   }
 162
 163   return val_type;
 164 }
 165
 166 static VikGpsLayer *vik_gps_layer_create (VikViewport *vp)
 167 {
 168   VikGpsLayer *rv = vik_gps_layer_new ();
 169   vik_layer_rename ( VIK_LAYER(rv), vik_gps_layer_interface.name );
 170   rv->trw_children[TRW_UPLOAD] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE ));
 171   rv->trw_children[TRW_DOWNLOAD] = VIK_TRW_LAYER(vik_layer_create ( VIK_LAYER_TRW, vp, NULL, FALSE ));
 172   return rv;
 173 }
 174
 175 static VikGpsLayer *gps_layer_copy ( VikGpsLayer *vgl, gpointer vp )
 176 {
 177   VikGpsLayer *rv = vik_gps_layer_new ();
 178   int i;
 179
 180   for (i = 0; i < NUM_TRW; i++) {
 181     rv->trw_children[i] = (VikTrwLayer *)vik_layer_copy(VIK_LAYER(vgl->trw_children[i]), vp);
 182     g_signal_connect_swapped ( G_OBJECT(rv->trw_children[i]), "update", G_CALLBACK(vik_layer_emit_update), rv );
 183   }
 184
 185   return rv;
 186 }
 187
 188 /* "Copy" */
 189 static void gps_layer_marshall( VikGpsLayer *vgl, guint8 **data, gint *datalen )
 190 {
 191   VikLayer *child_layer;
 192   guint8 *ld;
 193   gint ll;
 194   GByteArray* b = g_byte_array_new ();
 195   gint len;
 196   gint i;
 197
 198 #define alm_append(obj, sz)     \
 199   len = (sz);                   \
 200   g_byte_array_append ( b, (guint8 *)&len, sizeof(len) );       \
 201   g_byte_array_append ( b, (guint8 *)(obj), len );
 202
 203   vik_layer_marshall_params(VIK_LAYER(vgl), &ld, &ll);
 204   alm_append(ld, ll);
 205   g_free(ld);
 206
 207   for (i = 0; i < NUM_TRW; i++) {
 208     child_layer = VIK_LAYER(vgl->trw_children[i]);
 209     vik_layer_marshall(child_layer, &ld, &ll);
 210     if (ld) {
 211       alm_append(ld, ll);
 212       g_free(ld);
 213     }
 214   }
 215   *data = b->data;
 216   *datalen = b->len;
 217   g_byte_array_free(b, FALSE);
 218 #undef alm_append
 219 }
 220
 221 /* "Paste" */
 222 static VikGpsLayer *gps_layer_unmarshall( guint8 *data, gint len, VikViewport *vvp )
 223 {
 224 #define alm_size (*(gint *)data)
 225 #define alm_next \
 226   len -= sizeof(gint) + alm_size; \
 227   data += sizeof(gint) + alm_size;
 228
 229   VikGpsLayer *rv = vik_gps_layer_new();
 230   VikLayer *child_layer;
 231   gint i;
 232
 233   vik_layer_unmarshall_params ( VIK_LAYER(rv), data+sizeof(gint), alm_size, vvp );
 234   alm_next;
 235
 236   i = 0;
 237   while (len>0 && i < NUM_TRW) {
 238     child_layer = vik_layer_unmarshall ( data + sizeof(gint), alm_size, vvp );
 239     if (child_layer) {
 240       rv->trw_children[i++] = (VikTrwLayer *)child_layer;
 241       g_signal_connect_swapped ( G_OBJECT(child_layer), "update", G_CALLBACK(vik_layer_emit_update), rv );
 242     }
 243     alm_next;
 244   }
 245   //  g_print("gps_layer_unmarshall ended with len=%d\n", len);
 246   g_assert(len == 0);
 247   return rv;
 248 #undef alm_size
 249 #undef alm_next
 250 }
 251
 252 static gboolean gps_layer_set_param ( VikGpsLayer *vgl, guint16 id, VikLayerParamData data, VikViewport *vp )
 253 {
 254   switch ( id )
 255   {
 256     case PARAM_PROTOCOL:
 257       if (data.u < NUM_PROTOCOLS)
 258         vgl->protocol_id = data.u;
 259       else
 260         g_warning("Unknown GPS Protocol");
 261       break;
 262     case PARAM_PORT:
 263       if (data.u < NUM_PORTS)
 264         vgl->serial_port_id = data.u;
 265       else
 266         g_warning("Unknown serial port device");
 267       break;
 268   }
 269
 270   return TRUE;
 271 }
 272
 273 static VikLayerParamData gps_layer_get_param ( VikGpsLayer *vgl, guint16 id )
 274 {
 275   VikLayerParamData rv;
 276   switch ( id )
 277   {
 278     case PARAM_PROTOCOL:
 279       rv.u = vgl->protocol_id;
 280       break;
 281     case PARAM_PORT:
 282       rv.u = vgl->serial_port_id;
 283       break;
 284     default:
 285       g_warning("gps_layer_get_param(): unknown parameter");
 286   }
 287
 288   /* fprintf(stderr, "gps_layer_get_param() called\n"); */
 289
 290   return rv;
 291 }
 292
 293 VikGpsLayer *vik_gps_layer_new ()
 294 {
 295   gint i;
 296   VikGpsLayer *vgl = VIK_GPS_LAYER ( g_object_new ( VIK_GPS_LAYER_TYPE, NULL ) );
 297   vik_layer_init ( VIK_LAYER(vgl), VIK_LAYER_GPS );
 298   for (i = 0; i < NUM_TRW; i++) {
 299     vgl->trw_children[i] = NULL;
 300   }
 301
 302   /* Setting params here */
 303   vgl->protocol_id = 0;
 304   vgl->serial_port_id = 0;
 305
 306   return vgl;
 307 }
 308
 309 static void vik_gps_layer_draw ( VikGpsLayer *vgl, gpointer data )
 310 {
 311   gint i;
 312
 313   for (i = 0; i < NUM_TRW; i++) {
 314     vik_layer_draw((VikLayer*)(vgl->trw_children[i]), data);
 315   }
 316 }
 317
 318 static void gps_layer_change_coord_mode ( VikGpsLayer *vgl, VikCoordMode mode )
 319 {
 320   gint i;
 321   for (i = 0; i < NUM_TRW; i++) {
 322     vik_layer_change_coord_mode((VikTrwLayer *)(vgl->trw_children[i]), mode);
 323   }
 324 }
 325
 326 static void gps_layer_add_menu_items( VikGpsLayer *vgl, GtkMenu *menu, gpointer vlp )
 327 {
 328   static gpointer pass_along[2];
 329   GtkWidget *item;
 330   pass_along[0] = vgl;
 331   pass_along[1] = vlp;
 332
 333   item = gtk_menu_item_new();
 334   gtk_menu_shell_append ( GTK_MENU_SHELL(menu), item );
 335   gtk_widget_show ( item );
 336
 337   item = gtk_menu_item_new_with_label ( "Upload to GPS" );
 338   g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_upload_cb), pass_along );
 339   gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
 340   gtk_widget_show ( item );
 341
 342   item = gtk_menu_item_new_with_label ( "Download from GPS" );
 343   g_signal_connect_swapped ( G_OBJECT(item), "activate", G_CALLBACK(gps_download_cb), pass_along );
 344   gtk_menu_shell_append (GTK_MENU_SHELL (menu), item);
 345   gtk_widget_show ( item );
 346
 347 }
 348
 349 static void disconnect_layer_signal ( VikLayer *vl, VikGpsLayer *vgl )
 350 {
 351   g_assert(DISCONNECT_UPDATE_SIGNAL(vl,vgl)==1);
 352 }
 353
 354 static void vik_gps_layer_free ( VikGpsLayer *vgl )
 355 {
 356   gint i;
 357   for (i = 0; i < NUM_TRW; i++) {
 358     if (vgl->vl.realized)
 359       disconnect_layer_signal(VIK_LAYER(vgl->trw_children[i]), vgl);
 360     g_object_unref(vgl->trw_children[i]);
 361   }
 362 }
 363
 364 static void delete_layer_iter ( VikLayer *vl )
 365 {
 366   if ( vl->realized )
 367     vik_treeview_item_delete ( vl->vt, &(vl->iter) );
 368 }
 369
 370 gboolean vik_gps_layer_delete ( VikGpsLayer *vgl, GtkTreeIter *iter )
 371 {
 372   gint i;
 373   VikLayer *l = VIK_LAYER( vik_treeview_item_get_pointer ( VIK_LAYER(vgl)->vt, iter ) );
 374   gboolean was_visible = l->visible;
 375
 376   vik_treeview_item_delete ( VIK_LAYER(vgl)->vt, iter );
 377   for (i = 0; i < NUM_TRW; i++) {
 378     if (vgl->trw_children[i] == l)
 379       vgl->trw_children[i] = NULL;
 380   }
 381   g_assert(DISCONNECT_UPDATE_SIGNAL(l,vgl)==1);
 382   g_object_unref ( l );
 383
 384   return was_visible;
 385 }
 386
 387 #if 0
 388 /* returns 0 == we're good, 1 == didn't find any layers, 2 == got rejected */
 389 guint vik_gps_layer_tool ( VikGpsLayer *val, guint16 layer_type, VikToolInterfaceFunc tool_func, GdkEventButton *event, VikViewport *vvp )
 390 {
 391   GList *iter = val->children;
 392   gboolean found_rej = FALSE;
 393   if (!iter)
 394     return FALSE;
 395   while (iter->next)
 396     iter = iter->next;
 397
 398   while ( iter )
 399   {
 400     /* if this layer "accepts" the tool call */
 401     if ( VIK_LAYER(iter->data)->visible && VIK_LAYER(iter->data)->type == layer_type )
 402     {
 403       if ( tool_func ( VIK_LAYER(iter->data), event, vvp ) )
 404         return 0;
 405       else
 406         found_rej = TRUE;
 407     }
 408
 409     /* recursive -- try the same for the child gps layer. */
 410     else if ( VIK_LAYER(iter->data)->visible && VIK_LAYER(iter->data)->type == VIK_LAYER_GPS )
 411     {
 412       gint rv = vik_gps_layer_tool(VIK_GPS_LAYER(iter->data), layer_type, tool_func, event, vvp);
 413       if ( rv == 0 )
 414         return 0;
 415       else if ( rv == 2 )
 416         found_rej = TRUE;
 417     }
 418     iter = iter->prev;
 419   }
 420   return found_rej ? 2 : 1; /* no one wanted to accept the tool call in this layer */
 421 }
 422 #endif
 423
 424 static void vik_gps_layer_realize ( VikGpsLayer *vgl, VikTreeview *vt, GtkTreeIter *layer_iter )
 425 {
 426   GtkTreeIter iter;
 427   int ix;
 428
 429   for (ix = 0; ix < NUM_TRW; ix++) {
 430     VikLayer * trw = VIK_LAYER(vgl->trw_children[ix]);
 431     vik_treeview_add_layer ( VIK_LAYER(vgl)->vt, layer_iter, &iter,
 432         trw_names[ix], vgl,
 433         trw, trw->type, trw->type );
 434     if ( ! trw->visible )
 435       vik_treeview_item_set_visible ( VIK_LAYER(vgl)->vt, &iter, FALSE );
 436     vik_layer_realize ( trw, VIK_LAYER(vgl)->vt, &iter );
 437     g_signal_connect_swapped ( G_OBJECT(trw), "update", G_CALLBACK(vik_layer_emit_update), vgl );
 438   }
 439 }
 440
 441 static void gps_layer_drag_drop_request ( VikGpsLayer *val_src, VikGpsLayer *val_dest, GtkTreeIter *src_item_iter, GtkTreePath *dest_path )
 442 {
 443   VikTreeview *vt = VIK_LAYER(val_src)->vt;
 444   VikLayer *vl = vik_treeview_item_get_pointer(vt, src_item_iter);
 445   GtkTreeIter dest_iter;
 446   gchar *dp;
 447   gboolean target_exists;
 448
 449   /* DEBUG */
 450   fprintf(stderr, "gps_layer_drag_drop_request() called\n");
 451
 452   dp = gtk_tree_path_to_string(dest_path);
 453   target_exists = vik_treeview_get_iter_from_path_str(vt, &dest_iter, dp);
 454
 455   /* vik_gps_layer_delete unrefs, but we don't want that here.
 456    * we're still using the layer. */
 457   g_object_ref ( vl );
 458   vik_gps_layer_delete(val_src, src_item_iter);
 459
 460 #ifdef XXXXXXXXXXXXXXXXXXXXXXXXX
 461   TODO:
 462   if (target_exists) {
 463     vik_gps_layer_insert_layer(val_dest, vl, &dest_iter);
 464   } else {
 465     vik_gps_layer_insert_layer(val_dest, vl, NULL); /* append */
 466   }
 467 #endif /* XXXXXXXXXXXXXXXXXXXXXXXXX */
 468   g_free(dp);
 469 }
 470
 471 static void gps_session_delete(GpsSession *sess)
 472 {
 473   /* TODO */
 474   g_mutex_free(sess->mutex);
 475   g_free(sess->cmd_args);
 476
 477   g_free(sess);
 478
 479 }
 480
 481 static void set_total_count(gint cnt, GpsSession *sess)
 482 {
 483   gchar s[128];
 484   gdk_threads_enter();
 485   g_mutex_lock(sess->mutex);
 486   if (sess->ok) {
 487     g_sprintf(s, "%s %d %s...",
 488         (sess->direction == GPS_DOWN) ? "Downloading" : "Uploading", cnt,
 489         (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
 490     gtk_label_set_text ( GTK_LABEL(sess->progress_label), s );
 491     gtk_widget_show ( sess->progress_label );
 492     sess->total_count = cnt;
 493   }
 494   g_mutex_unlock(sess->mutex);
 495   gdk_threads_leave();
 496 }
 497
 498 static void set_current_count(gint cnt, GpsSession *sess)
 499 {
 500   gchar s[128];
 501   gchar *dir_str = (sess->direction == GPS_DOWN) ? "Downloaded" : "Uploaded";
 502
 503   gdk_threads_enter();
 504   g_mutex_lock(sess->mutex);
 505   if (sess->ok) {
 506     if (cnt < sess->total_count) {
 507       g_sprintf(s, "%s %d out of %d %s...", dir_str, cnt, sess->total_count, (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
 508     } else {
 509       g_sprintf(s, "%s %d %s.", dir_str, cnt, (sess->progress_label == sess->wp_label) ? "waypoints" : "trackpoints");
 510     }
 511     gtk_label_set_text ( GTK_LABEL(sess->progress_label), s );
 512   }
 513   g_mutex_unlock(sess->mutex);
 514   gdk_threads_leave();
 515 }
 516
 517 static void set_gps_info(const gchar *info, GpsSession *sess)
 518 {
 519   gchar s[256];
 520   gdk_threads_enter();
 521   g_mutex_lock(sess->mutex);
 522   if (sess->ok) {
 523     g_sprintf(s, "GPS Device: %s", info);
 524     gtk_label_set_text ( GTK_LABEL(sess->gps_label), s );
 525   }
 526   g_mutex_unlock(sess->mutex);
 527   gdk_threads_leave();
 528 }
 529
 530 static void gps_download_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess )
 531 {
 532   gchar *line;
 533
 534   gdk_threads_enter ();
 535   g_mutex_lock(sess->mutex);
 536   if (!sess->ok) {
 537     g_mutex_unlock(sess->mutex);
 538     gps_session_delete(sess);
 539     gdk_threads_leave();
 540     g_thread_exit ( NULL );
 541   }
 542   g_mutex_unlock(sess->mutex);
 543   gdk_threads_leave ();
 544
 545   switch(c) {
 546   case BABEL_DIAG_OUTPUT:
 547     line = (gchar *)data;
 548
 549     /* tells us how many items there will be */
 550     if (strstr(line, "Xfer Wpt")) {
 551       sess->progress_label = sess->wp_label;
 552     }
 553     if (strstr(line, "Xfer Trk")) {
 554       sess->progress_label = sess->trk_label;
 555     }
 556     if (strstr(line, "PRDDAT")) {
 557       gchar **tokens = g_strsplit(line, " ", 0);
 558       gchar info[128];
 559       int ilen = 0;
 560       int i;
 561
 562       for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
 563         guint ch;
 564         sscanf(tokens[i], "%x", &ch);
 565         info[ilen++] = ch;
 566       }
 567       info[ilen++] = 0;
 568       set_gps_info(info, sess);
 569     }
 570     if (strstr(line, "RECORD")) {
 571       int lsb, msb, cnt;
 572
 573       sscanf(line+17, "%x", &lsb);
 574       sscanf(line+20, "%x", &msb);
 575       cnt = lsb + msb * 256;
 576       set_total_count(cnt, sess);
 577       sess->count = 0;
 578     }
 579     if ( strstr(line, "WPTDAT") || strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
 580       sess->count++;
 581       set_current_count(sess->count, sess);
 582     }
 583     break;
 584   case BABEL_DONE:
 585     break;
 586   default:
 587     break;
 588   }
 589
 590 }
 591
 592 static void gps_upload_progress_func(BabelProgressCode c, gpointer data, GpsSession * sess )
 593 {
 594   gchar *line;
 595   static int cnt = 0;
 596
 597   gdk_threads_enter ();
 598   g_mutex_lock(sess->mutex);
 599   if (!sess->ok) {
 600     g_mutex_unlock(sess->mutex);
 601     gps_session_delete(sess);
 602     gdk_threads_leave();
 603     g_thread_exit ( NULL );
 604   }
 605   g_mutex_unlock(sess->mutex);
 606   gdk_threads_leave ();
 607
 608   switch(c) {
 609   case BABEL_DIAG_OUTPUT:
 610     line = (gchar *)data;
 611
 612     if (strstr(line, "PRDDAT")) {
 613       gchar **tokens = g_strsplit(line, " ", 0);
 614       gchar info[128];
 615       int ilen = 0;
 616       int i;
 617
 618       for (i=8; tokens[i] && ilen < sizeof(info)-2 && strcmp(tokens[i], "00"); i++) {
 619         guint ch;
 620         sscanf(tokens[i], "%x", &ch);
 621         info[ilen++] = ch;
 622       }
 623       info[ilen++] = 0;
 624       set_gps_info(info, sess);
 625     }
 626     if (strstr(line, "RECORD")) {
 627       int lsb, msb;
 628
 629       sscanf(line+17, "%x", &lsb);
 630       sscanf(line+20, "%x", &msb);
 631       cnt = lsb + msb * 256;
 632       /* set_total_count(cnt, sess); */
 633       sess->count = 0;
 634     }
 635     if ( strstr(line, "WPTDAT")) {
 636       if (sess->count == 0) {
 637         sess->progress_label = sess->wp_label;
 638         set_total_count(cnt, sess);
 639       }
 640       sess->count++;
 641       set_current_count(sess->count, sess);
 642
 643     }
 644     if ( strstr(line, "TRKHDR") || strstr(line, "TRKDAT") ) {
 645       if (sess->count == 0) {
 646         sess->progress_label = sess->trk_label;
 647         set_total_count(cnt, sess);
 648       }
 649       sess->count++;
 650       set_current_count(sess->count, sess);
 651     }
 652     break;
 653   case BABEL_DONE:
 654     break;
 655   default:
 656     break;
 657   }
 658
 659 }
 660
 661 static void gps_comm_thread(GpsSession *sess)
 662 {
 663   gboolean result;
 664
 665   if (sess->direction == GPS_DOWN)
 666     result = a_babel_convert_from (sess->vtl, sess->cmd_args,
 667         (BabelStatusFunc) gps_download_progress_func, sess->port, sess);
 668   else
 669     result = a_babel_convert_to (sess->vtl, sess->cmd_args,
 670         (BabelStatusFunc) gps_upload_progress_func, sess->port, sess);
 671
 672   gdk_threads_enter();
 673   if (!result) {
 674     gtk_label_set_text ( GTK_LABEL(sess->status_label), "Error: couldn't find gpsbabel." );
 675   }
 676   else {
 677     g_mutex_lock(sess->mutex);
 678     if (sess->ok) {
 679       gtk_label_set_text ( GTK_LABEL(sess->status_label), "Done." );
 680       gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_ACCEPT, TRUE );
 681       gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog), GTK_RESPONSE_REJECT, FALSE );
 682     } else {
 683       /* canceled */
 684     }
 685     g_mutex_unlock(sess->mutex);
 686   }
 687
 688   g_mutex_lock(sess->mutex);
 689   if (sess->ok) {
 690     sess->ok = FALSE;
 691     g_mutex_unlock(sess->mutex);
 692   }
 693   else {
 694     g_mutex_unlock(sess->mutex);
 695     gps_session_delete(sess);
 696   }
 697   gdk_threads_leave();
 698   g_thread_exit(NULL);
 699 }
 700
 701 static gint gps_comm(VikTrwLayer *vtl, gps_dir dir, vik_gps_proto proto, gchar *port) {
 702   GpsSession *sess = g_malloc(sizeof(GpsSession));
 703
 704   sess->mutex = g_mutex_new();
 705   sess->direction = dir;
 706   sess->vtl = vtl;
 707   sess->port = g_strdup(port);
 708   sess->ok = TRUE;
 709   sess->cmd_args = g_strdup_printf("-D 9 -t -w -%c %s",
 710       (dir == GPS_DOWN) ? 'i' : 'o', protocols_args[proto]);
 711   sess->window_title = (dir == GPS_DOWN) ? "GPS Download" : "GPS Upload";
 712
 713   sess->dialog = gtk_dialog_new_with_buttons ( "", NULL, 0, GTK_STOCK_OK, GTK_RESPONSE_ACCEPT, GTK_STOCK_CANCEL, GTK_RESPONSE_REJECT, NULL );
 714   gtk_dialog_set_response_sensitive ( GTK_DIALOG(sess->dialog),
 715       GTK_RESPONSE_ACCEPT, FALSE );
 716   gtk_window_set_title ( GTK_WINDOW(sess->dialog), sess->window_title );
 717
 718   sess->status_label = gtk_label_new ("Status: detecting gpsbabel");
 719   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox),
 720       sess->status_label, FALSE, FALSE, 5 );
 721   gtk_widget_show_all(sess->status_label);
 722
 723   sess->gps_label = gtk_label_new ("GPS device: N/A");
 724   sess->ver_label = gtk_label_new ("");
 725   sess->id_label = gtk_label_new ("");
 726   sess->wp_label = gtk_label_new ("");
 727   sess->trk_label = gtk_label_new ("");
 728
 729   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->gps_label, FALSE, FALSE, 5 );
 730   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->wp_label, FALSE, FALSE, 5 );
 731   gtk_box_pack_start ( GTK_BOX(GTK_DIALOG(sess->dialog)->vbox), sess->trk_label, FALSE, FALSE, 5 );
 732
 733   gtk_widget_show_all(sess->dialog);
 734
 735   sess->progress_label = sess->wp_label;
 736   sess->total_count = -1;
 737
 738   /* TODO: starting gps read/write thread here */
 739   g_thread_create((GThreadFunc)gps_comm_thread, sess, FALSE, NULL );
 740
 741   gtk_dialog_run(GTK_DIALOG(sess->dialog));
 742
 743   gtk_widget_destroy(sess->dialog);
 744
 745   g_mutex_lock(sess->mutex);
 746   if (sess->ok) {
 747     sess->ok = FALSE;   /* tell thread to stop */
 748     g_mutex_unlock(sess->mutex);
 749   }
 750   else {
 751     g_mutex_unlock(sess->mutex);
 752     gps_session_delete(sess);
 753   }
 754
 755   // fprintf(stderr, "\"gps_comm: cmd_args=%s\" port=%s\n", sess->cmd_args, sess->port);
 756   return 0;
 757 }
 758
 759 static void gps_upload_cb( gpointer layer_and_vlp[2] )
 760 {
 761   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
 762   VikTrwLayer *vtl = vgl->trw_children[TRW_UPLOAD];
 763   gps_comm(vtl, GPS_UP, vgl->protocol_id, params_ports[vgl->serial_port_id]);
 764 }
 765
 766 static void gps_download_cb( gpointer layer_and_vlp[2] )
 767 {
 768   VikGpsLayer *vgl = (VikGpsLayer *)layer_and_vlp[0];
 769   VikTrwLayer *vtl = vgl->trw_children[TRW_DOWNLOAD];
 770   gps_comm(vtl, GPS_DOWN, vgl->protocol_id, params_ports[vgl->serial_port_id]);
 771 }