FreeCalypso > hg > fc-sim-tools
comparison simtool/grcard2ki.c @ 97:9f1cc3174e45
grcard2-set-comp128: allow optional setting of upper 6 bits
| author | Mychaela Falconia <falcon@freecalypso.org> |
|---|---|
| date | Wed, 05 May 2021 04:05:57 +0000 |
| parents | a5cfe5135701 |
| children |
comparison
equal
deleted
inserted
replaced
| 96:a5cfe5135701 | 97:9f1cc3174e45 |
|---|---|
| 38 | 38 |
| 39 cmd_grcard2_set_comp128(argc, argv) | 39 cmd_grcard2_set_comp128(argc, argv) |
| 40 char **argv; | 40 char **argv; |
| 41 { | 41 { |
| 42 int rc; | 42 int rc; |
| 43 unsigned code; | 43 unsigned code, upper; |
| 44 u_char magic_byte; | 44 u_char magic_byte; |
| 45 | 45 |
| 46 if (argv[1][0] < '1' || argv[1][0] > '3' || argv[1][1]) { | 46 if (argv[1][0] < '1' || argv[1][0] > '3' || argv[1][1]) { |
| 47 fprintf(stderr, "error: invalid argument\n"); | 47 fprintf(stderr, "error: invalid COMP128 version argument\n"); |
| 48 return(-1); | 48 return(-1); |
| 49 } | 49 } |
| 50 code = argv[1][0] - '1'; | 50 code = argv[1][0] - '1'; |
| 51 if (argv[2]) { | |
| 52 upper = strtoul(argv[2], 0, 16); | |
| 53 if ((upper & 3) || (upper > 0xFC)) { | |
| 54 fprintf(stderr, "error: invalid upper bits argument\n"); | |
| 55 return(-1); | |
| 56 } | |
| 57 } | |
| 51 rc = select_ef_weki(); | 58 rc = select_ef_weki(); |
| 52 if (rc < 0) | 59 if (rc < 0) |
| 53 return(rc); | 60 return(rc); |
| 54 rc = readbin_op(2, 1); | 61 if (argv[2]) |
| 55 if (rc < 0) | 62 magic_byte = upper; |
| 56 return(rc); | 63 else { |
| 57 magic_byte = sim_resp_data[0]; | 64 rc = readbin_op(2, 1); |
| 58 magic_byte &= 0xFC; | 65 if (rc < 0) |
| 66 return(rc); | |
| 67 magic_byte = sim_resp_data[0] & 0xFC; | |
| 68 } | |
| 59 magic_byte |= code; | 69 magic_byte |= code; |
| 60 return update_bin_op(2, &magic_byte, 1); | 70 return update_bin_op(2, &magic_byte, 1); |
| 61 } | 71 } |
| 62 | 72 |
| 63 cmd_grcard2_set_ki(argc, argv) | 73 cmd_grcard2_set_ki(argc, argv) |
