Michael Mann 362528c613 Start finding commonality between CAN wiretaps
Use socketcan.[c|h] for shared (Socket)CAN functionality where the wiretaps create records of the  WTAP_ENCAP_SOCKETCAN encapsulation type.

Adjust existing "homegrown" structures to use as much of the "shared" data structures from socketcan.h so that all can use the single function wtap_socketcan_gen_packet() to create records.
2025-06-17 15:05:15 +00:00

970 lines
34 KiB
C

/* cllog.c
*
* Wiretap Library
* Copyright (c) 1998 by Gilbert Ramirez <gram@alumni.rice.edu>
*
* SPDX-License-Identifier: GPL-2.0-or-later
*/
/*
* Reads log files from CLX000 CAN loggers from CSS Electronics:
*
* https://canlogger.csselectronics.com/clx000-docs/cl1000/log/index.html
* https://canlogger.csselectronics.com/clx000-docs/cl2000/log/index.html
*
* Based on the cCLLog.c, cCLLog.h, and wtap-cllog.c source files from
* the WS_v2.4-Plugin_v7.1.zip version of the CSS Electronics plugin at
*
* https://canlogger.csselectronics.com/downloads.php?q=wireshark
*
* with the files combined into one source file, modernized to
* fit into an up-to-date version of Wireshark, and cleaned up
* not to, for example, do seeks by rewinding and reading to
* get to the seek target.
*
* It could probably use some further cleanup.
*/
#include "config.h"
#include <stdio.h>
#include <stdbool.h>
#include <stdint.h>
#include <string.h>
#include <stdlib.h>
#include <time.h>
#include <wsutil/str_util.h>
#include <wsutil/strtoi.h>
#include "socketcan.h"
#include "file_wrappers.h"
#include "cllog.h"
static int cllog_file_type_subtype = -1;
/***********************************************************************************************************************
* Public definitions
**********************************************************************************************************************/
#define MAX_LOG_LINE_FIELDS 7 /*( seqNo, timestamp, lost, SE, ID, length, data) */
/***********************************************************************************************************************
* Public type declarations
**********************************************************************************************************************/
/* Message type */
typedef enum
{
msg_rx_standard_e = 0,
msg_rx_extended_e = 1,
msg_tx_standard_e = 7,
msg_tx_extended_e = 8,
} cCLLog_messageType_t;
/* Typedef CAN-bus message type */
typedef struct
{
uint32_t lost;
cCLLog_messageType_t msgType;
wtap_can_msg_t msg;
} cCLLog_message_t;
/* Silent-mode*/
typedef enum { silent_disabled_e = 0, silent_enabled_e } cCLLog_silentMode_t;
/* Cyclic-mode*/
typedef enum { cyclic_disabled_e = 0, cyclic_enabled_e } cCLLog_cyclicMode_t;
/* Logger type */
typedef enum { type_CL1000_e = 0, type_CL2000_e, type_CL3000_e } cCLLog_loggerType_t;
typedef char * (*CLLog_gets_t)(char *s, int size, void *stream);
typedef int (*CLLog_rewind_t)(void *stream);
typedef struct cLLog_private cCLLog_logFileInfo_t;
/* Type used to parse a field in a log line */
typedef bool (*parseFieldFunc_t)(cCLLog_logFileInfo_t *pInfo, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info);
/* Log file information */
struct cLLog_private
{
uint32_t firstLogRow;
cCLLog_loggerType_t loggerType;
char hwrev[5];
char fwrev[5];
char id[20];
uint32_t sessionNo;
uint32_t splitNo;
nstime_t logStartTime;
char logStartTimeString[ 20 ];
char separator;
uint8_t timeFormat;
char timeSeparator;
char timeSeparatorMs;
char dateSeparator;
char dateAndTimeSeparator;
uint32_t bitRate;
cCLLog_silentMode_t silentMode;
cCLLog_cyclicMode_t cyclicMode;
parseFieldFunc_t parseFieldFunc[ MAX_LOG_LINE_FIELDS ];
/* First log time stamp as relative offset */
nstime_t firstTimeStampAbs;
};
/***********************************************************************************************************************
* Private definitions
**********************************************************************************************************************/
#define HEADER_LINE_PARSE_MAPPING_LENGTH array_length(headerLineParseMapping)
#define MAX_LOG_LINE_LENGTH 200
#define TIME_STAMP_STRING_MAX_LENGTH ( sizeof( "YYYY/MM/DDThh:mm:ss.kkk" ) )
#define TIME_STAMP_STRING_STRIPPED_MAX_LENGTH ( sizeof( "YYYYMMDDhhmmsskkk" ) )
/***********************************************************************************************************************
* Private type definitions
**********************************************************************************************************************/
/* Function type to parse a single log file line */
typedef bool (*parseFunc_t)(cCLLog_logFileInfo_t *pInfo, char *pLine, int *err, char **err_info);
/* Structure of the header parse mapping. A match string is paired with a parse function */
typedef struct
{
const char *pMatchString;
parseFunc_t parseFunc;
} headerLineParseMapping_t;
/***********************************************************************************************************************
* Private function declarations
**********************************************************************************************************************/
static bool parseColumnHeaderFields( cCLLog_logFileInfo_t *pInfo, char *pColLine );
static uint8_t stripTimeStamp( const cCLLog_logFileInfo_t *pInfo, char *pTimeStampString );
/* Parse header lines functions */
static bool parseLogFileHeaderLine_type(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_hwrev(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_fwrev(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_id(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_sessionNo(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_splitNo(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_time(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_valueSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_timeFormat(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_timeSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_timeSeparatorMs(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_dateSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_timeAndDateSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_bitRate(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_silentMode(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
static bool parseLogFileHeaderLine_cyclicMode(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info);
/***********************************************************************************************************************
* Private variable definitions
**********************************************************************************************************************/
/* Array of header line match strings and associated parse functions */
static const headerLineParseMapping_t headerLineParseMapping[] =
{
{ .pMatchString = "Logger type: ", .parseFunc = parseLogFileHeaderLine_type},
{ .pMatchString = "HW rev: ", .parseFunc = parseLogFileHeaderLine_hwrev },
{ .pMatchString = "FW rev: ", .parseFunc = parseLogFileHeaderLine_fwrev },
{ .pMatchString = "Logger ID: ", .parseFunc = parseLogFileHeaderLine_id},
{ .pMatchString = "Session No.: ", .parseFunc = parseLogFileHeaderLine_sessionNo},
{ .pMatchString = "Split No.: ", .parseFunc = parseLogFileHeaderLine_splitNo},
{ .pMatchString = "Time: ", .parseFunc = parseLogFileHeaderLine_time},
{ .pMatchString = "Value separator: ", .parseFunc = parseLogFileHeaderLine_valueSeparator},
{ .pMatchString = "Time format: ", .parseFunc = parseLogFileHeaderLine_timeFormat},
{ .pMatchString = "Time separator: ", .parseFunc = parseLogFileHeaderLine_timeSeparator},
{ .pMatchString = "Time separator ms: ", .parseFunc = parseLogFileHeaderLine_timeSeparatorMs},
{ .pMatchString = "Date separator: ", .parseFunc = parseLogFileHeaderLine_dateSeparator},
{ .pMatchString = "Time and date separator: ", .parseFunc = parseLogFileHeaderLine_timeAndDateSeparator},
{ .pMatchString = "Bit-rate: ", .parseFunc = parseLogFileHeaderLine_bitRate},
{ .pMatchString = "Silent mode: ", .parseFunc = parseLogFileHeaderLine_silentMode},
{ .pMatchString = "Cyclic mode: ", .parseFunc = parseLogFileHeaderLine_cyclicMode},
};
/*
* Do a string copy to a buffer of a specified length.
* If the string will fit, return true.
* If the string won't fit, return false.
*/
static bool
checked_strcpy(char *dest, size_t destlen, const char *src)
{
size_t srclen;
srclen = strlen(src) + 1; // count the trailing '\0'
if (srclen > destlen)
return false;
memcpy(dest, src, srclen);
return true;
}
/* TODO: Does not support separators set to numbers (will remove part of the time stamp also */
/* TODO: Does not support time stamps without ms, as given in the header */
/* TODO: Alot of copying slows down the parsing */
static bool parseFieldTS(cCLLog_logFileInfo_t *pInfo, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
struct tm tm;
int ms;
/* Copy the string to not modify the original */
char timeStampCopy[TIME_STAMP_STRING_MAX_LENGTH];
if (!checked_strcpy(timeStampCopy, sizeof timeStampCopy, pField))
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: time stamp is too long");
return false;
}
/* Copy the header time stamp string to not modify the original */
char timeStampHeaderCopy[TIME_STAMP_STRING_MAX_LENGTH];
if (!checked_strcpy(timeStampHeaderCopy, sizeof timeStampHeaderCopy, pInfo->logStartTimeString))
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: header time stamp too long");
return false;
}
/* Strip the delimiters from the time strings */
uint8_t msgTimeStrippedLen = stripTimeStamp(pInfo, timeStampCopy);
if (msgTimeStrippedLen > TIME_STAMP_STRING_STRIPPED_MAX_LENGTH - 1) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: time stamp incorrectly formatted");
return false;
}
uint8_t headerTimeStrippedLen = stripTimeStamp(pInfo, timeStampHeaderCopy);
if (headerTimeStrippedLen > TIME_STAMP_STRING_STRIPPED_MAX_LENGTH - 1) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: header time stamp incorrectly formatted");
return false;
}
/* Set time string (YYYYMMDDhhmmsskkk) to the epoch */
char timeStampStringFull[TIME_STAMP_STRING_STRIPPED_MAX_LENGTH] = "19700101000000000";
/* Copy the header time to the template */
memcpy(timeStampStringFull, timeStampHeaderCopy, headerTimeStrippedLen);
/* Copy the stripped timestamp into the full template */
memcpy(&timeStampStringFull[TIME_STAMP_STRING_STRIPPED_MAX_LENGTH - 1 - msgTimeStrippedLen], timeStampCopy, msgTimeStrippedLen);
timeStampStringFull[TIME_STAMP_STRING_STRIPPED_MAX_LENGTH - 1] = '\0';
memset(&tm, 0, sizeof tm);
/* YYYYMMDDThhmmss */
sscanf(timeStampStringFull, "%4u%2u%2u%2u%2u%2u%3d",
&tm.tm_year,
&tm.tm_mon,
&tm.tm_mday,
&tm.tm_hour,
&tm.tm_min,
&tm.tm_sec,
&ms
);
tm.tm_mon -= 1;
tm.tm_year -= 1900;
/* To Epoch (mktime converts to epoch from local (!!!) timezone) */
pLogEntry->msg.ts.secs = mktime(&tm);
pLogEntry->msg.ts.nsecs = ms*1000 * 1000;
/* Is first time stamp ? */
if (pInfo->firstTimeStampAbs.secs == 0 && pInfo->firstTimeStampAbs.nsecs == 0)
pInfo->firstTimeStampAbs = pLogEntry->msg.ts;
return true;
}
static bool parseFieldLost(cCLLog_logFileInfo_t *pInfo _U_, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
uint32_t lost;
if (!ws_strtou32(pField, NULL, &lost)) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: lost packet count value is not valid");
return false;
}
pLogEntry->lost = lost;
return true;
}
static bool parseFieldMsgType(cCLLog_logFileInfo_t *pInfo _U_, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
switch (pField[0])
{
case '0':
pLogEntry->msgType = msg_rx_standard_e;
pLogEntry->msg.type = MSG_TYPE_STD;
return true;
case '1':
pLogEntry->msgType = msg_rx_extended_e;
pLogEntry->msg.type = MSG_TYPE_EXT;
return true;
case '8':
pLogEntry->msgType = msg_tx_standard_e;
pLogEntry->msg.type = MSG_TYPE_STD;
return true;
case '9':
pLogEntry->msgType = msg_tx_extended_e;
pLogEntry->msg.type = MSG_TYPE_EXT;
return true;
default:
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: unknown message type");
return false;
}
}
static bool parseFieldID(cCLLog_logFileInfo_t *pInfo _U_, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
uint32_t id;
if (!ws_hexstrtou32(pField, NULL, &id)) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: ID value is not valid");
return false;
}
pLogEntry->msg.id = id;
return true;
}
static bool parseFieldLength(cCLLog_logFileInfo_t *pInfo _U_, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
uint32_t length;
if (!ws_strtou32(pField, NULL, &length)) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: length value is not valid");
return false;
}
if (length > array_length(pLogEntry->msg.data.data)) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: length value %u > maximum length %zu",
length, array_length(pLogEntry->msg.data.data));
return false;
}
pLogEntry->msg.data.length = length;
return true;
}
static bool parseFieldData(cCLLog_logFileInfo_t *pInfo _U_, char *pField, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
char *pFieldStart = pField;
/* Set data length in case length field is not set explicitly in the log file */
pLogEntry->msg.data.length = 0;
/* Loop all data bytes */
while (pLogEntry->msg.data.length < array_length(pLogEntry->msg.data.data))
{
int hexdigit;
uint8_t data;
if (*pFieldStart == '\n' || *pFieldStart == '\r' || *pFieldStart == '\0')
{
break;
}
hexdigit = ws_xton(*pFieldStart);
if (hexdigit < 0) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: packet byte value 0x%02x is not valid", *pFieldStart);
return false;
}
data = (uint8_t)hexdigit << 4U;
pFieldStart++;
hexdigit = ws_xton(*pFieldStart);
if (hexdigit < 0) {
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup_printf("cllog: packet byte value 0x%02x is not valid", *pFieldStart);
return false;
}
data = data | (uint8_t)hexdigit;
pFieldStart++;
pLogEntry->msg.data.data[pLogEntry->msg.data.length++] = data;
}
return true;
}
static bool parseLogLine(cCLLog_logFileInfo_t *pInfo, char *pLine, cCLLog_message_t *pLogEntry, int *err, char **err_info)
{
char *pFieldStart = pLine;
/* Loop all fields in log line */
for (unsigned int fieldNo = 0, finalField = 0; fieldNo < MAX_LOG_LINE_FIELDS && finalField == 0; fieldNo++)
{
/* Find field end by separator */
char *pFieldEnd = strchr(pFieldStart, pInfo->separator);
/* If final field, then EOL marks the end of the field */
if (pFieldEnd == NULL)
{
pFieldEnd = strchr(pFieldStart, '\n');
finalField = 1;
}
/* Replace separator or terminator with string termination */
if (pFieldEnd != NULL)
{
*pFieldEnd = '\0';
}
/* Is parse function assigned to field? */
if (pInfo->parseFieldFunc[fieldNo] != NULL)
{
/* Parse field */
if (!pInfo->parseFieldFunc[fieldNo](pInfo, pFieldStart, pLogEntry, err, err_info))
{
return false;
}
}
/* Skip over the separator */
pFieldStart = pFieldEnd + 1;
}
return true;
}
/***********************************************************************************************************************
* parseColumnHeaderFields
*
* Parse the column fields and determine which fields are present and the position of the fields
*
* @param[ in ] pInfo Pointer to the CLLog object
* @param[ in ] pColLine The column line
**********************************************************************************************************************/
static bool parseColumnHeaderFields( cCLLog_logFileInfo_t *pInfo, char *pColLine )
{
bool resultFlag = false;
/* Initialise field start */
char *pFieldStart = pColLine;
/* Loop all fields in line */
for ( uint8_t fieldNo = 0, finalField = 0 ; fieldNo < MAX_LOG_LINE_FIELDS && finalField == 0 ; fieldNo++ )
{
/* Find field end */
char *pFieldEnd = strchr( pFieldStart, pInfo->separator );
/* If final field, then EOL marks the end of the field */
if( pFieldEnd == NULL )
{
pFieldEnd = strchr( pFieldStart, '\n' );
finalField = 1;
}
/* Replace separator or terminator with string termination */
if (pFieldEnd != NULL)
{
*pFieldEnd = '\0';
}
/* Set field number */
if( strcmp( pFieldStart, "Timestamp" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldTS; resultFlag = true; }
if( strcmp( pFieldStart, "Lost" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldLost; resultFlag = true; }
if( strcmp( pFieldStart, "Type" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldMsgType; resultFlag = true; }
if( strcmp( pFieldStart, "ID" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldID; resultFlag = true; }
if( strcmp( pFieldStart, "Length" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldLength; resultFlag = true; }
if( strcmp( pFieldStart, "Data" ) == 0 ) { pInfo->parseFieldFunc[ fieldNo ] = parseFieldData; resultFlag = true; }
/* Set start of next field to end of previous + 1 */
pFieldStart = pFieldEnd + 1;
}
return resultFlag;
}
/***********************************************************************************************************************
* stripTimeStamp
*
* Strips a time stamp string for any delimiters
**********************************************************************************************************************/
static uint8_t stripTimeStamp( const cCLLog_logFileInfo_t *pInfo, char *pTimeStampString )
{
uint8_t strippedLength = 0U;
/* Char by char, strip the delimiters from the time stamp string */
size_t timeStampStringLen = strlen( pTimeStampString );
for (size_t i = 0U; i < timeStampStringLen; i++ )
{
/* Get char */
char charTmp = pTimeStampString[i];
/* If delimiter, skip */
if( charTmp == pInfo->separator ){ continue; }
if( charTmp == pInfo->timeSeparator ){ continue; }
if( charTmp == pInfo->timeSeparatorMs ){ continue; }
if( charTmp == pInfo->dateSeparator ){ continue; }
if( charTmp == pInfo->dateAndTimeSeparator ){ continue; }
/* Not a delimiter, keep char */
pTimeStampString[ strippedLength++ ] = charTmp;
}
pTimeStampString[ strippedLength ] = '\0';
return strippedLength;
}
static bool parseString(const char *pFieldValue, char *valuep, size_t valueSize, char *fieldName, int *err, char **err_info)
{
if (!checked_strcpy(valuep, valueSize, pFieldValue))
{
*err = WTAP_ERR_BAD_FILE;
*err_info = ws_strdup_printf("cllog: %s is too long",
fieldName);
return false;
}
return true;
}
static bool parseUnsigned(const char *pFieldValue, uint32_t *valuep, char *fieldName, int *err, char **err_info)
{
uint32_t value;
if (!ws_strtou32(pFieldValue, NULL, &value)) {
*err = WTAP_ERR_BAD_FILE;
*err_info = ws_strdup_printf("cllog: %s value is not valid",
fieldName);
return false;
}
*valuep = value;
return true;
}
static bool parseSeparator(const char *pFieldValue, char *separatorp, char *fieldName, int *err, char **err_info)
{
char separator = '\0';
/* Separator field is if set e.g. ";" - that is 3 chars. Else it is "" */
if (strlen( pFieldValue) == 3)
{
if (pFieldValue[0] != '"' || !g_ascii_isprint(pFieldValue[1]) ||
pFieldValue[2] != '"')
{
*err = WTAP_ERR_BAD_FILE;
*err_info = ws_strdup_printf("cllog: %s separator is not valid",
fieldName);
return false;
}
separator = pFieldValue[1];
}
*separatorp = separator;
return true;
}
static bool parseBoolean(const char *pFieldValue, bool *value, char *fieldName, int *err, char **err_info)
{
if (strcmp(pFieldValue, "true") == 0)
{
*value = true;
}
else if (strcmp(pFieldValue, "false") == 0)
{
*value = false;
}
else
{
*err = WTAP_ERR_BAD_FILE;
*err_info = ws_strdup_printf("cllog: %s value is not valid",
fieldName);
return false;
}
return true;
}
static bool parseLogFileHeaderLine_type(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
if (strcmp(pFieldValue, "CANLogger1000") == 0 || strcmp(pFieldValue, "CL1000") == 0)
{
pInfo->loggerType = type_CL1000_e;
}
else if (strcmp(pFieldValue, "CANLogger2000") == 0 || strcmp(pFieldValue, "CL2000") == 0)
{
pInfo->loggerType = type_CL2000_e;
}
else if (strcmp(pFieldValue, "CANLogger3000") == 0 || strcmp(pFieldValue, "CL3000") == 0)
{
pInfo->loggerType = type_CL3000_e;
}
else
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: logger type value is not valid");
return false;
}
return true;
}
static bool parseLogFileHeaderLine_hwrev(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseString(pFieldValue, pInfo->hwrev, sizeof pInfo->hwrev, "hardware revision", err, err_info);
}
static bool parseLogFileHeaderLine_fwrev(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseString(pFieldValue, pInfo->fwrev, sizeof pInfo->fwrev, "firmware revision", err, err_info);
}
static bool parseLogFileHeaderLine_id(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseString(pFieldValue, pInfo->id, sizeof pInfo->id, "ID", err, err_info);
}
static bool parseLogFileHeaderLine_sessionNo(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseUnsigned(pFieldValue, &pInfo->sessionNo, "session number", err, err_info);
}
static bool parseLogFileHeaderLine_splitNo(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseUnsigned(pFieldValue, &pInfo->splitNo, "split number", err, err_info);
}
static bool parseLogFileHeaderLine_time(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
struct tm tm;
memset(&tm, 0, sizeof tm);
/* YYYYMMDDThhmmss */
sscanf(pFieldValue,
"%4u%2u%2uT%2u%2u%2u",
&tm.tm_year,
&tm.tm_mon,
&tm.tm_mday,
&tm.tm_hour,
&tm.tm_min,
&tm.tm_sec);
tm.tm_mon -= 1;
tm.tm_year -= 1900;
/* To Epoch ( mktime converts to epoch from local (!!!) timezone )*/
pInfo->logStartTime.secs = mktime(&tm);
pInfo->logStartTime.nsecs = 0;
if (!checked_strcpy(pInfo->logStartTimeString, sizeof pInfo->logStartTimeString, pFieldValue))
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: time is too long");
return false;
}
return true;
}
static bool parseLogFileHeaderLine_valueSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseSeparator(pFieldValue, &pInfo->separator, "value", err, err_info);
}
static bool parseLogFileHeaderLine_timeFormat(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
uint32_t format;
if (!ws_strtou32(pFieldValue, NULL, &format))
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: time format value is not valid");
return false;
}
if (format > 6)
{
*err = WTAP_ERR_BAD_FILE;
*err_info = g_strdup("cllog: time format value is not valid");
return false;
}
pInfo->timeFormat = (uint8_t)format;
return true;
}
static bool parseLogFileHeaderLine_timeSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseSeparator(pFieldValue, &pInfo->timeSeparator, "time", err, err_info);
}
static bool parseLogFileHeaderLine_timeSeparatorMs(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseSeparator(pFieldValue, &pInfo->timeSeparatorMs, "time millisecond", err, err_info);
}
static bool parseLogFileHeaderLine_dateSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseSeparator(pFieldValue, &pInfo->dateSeparator, "date", err, err_info);
}
static bool parseLogFileHeaderLine_timeAndDateSeparator(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseSeparator(pFieldValue, &pInfo->dateAndTimeSeparator, "date and time", err, err_info);
}
static bool parseLogFileHeaderLine_bitRate(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
return parseUnsigned(pFieldValue, &pInfo->bitRate, "bit rate", err, err_info);
}
static bool parseLogFileHeaderLine_silentMode(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
bool silentMode;
if (!parseBoolean(pFieldValue, &silentMode, "silent mode", err, err_info))
{
return false;
}
if (silentMode)
{
pInfo->silentMode = silent_enabled_e;
}
else
{
pInfo->silentMode = silent_disabled_e;
}
return true;
}
static bool parseLogFileHeaderLine_cyclicMode(cCLLog_logFileInfo_t *pInfo, char *pFieldValue, int *err, char **err_info)
{
bool cyclicMode;
if (!parseBoolean(pFieldValue, &cyclicMode, "silent mode", err, err_info))
{
return false;
}
if (cyclicMode)
{
pInfo->cyclicMode = cyclic_enabled_e;
}
else
{
pInfo->cyclicMode = cyclic_disabled_e;
}
return true;
}
static bool
cllog_read_common(wtap *wth, FILE_T fh, wtap_rec *rec, int *err, char **err_info)
{
cCLLog_logFileInfo_t *clLog = (cCLLog_logFileInfo_t *) wth->priv;
char line[MAX_LOG_LINE_LENGTH];
cCLLog_message_t logEntry;
/* Read a line */
if (file_gets(line, sizeof(line), fh) == NULL)
{
/* EOF or error. */
*err = file_error(fh, err_info);
return false;
}
/* Default the log entry structure */
memset(&logEntry, 0, sizeof(logEntry));
/* Parse the line */
if (!parseLogLine(clLog, line, &logEntry, err, err_info))
{
return false;
}
if (!wtap_socketcan_gen_packet(wth, rec, &logEntry.msg, "cllog", err, err_info))
return false;
if (logEntry.msgType == msg_tx_standard_e || logEntry.msgType == msg_tx_extended_e)
{
wtap_block_add_uint32_option(rec->block, OPT_PKT_FLAGS, PACK_FLAGS_DIRECTION_OUTBOUND);
}
else if (logEntry.msgType == msg_rx_standard_e || logEntry.msgType == msg_rx_extended_e)
{
wtap_block_add_uint32_option(rec->block, OPT_PKT_FLAGS, PACK_FLAGS_DIRECTION_INBOUND);
}
return true;
}
static bool
cllog_read(wtap *wth, wtap_rec *rec, int *err, char **err_info, int64_t *data_offset)
{
*data_offset = file_tell(wth->fh);
return cllog_read_common(wth, wth->fh, rec, err, err_info);
}
static bool
cllog_seek_read(wtap *wth, int64_t seek_off, wtap_rec *rec, int *err, char **err_info)
{
if (file_seek(wth->random_fh, seek_off, SEEK_SET, err) == -1)
return false;
return cllog_read_common(wth, wth->random_fh, rec, err, err_info);
}
wtap_open_return_val
cllog_open(wtap *wth, int *err, char **err_info)
{
cCLLog_logFileInfo_t *clLog;
char line[ MAX_LOG_LINE_LENGTH ];
char *linep;
clLog = g_new0(cCLLog_logFileInfo_t, 1);
/*
* We're at the beginning of the file. The header is a set
* of comment lines, each beginning with a '#'. Read each line,
* stopping if we see a non-comment line, and parse each
* comment line; if any aren't valid, quit and indicate that
* this isn't a CLX log file.
*/
while ((linep = file_gets(line, sizeof(line), wth->fh)) != NULL &&
linep[0] == '#')
{
/*
* Skip the comment character and white space following it.
*/
linep++;
while (*linep == ' ' || *linep == '\t')
linep++;
if (*linep == '\0')
{
/*
* Skip over empty comment lines.
* XXX - should we treat that as an indication of an
* invalid file?
*/
continue;
}
/*
* Look for the handler for this particular header line.
*/
for (unsigned int i = 0U; i < HEADER_LINE_PARSE_MAPPING_LENGTH; i++)
{
const headerLineParseMapping_t *pHeaderMapping = &headerLineParseMapping[i];
size_t matchStringLen = strlen(pHeaderMapping->pMatchString);
if (strncmp(linep, pHeaderMapping->pMatchString, matchStringLen) == 0 &&
pHeaderMapping->parseFunc != NULL)
{
/*
* This matches this header value.
* Skip past the tag.
*/
linep += matchStringLen;
/* Replace any newline chars with end of line */
for (char *pChar = linep; ; pChar++)
{
if (*pChar == '\n' || *pChar == '\r' || *pChar == '\0')
{
*pChar = '\0';
break;
}
}
/*
* Call the handler.
*/
if (!pHeaderMapping->parseFunc(clLog, linep, err, err_info))
{
/*
* XXX - should this file be rejected as not
* one of ours? Given the line looks like
* a comment that begins with a valid header
* field tag, it may be likely to be one of
* ours.
*/
g_free(clLog);
if (*err == WTAP_ERR_BAD_FILE)
{
wmem_free(NULL, *err_info);
*err_info = NULL;
}
return WTAP_OPEN_NOT_MINE;
}
}
}
}
/*
* Did file_gets() fail?
*/
if (linep == NULL)
{
/*
* Yes - file_gets() didn't return a line.
* Did it get an error?
*/
*err = file_error(wth->fh, err_info);
if (*err != 0)
{
/* Yes. What was it? */
if (*err == WTAP_ERR_SHORT_READ)
{
/* Incomplete header, so not ours. */
g_free(clLog);
return WTAP_OPEN_NOT_MINE;
}
else
{
/* I/O error. */
g_free(clLog);
return WTAP_OPEN_ERROR;
}
}
/*
* No, it just got an EOF; treat it as our file, as
* older versions did so.
*
* XXX - should we treat it as not our file, as it lacks
* the column header line?
*/
}
else
{
/*
* We've read the first line after the header, so it's the column
* header line. Parse it.
*/
if (!parseColumnHeaderFields(clLog, linep))
{
g_free(clLog);
return WTAP_OPEN_NOT_MINE;
}
}
wth->priv = clLog;
wtap_set_as_socketcan(wth, cllog_file_type_subtype, WTAP_TSPREC_MSEC);
wth->snapshot_length = 0;
wth->subtype_read = cllog_read;
wth->subtype_seek_read = cllog_seek_read;
return WTAP_OPEN_MINE;
}
/* Options for packet blocks. */
static const struct supported_option_type packet_block_options_supported[] = {
{ OPT_PKT_FLAGS, ONE_OPTION_SUPPORTED },
};
static const struct supported_block_type cllog_blocks_supported[] = {
/*
* We support packet blocks, with only the flags option supported.
*/
{ WTAP_BLOCK_PACKET, MULTIPLE_BLOCKS_SUPPORTED, OPTION_TYPES_SUPPORTED(packet_block_options_supported) }
};
static const struct file_type_subtype_info cllog_info = {
"CSS Electronics CLX000 CAN log", "cllog", "txt", NULL,
false, BLOCKS_SUPPORTED(cllog_blocks_supported),
NULL, NULL, NULL
};
void
register_canlogger(void)
{
cllog_file_type_subtype = wtap_register_file_type_subtype(&cllog_info);
}