comparison 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
comparison
equal deleted inserted replaced
789:464a531122ab 790:0bbe0213812d
1 /*
2 * This module implements the stage in fc-simint where the sim-up
3 * command is fed to simagent and the ATR response is parsed.
4 */
5
6 #include <sys/types.h>
7 #include <ctype.h>
8 #include <stdio.h>
9 #include <stdlib.h>
10 #include <string.h>
11 #include <strings.h>
12
13 extern int sim_voltage_mode_1v8;
14
15 #define MAX_ATR_BYTES 33
16
17 u_char sim_atr[MAX_ATR_BYTES];
18 unsigned sim_atr_len;
19
20 static
21 sim_up_callback(line)
22 char *line;
23 {
24 char *cp;
25
26 puts(line);
27 if (strncmp(line, "ATR:", 4))
28 return(1);
29 sim_atr_len = 0;
30 for (cp = line + 4; *cp; cp += 3) {
31 if (cp[0] != ' ' || !isxdigit(cp[1]) || !isxdigit(cp[2])) {
32 fprintf(stderr,
33 "error: invalid ATR line from simagent\n");
34 return(1);
35 }
36 if (sim_atr_len >= MAX_ATR_BYTES) {
37 fprintf(stderr,
38 "error: ATR from simagent is too long\n");
39 return(1);
40 }
41 sim_atr[sim_atr_len++] = decode_hex_byte(cp + 1);
42 }
43 return(0);
44 }
45
46 void
47 do_sim_up()
48 {
49 char *targv[3];
50
51 targv[0] = "sim-up";
52 if (sim_voltage_mode_1v8)
53 targv[1] = "1.8";
54 else
55 targv[2] = "3";
56 targv[2] = 0;
57 tpinterf_make_cmd(targv);
58 if (tpinterf_send_cmd() < 0)
59 exit(1);
60 if (tpinterf_capture_output(20, sim_up_callback))
61 exit(1);
62 if (!sim_atr_len) {
63 fprintf(stderr, "error: no ATR returned from simagent\n");
64 exit(1);
65 }
66 }