FreeCalypso > hg > fc-sim-tools
view simtool/pnnprog.c @ 44:0bc89d61fc59
top Makefile: add serial
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 20 Mar 2021 21:53:31 +0000 |
parents | ddd767f6e15b |
children |
line wrap: on
line source
/* * This module implements functions for admin programming of EF_PNN. */ #include <sys/types.h> #include <stdio.h> #include <stdlib.h> #include <string.h> #include <strings.h> #include "curfile.h" static u_char * add_field(dp, bytes_avail, namearg, type) u_char *dp; char *namearg; unsigned bytes_avail, type; { u_char gsm7_buf[289]; unsigned nsept, noct; int rc; if (bytes_avail < 4) { fprintf(stderr, "error: PNN record is too short for name element\n"); return(0); } rc = qstring_arg_to_gsm7(namearg, gsm7_buf, (bytes_avail-3) * 8 / 7); if (rc < 0) return(0); nsept = rc; gsm7_buf[nsept] = 0; noct = (nsept * 7 + 7) / 8; *dp++ = type; *dp++ = noct + 1; *dp++ = 0x80 | (nsept & 7); gsm7_pack(gsm7_buf, dp, noct); dp += noct; return dp; } cmd_pnn_write(argc, argv) char **argv; { int rc; unsigned recno; u_char record[255], *dp, *endp; rc = select_ef_pnn(); if (rc < 0) return(rc); recno = strtoul(argv[1], 0, 0); if (recno < 1 || recno > curfile_record_count) { fprintf(stderr, "error: specified record number is invalid\n"); return(-1); } dp = record; endp = record + curfile_record_len; dp = add_field(dp, endp - dp, argv[2], 0x43); if (!dp) return(-1); if (argv[3]) { dp = add_field(dp, endp - dp, argv[3], 0x45); if (!dp) return(-1); } while (dp < endp) *dp++ = 0xFF; return update_rec_op(recno, 0x04, record, curfile_record_len); } cmd_pnn_erase(argc, argv) char **argv; { int rc; unsigned recno, startrec, endrec; u_char record[255]; rc = select_ef_pnn(); if (rc < 0) return(rc); startrec = strtoul(argv[1], 0, 0); if (startrec < 1 || startrec > curfile_record_count) { fprintf(stderr, "error: specified starting record number is invalid\n"); return(-1); } if (!argv[2]) endrec = startrec; else if (!strcmp(argv[2], "end")) endrec = curfile_record_count; else { endrec = strtoul(argv[2], 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); } } memset(record, 0xFF, curfile_record_len); for (recno = startrec; recno <= endrec; recno++) { rc = update_rec_op(recno, 0x04, record, curfile_record_len); if (rc < 0) return(rc); } return(0); }