Move GPS code to Azimuth
[azimuth] / src / position-publisher.c
1 /*
2  * position-publisher.c - Source for PositionPublisher
3  * Copyright (C) 2010 Guillaume Desmottes
4  * @author Guillaume Desmottes <gdesmott@gnome.org>
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2.1 of the License, or (at your option) any later version.
10  *
11  * This library 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 GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, write to the Free Software
18  * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301  USA
19  */
20
21
22 #include <stdio.h>
23 #include <stdlib.h>
24
25 #include <telepathy-glib/dbus.h>
26 #include <telepathy-glib/interfaces.h>
27
28 #include <location/location-gps-device.h>
29
30 #include "connection-watcher.h"
31 #include "position-publisher.h"
32
33 G_DEFINE_TYPE(PositionPublisher, position_publisher, G_TYPE_OBJECT)
34
35 /* properties */
36 enum
37 {
38   PROP_BLUR = 1,
39   LAST_PROPERTY
40 };
41
42 /* Minimum time before 2 publishing (in seconds) */
43 #define PUBLISH_THROTTLE 10
44
45 /* private structure */
46 typedef struct _PositionPublisherPrivate PositionPublisherPrivate;
47
48 struct _PositionPublisherPrivate
49 {
50   ConnectionWatcher *watcher;
51   LocationGPSDevice *gps_device;
52   GSList *connections;
53   GHashTable *location;
54   /* If not 0, we are waiting before publishing again */
55   guint throttle_timeout;
56   /* TRUE if location has been modified while we were waiting */
57   gboolean modified;
58   gboolean blur;
59
60   gboolean dispose_has_run;
61 };
62
63 #define POSITION_PUBLISHER_GET_PRIVATE(o)     (G_TYPE_INSTANCE_GET_PRIVATE ((o), POSITION_PUBLISHER_TYPE, PositionPublisherPrivate))
64
65 static void conn_invalidated_cb (TpProxy *conn,
66     guint domain,
67     gint code,
68     gchar *message,
69     PositionPublisher *self);
70
71 static void publish_to_all (PositionPublisher *self);
72
73 static void
74 remove_connection (PositionPublisher *self,
75     TpConnection *conn)
76 {
77   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
78
79   g_signal_handlers_disconnect_by_func (conn, G_CALLBACK (conn_invalidated_cb),
80       self);
81   priv->connections = g_slist_remove (priv->connections, conn);
82   g_object_unref (conn);
83 }
84
85 static void
86 set_location_cb (TpConnection *conn,
87     const GError *error,
88     gpointer user_data,
89     GObject *weak_object)
90 {
91   PositionPublisher *self = POSITION_PUBLISHER (weak_object);
92
93   if (error != NULL)
94     {
95       g_print ("SetLocation failed (%s): %s\n", tp_proxy_get_object_path (conn),
96           error->message);
97
98       if (error->code == TP_ERROR_NOT_IMPLEMENTED)
99         {
100           g_print ("remove connection\n");
101           remove_connection (self, conn);
102         }
103
104       return;
105     }
106
107   g_print ("SetLocation succeed (%s)\n", tp_proxy_get_object_path (conn));
108 }
109
110 static gboolean
111 publish_throttle_timeout_cb (gpointer data)
112 {
113   PositionPublisher *self = data;
114   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
115
116   priv->throttle_timeout = 0;
117
118   if (priv->modified)
119     {
120       publish_to_all (self);
121       priv->modified = FALSE;
122     }
123
124   return FALSE;
125 }
126
127 static void
128 publish_to_conn (PositionPublisher *self,
129     TpConnection *conn)
130 {
131   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
132
133   if (priv->location == NULL)
134     return;
135
136   if (priv->throttle_timeout != 0)
137     /* We are waiting */
138     return;
139
140   tp_cli_connection_interface_location_call_set_location (conn, -1,
141       priv->location, set_location_cb, NULL, NULL, G_OBJECT (self));
142
143   /* We won't publish during the next PUBLISH_THROTTLE seconds */
144   priv->throttle_timeout = g_timeout_add_seconds (PUBLISH_THROTTLE,
145       publish_throttle_timeout_cb, self);
146 }
147
148 static void
149 publish_to_all (PositionPublisher *self)
150 {
151   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
152   GSList *l;
153
154   for (l = priv->connections; l != NULL; l = g_slist_next (l))
155     {
156       TpConnection *conn = l->data;
157
158       publish_to_conn (self, conn);
159     }
160 }
161
162 static void
163 update_position (PositionPublisher *self,
164     gdouble lat,
165     gdouble lon,
166     gdouble alt,
167     gdouble accuracy)
168 {
169   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
170
171   g_print ("update position: lat: %f  lon:  %f  alt: %f accuracy: %f\n",
172       lat, lon, alt, accuracy);
173
174   if (priv->location != NULL)
175     g_hash_table_unref (priv->location);
176
177   priv->location = tp_asv_new (
178       "timestamp", G_TYPE_INT64, (gint64) time (NULL),
179       "lat", G_TYPE_DOUBLE, lat,
180       "lon", G_TYPE_DOUBLE, lon,
181       "alt", G_TYPE_DOUBLE, alt,
182       "accuracy", G_TYPE_DOUBLE, accuracy,
183       NULL);
184
185   priv->modified = TRUE;
186
187   publish_to_all (self);
188 }
189
190 static void
191 location_changed_cb (LocationGPSDevice *device,
192     PositionPublisher *self)
193 {
194   if (device == NULL)
195     return;
196
197   if (device->fix == NULL)
198     return;
199
200   if (!(device->fix->fields & LOCATION_GPS_DEVICE_LATLONG_SET))
201     return;
202
203   update_position (self, device->fix->latitude, device->fix->longitude,
204       device->fix->altitude, device->fix->eph / 100.0);
205 }
206
207 static void
208 conn_invalidated_cb (TpProxy *conn,
209     guint domain,
210     gint code,
211     gchar *message,
212     PositionPublisher *self)
213 {
214   g_print ("connection %s invalidated; removing\n", tp_proxy_get_object_path (
215         conn));
216
217   remove_connection (self, TP_CONNECTION (conn));
218 }
219
220 static void
221 connection_added_cb (ConnectionWatcher *watcher,
222     TpConnection *conn,
223     PositionPublisher *self)
224 {
225   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
226
227   if (g_slist_find (priv->connections, conn) != NULL)
228     return;
229
230   if (!tp_proxy_has_interface_by_id (conn,
231         TP_IFACE_QUARK_CONNECTION_INTERFACE_LOCATION))
232     return;
233
234   priv->connections = g_slist_prepend (priv->connections, g_object_ref (conn));
235
236   g_signal_connect (conn, "invalidated",
237       G_CALLBACK (conn_invalidated_cb), self);
238
239   publish_to_conn (self, conn);
240 }
241
242 static void
243 position_publisher_init (PositionPublisher *obj)
244 {
245   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (obj);
246
247   priv->watcher = connection_watcher_new ();
248
249   g_signal_connect (priv->watcher, "connection-added",
250       G_CALLBACK (connection_added_cb), obj);
251
252   priv->gps_device = g_object_new (LOCATION_TYPE_GPS_DEVICE, NULL);
253
254   g_signal_connect (priv->gps_device, "changed",
255       G_CALLBACK (location_changed_cb), obj);
256
257   priv->connections = NULL;
258 }
259
260 static void
261 position_publisher_constructed (GObject *object)
262 {
263   PositionPublisher *self = POSITION_PUBLISHER (object);
264   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
265
266   connection_watcher_start (priv->watcher);
267
268   if (G_OBJECT_CLASS (position_publisher_parent_class)->constructed)
269     G_OBJECT_CLASS (position_publisher_parent_class)->constructed (object);
270 }
271
272 static void position_publisher_dispose (GObject *object);
273 static void position_publisher_finalize (GObject *object);
274 static void position_publisher_get_property (GObject *object,
275     guint property_id, GValue *value, GParamSpec *pspec);
276 static void position_publisher_set_property (GObject *object,
277     guint property_id, const GValue *value, GParamSpec *pspec);
278
279 static void
280 position_publisher_class_init (PositionPublisherClass *position_publisher_class)
281 {
282   GObjectClass *object_class = G_OBJECT_CLASS (position_publisher_class);
283   GParamSpec *param_spec;
284
285   g_type_class_add_private (position_publisher_class, sizeof (PositionPublisherPrivate));
286
287   object_class->dispose = position_publisher_dispose;
288   object_class->finalize = position_publisher_finalize;
289   object_class->get_property = position_publisher_get_property;
290   object_class->set_property = position_publisher_set_property;
291
292   object_class->constructed = position_publisher_constructed;
293
294   param_spec = g_param_spec_boolean ("blur", "Blur?",
295       "Whether the real GPS position is truncated for privacy concerns.", TRUE,
296       G_PARAM_CONSTRUCT | G_PARAM_WRITABLE | G_PARAM_READABLE
297       | G_PARAM_STATIC_STRINGS);
298   g_object_class_install_property (object_class, PROP_BLUR, param_spec);
299 }
300
301 void
302 position_publisher_dispose (GObject *object)
303 {
304   PositionPublisher *self = POSITION_PUBLISHER (object);
305   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
306   GSList *l;
307
308   if (priv->dispose_has_run)
309     return;
310
311   priv->dispose_has_run = TRUE;
312
313   g_object_unref (priv->watcher);
314   g_object_unref (priv->gps_device);
315
316   for (l = priv->connections; l != NULL; l = g_slist_next (l))
317     {
318       g_object_unref (l->data);
319     }
320
321   g_hash_table_unref (priv->location);
322
323   if (priv->throttle_timeout != 0)
324     g_source_remove (priv->throttle_timeout);
325
326   if (G_OBJECT_CLASS (position_publisher_parent_class)->dispose)
327     G_OBJECT_CLASS (position_publisher_parent_class)->dispose (object);
328 }
329
330 void
331 position_publisher_finalize (GObject *object)
332 {
333   PositionPublisher *self = POSITION_PUBLISHER (object);
334   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
335
336   g_slist_free (priv->connections);
337
338   G_OBJECT_CLASS (position_publisher_parent_class)->finalize (object);
339 }
340
341 static void
342 position_publisher_get_property (GObject *object,
343                                  guint property_id,
344                                  GValue *value,
345                                  GParamSpec *pspec)
346 {
347   PositionPublisher *self = POSITION_PUBLISHER (object);
348   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
349
350   switch (property_id) {
351     case PROP_BLUR:
352       g_value_set_boolean (value, priv->blur);
353       break;
354     default:
355       G_OBJECT_WARN_INVALID_PROPERTY_ID (object, property_id, pspec);
356       break;
357   }
358 }
359
360 static void
361 position_publisher_set_property (GObject *object,
362                                  guint property_id,
363                                  const GValue *value,
364                                  GParamSpec *pspec)
365 {
366   PositionPublisher *self = POSITION_PUBLISHER (object);
367   PositionPublisherPrivate *priv = POSITION_PUBLISHER_GET_PRIVATE (self);
368
369   switch (property_id) {
370     case PROP_BLUR:
371       priv->blur = g_value_get_boolean (value);
372       break;
373
374       break;
375     default:
376       G_OBJECT_WARN_INVALID_PROPERTY_ID (object, property_id, pspec);
377       break;
378   }
379 }
380
381 PositionPublisher *
382 position_publisher_new (gboolean blur)
383 {
384   return g_object_new (POSITION_PUBLISHER_TYPE,
385       "blur", blur,
386       NULL);
387 }