FreeCalypso > hg > freecalypso-tools
view target-utils/simagent/tx.c @ 939:4d2e6a2dd1a1
libprint: implement libg23 replacement
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 24 May 2023 06:29:13 +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); }