FreeCalypso > hg > freecalypso-tools
diff loadtools/simup.c @ 790:0bbe0213812d
fc-simint put together, compiles
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Fri, 19 Mar 2021 04:40:05 +0000 |
parents | |
children | 44e034f21916 |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/loadtools/simup.c Fri Mar 19 04:40:05 2021 +0000 @@ -0,0 +1,66 @@ +/* + * This module implements the stage in fc-simint where the sim-up + * command is fed to simagent and the ATR response is parsed. + */ + +#include <sys/types.h> +#include <ctype.h> +#include <stdio.h> +#include <stdlib.h> +#include <string.h> +#include <strings.h> + +extern int sim_voltage_mode_1v8; + +#define MAX_ATR_BYTES 33 + +u_char sim_atr[MAX_ATR_BYTES]; +unsigned sim_atr_len; + +static +sim_up_callback(line) + char *line; +{ + char *cp; + + puts(line); + if (strncmp(line, "ATR:", 4)) + return(1); + sim_atr_len = 0; + for (cp = line + 4; *cp; cp += 3) { + if (cp[0] != ' ' || !isxdigit(cp[1]) || !isxdigit(cp[2])) { + fprintf(stderr, + "error: invalid ATR line from simagent\n"); + return(1); + } + if (sim_atr_len >= MAX_ATR_BYTES) { + fprintf(stderr, + "error: ATR from simagent is too long\n"); + return(1); + } + sim_atr[sim_atr_len++] = decode_hex_byte(cp + 1); + } + return(0); +} + +void +do_sim_up() +{ + char *targv[3]; + + targv[0] = "sim-up"; + if (sim_voltage_mode_1v8) + targv[1] = "1.8"; + else + targv[2] = "3"; + targv[2] = 0; + tpinterf_make_cmd(targv); + if (tpinterf_send_cmd() < 0) + exit(1); + if (tpinterf_capture_output(20, sim_up_callback)) + exit(1); + if (!sim_atr_len) { + fprintf(stderr, "error: no ATR returned from simagent\n"); + exit(1); + } +}