canparser.c

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <sys/time.h>
#include <errno.h>

#define MAX_LINE_LENGTH 1024

// Function prototype
char *process_line(char *line);
char *trim_whitespace(char *str);
char *convert_to_lowercase(char *line);
struct timeval add_milliseconds(struct timeval tv, long milliseconds) ;


struct timeval tv;
    

int main() {
    FILE *input_file, *output_file;
    char line[MAX_LINE_LENGTH];

    // Open input file
    input_file = fopen("scripts/input.txt", "r");
    if (input_file == NULL) {
        printf("Error opening input file.\n");
        return 1;
    }

    // Open output file
    output_file = fopen("scripts/output.txt", "w");
    if (output_file == NULL) {
        printf("Error opening output file.\n");
        fclose(input_file);
        return 1;
    }

    gettimeofday(&tv, NULL);

    // Read input file line by line
    while (fgets(line, MAX_LINE_LENGTH, input_file)) {
        
        // Process the line
        char *processed_line = process_line(line);

        if(processed_line != NULL && *processed_line != '\0')
        {
            // Write processed line to output file
            fputs(processed_line, output_file);

            // Clean up
            free(processed_line);
        }
        else
        {
            printf("empty");
        }

            
    }
    printf("out");

    // Close files
    fclose(input_file);
    fclose(output_file);
    printf("parsing completed");
    int return_value = system("canplayer -I scripts/output.txt");
    return 0;
}

