colin/ModemManager
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

gps-serial-port: new type to handle read-only serial ports with GPS traces

Browse Source
This commit is contained in:
Aleksander Morgado
2012-03-27 11:21:06 +02:00
parent 2bd321489d
commit a0b3663274
3 changed files with 278 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
src/Makefile.am
View File

@@ -70,7 +70,9 @@ libserial_la_SOURCES = \
mm-at-serial-port.c \
mm-at-serial-port.h \
mm-qcdm-serial-port.c \
mm-qcdm-serial-port.h
mm-qcdm-serial-port.h \
mm-gps-serial-port.c \
mm-gps-serial-port.h
# Daemon specific enum types
DAEMON_ENUMS = \

218
src/mm-gps-serial-port.c Normal file
View File

@@ -0,0 +1,218 @@
/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
/*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details:
*
* Copyright (C) 2012 Aleksander Morgado <aleksander@gnu.org>
*/
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include "mm-gps-serial-port.h"
#include "mm-log.h"
G_DEFINE_TYPE (MMGpsSerialPort, mm_gps_serial_port, MM_TYPE_SERIAL_PORT)
struct _MMGpsSerialPortPrivate {
/* Trace handler data */
MMGpsSerialTraceFn callback;
gpointer user_data;
GDestroyNotify notify;
/* Regex for all known traces */
GRegex *known_traces_regex;
};
/*****************************************************************************/
void
mm_gps_serial_port_add_trace_handler (MMGpsSerialPort *self,
MMGpsSerialTraceFn callback,
gpointer user_data,
GDestroyNotify notify)
{
g_return_if_fail (MM_IS_GPS_SERIAL_PORT (self));
if (self->priv->notify)
self->priv->notify (self->priv->user_data);
self->priv->callback = callback;
self->priv->user_data = user_data;
self->priv->notify = notify;
}
/*****************************************************************************/
static gboolean
remove_eval_cb (const GMatchInfo *match_info,
GString *result,
gpointer user_data)
{
int *result_len = (int *) user_data;
int start;
int end;
if (g_match_info_fetch_pos (match_info, 0, &start, &end))
*result_len -= (end - start);
return FALSE;
}
static gboolean
parse_response (MMSerialPort *port,
GByteArray *response,
GError **error)
{
MMGpsSerialPort *self = MM_GPS_SERIAL_PORT (port);
gboolean matches;
GMatchInfo *match_info;
gchar *str;
gint result_len;
guint i;
for (i = 0; i < response->len; i++) {
/* If there is any content before the first $,
* assume it's garbage, and skip it */
if (response->data[i] == '$') {
if (i > 0)
g_byte_array_remove_range (response, 0, i);
/* else, good, we're already started with $ */
break;
}
}
matches = g_regex_match_full (self->priv->known_traces_regex,
(const gchar *) response->data,
response->len,
0, 0, &match_info, NULL);
if (self->priv->callback) {
while (g_match_info_matches (match_info)) {
gchar *trace;
trace = g_match_info_fetch (match_info, 0);
if (trace) {
self->priv->callback (self, trace, self->priv->user_data);
g_free (trace);
}
g_match_info_next (match_info, NULL);
}
}
g_match_info_free (match_info);
if (!matches)
return FALSE;
/* Remove matches */
result_len = response->len;
str = g_regex_replace_eval (self->priv->known_traces_regex,
(const char *) response->data,
response->len,
0, 0,
remove_eval_cb, &result_len, NULL);
g_byte_array_remove_range (response, 0, response->len);
g_byte_array_append (response, (const guint8 *) str, result_len);
g_free (str);
return TRUE;
}
/*****************************************************************************/
static void
debug_log (MMSerialPort *port, const char *prefix, const char *buf, gsize len)
{
static GString *debug = NULL;
const char *s;
if (!debug)
debug = g_string_sized_new (256);
g_string_append (debug, prefix);
g_string_append (debug, " '");
s = buf;
while (len--) {
if (g_ascii_isprint (*s))
g_string_append_c (debug, *s);
else if (*s == '\r')
g_string_append (debug, "<CR>");
else if (*s == '\n')
g_string_append (debug, "<LF>");
else
g_string_append_printf (debug, "\\%u", (guint8) (*s & 0xFF));
s++;
}
g_string_append_c (debug, '\'');
mm_dbg ("(%s): %s", mm_port_get_device (MM_PORT (port)), debug->str);
g_string_truncate (debug, 0);
}
/*****************************************************************************/
MMGpsSerialPort *
mm_gps_serial_port_new (const char *name)
{
return MM_GPS_SERIAL_PORT (g_object_new (MM_TYPE_GPS_SERIAL_PORT,
MM_PORT_DEVICE, name,
MM_PORT_SUBSYS, MM_PORT_SUBSYS_TTY,
MM_PORT_TYPE, MM_PORT_TYPE_GPS,
NULL));
}
static void
mm_gps_serial_port_init (MMGpsSerialPort *self)
{
self->priv = G_TYPE_INSTANCE_GET_PRIVATE ((self),
MM_TYPE_GPS_SERIAL_PORT,
MMGpsSerialPortPrivate);
/* We'll assume that all traces start with the dollar sign and end with \r\n */
self->priv->known_traces_regex =
g_regex_new ("\\$.*\\r\\n",
G_REGEX_RAW | G_REGEX_OPTIMIZE,
0,
NULL);
}
static void
finalize (GObject *object)
{
MMGpsSerialPort *self = MM_GPS_SERIAL_PORT (object);
if (self->priv->notify)
self->priv->notify (self->priv->user_data);
g_regex_unref (self->priv->known_traces_regex);
G_OBJECT_CLASS (mm_gps_serial_port_parent_class)->finalize (object);
}
static void
mm_gps_serial_port_class_init (MMGpsSerialPortClass *klass)
{
GObjectClass *object_class = G_OBJECT_CLASS (klass);
MMSerialPortClass *port_class = MM_SERIAL_PORT_CLASS (klass);
g_type_class_add_private (object_class, sizeof (MMGpsSerialPortPrivate));
/* Virtual methods */
object_class->finalize = finalize;
port_class->parse_response = parse_response;
port_class->debug_log = debug_log;
}

