/* Wavecom Q26 gsmd plugin * * (C) 2012 by Harald Welte * 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 #include #include #include #include #include #include "gsmd.h" #include #include #include #include #include #include #include #include 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; } #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 */ { "+SYSMOCOM_GPS", &sgps_parse }, { "+SYSMOCOM_AIS", &sais_parse }, }; 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=0"); 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, };