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) |