add new (incomplete) Wavecom vendor module
This commit is contained in:
parent
177b57c5c4
commit
be32141745
|
@ -30,7 +30,8 @@ plugin_LTLIBRARIES = libgsmd-machine_generic.la \
|
|||
libgsmd-vendor_tihtc.la \
|
||||
libgsmd-vendor_qc.la \
|
||||
libgsmd-vendor_bcm.la \
|
||||
libgsmd-vendor_telit.la
|
||||
libgsmd-vendor_telit.la \
|
||||
libgsmd-vendor_wavecom.la
|
||||
|
||||
libgsmd_machine_generic_la_SOURCES = machine_generic.c
|
||||
libgsmd_machine_generic_la_LDFLAGS = -module
|
||||
|
@ -51,6 +52,8 @@ libgsmd_vendor_bcm_la_SOURCES = vendor_bcm.c
|
|||
libgsmd_vendor_bcm_la_LDFLAGS = -module
|
||||
libgsmd_vendor_telit_la_SOURCES = vendor_telit.c
|
||||
libgsmd_vendor_telit_la_LDFLAGS = -module
|
||||
libgsmd_vendor_wavecom_la_SOURCES = vendor_wavecom.c
|
||||
libgsmd_vendor_wavecom_la_LDFLAGS = -module
|
||||
|
||||
|
||||
noinst_HEADERS = gsmd.h
|
||||
|
|
|
@ -0,0 +1,152 @@
|
|||
/* Wavecom Q26 gsmd plugin
|
||||
*
|
||||
* (C) 2012 by Harald Welte <laforge@openmoko.org>
|
||||
* All Rights Reserved
|
||||
*
|
||||
* 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.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||||
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
||||
*
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <unistd.h>
|
||||
#include <string.h>
|
||||
#include <stdio.h>
|
||||
#include <errno.h>
|
||||
#include <stdint.h>
|
||||
|
||||
#include "gsmd.h"
|
||||
|
||||
#include <gsmd/gsmd.h>
|
||||
#include <gsmd/usock.h>
|
||||
#include <gsmd/event.h>
|
||||
#include <gsmd/talloc.h>
|
||||
#include <gsmd/extrsp.h>
|
||||
#include <gsmd/atcmd.h>
|
||||
#include <gsmd/vendorplugin.h>
|
||||
#include <gsmd/unsolicited.h>
|
||||
|
||||
struct cell_info_fsq {
|
||||
uint8_t cur;
|
||||
uint8_t full;
|
||||
uint8_t sub;
|
||||
};
|
||||
|
||||
#define TOK_OR_OUT(in) do { tok = strchr(in, ','); if (!tok || *(tok+1) == 0) goto out; tok += 1; } while (0)
|
||||
|
||||
static int cced_parse(const char *buf, int len, const char *param,
|
||||
struct gsmd *gsmd)
|
||||
{
|
||||
struct gsmd_evt_auxdata *aux;
|
||||
struct gsmd_ucmd *ucmd = usock_build_event(GSMD_MSG_EVENT, GSMD_EVT_CELLINFO, sizeof(*aux));
|
||||
char *tok = buf;
|
||||
int rc;
|
||||
|
||||
if (!ucmd)
|
||||
return -ENOMEM;
|
||||
|
||||
aux = (struct gsmd_evt_auxdata *) ucmd->buf;
|
||||
|
||||
DEBUGP("entering cced_parse param=`%s'\n", param);
|
||||
|
||||
aux->u.cell_info.mcc = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.mnc = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
sscanf(tok, "%x", &aux->u.cell_info.lac);
|
||||
TOK_OR_OUT(tok);
|
||||
sscanf(tok, "%x", &aux->u.cell_info.ci);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.bsic = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.arfcn = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.rxlev = atoi(tok);
|
||||
|
||||
usock_evt_send(gsmd, ucmd, GSMD_EVT_SIGNAL);
|
||||
ucmd = NULL;
|
||||
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
|
||||
/* iterate over neighbor cell records */
|
||||
while (tok) {
|
||||
//DEBUGP("remaining: `%s'\n", tok);
|
||||
|
||||
ucmd = usock_build_event(GSMD_MSG_EVENT, GSMD_EVT_CELLINFO, sizeof(*aux));
|
||||
if (!ucmd)
|
||||
return -ENOMEM;
|
||||
aux = (struct gsmd_evt_auxdata *) ucmd->buf;
|
||||
|
||||
aux->u.cell_info.mcc = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.mnc = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
sscanf(tok, "%x", &aux->u.cell_info.lac);
|
||||
TOK_OR_OUT(tok);
|
||||
sscanf(tok, "%x", &aux->u.cell_info.ci);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.bsic = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.arfcn = atoi(tok);
|
||||
TOK_OR_OUT(tok);
|
||||
aux->u.cell_info.rxlev = atoi(tok);
|
||||
|
||||
usock_evt_send(gsmd, ucmd, GSMD_EVT_SIGNAL);
|
||||
ucmd = NULL;
|
||||
|
||||
TOK_OR_OUT(tok);
|
||||
}
|
||||
|
||||
return 0;
|
||||
out:
|
||||
talloc_free(ucmd);
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct gsmd_unsolicit wavecom_unsolicit[] = {
|
||||
{ "+CCED", &cced_parse }, /* Cell Environment Report */
|
||||
};
|
||||
|
||||
static int wavecom_detect(struct gsmd *g)
|
||||
{
|
||||
/* FIXME: do actual detection of vendor if we have multiple vendors */
|
||||
return 1;
|
||||
}
|
||||
|
||||
static int wavecom_initsettings(struct gsmd *g)
|
||||
{
|
||||
int rc = 0;
|
||||
struct gsmd_atcmd *cmd;
|
||||
|
||||
/* use +WREGC to enter "spy mode" (no transmit / registration) */
|
||||
rc |= gsmd_simplecmd(g, "AT+WREGC=1");
|
||||
rc |= gsmd_simplecmd(g, "AT+CCED=1,3");
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
struct gsmd_vendor_plugin gsmd_vendor_plugin = {
|
||||
.name = "Wavecom Q26",
|
||||
.ext_chars = "",
|
||||
.num_unsolicit = ARRAY_SIZE(wavecom_unsolicit),
|
||||
.unsolicit = wavecom_unsolicit,
|
||||
.detect = &wavecom_detect,
|
||||
.initsettings = &wavecom_initsettings,
|
||||
};
|
Loading…
Reference in New Issue