/*
 * This module implements transmission of bytes toward the SIM.
 */

#include "types.h"
#include "simregs.h"

extern u16 conf1_reg;

send_to_sim(bytes, count)
	u8 *bytes;
	unsigned count;
{
	unsigned n, timeout;

	SIMREGS.conf1 = conf1_reg |= SIM_CONF1_TXRX;
	if (count == 1)
		wait_ARM_cycles(30000);
	(void) SIMREGS.it;
	for (n = 0; ; ) {
		SIMREGS.dtx = bytes[n++];
		if (n == count) {
			SIMREGS.conf1 = conf1_reg &= ~SIM_CONF1_TXRX;
			return(0);
		}
		wait_ARM_cycles(30000);
		for (timeout = 12000; timeout; timeout--)
			if (SIMREGS.it & SIM_IT_ITTX)
				break;
		if (!timeout) {
			printf("ERROR: SIM interface Tx timeout on byte %u\n",
				n);
			return(-1);
		}
	}
}

cmd_tx(argstr)
	char *argstr;
{
	u8 bytes[5];
	int rc;

	rc = decode_hex_string_arg(argstr, bytes, sizeof bytes);
	if (rc < 0)
		return;
	if (rc == 0) {
		printf("ERROR: empty hex string argument\n");
		return;
	}
	send_to_sim(bytes, rc);
}