FreeCalypso > hg > freecalypso-tools
view rvinterf/tmsh/rftablerd.c @ 167:6e4120cdb456
fc-tmsh: auw command sending implemented
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sun, 19 Mar 2017 18:02:07 +0000 |
parents | db7fc16bac1e |
children |
line wrap: on
line source
/* * Reading RF tables from formatted ASCII files for the rftw command */ #include <sys/types.h> #include <ctype.h> #include <stdio.h> #include <string.h> #include <strings.h> #include <stdlib.h> #include "localtypes.h" #include "l1tm.h" #include "exitcodes.h" #define MAX_FIELDS_PER_LINE 64 static char *filename; static FILE *rdfile; static unsigned lineno; static char linebuf[256], *line_fields[MAX_FIELDS_PER_LINE]; static unsigned line_nfields, line_field_ptr; static char *format; static u_char *writeptr; static unsigned written_size; static int read_line() { char *cp; if (!fgets(linebuf, sizeof linebuf, rdfile)) return(0); lineno++; cp = linebuf; for (line_nfields = 0; ; ) { while (isspace(*cp)) cp++; if (*cp == '\0' || *cp == '#') break; if (line_nfields >= MAX_FIELDS_PER_LINE) { printf("%s line %d: too many fields on one line\n", filename, lineno); return(-1); } line_fields[line_nfields++] = cp; while (*cp && !isspace(*cp)) cp++; if (*cp) *cp++ = '\0'; } return(1); } static get_field(retp) char **retp; { int rc; if (line_field_ptr < line_nfields) { *retp = line_fields[line_field_ptr++]; return(1); } do { rc = read_line(); if (rc <= 0) return(rc); } while (!line_nfields); *retp = line_fields[0]; line_field_ptr = 1; return(1); } static process_number(size) { char *field; int rc; u_long number; rc = get_field(&field); if (rc < 0) return(ERROR_USAGE); if (!rc) { printf("error: %s is too short for table format %s\n", filename, format); return(ERROR_USAGE); } if (field[0] == '-') number = strtol(field, 0, 0); else number = strtoul(field, 0, 0); switch (size) { case 1: *writeptr++ = number; break; case 2: *writeptr++ = number; *writeptr++ = number >> 8; break; case 4: *writeptr++ = number; *writeptr++ = number >> 8; *writeptr++ = number >> 16; *writeptr++ = number >> 24; break; default: abort(); } written_size += size; return(0); } static ensure_eof() { char *field; int rc; rc = get_field(&field); if (rc < 0) return(ERROR_USAGE); if (rc) { printf("error: %s is too long for table format %s\n", filename, format); return(ERROR_USAGE); } return(0); } static read_agc_table() { int i, rc; for (i = 0; i < 20; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_afcparams() { int i, rc; for (i = 0; i < 4; i++) { rc = process_number(4); if (rc) return(rc); } for (i = 0; i < 4; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_agc_global_params() { int i, rc; for (i = 0; i < 4; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_il2agc() { int i, rc; for (i = 0; i < 121; i++) { rc = process_number(1); if (rc) return(rc); } return ensure_eof(); } static read_tx_levels() { int i, rc; for (i = 0; i < 32; i++) { rc = process_number(2); if (rc) return(rc); rc = process_number(1); if (rc) return(rc); rc = process_number(1); if (rc) return(rc); } return ensure_eof(); } static read_tx_calchan() { int i, rc; for (i = 0; i < 64; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_tx_caltemp() { int i, rc; for (i = 0; i < 20; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_rx_calchan() { int i, rc; for (i = 0; i < 20; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_rx_caltemp() { int i, rc; for (i = 0; i < 22; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_rx_agc_params() { int i, rc; for (i = 0; i < 4; i++) { rc = process_number(2); if (rc) return(rc); } return ensure_eof(); } static read_raw_table() { int rc; char *field; u_long number; for (;;) { rc = get_field(&field); if (rc < 0) return(ERROR_USAGE); if (!rc) break; number = strtoul(field, 0, 16); if (written_size >= MAX_RF_TABLE_SIZE) { printf("error: raw table %s exceeds maximum size\n", filename); return(ERROR_USAGE); } *writeptr++ = number; written_size++; } if (!written_size) { printf("error: raw table %s is empty\n", filename); return(ERROR_USAGE); } return(0); } static struct table_format { char *kw; int (*handler)(); } table_formats[] = { {"agc-table", read_agc_table}, {"afcparams", read_afcparams}, {"agc-global-params", read_agc_global_params}, {"il2agc", read_il2agc}, {"tx-levels", read_tx_levels}, {"tx-calchan", read_tx_calchan}, {"tx-caltemp", read_tx_caltemp}, {"rx-calchan", read_rx_calchan}, {"rx-caltemp", read_rx_caltemp}, {"rx-agc-params", read_rx_agc_params}, {"raw", read_raw_table}, {0, 0} }; read_rf_table(filename_arg, rdbuf, format_ret, size_ret) char *filename_arg; u_char *rdbuf; char **format_ret; unsigned *size_ret; { char *field; int rc; struct table_format *tp; filename = filename_arg; rdfile = fopen(filename, "r"); if (!rdfile) { perror(filename); return(ERROR_UNIX); } lineno = 0; line_nfields = 0; rc = get_field(&field); if (rc <= 0) { not_valid_rftable: printf("error: %s is not a valid RF table file\n", filename); fclose(rdfile); return(ERROR_USAGE); } if (strcmp(field, "rf_table")) goto not_valid_rftable; rc = get_field(&field); if (rc <= 0) goto not_valid_rftable; for (tp = table_formats; tp->kw; tp++) if (!strcmp(tp->kw, field)) break; if (!tp->kw) { printf("error: table format \"%s\" not recognized\n", field); fclose(rdfile); return(ERROR_USAGE); } format = tp->kw; if (format_ret) *format_ret = format; writeptr = rdbuf; written_size = 0; rc = tp->handler(); fclose(rdfile); if (size_ret) *size_ret = written_size; return(rc); } static process_txramp_number() { char *field; int rc; u_long number; rc = get_field(&field); if (rc < 0) return(ERROR_USAGE); if (!rc) { printf("error: %s is too short for a Tx ramp template\n", filename); return(ERROR_USAGE); } number = strtoul(field, 0, 0); *writeptr++ = number; return(0); } static read_txramp_16num() { int i, rc; for (i = 0; i < 16; i++) { rc = process_txramp_number(); if (rc) return(rc); } return(0); } read_tx_ramp_template(filename_arg, rdbuf) char *filename_arg; u_char *rdbuf; { char *field; int rc; filename = filename_arg; rdfile = fopen(filename, "r"); if (!rdfile) { perror(filename); return(ERROR_UNIX); } lineno = 0; line_nfields = 0; rc = get_field(&field); if (rc <= 0) { not_valid_ramp_file: printf("error: %s is not a valid Tx ramp template file\n", filename); fclose(rdfile); return(ERROR_USAGE); } if (strcmp(field, "ramp-up")) goto not_valid_ramp_file; writeptr = rdbuf; rc = read_txramp_16num(); if (rc) { fclose(rdfile); return(rc); } rc = get_field(&field); if (rc <= 0) goto not_valid_ramp_file; if (strcmp(field, "ramp-down")) goto not_valid_ramp_file; rc = read_txramp_16num(); if (rc) { fclose(rdfile); return(rc); } rc = get_field(&field); fclose(rdfile); if (rc < 0) return(ERROR_USAGE); if (rc) { printf("error: %s is too long for a Tx ramp template\n", filename); return(ERROR_USAGE); } return(0); }