FreeCalypso > hg > freecalypso-hwlab
view simtool/hlread.c @ 156:6d9d0cfc9ed8
fc-simtool: grcard2-set-adm command implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 07 Feb 2021 02:40:28 +0000 |
parents | 90eff13a72fd |
children |
line wrap: on
line source
/* * This module implements some high-level or user-friendly read commands. */ #include <sys/types.h> #include <stdio.h> #include <stdlib.h> #include <pcsclite.h> #include <winscard.h> #include "globals.h" #include "file_id.h" encode_hex_digit(d) unsigned d; { if (d <= 9) return(d + '0'); else return(d - 10 + 'A'); } decode_reversed_nibbles(bytes, nbytes, dest) u_char *bytes; unsigned nbytes; char *dest; { u_char *sp; char *dp; unsigned n, c; sp = bytes; dp = dest; for (n = 0; n < nbytes; n++) { c = *sp & 0xF; *dp++ = encode_hex_digit(c); c = *sp >> 4; *dp++ = encode_hex_digit(c); sp++; } } cmd_iccid() { int rc; char buf[21]; rc = select_op(FILEID_MF); if (rc < 0) return(rc); rc = select_op(EF_ICCID); if (rc < 0) return(rc); rc = parse_ef_select_response(); if (rc < 0) return(rc); if (curfile_structure != 0x00 || curfile_total_size != 10) { fprintf(stderr, "error: expected transparent EF of 10 bytes\n"); return(-1); } rc = readbin_op(0, 10); if (rc < 0) return(rc); decode_reversed_nibbles(sim_resp_data, 10, buf); buf[20] = '\0'; printf("%s\n", buf); return(0); } cmd_imsi() { int rc; char buf[17]; rc = select_op(DF_GSM); if (rc < 0) return(rc); rc = select_op(EF_IMSI); if (rc < 0) return(rc); rc = parse_ef_select_response(); if (rc < 0) return(rc); if (curfile_structure != 0x00 || curfile_total_size != 9) { fprintf(stderr, "error: expected transparent EF of 9 bytes\n"); return(-1); } rc = readbin_op(0, 9); if (rc < 0) return(rc); decode_reversed_nibbles(sim_resp_data + 1, 8, buf); buf[16] = '\0'; printf("%s parity=%c len=%u\n", buf + 1, buf[0], sim_resp_data[0]); return(0); } cmd_spn() { int rc; unsigned textlen; rc = select_op(DF_GSM); if (rc < 0) return(rc); rc = select_op(EF_SPN); if (rc < 0) return(rc); rc = parse_ef_select_response(); if (rc < 0) return(rc); if (curfile_structure != 0x00 || curfile_total_size != 17) { fprintf(stderr, "error: expected transparent EF of 17 bytes\n"); return(-1); } rc = readbin_op(0, 17); if (rc < 0) return(rc); printf("Display condition: %02X\n", sim_resp_data[0]); printf("SPN: "); rc = validate_alpha_field(sim_resp_data + 1, 16, &textlen); if (rc >= 0) print_alpha_field(sim_resp_data, textlen, stdout); else printf("malformed alpha field"); putchar('\n'); return(0); }