FreeCalypso > hg > fc-pcsc-tools
annotate simtool/sysmo.c @ 215:3a2f43460582
fc-simtool pnn-write command implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 07 Mar 2021 08:35:57 +0000 |
parents | c0cd0d4635bb |
children |
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 } |