57
src/mm-gps-serial-port.h Normal file
View File

@@ -0,0 +1,57 @@
/* -*- Mode: C; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
/*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details:
*
* Copyright (C) 2012 - Aleksander Morgado <aleksander@gnu.org>
*/
#ifndef MM_GPS_SERIAL_PORT_H
#define MM_GPS_SERIAL_PORT_H
#include <glib.h>
#include <glib-object.h>
#include "mm-serial-port.h"
#define MM_TYPE_GPS_SERIAL_PORT (mm_gps_serial_port_get_type ())
#define MM_GPS_SERIAL_PORT(obj) (G_TYPE_CHECK_INSTANCE_CAST ((obj), MM_TYPE_GPS_SERIAL_PORT, MMGpsSerialPort))
#define MM_GPS_SERIAL_PORT_CLASS(klass) (G_TYPE_CHECK_CLASS_CAST ((klass), MM_TYPE_GPS_SERIAL_PORT, MMGpsSerialPortClass))
#define MM_IS_GPS_SERIAL_PORT(obj) (G_TYPE_CHECK_INSTANCE_TYPE ((obj), MM_TYPE_GPS_SERIAL_PORT))
#define MM_IS_GPS_SERIAL_PORT_CLASS(klass) (G_TYPE_CHECK_CLASS_TYPE ((klass), MM_TYPE_GPS_SERIAL_PORT))
#define MM_GPS_SERIAL_PORT_GET_CLASS(obj) (G_TYPE_INSTANCE_GET_CLASS ((obj), MM_TYPE_GPS_SERIAL_PORT, MMGpsSerialPortClass))
typedef struct _MMGpsSerialPort MMGpsSerialPort;
typedef struct _MMGpsSerialPortClass MMGpsSerialPortClass;
typedef struct _MMGpsSerialPortPrivate MMGpsSerialPortPrivate;
typedef void (*MMGpsSerialTraceFn) (MMGpsSerialPort *port,
const gchar *trace,
gpointer user_data);
struct _MMGpsSerialPort {
MMSerialPort parent;
MMGpsSerialPortPrivate *priv;
};
struct _MMGpsSerialPortClass {
MMSerialPortClass parent;
};
GType mm_gps_serial_port_get_type (void);
MMGpsSerialPort *mm_gps_serial_port_new (const char *name);
void mm_gps_serial_port_add_trace_handler (MMGpsSerialPort *self,
MMGpsSerialTraceFn callback,
gpointer user_data,
GDestroyNotify notify);
#endif /* MM_GPS_SERIAL_PORT_H */