FreeCalypso > hg > freecalypso-tools
view target-utils/simagent/tx.c @ 778:3ba64341137b
simagent: bare Tx works with extra delays
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 13 Mar 2021 19:31:53 +0000 |
parents | fac3176de18d |
children | 8a94593fb7ef |
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; 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); }