view target-utils/simagent/tx.c @ 801:da724c67159d

fcup-smdump: use new function for Phonebook-Name
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 25 Mar 2021 01:40:36 +0000
parents 289733ff272b
children
line wrap: on
line source

/*
 * 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, delay;

	if (conf1_reg & SIM_CONF1_ETU)
		delay = 6000;
	else
		delay = 30000;
	SIMREGS.conf1 = conf1_reg |= SIM_CONF1_TXRX;
	if (count == 1)
		wait_ARM_cycles(delay);
	(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(delay);
		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);
		}
	}
}

void
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);
}