#include <errno.h>
#include <sys/wait.h>
#include <glib/gstdio.h>
+#include <dbus/dbus.h>
+#include <dbus/dbus-glib.h>
#include <fcntl.h>
#include "gps.h"
#include "gps-conn.h"
#include "track.h"
-#define GPSD_NMEA "r+\r\n"
-#define GPSD_PORT (2947)
+#ifdef WITH_HILDON_DBUS_BT
+#include <bt-dbus.h>
+#endif
+
+#ifdef WITH_GPSBT
+#include <gpsbt.h>
+static gpsbt_t ctx = {0};
+#endif
static gboolean gps_channel_cb_error(GIOChannel *src, GIOCondition condition, gpointer data);
static gboolean gps_channel_cb_input(GIOChannel *src, GIOCondition condition, gpointer data);
static gboolean gps_channel_cb_connect(GIOChannel * src, GIOCondition condition, gpointer data);
static gboolean gps_connect_socket(Gps *gps);
-static gboolean gps_connect_file(Gps *gps);
+static gboolean gps_connect_file(Gps *gps, gchar *file);
+
+#define GPSD_NMEA "r+\r\n"
+#define GPSD_PORT (2947)
+
+const GpsTypes gps_types[] = {
+ { GPS_IO_RFCOMM, "Direct bluetooth connection", TRUE, TRUE},
+ { GPS_IO_HILDON_DBUS, "Hildon D-Bus", TRUE, TRUE },
+ { GPS_IO_BLUEZ_DBUS, "Blues D-Bus", TRUE, TRUE},
+ { GPS_IO_FILE, "File or device", FALSE, TRUE},
+ { GPS_IO_TCP, "TCP Connection", FALSE, TRUE},
+ { GPS_IO_GPSD, "GPSD", FALSE, TRUE},
+ { GPS_IO_GYPSY, "Gypsy", FALSE, TRUE},
+ { GPS_IO_SIMULATION, "Simulation", FALSE, FALSE},
+ { 0 }
+};
+
+GpsTypes *
+gps_get_supported_types(void)
+{
+return gps_types;
+}
/**
* Init GPS structure
gps->io.address=NULL;
gps->io.type=type;
gps->io.conn=RCVR_OFF;
-gps->data.lat=64.20;
+gps->data.lat=60.20;
gps->data.lon=22.20;
+gps->connection_error=NULL;
+gps->connection_retry=NULL;
gps_data_integerize(&gps->data);
return gps;
}
gps->io.port=port;
}
+void
+gps_set_type(Gps *gps, GpsIOSourceType type)
+{
+gps->io.type=type;
+}
+
void
gps_free(Gps *gps)
{
gpsdata->vel_offsety=-(gint)(floor(gpsdata->speed*cos(tmp)+0.5f));
}
+#ifdef WITH_HILDON_DBUS_BT
+void
+gps_connect_response(DBusGProxy *proxy, DBusGProxyCall *call_id, Gps *gps)
+{
+GError *error = NULL;
+gchar *fdpath = NULL;
+
+if (gps->io.conn==RCVR_DOWN && gps->io.address) {
+ if (!dbus_g_proxy_end_call(gps->io.rfcomm_req_proxy, call_id, &error, G_TYPE_STRING, &fdpath, G_TYPE_INVALID)) {
+ if (error->domain == DBUS_GERROR && error->code == DBUS_GERROR_REMOTE_EXCEPTION) {
+ /* If we're already connected, it's not an error, unless
+ * they don't give us the file descriptor path, in which
+ * case we re-connect.*/
+ if (!strcmp(BTCOND_ERROR_CONNECTED, dbus_g_error_get_name(error)) || !fdpath) {
+ g_printerr("Caught remote method exception %s: %s", dbus_g_error_get_name(error), error->message);
+ gps_disconnect(gps);
+
+ if (gps->connection_retry==NULL)
+ return;
+
+ if (gps->connection_retry(gps, error->message)==TRUE) {
+ gps_connect_later(gps);
+ } else {
+ gps_conn_set_state(gps, RCVR_OFF);
+ }
+ return;
+ }
+ } else {
+ /* Unknown error. */
+ g_printerr("Error: %s\n", error->message);
+ gps_disconnect(_gps);
+ gps_connect_later(_gps); /* Try again later. */
+ return;
+ }
+ }
+ gps_connect_fd(fdpath);
+}
+/* else { Looks like the middle of a disconnect. Do nothing. } */
+}
+#endif
+
/**
* Place a request to connect about 1 second after the function is called.
*/
{
switch (gps->io.type) {
case GPS_IO_FILE:
- return gps_connect_file(gps);
+ return TRUE;
break;
case GPS_IO_RFCOMM:
case GPS_IO_TCP:
* Helper to open a file or device node
*/
static gboolean
-gps_connect_file(Gps *gps)
+gps_connect_file(Gps *gps, gchar *file)
{
-if (-1==(gps->io.fd=open(gps->io.address, O_RDONLY))) {
+if (-1==(gps->io.fd=open(file, O_RDONLY))) {
gps_disconnect(gps);
gps_connect_later(gps);
+ /* Add retry cb */
return FALSE;
}
return TRUE;
gps->io.fd=-1;
}
+#ifdef WITH_GPSBT
+if (gps->io.type==GPS_IO_GPSD) {
+ gint r;
+ r=gpsbt_stop(&ctx);
+ if (r!=0)
+ g_warning("Failed to stop gpsd\n");
+}
+#endif
+
#ifdef WITH_HILDON_DBUS_BT
if (gps->io.type==GPS_IO_HILDON_DBUS && gps->io.rfcomm_req_proxy) {
- GError *error = NULL;
+ GError *error = NULL;
- dbus_g_proxy_call(gps->io.rfcomm_req_proxy, BTCOND_RFCOMM_CANCEL_CONNECT_REQ, &error, G_TYPE_STRING, gps->io.address, G_TYPE_STRING, "SPP", G_TYPE_INVALID, G_TYPE_INVALID);
- error = NULL;
- dbus_g_proxy_call(gps->io.rfcomm_req_proxy, BTCOND_RFCOMM_DISCONNECT_REQ, &error,G_TYPE_STRING, gps->io.address, G_TYPE_STRING, "SPP", G_TYPE_INVALID, G_TYPE_INVALID);
+ dbus_g_proxy_call(gps->io.rfcomm_req_proxy, BTCOND_RFCOMM_CANCEL_CONNECT_REQ, &error, G_TYPE_STRING, gps->io.address, G_TYPE_STRING, "SPP", G_TYPE_INVALID, G_TYPE_INVALID);
+ error = NULL;
+ dbus_g_proxy_call(gps->io.rfcomm_req_proxy, BTCOND_RFCOMM_DISCONNECT_REQ, &error,G_TYPE_STRING, gps->io.address, G_TYPE_STRING, "SPP", G_TYPE_INVALID, G_TYPE_INVALID);
}
#endif
#ifdef WITH_BLUEZ_DBUS_BT
if (gps->io.type==GPS_IO_BLUEZ_DBUS && gps->io.rfcomm_req_proxy) {
GError *error = NULL;
-
}
#endif
}
+static void
+gps_simulate_start(Gps *gps)
+{
+gps->data.lat=60.45;
+gps->data.lon=22.26;
+gps->io.conn=RCVR_FIXED;
+gps->data.fix=FIX_2D;
+gps_data_integerize(&gps->data);
+}
+
+static gboolean
+gps_simulate_move(Gps *gps)
+{
+static gdouble slat=0, slon=0;
+gdouble plat, plon;
+gfloat h;
+g_assert(gps);
+
+if (g_random_double()<0.5) {
+ slat=g_random_double_range(-0.0003, 0.0003);
+ slon=g_random_double_range(-0.0003, 0.0003);
+}
+plat=gps->data.lat;
+plon=gps->data.lon;
+gps->data.lat+=slat;
+gps->data.lon+=slon;
+BOUND(gps->data.lat, -80.0, 80.0);
+BOUND(gps->data.lon, -80.0, 80.0);
+
+g_debug("Sim: %f %f\n", gps->data.lat, gps->data.lon);
+
+gps->data.speed=1+g_random_double_range(0.1, 10.0);
+h=calculate_course(plat, plon, gps->data.lat, gps->data.lon);
+gps->data.heading=(h<0) ? 360+h : h;
+gps->data.time=time(NULL);
+gps_data_integerize(&gps->data);
+track_add(&gps->data, FALSE);
+gps->data.lheading=gps->data.heading;
+map_refresh_mark();
+
+return gps->io.conn==RCVR_FIXED ? TRUE : FALSE;
+}
+
+/**
+ * Reset GPS read buffer
+ */
+static void
+gps_read_buffer_prepare(Gps *gps)
+{
+gps->io.curr=gps->io.buffer;
+*gps->io.curr = '\0';
+gps->io.last=gps->io.buffer+GPS_READ_BUF_SIZE-1;
+}
+
+/**
+ * Connect file descriptor to channel and add watches.
+ */
+static void
+gps_read_channel_connect(Gps *gps)
+{
+gps->io.channel=g_io_channel_unix_new(gps->io.fd);
+g_io_channel_set_encoding(gps->io.channel, NULL, NULL);
+g_io_channel_set_flags(gps->io.channel, G_IO_FLAG_NONBLOCK, NULL);
+gps->io.error_sid=g_io_add_watch_full(gps->io.channel, G_PRIORITY_HIGH_IDLE, G_IO_ERR | G_IO_HUP, gps_channel_cb_error, NULL, NULL);
+gps->io.connect_sid=g_io_add_watch_full(gps->io.channel, G_PRIORITY_HIGH_IDLE, G_IO_OUT, gps_channel_cb_connect, NULL, NULL);
+gps->io.clater_sid=0;
+}
+
/**
* Connect to the receiver.
* This method assumes that fd is -1 and _channel is NULL. If unsure, call
gboolean
gps_connect_now(Gps *gps)
{
+GError *error = NULL;
+
g_assert(gps);
+g_debug("GPS: Connecting GPS type %d to %s:%d\n", gps->io.type, gps->io.address, gps->io.port);
switch (gps->io.type) {
case GPS_IO_FILE:
if (!gps->io.address)
return FALSE;
- if (*gps->io.address=='/')
- gps->io.fd=open(gps->io.address, O_RDONLY);
- else
- return FALSE;
+ gps_connect_file(gps, gps->io.address);
+ return FALSE;
break;
case GPS_IO_TCP:
case GPS_IO_GPSD:
} else {
return FALSE;
}
+#ifdef WITH_GPSBT
+ if (gps->io.type==GPS_IO_GPSD) {
+ gint r;
+ gchar ebuf[128];
+ r=gpsbt_start(NULL, 0, 0, 0, ebuf, 128, 0, &ctx);
+ if (r!=0) {
+ g_warning("Failed to start gpsd");
+ return FALSE;
+ }
+ }
+#endif
break;
case GPS_IO_HILDON_DBUS:
#ifdef WITH_HILDON_DBUS_BT
+ if (NULL == (gps->io.dbus_conn=dbus_g_bus_get(DBUS_BUS_SYSTEM, &error))) {
+ g_printerr("Failed to get D-Bus connection.");
+ return FALSE;
+ }
+ if (NULL == (gps->io.rfcomm_req_proxy = dbus_g_proxy_new_for_name(gps->io.dbus_conn, BTCOND_SERVICE, BTCOND_REQ_PATH, BTCOND_REQ_INTERFACE))) {
+ g_printerr("Failed to open connection to %s.\n", BTCOND_REQ_INTERFACE);
+ return FALSE;
+ }
+
if (gps->io.rfcomm_req_proxy) {
gboolean mybool = TRUE;
- dbus_g_proxy_begin_call(_rfcomm_req_proxy,
- BTCOND_RFCOMM_CONNECT_REQ, (DBusGProxyCallNotify)gps_connect_response, NULL, NULL,
+ dbus_g_proxy_begin_call(gps->io.rfcomm_req_proxy,
+ BTCOND_RFCOMM_CONNECT_REQ, (DBusGProxyCallNotify)gps_connect_response, gps, NULL,
G_TYPE_STRING, gps->io.address,
G_TYPE_STRING, "SPP",
G_TYPE_BOOLEAN, &mybool,
G_TYPE_INVALID);
}
-#else
- return FALSE;
#endif
+ return FALSE;
break;
case GPS_IO_RFCOMM:
#ifdef WITH_BLUEZ
#endif
return FALSE;
break;
+ case GPS_IO_SIMULATION:
+ /* Set a periodic cb to generate random movement */
+ gps_simulate_start(gps);
+ gps->io.input_sid=g_timeout_add(1000, (GSourceFunc)gps_simulate_move, gps);
+ return FALSE;
+ break;
default:
return FALSE;
break;
}
-/* Reset GPS read buffer */
-gps->io.curr=gps->io.buffer;
-*gps->io.curr = '\0';
-gps->io.last=gps->io.buffer+GPS_READ_BUF_SIZE-1;
-
-/* Create channel and add watches. */
-gps->io.channel=g_io_channel_unix_new(gps->io.fd);
-g_io_channel_set_encoding(gps->io.channel, NULL, NULL);
-g_io_channel_set_flags(gps->io.channel, G_IO_FLAG_NONBLOCK, NULL);
-gps->io.error_sid=g_io_add_watch_full(gps->io.channel, G_PRIORITY_HIGH_IDLE, G_IO_ERR | G_IO_HUP, gps_channel_cb_error, NULL, NULL);
-gps->io.connect_sid=g_io_add_watch_full(gps->io.channel, G_PRIORITY_HIGH_IDLE, G_IO_OUT, gps_channel_cb_connect, NULL, NULL);
-gps->io.clater_sid=0;
+gps_read_buffer_prepare(gps);
+gps_read_channel_connect(gps);
gps_connect(gps);
return FALSE;
}
projects / mapper / blobdiff