/*
 * Commands for manipulating the experimental TCH rerouting feature
 * of FreeCalypso GSM firmware
 */

#include <sys/types.h>
#include <stdio.h>
#include <string.h>
#include <strings.h>
#include <stdlib.h>
#include "pktmux.h"
#include "limits.h"
#include "tch_feature.h"

extern u_char rvi_msg[];
extern int rvi_msg_len;

static int tch_rawdump_mode;

send_tch_config_req(config)
{
	u_char sendpkt[3];

	sendpkt[0] = RVT_TCH_HEADER;
	sendpkt[1] = TCH_CONFIG_REQ;
	sendpkt[2] = config;
	/* send it! */
	send_pkt_to_target(sendpkt, 3);
	return(0);
}

cmd_tchdl_common(argc, argv)
	char **argv;
{
	int config;

	if (!strcmp(argv[0], "enable") || !strcmp(argv[0], "on") ||
	    !strcmp(argv[0], "1"))
		config = 1;
	else if (!strcmp(argv[0], "disable") || !strcmp(argv[0], "off") ||
		 !strcmp(argv[0], "0"))
		config = 0;
	else {
		printf("error: boolean argument required\n");
		return(1);
	}
	return send_tch_config_req(config);
}

void
cmd_tchdl_interactive(argstr)
	char *argstr;
{
	char *argv[2];
	int argc, rc;

	rc = parse_interactive_command_into_argv(argstr, argv, 1, 1, &argc);
	if (rc < 0)
		return;
	tch_rx_control(1);
	cmd_tchdl_common(argc, argv);
}

cmd_tchdl_oneshot(argc, argv)
	char **argv;
{
	return cmd_tchdl_common(argc - 1, argv + 1);
}

static void
tch_rawdump()
{
	char buf[MAX_PKT_FROM_TARGET*3+5], *dp;
	u_char *cp, *endp;

	cp = rvi_msg + 2;
	endp = rvi_msg + rvi_msg_len;
	strcpy(buf, "TCH:");
	dp = buf + 4;
	while (cp < endp) {
		sprintf(dp, " %02X", *cp++);
		dp += 3;
	}
	*dp = '\0';
	async_msg_output(buf);
}

void
tch_packet_rx()
{
	char buf[128];

	if (tch_rawdump_mode) {
		tch_rawdump();
		return;
	}
	if (rvi_msg_len < 3) {
inv:		async_msg_output("Error: invalid TCH packet received");
		return;
	}
	switch (rvi_msg[2]) {
	case TCH_CONFIG_CONF:
		if (rvi_msg_len != 4)
			goto inv;
		if (rvi_msg[3] & 0xFE)
			goto inv;
		sprintf(buf, "TCH_CONFIG_CONF: DL forwarding is %s",
			rvi_msg[3] ? "enabled" : "disabled");
		async_msg_output(buf);
		return;
	case TCH_ULBITS_CONF:
		/* TCH UL play code will hook in here */
		return;
	case TCH_DLBITS_IND:
		/* TCH DL record code will hook in here */
		return;
	default:
		goto inv;
	}
}