FreeCalypso > hg > fc-pcsc-tools

annotate simtool/sysmo.c @ 197:3ddbc3fea5f0

Find changesets by keywords (author, files, the commit message), revision number or hash, or revset expression.
encode_plmn_3bytes() error handling change in preparation for PLMN list reading addition
author Mychaela Falconia <falcon@freecalypso.org>
date Sun, 07 Mar 2021 02:36:27 +0000
parents c0cd0d4635bb
children
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
1
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
1 /*
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
2 * This module implements special commands for programmable and
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
3 * semi-programmable (made-up term for the version without ADM keys)
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
4 * SIM cards made by Sysmocom.
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
5 */
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
6
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
7 #include <sys/types.h>
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
8 #include <string.h>
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
9 #include <strings.h>
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
10 #include <stdio.h>
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
11 #include <stdlib.h>
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
12 #include "simresp.h"
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
13 #include "curfile.h"
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
14 #include "file_id.h"
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
15
122
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
16 cmd_verify_sjs1_adm1(argc, argv)
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
17 char **argv;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
18 {
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
19 u_char cmd[13];
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
20 int rc;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
21
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
22 /* UICC-style VERIFY PIN command APDU */
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
23 cmd[0] = 0x00;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
24 cmd[1] = 0x20;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
25 cmd[2] = 0x00;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
26 cmd[3] = 0x0A;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
27 cmd[4] = 8;
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
28 rc = encode_pin_entry(argv[1], cmd + 5);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
29 if (rc < 0)
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
30 return(rc);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
31 rc = apdu_exchange(cmd, 13);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
32 if (rc < 0)
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
33 return(rc);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
34 if (sim_resp_sw != 0x9000) {
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
35 fprintf(stderr, "bad SW response: %04X\n", sim_resp_sw);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
36 return(-1);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
37 }
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
38 return(0);
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
39 }
c0cd0d4635bb fc-simtool verify-sjs1-adm1 command implemented
Mychaela Falconia <falcon@freecalypso.org>
parents: 1
diff changeset
40
1
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
41 cmd_fix_sysmo_msisdn()
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
42 {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
43 int rc;
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
44 unsigned n;
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
45 u_char newrec[34];
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
46
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
47 rc = select_op(DF_TELECOM);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
48 if (rc < 0)
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
49 return(rc);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
50 rc = select_op(EF_MSISDN);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
51 if (rc < 0)
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
52 return(rc);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
53 rc = parse_ef_select_response();
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
54 if (rc < 0)
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
55 return(rc);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
56 if (curfile_structure != 0x01) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
57 fprintf(stderr, "error: EF_MSISDN is not linear fixed\n");
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
58 return(-1);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
59 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
60 if (curfile_record_len != 34) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
61 fprintf(stderr,
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
62 "error: expected EF_MSISDN record length of 34 bytes, got %u\n",
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
63 curfile_record_len);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
64 return(-1);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
65 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
66 rc = readrec_op(1, 0x04, 34);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
67 if (rc < 0)
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
68 return(rc);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
69 for (n = 0; n < 18; n++) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
70 if (sim_resp_data[n] != 0xFF) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
71 fprintf(stderr,
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
72 "error: non-FF data in the first 18 bytes of alpha tag area\n");
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
73 return(-1);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
74 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
75 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
76 if (sim_resp_data[18] == 0xFF && sim_resp_data[19] == 0xFF) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
77 printf(
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
78 "last 2 bytes of alpha tag area are clear - already fixed?\n");
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
79 return(0);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
80 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
81 if (sim_resp_data[18] != 0x07 || sim_resp_data[19] != 0x91) {
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
82 fprintf(stderr,
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
83 "error: bytes 18 & 19 don't match expected bogus programming\n");
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
84 return(-1);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
85 }
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
86 memset(newrec, 0xFF, 34);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
87 memcpy(newrec + 20, sim_resp_data + 18, 8);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
88 return update_rec_op(1, 0x04, newrec, 34);
2071b28cd0c7 simtool: first refactored version
Mychaela Falconia <falcon@freecalypso.org>
parents:
diff changeset
89 }