N2KRead.c

Go to the documentation of this file.

/*
 *  Copyright (C) 2023 Swansea University
 *
 *  This file is part of the SELKIELogger suite of tools.
 *
 *  SELKIELogger 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 3 of the License, or (at your option)
 *  any later version.
 *
 *  SELKIELogger 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 SELKIELogger product.
 *  If not, see <http://www.gnu.org/licenses/>.
*/
 
#include <stdbool.h>
#include <stdint.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <unistd.h>
 
#include "SELKIELoggerBase.h"
 
#include "SELKIELoggerN2K.h"
 
#include "version.h"
#define BUFSIZE 1024
 
int main(int argc, char *argv[]) {
    program_state state = {0};
    state.verbose = 1;
 
    char *usage = "Usage: %1$s [-v] [-q] datfile\n"
              "\t-v\tIncrease verbosity\n"
              "\t-q\tDecrease verbosity\n"
              "\nVersion: " GIT_VERSION_STRING "\n";
 
    opterr = 0; // Handle errors ourselves
    int go = 0;
    bool doUsage = false;
    while ((go = getopt(argc, argv, "vq")) != -1) {
        switch (go) {
            case 'v':
                state.verbose++;
                break;
            case 'q':
                state.verbose--;
                break;
            case '?':
                log_error(&state, "Unknown option `-%c'", optopt);
                doUsage = true;
        }
    }
 
    // Should be 1 spare arguments: The file to convert
    if (argc - optind != 1) {
        log_error(&state, "Invalid arguments");
        doUsage = true;
    }
 
    if (doUsage) {
        fprintf(stderr, usage, argv[0]);
        return -1;
    }
 
    FILE *nf = fopen(argv[optind], "r");
 
    if (nf == NULL) {
        log_error(&state, "Unable to open input file \"%s\"", argv[optind]);
        return -1;
    }
 
    state.started = true;
    bool processing = true;
 
    uint8_t buf[BUFSIZE] = {0};
    size_t hw = 0;
    int count = 0;
    while (processing || hw > 18) {
        if (processing && (hw < BUFSIZE)) {
            ssize_t ret = fread(&(buf[hw]), sizeof(uint8_t), BUFSIZE - hw, nf);
            if (ret < 0) {
                log_error(&state, "Unable to read data from input");
                processing = false;
            } else {
                hw += ret;
            }
        }
        if (feof(nf)) {
            log_info(&state, 2, "End of file reached");
            processing = false;
        }
        n2k_act_message *nm = NULL;
        size_t end = 0;
        bool r = n2k_act_from_bytes(buf, hw, &nm, &end, (state.verbose > 2));
        if (r) {
            log_info(&state, 2, "%d=>%d: PGN %d, Priority %d", nm->src, nm->dst,
                     nm->PGN, nm->priority);
            switch (nm->PGN) {
                case 60928:
                    n2k_60928_print(nm);
                    break;
                case 127250:
                    n2k_127250_print(nm);
                    break;
                case 127251:
                    n2k_127251_print(nm);
                    break;
                case 127257:
                    n2k_127257_print(nm);
                    break;
                case 128267:
                    n2k_128267_print(nm);
                    break;
                case 129025:
                    n2k_129025_print(nm);
                    break;
                case 129026:
                    n2k_129026_print(nm);
                    break;
                case 129029:
                    n2k_129029_print(nm);
                    break;
                case 129033:
                    n2k_129033_print(nm);
                    break;
                case 130306:
                    n2k_130306_print(nm);
                    break;
                case 130311:
                    n2k_130311_print(nm);
                    break;
                default:
                    n2k_basic_print(nm);
                    break;
            }
            count++;
        } else {
            log_info(&state, 3, "%zu bytes read, failed to decode message", end);
            if (!processing && end == 0) {
                // If we're not making progress and we're at the end of file then
                // this must be a bad message Force the process to move onwards
                end = 1;
            }
        }
 
        if (nm) {
            if (nm->data) { free(nm->data); }
            free(nm);
            nm = NULL;
        }
 
        if ((hw - end) > 0) {
            memmove(buf, &(buf[end]), hw - end);
            hw -= end;
        } else {
            hw = 0;
            end = 0;
        }
 
        memset(&(buf[hw]), 0, BUFSIZE - hw);
    }
    log_info(&state, 0, "%d messages successfully read from file", count);
    fclose(nf);
    return 0;
}