diff options
Diffstat (limited to 'xpp/astribank_license.c')
-rw-r--r-- | xpp/astribank_license.c | 340 |
1 files changed, 340 insertions, 0 deletions
diff --git a/xpp/astribank_license.c b/xpp/astribank_license.c new file mode 100644 index 0000000..8eeb7c2 --- /dev/null +++ b/xpp/astribank_license.c @@ -0,0 +1,340 @@ +/* + * Written by Oron Peled <oron@actcom.co.il> + * Copyright (C) 2012, Xorcom + * + * All rights reserved. + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. + * + */ + +#include <errno.h> +#include <stdio.h> +#include <string.h> +#include <debug.h> +#include "astribank_license.h" + +#define ARRAY_SIZE(a) (sizeof(a)/sizeof((a)[0])) + +static const struct boundary { + const char *name; + const char *markers[2]; +} boundaries[] = { + [LICENSE_MARKER_NONE] = { /* Skip 0 */ + }, + [LICENSE_MARKER_XORCOM] = { + "Xorcom", + { + "-----BEGIN XORCOM LICENSE BLOCK-----", + "-----END XORCOM LICENSE BLOCK-----", + }, + }, + [LICENSE_MARKER_GENERIC] = { + "Generic", + { + "-----BEGIN TELEPHONY DEVICE LICENSE BLOCK-----", + "-----END TELEPHONY DEVICE LICENSE BLOCK-----", + } + }, +}; + +void license_markers_help(const char *prefix, FILE *fp) +{ + int i; + + fprintf(fp, "%sValid license markers:\n", prefix); + for (i = LICENSE_MARKER_NONE + 1; i < ARRAY_SIZE(boundaries); i++) { + const struct boundary *b = &boundaries[i]; + if (b->markers[0] != 0) + fprintf(fp, "%s\t%d - %s\n", prefix, i, b->name); + } +} + +int license_marker_valid(unsigned int which) +{ + if (which >= ARRAY_SIZE(boundaries)) + return 0; + if (boundaries[which].markers[0] == NULL) + return 0; + return 1; +} + +static const char *marker_string(unsigned int which, int end_marker) +{ + int selector = (end_marker) ? 1 : 0; + + if (license_marker_valid(which)) { + return boundaries[which].markers[selector]; + } + ERR("gen_marker: invalid marker %d\n", which); + return NULL; +} + +static int marker_find(const char *str, int end_marker) +{ + int selector = (end_marker) ? 1 : 0; + int i; + + for (i = LICENSE_MARKER_NONE + 1; i < ARRAY_SIZE(boundaries); i++) { + const struct boundary *b = &boundaries[i]; + const char *marker_str = b->markers[selector]; + +#if 0 + DBG("marker_find(%s,%d)[%d]: %s\n", + str, end_marker, i, marker_str); +#endif + if (!marker_str) + continue; + if (strcmp(str, marker_str) == 0) + return i; + } + return 0; +} + +static int bin_to_file(void *buf, int len, FILE *f) +{ + static int bytes_on_line; + unsigned char *p = buf; + if (buf == NULL) { + if (bytes_on_line != 0) { + if (fprintf(f, "\n") != 1) + return -1; + bytes_on_line = 0; + } + return 0; + } + int i; + for (i = 0; i < len; i++) { + if (fprintf(f, "%02x", *p++) != 2) + return -1; + bytes_on_line++; + if (bytes_on_line >= 16) { + if (fprintf(f, "\n") != 1) + return -1; + bytes_on_line = 0; + } + } + return 0; +} + +int write_to_file( + struct eeprom_table *eeprom_table, + struct capabilities *caps, + struct capkey *key, + unsigned int marker, + FILE *f) +{ + fprintf(f, "%s\n", marker_string(marker, 0)); + fprintf(f, "Version: 1.0\n"); + fprintf(f, "Timestamp: %u\n", caps->timestamp); + fprintf(f, "Serial: %.*s\n", LABEL_SIZE, eeprom_table->label); + fprintf(f, "Capabilities.Port.FXS: %d\n", caps->ports_fxs); + fprintf(f, "Capabilities.Port.FXO: %d\n", caps->ports_fxo); + fprintf(f, "Capabilities.Port.BRI: %d\n", caps->ports_bri); + fprintf(f, "Capabilities.Port.PRI: %d\n", caps->ports_pri); + fprintf(f, "Capabilities.Port.ECHO: %d\n", caps->ports_echo); + fprintf(f, "Capabilities.Twinstar: %d\n", CAP_EXTRA_TWINSTAR(caps)); + fprintf(f, "Data:\n"); + bin_to_file(eeprom_table, sizeof(*eeprom_table), f); + bin_to_file(caps, sizeof(*caps), f); + bin_to_file(key, sizeof(*key), f); + bin_to_file(NULL, 0, f); + fprintf(f, "%s\n", marker_string(marker, 1)); + return 0; +} + +/* + * Removes whitespace on both sizes of the string. + * Returns a pointer to the first non-space char. The string + * is modified in place to trim trailing whitespace. + * If the whole string is whitespace, returns NULL. + */ +static char *trim(char *s) +{ + int len = strlen(s); + while (len > 0 && isspace(s[len-1])) { + len--; + } + if (len == 0) + return NULL; + s[len] = '\0'; + while (isspace(*s)) + s++; + /* *s is not a space, since in this case we'd return NULL above */ + return s; +} + +static int get_key_value(char *line, char **key, char **value) +{ + char *p = strchr(line, ':'); + if (p == NULL) + return -1; + *p = '\0'; + *key = trim(line); + *value = trim(p + 1); + return 0; +} + +static int hex_digit_to_int(char c) +{ + if (c >= '0' && c <= '9') + return c - '0'; + else if (c >= 'a' && c <= 'f') + return c - 'a' + 10; + else + return -1; +} + +static int str_to_bin(char *line, void *buf, int maxlen) +{ + static int offset; + unsigned char *p = buf; + if (strlen(line) % 2 != 0) + return -1; + while (offset < maxlen && *line) { + uint8_t value; + char c = hex_digit_to_int(*line++); + if (c < 0 || *line == '\0') + return -1; + value = c << 4; + c = hex_digit_to_int(*line++); + if (c < 0) + return -1; + value |= c; + p[offset++] = value; + } + if (offset == maxlen && *line) + return -1; + return offset; +} + +int read_from_file( + struct eeprom_table *eeprom_table, + struct capabilities *caps, + struct capkey *capkey, + unsigned int *used_marker, + FILE *f) +{ + char buf[256]; + char *line, *key, *value; + int lineno = 0; + unsigned int license_marker_begin; + unsigned int license_marker_end; + struct table { + struct eeprom_table eeprom_table; + struct capabilities capabilities; + struct capkey capkey; + } PACKED table; + enum PARSE_STATES { + STATE_BEFORE_LICENSE = 0, + STATE_EXPECT_VERSION = 1, + STATE_EXPECT_DATA = 2, + STATE_READ_DATA = 3, + STATE_AFTER_LICENSE = 4, + } state = STATE_BEFORE_LICENSE; + + memset(&table, 0, sizeof(struct table)); + /* + * states: + * 0: start - before BEGIN_LICENSE_BLOCK line. on BEGIN_LICENSE_BLOCK line goto 1. + * 1: read Version, goto 2. if not version line then error. + * 2: after BEGIN line. split line into key:value. if line is Data:, goto 3. + * 3: read binary data. if line is END_LICENSE_BLOCK goto 4. + * 4: END_LICENSE_BLOCK - ignore lines. + */ + while (fgets(buf, 256, f) != NULL) { + lineno++; + int len = strlen(buf); + if (len > 0 && buf[len-1] != '\n') { + ERR("Line %d: Line too long\n", lineno); + return -1; + } + line = trim(buf); + if (line == NULL) { + if (state > STATE_BEFORE_LICENSE && state < STATE_AFTER_LICENSE) { + ERR("Line %d: Empty line\n", lineno); + return -1; + } + else + continue; + } + switch (state) { + case STATE_BEFORE_LICENSE: + license_marker_begin = marker_find(line, 0); + if (license_marker_begin) + state = STATE_EXPECT_VERSION; + else { + ERR("Line %d: Invalid license begin block\n", lineno); + return -1; + } + break; + case STATE_EXPECT_VERSION: + if (get_key_value(line, &key, &value) < 0) { + ERR("Line %d: Can't parse line\n", lineno); + return -1; + } + if (strcmp(key, "Version") == 0) { + if (strcmp(value, "1.0") == 0) { + state = STATE_EXPECT_DATA; + } else { + ERR("Line %d: Unknown license file version '%s', need version '1.0'\n", lineno, value); + return -1; + } + } else { + ERR("Line %d: No license file version\n", lineno); + return -1; + } + break; + case STATE_EXPECT_DATA: + if (get_key_value(line, &key, &value) < 0) { + ERR("Line %d: Can't parse line\n", lineno); + return -1; + } + if (strcmp(key, "Data") == 0) { + state = STATE_READ_DATA; + break; + } + break; + case STATE_READ_DATA: + license_marker_end = marker_find(line, 1); + if (license_marker_end) { + printf("DEBUG: end=%d begin=%d\n", license_marker_end, license_marker_begin); + if (license_marker_end != license_marker_begin) { + ERR("Line %d: End marker != Begin marker\n", lineno); + return -1; + } + state = STATE_AFTER_LICENSE; + break; + } + if (str_to_bin(line, &table, sizeof(table)) < 0) { + ERR("Line %d: Error in data block\n", lineno); + return -1; + } + break; + case STATE_AFTER_LICENSE: + break; + + } + } + if (state != STATE_AFTER_LICENSE) { + ERR("Invalid license file\n"); + return -1; + } + memcpy(eeprom_table, &table.eeprom_table, sizeof(*eeprom_table)); + memcpy(caps, &table.capabilities, sizeof(*caps)); + memcpy(capkey, &table.capkey, sizeof(*capkey)); + return 0; +} + |