// Function to process a line of text
char *process_line(char *line) {
    if(line == NULL || *line == '\0')
    {
        return NULL;
    }

    char *result = malloc(MAX_LINE_LENGTH); // Allocate memory for processed line
    char *str_frame = malloc(MAX_LINE_LENGTH); // Allocate memory for processed line

    line = convert_to_lowercase(line);
    // Split the line into tokens based on whitespace
    char *first_token = strtok(line, " "); // Split on space
    char *second_token = strtok(NULL, " "); // Split on space
    first_token=trim_whitespace(first_token);//trim spces
    second_token=trim_whitespace(second_token);//trim spces
    
    if (first_token != NULL && strcmp(first_token, "delay") == 0 && second_token != NULL) {
        // Convert the string to a long integer
        char *endptr; // Pointer to track where the conversion stopped
        errno = 0; // Reset errno before conversion
        long value = strtol(second_token, &endptr, 10); // Base 10 conversion

        // Check for conversion errors
        if (errno == ERANGE) {
            printf("Error: The number is out of range for long.\n");
        } else if (endptr == second_token) {
            printf("Error: No digits were found in the input string.\n");
        } 
        tv = add_milliseconds(tv, value);
        return NULL;
    }
    else if (first_token != NULL && strcmp(first_token, "all_door") == 0 && second_token != NULL && (strcmp(second_token, "unlocked") == 0 || strcmp(second_token, "unlock") == 0)) {
        sprintf(str_frame, "%s", "19B#000000000000");
    }
    else if (first_token != NULL && strcmp(first_token, "all_door") == 0 && second_token != NULL && (strcmp(second_token, "locked") == 0 || strcmp(second_token, "lock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000F000000");
    }
    else if (first_token != NULL && strcmp(first_token, "front_left_door") == 0 && second_token != NULL && (strcmp(second_token, "unlocked") == 0 || strcmp(second_token, "unlock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000E000000");
    }
    else if (first_token != NULL && strcmp(first_token, "front_left_door") == 0 && second_token != NULL && (strcmp(second_token, "locked") == 0 || strcmp(second_token, "lock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000F000000");
    }
    else if (first_token != NULL && strcmp(first_token, "front_right_door") == 0 && second_token != NULL && (strcmp(second_token, "unlocked") == 0 || strcmp(second_token, "unlock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000D000000");
    }
    else if (first_token != NULL && strcmp(first_token, "front_right_door") == 0 && second_token != NULL && (strcmp(second_token, "locked") == 0 || strcmp(second_token, "lock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000F000000");
    }
    else if (first_token != NULL && strcmp(first_token, "back_left_door") == 0 && second_token != NULL && (strcmp(second_token, "unlocked") == 0 || strcmp(second_token, "unlock") == 0)) {
        sprintf(str_frame, "%s", "19B#000007000000");
    }
    else if (first_token != NULL && strcmp(first_token, "back_left_door") == 0 && second_token != NULL && (strcmp(second_token, "locked") == 0 || strcmp(second_token, "lock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000F000000");
    }
    else if (first_token != NULL && strcmp(first_token, "back_right_door") == 0 && second_token != NULL && (strcmp(second_token, "unlocked") == 0 || strcmp(second_token, "unlock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000B000000");
    }
    else if (first_token != NULL && strcmp(first_token, "back_right_door") == 0 && second_token != NULL && (strcmp(second_token, "locked") == 0 || strcmp(second_token, "lock") == 0)) {
        sprintf(str_frame, "%s", "19B#00000F000000");
    }
    else if (first_token != NULL && strcmp(first_token, "head_light") == 0 && second_token != NULL && strcmp(second_token, "on") == 0) {
        sprintf(str_frame, "%s", "249#0000000B");
    }
    else if (first_token != NULL && strcmp(first_token, "head_light") == 0 && second_token != NULL && strcmp(second_token, "off") == 0) {
        sprintf(str_frame, "%s", "249#0000000A");
    }
    else if (first_token != NULL && strcmp(first_token, "wiper") == 0 && second_token != NULL && strcmp(second_token, "on") == 0) {
        sprintf(str_frame, "%s", "240#000000000009");
    }
    else if (first_token != NULL && strcmp(first_token, "wiper") == 0 && second_token != NULL && strcmp(second_token, "off") == 0 ) {
        sprintf(str_frame, "%s", "240#000000000008");
    }
    else if (first_token != NULL && strcmp(first_token, "throttle") == 0 && second_token != NULL && strcmp(second_token, "on") == 0) {
        sprintf(str_frame, "%s", "238#00000000010000");
    }
    else if (first_token != NULL && strcmp(first_token, "throttle") == 0 && second_token != NULL && strcmp(second_token, "off") == 0 ) {
        sprintf(str_frame, "%s", "238#00000000000000");
    }
    else if (first_token != NULL && strcmp(first_token, "handbrake") == 0 && second_token != NULL && strcmp(second_token, "on") == 0) {
        sprintf(str_frame, "%s", "241#00000F");
    }
    else if (first_token != NULL && strcmp(first_token, "handbrake") == 0 && second_token != NULL && strcmp(second_token, "off") == 0 ) {
        sprintf(str_frame, "%s", "241#00000E");
    }
    else {
        return NULL;
    }
    
    sprintf(result, "(%010llu.%06llu) vcan0 %s\n", (unsigned long long)tv.tv_sec, (unsigned long long)tv.tv_usec, str_frame);
    return result; // Return the processed line
}

// Function to trim whitespace from the beginning and end of a string
char *trim_whitespace(char *str) {
    char *end;

    // Trim leading space
    while (isspace((unsigned char)*str)) str++;

    // Trim trailing space
    end = str + strlen(str) - 1;
    while (end > str && isspace((unsigned char)*end)) end--;

    // Null terminate the trimmed string
    end[1] = '\0';

    // Allocate memory for the trimmed string
    char *trimmed = malloc(strlen(str) + 1);
    if (trimmed == NULL) {
        printf("Memory allocation failed.\n");
        exit(1);
    }
    strcpy(trimmed, str); // Copy the trimmed string

    return trimmed; // Return the trimmed string
}

struct timeval add_milliseconds(struct timeval tv, long milliseconds) {
    // Convert milliseconds to seconds and microseconds
    long seconds = milliseconds / 1000;
    long useconds = (milliseconds % 1000) * 1000;

    // Add the seconds and microseconds to the timeval structure
    tv.tv_sec += seconds;
    tv.tv_usec += useconds;

    // Handle overflow in microseconds
    if (tv.tv_usec >= 1000000) {
        tv.tv_sec += tv.tv_usec / 1000000; // Add the overflow to seconds
        tv.tv_usec %= 1000000; // Keep only the remainder
    }

    return tv; // Return the updated timeval structure
}

char *convert_to_lowercase(char *line) {
    char *result = malloc(strlen(line) + 1); // Allocate memory for the result
    if (result == NULL) {
        printf("Memory allocation failed.\n");
        exit(1);
    }

    // Copy the input line to the result
    strcpy(result, line);

    // Convert each character to lowercase
    for (int i = 0; result[i]; i++) {
        result[i] = tolower(result[i]);
    }

    return result; // Return the lowercase line
}