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.
970 lines
34 KiB
C
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);
|
|
}
|