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