diff --git a/src/gps.c b/src/gps.c
index b4a273ebc6aaaec28979ae1767abf16820c36118..19f317cb03690a8ef3f8104d5609f67e7b1455eb 100644 (file)
--- a/src/gps.c
+++ b/src/gps.c
*
* Authors:
* Nicolas JOURDEN <nicolas.jourden at laposte.net>
+ * Florian octo Forster <octo at collectd.org>
+ * Marc Fournier <marc.fournier at camptocamp.com>
**/
#include "collectd.h"
#include "utils_time.h"
#include "configfile.h"
-#define GPS_DEFAULT_HOST "localhost"
-#define GPS_DEFAULT_PORT "2947"
-#define GPS_DEFAULT_TIMEOUT 15
-#define GPS_DEFAULT_PAUSE 1
+#define CGPS_TRUE 1
+#define CGPS_FALSE 0
+#define CGPS_DEFAULT_HOST "localhost"
+#define CGPS_DEFAULT_PORT "2947" /* DEFAULT_GPSD_PORT */
+#define CGPS_DEFAULT_TIMEOUT MS_TO_CDTIME_T (15)
+#define CGPS_DEFAULT_PAUSE_CONNECT TIME_T_TO_CDTIME_T (5)
+#define CGPS_MAX_ERROR 100
+#define CGPS_CONFIG "?WATCH={\"enable\":true,\"json\":true,\"nmea\":false}\r\n"
#include <gps.h>
#include <pthread.h>
typedef struct {
char *host;
char *port;
- int timeout;
- int pause;
+ cdtime_t timeout;
+ cdtime_t pause_connect;
} cgps_config_t;
typedef struct {
gauge_t vdop;
} cgps_data_t;
-static const char *config_keys[] =
-{
- "Host",
- "Port",
- "Timeout",
- "Pause"
-};
-static int config_keys_num = STATIC_ARRAY_SIZE (config_keys);
+static cgps_config_t cgps_config_data;
+
+static cgps_data_t cgps_data = {NAN, NAN, NAN, NAN};
+
+static pthread_t cgps_thread_id;
+static pthread_mutex_t cgps_data_lock = PTHREAD_MUTEX_INITIALIZER;
+static pthread_mutex_t cgps_thread_lock = PTHREAD_MUTEX_INITIALIZER;
+static int cgps_thread_shutdown = CGPS_FALSE;
+static int cgps_thread_running = CGPS_FALSE;
-// Thread items:
-static pthread_t connector = (pthread_t) 0;
+/**
+ * Non blocking pause for the thread.
+ */
+static int cgps_thread_pause(cdtime_t pTime)
+{
+ cdtime_t now;
+ now = cdtime ();
+ struct timespec pause_th;
+ CDTIME_T_TO_TIMESPEC (MS_TO_CDTIME_T(10), &pause_th);
+ while (CGPS_TRUE)
+ {
+ if ( (cdtime () - now) > pTime )
+ {
+ break;
+ }
-static cgps_config_t config;
+ pthread_mutex_lock (&cgps_thread_lock);
+ if (cgps_thread_shutdown == CGPS_TRUE)
+ {
+ return CGPS_FALSE;
+ }
+ pthread_mutex_unlock (&cgps_thread_lock);
+ nanosleep (&pause_th, NULL);
+ }
-static cgps_data_t data = {NAN, NAN, NAN, NAN};
-static pthread_mutex_t data_lock = PTHREAD_MUTEX_INITIALIZER;
+ return CGPS_TRUE;
+}
/**
* Thread reading from gpsd.
*/
-static void * gps_collectd_thread (void * pData)
+static void * cgps_thread (void * pData)
{
- struct gps_data_t conn;
+ struct gps_data_t gpsd_conn;
+ unsigned int err_count;
+ cgps_thread_running = CGPS_TRUE;
- while (1)
+ while (CGPS_TRUE)
{
- int status = gps_open (config.host, config.port, &conn);
+ pthread_mutex_lock (&cgps_thread_lock);
+ if (cgps_thread_shutdown == CGPS_TRUE)
+ {
+ goto quit;
+ }
+ pthread_mutex_unlock (&cgps_thread_lock);
+
+ err_count = 0;
+
+#if GPSD_API_MAJOR_VERSION > 4
+ int status = gps_open (cgps_config_data.host, cgps_config_data.port, &gpsd_conn);
+#else
+ int status = gps_open_r (cgps_config_data.host, cgps_config_data.port, &gpsd_conn);
+#endif
if (status < 0)
{
- WARNING ("gps plugin: Connecting to %s:%s failed: %s",
- config.host, config.port, gps_errstr (status));
- sleep (60);
+ WARNING ("gps plugin: connecting to %s:%s failed: %s",
+ cgps_config_data.host, cgps_config_data.port, gps_errstr (status));
+
+ // Here we make a pause until a new tentative to connect, we check also if
+ // the thread does not need to stop.
+ if (cgps_thread_pause(cgps_config_data.pause_connect) == CGPS_FALSE)
+ {
+ goto quit;
+ }
+
continue;
}
- gps_stream (&conn, WATCH_ENABLE | WATCH_JSON | WATCH_NEWSTYLE, NULL);
- gps_send (&conn, "?WATCH={\"enable\":true,\"json\":true,\"nmea\":false}\r\n");
+ gps_stream (&gpsd_conn, WATCH_ENABLE | WATCH_JSON | WATCH_NEWSTYLE, NULL);
+ gps_send (&gpsd_conn, CGPS_CONFIG);
- while (1)
+ while (CGPS_TRUE)
{
- if (!gps_waiting (&conn, config.timeout))
+ pthread_mutex_lock (&cgps_thread_lock);
+ if (cgps_thread_shutdown == CGPS_TRUE)
+ {
+ goto stop;
+ }
+ pthread_mutex_unlock (&cgps_thread_lock);
+
+#if GPSD_API_MAJOR_VERSION > 4
+ long timeout_us = CDTIME_T_TO_US (cgps_config_data.timeout);
+ if (!gps_waiting (&gpsd_conn, (int) timeout_us ))
+#else
+ if (!gps_waiting (&gpsd_conn))
+#endif
{
- sleep (config.pause);
continue;
}
- if (gps_read (&conn) == -1)
+ if (gps_read (&gpsd_conn) == -1)
{
- WARNING ("gps plugin: incorrect data!");
+ WARNING ("gps plugin: incorrect data! (err_count: %d)", err_count);
+ err_count++;
+
+ if (err_count > CGPS_MAX_ERROR)
+ {
+ // Server is not responding ...
+ if (gps_send (&gpsd_conn, CGPS_CONFIG) == -1)
+ {
+ WARNING ("gps plugin: gpsd seems to be down, reconnecting");
+ gps_close (&gpsd_conn);
+ break;
+ }
+ // Server is responding ...
+ else
+ {
+ err_count = 0;
+ }
+ }
+
continue;
}
- pthread_mutex_lock (&data_lock);
+ pthread_mutex_lock (&cgps_data_lock);
// Number of sats in view:
- data.sats_used = (gauge_t) conn.satellites_used;
- data.sats_visible = (gauge_t) conn.satellites_visible;
+ cgps_data.sats_used = (gauge_t) gpsd_conn.satellites_used;
+ cgps_data.sats_visible = (gauge_t) gpsd_conn.satellites_visible;
// dilution of precision:
- data.vdop = NAN; data.hdop = NAN;
- if (data.sats_used > 0)
+ cgps_data.vdop = NAN;
+ cgps_data.hdop = NAN;
+ if (cgps_data.sats_used > 0)
{
- data.hdop = conn.dop.hdop;
- data.vdop = conn.dop.vdop;
+ cgps_data.hdop = gpsd_conn.dop.hdop;
+ cgps_data.vdop = gpsd_conn.dop.vdop;
}
-
DEBUG ("gps plugin: %.0f sats used (of %.0f visible), hdop = %.3f, vdop = %.3f",
- data.sats_used, data.sats_visible, data.hdop, data.vdop);
+ cgps_data.sats_used, cgps_data.sats_visible, cgps_data.hdop, cgps_data.vdop);
- pthread_mutex_unlock (&data_lock);
+ pthread_mutex_unlock (&cgps_data_lock);
}
}
- gps_stream (&conn, WATCH_DISABLE, /* data = */ NULL);
- gps_close (&conn);
-
- pthread_exit ((void *) 0);
+stop:
+ DEBUG ("gps plugin: thread closing gpsd connection ... ");
+ gps_stream (&gpsd_conn, WATCH_DISABLE, NULL);
+ gps_close (&gpsd_conn);
+quit:
+ DEBUG ("gps plugin: thread shutting down ... ");
+ cgps_thread_running = CGPS_FALSE;
+ pthread_mutex_unlock (&cgps_thread_lock);
+ pthread_exit (NULL);
}
+
/**
* Submit a piece of the data.
*/
@@ -155,13 +239,13 @@ static void cgps_submit (const char *type, gauge_t value, const char *type_insta
/**
* Read the data and submit by piece.
*/
-static int cgps_read ()
+static int cgps_read (void)
{
cgps_data_t data_copy;
- pthread_mutex_lock (&data_lock);
- data_copy = data;
- pthread_mutex_unlock (&data_lock);
+ pthread_mutex_lock (&cgps_data_lock);
+ data_copy = cgps_data;
+ pthread_mutex_unlock (&cgps_data_lock);
cgps_submit ("dilution_of_precision", data_copy.hdop, "horizontal");
cgps_submit ("dilution_of_precision", data_copy.vdop, "vertical");
/**
* Read configuration.
*/
-static int cgps_config (const char *key, const char *value)
+static int cgps_config (oconfig_item_t *ci)
{
- char *endptr = NULL;
+ int i;
- if (strcasecmp (key, "Host") == 0)
- {
- free (config.host);
- config.host = sstrdup (value);
- }
- else if (strcasecmp (key, "Port") == 0)
- {
- free (config.port);
- config.port = sstrdup (value);
- }
- else if (strcasecmp (key, "Timeout") == 0)
+ for (i = 0; i < ci->children_num; i++)
{
- config.timeout = (int) (strtod(value, &endptr) * 1000);
+ oconfig_item_t *child = ci->children + i;
+
+ if (strcasecmp ("Host", child->key) == 0)
+ cf_util_get_string (child, &cgps_config_data.host);
+ else if (strcasecmp ("Port", child->key) == 0)
+ cf_util_get_service (child, &cgps_config_data.port);
+ else if (strcasecmp ("Timeout", child->key) == 0)
+ cf_util_get_cdtime (child, &cgps_config_data.timeout);
+ else if (strcasecmp ("PauseConnect", child->key) == 0)
+ cf_util_get_cdtime (child, &cgps_config_data.pause_connect);
+ else
+ WARNING ("gps plugin: Ignoring unknown config option \"%s\".", child->key);
}
- else if (strcasecmp (key, "Pause") == 0)
+
+ // Controlling the value for timeout:
+ // If set too high it blocks the reading (> 5 s), too low it gets not reading (< 500 us).
+ // To avoid any issues we replace "out of range" value by the default value.
+ if (
+ cgps_config_data.timeout > TIME_T_TO_CDTIME_T(5)
+ ||
+ cgps_config_data.timeout < US_TO_CDTIME_T(500)
+ )
{
- config.pause = (int) (strtod (value, &endptr));
+ WARNING ("gps plugin: timeout set to %.6f sec. setting to default (%.6f).",
+ CDTIME_T_TO_DOUBLE(cgps_config_data.timeout),
+ CDTIME_T_TO_DOUBLE(CGPS_DEFAULT_TIMEOUT)
+ );
+ cgps_config_data.timeout = CGPS_DEFAULT_TIMEOUT;
}
return (0);
{
int status;
- DEBUG ("gps plugin: config{host: \"%s\", port: \"%s\", timeout: %d, pause: %d}",
- config.host, config.port, config.timeout, config.pause);
+ if (cgps_thread_running == CGPS_TRUE)
+ {
+ DEBUG ("gps plugin: error gps thread already running ... ");
+ return 0;
+ }
- status = plugin_thread_create (&connector, NULL, gps_collectd_thread, NULL);
+ DEBUG ("gps plugin: config{host: \"%s\", port: \"%s\", timeout: %.6f sec., pause connect: %.3f sec.}",
+ cgps_config_data.host, cgps_config_data.port,
+ CDTIME_T_TO_DOUBLE (cgps_config_data.timeout),
+ CDTIME_T_TO_DOUBLE (cgps_config_data.pause_connect));
+
+ status = plugin_thread_create (&cgps_thread_id, NULL, cgps_thread, NULL);
if (status != 0)
{
ERROR ("gps plugin: pthread_create() failed.");
*/
static int cgps_shutdown (void)
{
- if (connector != ((pthread_t) 0))
- {
- pthread_kill (connector, SIGTERM);
- connector = (pthread_t) 0;
- }
+ void * res;
+
+ pthread_mutex_lock (&cgps_thread_lock);
+ cgps_thread_shutdown = CGPS_TRUE;
+ pthread_mutex_unlock (&cgps_thread_lock);
+
+ pthread_join(cgps_thread_id, &res);
+ free(res);
+
+ // Clean mutex:
+ pthread_mutex_unlock(&cgps_thread_lock);
+ pthread_mutex_destroy(&cgps_thread_lock);
+ pthread_mutex_unlock(&cgps_data_lock);
+ pthread_mutex_destroy(&cgps_data_lock);
- sfree (config.port);
- sfree (config.host);
+ sfree (cgps_config_data.port);
+ sfree (cgps_config_data.host);
return (0);
}
*/
void module_register (void)
{
- config.host = sstrdup (GPS_DEFAULT_HOST);
- config.port = sstrdup (GPS_DEFAULT_PORT);
- config.timeout = GPS_DEFAULT_TIMEOUT;
- config.pause = GPS_DEFAULT_PAUSE;
+ cgps_config_data.host = sstrdup (CGPS_DEFAULT_HOST);
+ cgps_config_data.port = sstrdup (CGPS_DEFAULT_PORT);
+ cgps_config_data.timeout = CGPS_DEFAULT_TIMEOUT;
+ cgps_config_data.pause_connect = CGPS_DEFAULT_PAUSE_CONNECT;
- plugin_register_config ("gps", cgps_config, config_keys, config_keys_num);
+ plugin_register_complex_config ("gps", cgps_config);
plugin_register_init ("gps", cgps_init);
plugin_register_read ("gps", cgps_read);
plugin_register_shutdown ("gps", cgps_shutdown);