diff simtool/chvfunc.c @ 33:c83ec3bd9d67

fc-simtool sws-pin1-{dis,en}able implemented
author Mychaela Falconia <falcon@freecalypso.org>
date Wed, 17 Mar 2021 01:14:19 +0000
parents cca7d0528f89
children
line wrap: on
line diff
--- a/simtool/chvfunc.c	Wed Mar 17 00:49:50 2021 +0000
+++ b/simtool/chvfunc.c	Wed Mar 17 01:14:19 2021 +0000
@@ -33,3 +33,57 @@
 	}
 	return(0);
 }
+
+disable_chv_func(p2, pin)
+	unsigned p2;
+	char *pin;
+{
+	u_char cmd[13];
+	int rc;
+
+	/* DISABLE CHV command APDU */
+	cmd[0] = 0xA0;
+	cmd[1] = 0x26;
+	cmd[2] = 0x00;
+	cmd[3] = p2;
+	cmd[4] = 8;
+	rc = encode_pin_entry(pin, cmd + 5);
+	if (rc < 0)
+		return(rc);
+	rc = apdu_exchange(cmd, 13);
+	if (rc < 0)
+		return(rc);
+	if (sim_resp_sw != 0x9000 && sim_resp_sw != 0x9808) {
+		fprintf(stderr, "bad SW response to DISABLE CHV: %04X\n",
+			sim_resp_sw);
+		return(-1);
+	}
+	return(0);
+}
+
+enable_chv_func(p2, pin)
+	unsigned p2;
+	char *pin;
+{
+	u_char cmd[13];
+	int rc;
+
+	/* ENABLE CHV command APDU */
+	cmd[0] = 0xA0;
+	cmd[1] = 0x28;
+	cmd[2] = 0x00;
+	cmd[3] = p2;
+	cmd[4] = 8;
+	rc = encode_pin_entry(pin, cmd + 5);
+	if (rc < 0)
+		return(rc);
+	rc = apdu_exchange(cmd, 13);
+	if (rc < 0)
+		return(rc);
+	if (sim_resp_sw != 0x9000 && sim_resp_sw != 0x9808) {
+		fprintf(stderr, "bad SW response to ENABLE CHV: %04X\n",
+			sim_resp_sw);
+		return(-1);
+	}
+	return(0);
+}