FreeCalypso > hg > fc-pcsc-tools
view simtool/smsp_dump.c @ 169:c37a3cc0fafe
bfsearch-booty: bfsearch captures from GR2 and SJA2 cards
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 28 Feb 2021 21:22:59 +0000 |
parents | f1ea981ab225 |
children |
line wrap: on
line source
/* * This module implements intelligent dumping of EF_SMSP (smsp-dump). */ #include <sys/types.h> #include <stdio.h> #include "simresp.h" #include "curfile.h" static check_blank_area(dp, endp) u_char *dp, *endp; { while (dp < endp) if (*dp++ != 0xFF) return(-1); return(0); } static void dump_da_field(binaddr, outf) u_char *binaddr; FILE *outf; { char digits[21]; fputs("DA=", outf); if (binaddr[0] < 1 || binaddr[0] > 20) { malformed: fputs("malformed ", outf); return; } if ((binaddr[0] & 1) && (binaddr[(binaddr[0] >> 1) + 2] & 0xF0) != 0xF0) goto malformed; if (check_blank_area(binaddr + 2 + ((binaddr[0] + 1) >> 1), binaddr + 12) < 0) goto malformed; /* all checks passed */ decode_address_digits(binaddr + 2, digits, binaddr[0]); fprintf(outf, "%s,0x%02X ", digits, binaddr[1]); } static void dump_sca_field(binaddr, outf) u_char *binaddr; FILE *outf; { char digits[21]; int rc; fputs("SC=", outf); if (binaddr[0] < 2 || binaddr[0] > 11) { malformed: fputs("malformed ", outf); return; } rc = decode_phone_number(binaddr + 2, binaddr[0] - 1, digits); if (rc < 0) goto malformed; rc = check_blank_area(binaddr + 1 + binaddr[0], binaddr + 12); if (rc < 0) goto malformed; /* all checks passed */ fprintf(outf, "%s,0x%02X ", digits, binaddr[1]); } static void dump_record(recno, outf) unsigned recno; FILE *outf; { int rc; unsigned textlen; u_char *fixp; fprintf(outf, "#%u: ", recno); if (sim_resp_data_len > 28) { rc = validate_alpha_field(sim_resp_data, sim_resp_data_len - 28, &textlen); if (rc < 0) { malformed: fprintf(outf, "malformed record\n"); return; } } else textlen = 0; fixp = sim_resp_data + sim_resp_data_len - 28; if ((fixp[0] & 0xE0) != 0xE0) goto malformed; if ((fixp[0] & 0x01) && check_blank_area(fixp + 1, fixp + 13) < 0) goto malformed; if ((fixp[0] & 0x02) && check_blank_area(fixp + 13, fixp + 25) < 0) goto malformed; if ((fixp[0] & 0x04) && fixp[25] != 0xFF) goto malformed; if ((fixp[0] & 0x08) && fixp[26] != 0xFF) goto malformed; if ((fixp[0] & 0x10) && fixp[27] != 0xFF) goto malformed; /* basic checks passed, emit present fields */ if (!(fixp[0] & 0x01)) dump_da_field(fixp + 1, outf); if (!(fixp[0] & 0x02)) dump_sca_field(fixp + 13, outf); if (!(fixp[0] & 0x04)) fprintf(outf, "PID=0x%02X ", fixp[25]); if (!(fixp[0] & 0x08)) fprintf(outf, "DCS=0x%02X ", fixp[26]); if (!(fixp[0] & 0x10)) fprintf(outf, "VP=%u ", fixp[27]); print_alpha_field(sim_resp_data, textlen, outf); putc('\n', outf); } cmd_smsp_dump(argc, argv, outf) char **argv; FILE *outf; { int rc; unsigned recno; rc = select_ef_smsp(); if (rc < 0) return(rc); for (recno = 1; recno <= curfile_record_count; recno++) { rc = readrec_op(recno, 0x04, curfile_record_len); if (rc < 0) return(rc); dump_record(recno, outf); } return(0); }