add support for encapsulating and forwarding GPS and AIS data

we simply convert the sysmocom specific unsolicited messages into
an usock event which is transported to the client[s] who subscribed
to it.

2 files changed, 62 insertions, 1 deletions

diff --git a/src/gsmd/vendor_wavecom.c b/src/gsmd/vendor_wavecom.c
index c1683ea..e5a9f08 100644
--- a/src/gsmd/vendor_wavecom.c
+++ b/src/gsmd/vendor_wavecom.c
@@ -120,8 +120,61 @@ out:
 	return 0;
 }
 
+#define AIS_PFX "+SYSMOCOM_AIS: "
+
+struct gsmd_ucmd *usock_build_gps(uint8_t subtype, const char *data, uint16_t len)
+{
+	struct gsmd_evt_auxdata *aux;
+	struct gsmd_ucmd *ucmd;
+	int remain_len;
+
+	if (len <= strlen(AIS_PFX))
+		return NULL;
+
+	remain_len = len - strlen(AIS_PFX);
+
+	ucmd = usock_build_event(GSMD_MSG_EVENT, subtype, sizeof(*aux)+remain_len+1);
+	if (!ucmd)
+		return NULL;
+	aux = (struct gsmd_evt_auxdata *) ucmd->buf;
+
+	memcpy(aux->data, data+strlen(AIS_PFX), remain_len);
+	aux->data[remain_len] = '\0';
+
+	return ucmd;
+}
+
+static int sgps_parse(const char *buf, int len, const char *param,
+		     struct gsmd *gsmd)
+{
+	struct gsmd_ucmd *ucmd = usock_build_gps(GSMD_EVT_GPS, buf, len);
+
+	if (!ucmd)
+		return -ENOMEM;
+
+	usock_evt_send(gsmd, ucmd, GSMD_EVT_SIGNAL);
+
+	return 0;
+};
+
+static int sais_parse(const char *buf, int len, const char *param,
+		     struct gsmd *gsmd)
+{
+
+	struct gsmd_ucmd *ucmd = usock_build_gps(GSMD_EVT_AIS, buf, len);
+
+	if (!ucmd)
+		return -ENOMEM;
+
+	usock_evt_send(gsmd, ucmd, GSMD_EVT_SIGNAL);
+
+	return 0;
+};
+
 static const struct gsmd_unsolicit wavecom_unsolicit[] = {
-	{ "+CCED",	&cced_parse },	/* Cell Environment Report */
+	{ "+CCED",		&cced_parse },	/* Cell Environment Report */
+	{ "+SYSMOCOM_GPS",	&sgps_parse },
+	{ "+SYSMOCOM_AIS",	&sais_parse },
 };
 
 static int wavecom_detect(struct gsmd *g)
diff --git a/src/util/event.c b/src/util/event.c
index f086d84..ae5ca7b 100644
--- a/src/util/event.c
+++ b/src/util/event.c
@@ -261,6 +261,12 @@ static int cinfo_handler(struct lgsm_handle *lh, int evt, struct gsmd_evt_auxdat
 	return 0;
 }
 
+static int gps_handler(struct lgsm_handle *lh, int evt, struct gsmd_evt_auxdata *aux)
+{
+	printf("EVENT: %s: %s\n", evt == GSMD_EVT_GPS ? "GPS" : "AIS", aux->data);
+	return 0;
+}
+
 int event_init(struct lgsm_handle *lh)
 {
 	int rc;
@@ -277,6 +283,8 @@ int event_init(struct lgsm_handle *lh)
 	rc |= lgsm_evt_handler_register(lh, GSMD_EVT_IN_ERROR, &error_handler);
 	rc |= lgsm_evt_handler_register(lh, GSMD_EVT_CALL_WAIT, &ccwa_handler);
 	rc |= lgsm_evt_handler_register(lh, GSMD_EVT_CELLINFO, &cinfo_handler);
+	rc |= lgsm_evt_handler_register(lh, GSMD_EVT_GPS, &gps_handler);
+	rc |= lgsm_evt_handler_register(lh, GSMD_EVT_AIS, &gps_handler);
 	return rc;
 }