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)