FreeCalypso > hg > freecalypso-hwlab
view simtool/pbdump.c @ 122:f18704e91393
fc-simtool: pb-dump-rec command implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 28 Jan 2021 05:12:10 +0000 |
parents | a6de34816297 |
children |
line wrap: on
line source
/* * This module implements the pb-dump command. */ #include <sys/types.h> #include <string.h> #include <strings.h> #include <stdio.h> #include <stdlib.h> #include <pcsclite.h> #include <winscard.h> #include "globals.h" static char gsm_address_digits[16] = {'0','1','2','3','4','5','6','7','8','9','*','#','a','b','c','?'}; static check_all_blank() { u_char *dp, *endp; dp = sim_resp_data; endp = sim_resp_data + sim_resp_data_len; while (dp < endp) if (*dp++ != 0xFF) return(0); return(1); } static decode_number(data, nbytes, out) u_char *data; unsigned nbytes; char *out; { u_char *dp, *endp; int c; dp = data; endp = data + nbytes; while (dp < endp) { c = *dp & 0xF; if (c == 0xF) return(-1); *out++ = gsm_address_digits[c]; c = *dp >> 4; if (c == 0xF) { if (dp + 1 == endp) break; else return(-1); } *out++ = gsm_address_digits[c]; dp++; } *out = '\0'; return(0); } static check_blank_area(dp, endp) u_char *dp, *endp; { while (dp < endp) if (*dp++ != 0xFF) return(-1); return(0); } static void dump_record(recno, outf) unsigned recno; FILE *outf; { int rc; unsigned textlen; u_char *fixp; char digits[21]; fprintf(outf, "#%u: ", recno); if (curfile_record_len > 14) { rc = validate_alpha_field(sim_resp_data, curfile_record_len - 14, &textlen); if (rc < 0) { malformed: fprintf(outf, "malformed record\n"); return; } } else textlen = 0; fixp = sim_resp_data + sim_resp_data_len - 14; if (fixp[0] < 2 || fixp[0] > 11) goto malformed; rc = decode_number(fixp + 2, fixp[0] - 1, digits); if (rc < 0) goto malformed; rc = check_blank_area(fixp + 1 + fixp[0], fixp + 12); if (rc < 0) goto malformed; /* all checks passed */ fprintf(outf, "%s,0x%02X ", digits, fixp[1]); if (fixp[12] != 0xFF) fprintf(outf, "CCP=%u ", fixp[12]); if (fixp[13] != 0xFF) fprintf(outf, "EXT=%u ", fixp[13]); print_alpha_field(sim_resp_data, textlen, outf); putc('\n', outf); } cmd_pb_dump(argc, argv) char **argv; { int rc; FILE *outf; unsigned recno; rc = phonebook_op_common(argv[1]); if (rc < 0) return(rc); if (argv[2]) { outf = fopen(argv[2], "w"); if (!outf) { perror(argv[2]); return(-1); } } else outf = stdout; for (recno = 1; recno <= curfile_record_count; recno++) { rc = readrec_op(recno, 0x04, curfile_record_len); if (rc < 0) { if (argv[2]) fclose(outf); return(rc); } if (check_all_blank()) continue; dump_record(recno, outf); } if (argv[2]) fclose(outf); return(0); } cmd_pb_dump_rec(argc, argv) char **argv; { int rc; unsigned recno, startrec, endrec; rc = phonebook_op_common(argv[1]); if (rc < 0) return(rc); startrec = strtoul(argv[2], 0, 0); if (startrec < 1 || startrec > curfile_record_count) { fprintf(stderr, "error: specified starting record number is invalid\n"); return(-1); } if (argv[3]) { endrec = strtoul(argv[3], 0, 0); if (endrec < 1 || endrec > curfile_record_count) { fprintf(stderr, "error: specified final record number is invalid\n"); return(-1); } if (startrec > endrec) { fprintf(stderr, "error: reverse record range specified\n"); return(-1); } } else endrec = startrec; for (recno = startrec; recno <= endrec; recno++) { rc = readrec_op(recno, 0x04, curfile_record_len); if (rc < 0) return(rc); if (check_all_blank()) continue; dump_record(recno, stdout); } return(0); }