/* 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;
}

#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,
};