Первый коммит
This commit is contained in:
cfif
commit
8567a5bb2a
|
|
@ -0,0 +1,149 @@
|
||||||
|
//
|
||||||
|
// Created by xemon on 06.09.22.
|
||||||
|
//
|
||||||
|
|
||||||
|
#include <memory.h>
|
||||||
|
#include <math.h>
|
||||||
|
#include "AsciiStringAssmeblingUtils.h"
|
||||||
|
|
||||||
|
static const char ASCII_STRING_HEX_CHAR[] = "0123456789ABCDEF";
|
||||||
|
|
||||||
|
static const uint64_t ASCII_STRING_DEC_POW[] = {
|
||||||
|
1, 10, 100, 1000, 10000, 100000, 1000000, 10000000, 100000000, 1000000000, 10000000000, 100000000000
|
||||||
|
};
|
||||||
|
static const uint8_t ASCII_STRING_DEC_POW_LEN = (sizeof(ASCII_STRING_DEC_POW) / sizeof(uint64_t));
|
||||||
|
|
||||||
|
uint8_t vAsciiStringDecimalIntToChar(uint8_t number_0_9) {
|
||||||
|
number_0_9 = number_0_9 % 10; //cutoff digits more 1 (numbers between 0 and 9)
|
||||||
|
return ('0' + number_0_9); //return char of number('0' is base number in ascii)
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAdd(char *string, size_t *stringLen, char *addString, size_t addStringLen) {
|
||||||
|
memcpy(string + (*stringLen), addString, addStringLen);
|
||||||
|
*stringLen += addStringLen;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddChar(char *string, size_t *stringLen, uint8_t singleChar) {
|
||||||
|
string[*stringLen] = singleChar;
|
||||||
|
++(*stringLen);
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringInit(char *string, size_t *stringLen, size_t fullLen) {
|
||||||
|
memset(string, 0, fullLen);
|
||||||
|
*stringLen = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringClean(char *string, size_t *stringLen) {
|
||||||
|
if (*stringLen == 0)return;
|
||||||
|
memset(string, 0, *stringLen);
|
||||||
|
*stringLen = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalInt(char *string, size_t *stringLen, uint8_t number, uint8_t digits) {
|
||||||
|
for (uint8_t reverse_digit = 1; reverse_digit <= digits; ++reverse_digit) {
|
||||||
|
string[*stringLen + digits - reverse_digit] = vAsciiStringDecimalIntToChar(number);
|
||||||
|
number /= 10;
|
||||||
|
}
|
||||||
|
*stringLen += digits;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalInt64(char *string, size_t *stringLen, uint64_t number, uint8_t digits) {
|
||||||
|
for (uint8_t reverse_digit = 1; reverse_digit <= digits; ++reverse_digit) {
|
||||||
|
string[*stringLen + digits - reverse_digit] = vAsciiStringDecimalIntToChar(number % 10);
|
||||||
|
number /= 10;
|
||||||
|
}
|
||||||
|
*stringLen += digits;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringSpitChars(char *one, char *two) {
|
||||||
|
char tmp;
|
||||||
|
tmp = *one;
|
||||||
|
*one = *two;
|
||||||
|
*two = tmp;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalIntWithLimit(char *string, size_t *stringLen, int64_t number, uint8_t digitsLimit) {
|
||||||
|
|
||||||
|
if (number < 0) {
|
||||||
|
*(string + (*stringLen)) = '-';
|
||||||
|
++(*stringLen);
|
||||||
|
number = -number;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint32_t cutoffNumber = 1;
|
||||||
|
|
||||||
|
for (uint8_t scale = 0; scale < digitsLimit; ++scale) {
|
||||||
|
cutoffNumber *= 10;
|
||||||
|
}
|
||||||
|
number = number % cutoffNumber;
|
||||||
|
|
||||||
|
if (number == 0) {
|
||||||
|
string[*stringLen] = '0';
|
||||||
|
(*stringLen) += 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t digits = 0;
|
||||||
|
|
||||||
|
for (; (digits < digitsLimit) && (number != 0); ++digits) {
|
||||||
|
string[(*stringLen) + digits] = vAsciiStringDecimalIntToChar(number % 10);
|
||||||
|
number /= 10;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t reverses = digits / 2;
|
||||||
|
|
||||||
|
for (uint8_t reverse_digit = 0; reverse_digit < reverses; ++reverse_digit) {
|
||||||
|
vAsciiStringSpitChars(string + *stringLen + reverse_digit, string + *stringLen + digits - 1 - reverse_digit);
|
||||||
|
}
|
||||||
|
|
||||||
|
*stringLen += digits;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddByteAsHex(char *str, size_t *stringLen, uint8_t number) {
|
||||||
|
str[*stringLen + 0] = ASCII_STRING_HEX_CHAR[(number >> 4) & 0xF];
|
||||||
|
str[*stringLen + 1] = ASCII_STRING_HEX_CHAR[(number & 0xF)];
|
||||||
|
*stringLen += 2;
|
||||||
|
}
|
||||||
|
|
||||||
|
void vAsciiStringAddBytesAsHex(char *str, size_t *stringLen, uint8_t *bytesData, size_t bytesCount) {
|
||||||
|
uint8_t *end = bytesData + bytesCount;
|
||||||
|
while (end > bytesData) {
|
||||||
|
vAsciiStringAddByteAsHex(str, stringLen, *bytesData);
|
||||||
|
++bytesData;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline uint64_t get_dec_pow(uint8_t value) {
|
||||||
|
if (value < ASCII_STRING_DEC_POW_LEN) {
|
||||||
|
return ASCII_STRING_DEC_POW[value];
|
||||||
|
}
|
||||||
|
|
||||||
|
uint64_t mux = ASCII_STRING_DEC_POW[ASCII_STRING_DEC_POW_LEN - 1];
|
||||||
|
|
||||||
|
for (uint8_t scale = ASCII_STRING_DEC_POW_LEN; scale < value; ++scale) {
|
||||||
|
mux *= 10;
|
||||||
|
}
|
||||||
|
|
||||||
|
return mux;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalFloatWithLimit(
|
||||||
|
char *string,
|
||||||
|
size_t *stringLen,
|
||||||
|
double number,
|
||||||
|
uint8_t intDigits,
|
||||||
|
uint8_t fractionalDigits
|
||||||
|
) {
|
||||||
|
uint64_t dec_mux = get_dec_pow(fractionalDigits);
|
||||||
|
|
||||||
|
uint64_t intPart = (uint64_t) number;
|
||||||
|
double fractional = round(number * dec_mux) / dec_mux - intPart;
|
||||||
|
uint64_t fractionalPartInInteger = (uint64_t) (fractional * dec_mux);
|
||||||
|
|
||||||
|
|
||||||
|
vAsciiStringAddDecimalIntWithLimit(string, stringLen, intPart, intDigits);
|
||||||
|
vAsciiStringAddChar(string, stringLen, '.');
|
||||||
|
vAsciiStringAddDecimalInt64(string, stringLen, fractionalPartInInteger, fractionalDigits);
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,42 @@
|
||||||
|
//
|
||||||
|
// Created by xemon on 06.09.22.
|
||||||
|
//
|
||||||
|
|
||||||
|
#ifndef ASCIISTRINGASSMEBLINGUTILS_ASCIISTRINGASSMEBLINGUTILS_H
|
||||||
|
#define ASCIISTRINGASSMEBLINGUTILS_ASCIISTRINGASSMEBLINGUTILS_H
|
||||||
|
|
||||||
|
#include "stdint.h"
|
||||||
|
#include "stddef.h"
|
||||||
|
|
||||||
|
void vAsciiStringAdd(char *string, size_t *stringLen, char *addString, size_t addStringLen);
|
||||||
|
|
||||||
|
uint8_t vAsciiStringDecimalIntToChar(uint8_t number_0_9);
|
||||||
|
|
||||||
|
void vAsciiStringAddChar(char *string, size_t *stringLen, uint8_t singleChar);
|
||||||
|
|
||||||
|
#define vAsciiStringAddStatic(string, stringLen, staticString)\
|
||||||
|
vAsciiStringAdd(string, stringLen, staticString, sizeof(staticString)-1)
|
||||||
|
|
||||||
|
void vAsciiStringClean(char *string, size_t *stringLen);
|
||||||
|
|
||||||
|
void vAsciiStringInit(char *string, size_t *stringLen, size_t fullLen);
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalInt(char *string, size_t *stringLen, uint8_t number, uint8_t digits);
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalInt64(char *string, size_t *stringLen, uint64_t number, uint8_t digits);
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalIntWithLimit(char *string, size_t *stringLen, int64_t number, uint8_t digitsLimit);
|
||||||
|
|
||||||
|
void vAsciiStringAddByteAsHex(char *str, size_t *stringLen, uint8_t number);
|
||||||
|
|
||||||
|
void vAsciiStringAddBytesAsHex(char *str, size_t *stringLen, uint8_t *bytesData, size_t bytesCount);
|
||||||
|
|
||||||
|
void vAsciiStringAddDecimalFloatWithLimit(
|
||||||
|
char *string,
|
||||||
|
size_t *stringLen,
|
||||||
|
double number,
|
||||||
|
uint8_t intDigits,
|
||||||
|
uint8_t fractionalDigits
|
||||||
|
);
|
||||||
|
|
||||||
|
#endif //ASCIISTRINGASSMEBLINGUTILS_ASCIISTRINGASSMEBLINGUTILS_H
|
||||||
|
|
@ -0,0 +1,128 @@
|
||||||
|
/*
|
||||||
|
* BitOps.c
|
||||||
|
*
|
||||||
|
* Created on: Apr 13, 2021
|
||||||
|
* Author: zemon
|
||||||
|
*/
|
||||||
|
#include "BitBuffer.h"
|
||||||
|
|
||||||
|
|
||||||
|
void vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t appendableByte,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
) {
|
||||||
|
|
||||||
|
uint16_t fullBytesOffset = offsetOfFirstBit / 8;
|
||||||
|
uint8_t bitsOffsetInFirstByte = offsetOfFirstBit % 8;
|
||||||
|
uint8_t bitsWritedToSecondByte = bitsOffsetInFirstByte + countOfAppendableBits - 8;
|
||||||
|
|
||||||
|
uint8_t firstByteCut = appendableByte << (8 - countOfAppendableBits);
|
||||||
|
|
||||||
|
destinationBitSequence[fullBytesOffset] |= firstByteCut >> bitsOffsetInFirstByte;
|
||||||
|
|
||||||
|
if (bitsWritedToSecondByte > 0) {
|
||||||
|
destinationBitSequence[fullBytesOffset + 1] |= appendableByte << (8 - bitsWritedToSecondByte);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendByte(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t appendableByte,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableByte,
|
||||||
|
countOfAppendableBits
|
||||||
|
);
|
||||||
|
return countOfAppendableBits;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBits(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
) {
|
||||||
|
|
||||||
|
uint16_t fullBytes = countOfAppendableBits / 8;
|
||||||
|
uint16_t notFullByteBits = countOfAppendableBits % 8;
|
||||||
|
|
||||||
|
uint16_t i = 0;
|
||||||
|
for (; i < fullBytes; ++i) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableData[i], 8
|
||||||
|
);
|
||||||
|
offsetOfFirstBit += 8;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (notFullByteBits > 0) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableData[i],
|
||||||
|
notFullByteBits
|
||||||
|
);
|
||||||
|
}
|
||||||
|
return countOfAppendableBits;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBitsReverseBytes(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
) {
|
||||||
|
|
||||||
|
uint16_t fullBytes = countOfAppendableBits / 8;
|
||||||
|
uint16_t notFullByteBits = countOfAppendableBits % 8;
|
||||||
|
|
||||||
|
uint16_t totalBytes = fullBytes + (notFullByteBits > 0 ? 1 : 0);
|
||||||
|
|
||||||
|
uint16_t i = 0;
|
||||||
|
for (; i < fullBytes; ++i) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableData[(totalBytes - 1) - i],
|
||||||
|
8
|
||||||
|
);
|
||||||
|
offsetOfFirstBit += 8;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (notFullByteBits > 0) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableData[(totalBytes - 1) - i],
|
||||||
|
notFullByteBits
|
||||||
|
);
|
||||||
|
}
|
||||||
|
return countOfAppendableBits;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBytesReverse(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBytes
|
||||||
|
) {
|
||||||
|
for (int i = countOfAppendableBytes - 1; i > -1; --i) {
|
||||||
|
vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
destinationBitSequence,
|
||||||
|
offsetOfFirstBit,
|
||||||
|
appendableData[i], 8
|
||||||
|
);
|
||||||
|
offsetOfFirstBit += 8;
|
||||||
|
}
|
||||||
|
|
||||||
|
return countOfAppendableBytes * 8;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
@ -0,0 +1,50 @@
|
||||||
|
/*
|
||||||
|
* BitOps.h
|
||||||
|
*
|
||||||
|
* Created on: Apr 13, 2021
|
||||||
|
* Author: zemon
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef BITOPS_INC_BITOPS_H_
|
||||||
|
#define BITOPS_INC_BITOPS_H_
|
||||||
|
|
||||||
|
#include "stdint.h"
|
||||||
|
|
||||||
|
|
||||||
|
void vBitBufferAppendDataByteBitsCountWithBitsOffset(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t appendableByte,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
);
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendByte(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t appendableByte,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
);
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBits(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
);
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBitsReverseBytes(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBits
|
||||||
|
);
|
||||||
|
|
||||||
|
uint8_t vBitBufferAppendBytesReverse(
|
||||||
|
uint8_t *destinationBitSequence,
|
||||||
|
uint16_t offsetOfFirstBit,
|
||||||
|
uint8_t *appendableData,
|
||||||
|
uint8_t countOfAppendableBytes
|
||||||
|
);
|
||||||
|
|
||||||
|
|
||||||
|
#endif /* BITOPS_INC_BITOPS_H_ */
|
||||||
|
|
@ -0,0 +1,24 @@
|
||||||
|
//
|
||||||
|
// Created by xemon on 8/23/22.
|
||||||
|
//
|
||||||
|
|
||||||
|
#ifndef MODULE_ECALLTYPES_H
|
||||||
|
#define MODULE_ECALLTYPES_H
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
AUTOMATIC_ACTIVATION = 1,
|
||||||
|
MANUAL_ACTIVATION = 0
|
||||||
|
} eEcallActivationType;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
TEST_CALL = 1,
|
||||||
|
EMERGENCY_CALL = 0
|
||||||
|
} eEcallTestMode;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
NOT_CHANGE_TIME = 2,
|
||||||
|
GNSS_TIME_SOURSE = 1,
|
||||||
|
RTC_TIME_SOURSE = 0
|
||||||
|
} eEcallTimeSourse;
|
||||||
|
|
||||||
|
#endif //MODULE_ECALLTYPES_H
|
||||||
|
|
@ -0,0 +1,534 @@
|
||||||
|
/*
|
||||||
|
* msd.c
|
||||||
|
*
|
||||||
|
* Created on: OCT 21, 2020
|
||||||
|
* Author: FICOM-IT LTD
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include "EraGlonassMsd.h"
|
||||||
|
#include "BitBuffer.h"
|
||||||
|
#include <memory.h>
|
||||||
|
|
||||||
|
|
||||||
|
void EraGlonassMsdInit(tEraGlonassMsd *env) {
|
||||||
|
|
||||||
|
// env->lastPos = (tEraGlonassMsd_GpsPos) {512, 512};
|
||||||
|
|
||||||
|
//init not changeable fields
|
||||||
|
env->MSD_Data.msgId = 0;
|
||||||
|
|
||||||
|
env->MSD_Data.msdId = MSD_V_2; // MSD format version
|
||||||
|
|
||||||
|
env->MSD_Data.MSD_Control.extraData = 0x00; // Additional information not included
|
||||||
|
|
||||||
|
// aGpsStatus
|
||||||
|
env->MSD_Data.MSD_Control.recentPos1 = 0x01; // Recent vehicle position 1 available
|
||||||
|
env->MSD_Data.MSD_Control.recentPos2 = 0x01; // Recent vehicle position 2 available
|
||||||
|
|
||||||
|
env->MSD_Data.additionalData.coordSystem = ERA_GLONASS_MSD_COORDINATE_SYSTEM_TYPE_WGS84;
|
||||||
|
env->MSD_Data.additionalData.diagnosticResult = NULL;
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsd_ClearDiagnostic(tMSD_DiagnosticResult *env) {
|
||||||
|
memset(env, 0, sizeof(tMSD_DiagnosticResult));
|
||||||
|
}
|
||||||
|
|
||||||
|
// In case we don't have valid GPS data set defaults as described in EN15722
|
||||||
|
void EraGlonassMsdNoGnssSetDefaults(tEraGlonassMsd *env) {
|
||||||
|
env->MSD_Data.timestamp = 0x00;
|
||||||
|
env->MSD_Data.pos.lat = 0xFFFFFFFF;
|
||||||
|
env->MSD_Data.pos.lon = 0xFFFFFFFF;
|
||||||
|
// env->MSD_Data.pos.lat = 0xFFFFFFF;
|
||||||
|
// env->MSD_Data.pos.lon = 0xFFFFFFF;
|
||||||
|
env->MSD_Data.direction = 0xFF;
|
||||||
|
|
||||||
|
env->MSD_Data.MSD_PosDelta[0].lat = 512;
|
||||||
|
env->MSD_Data.MSD_PosDelta[0].lon = 512;
|
||||||
|
|
||||||
|
env->MSD_Data.MSD_PosDelta[1].lat = 512;
|
||||||
|
env->MSD_Data.MSD_PosDelta[1].lon = 512;
|
||||||
|
|
||||||
|
// aGpsStatus
|
||||||
|
env->MSD_Data.MSD_Control.recentPos1 = 0x00; // Recent vehicle position 1 available
|
||||||
|
env->MSD_Data.MSD_Control.recentPos2 = 0x00; // Recent vehicle position 2 available
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetDataEmergencySituationFlags(
|
||||||
|
tEraGlonassMsd *env,
|
||||||
|
int MSD_MSG_ID,
|
||||||
|
eEcallActivationType eCallType,
|
||||||
|
eEcallTestMode eCallTestMode
|
||||||
|
) {
|
||||||
|
// Message ID
|
||||||
|
env->MSD_Data.msgId = MSD_MSG_ID;
|
||||||
|
|
||||||
|
// Automatic or manual eCall activation
|
||||||
|
if (eCallType == AUTOMATIC_ACTIVATION) {
|
||||||
|
env->MSD_Data.MSD_Control.activation = 1;
|
||||||
|
}
|
||||||
|
if (eCallType == MANUAL_ACTIVATION) {
|
||||||
|
env->MSD_Data.MSD_Control.activation = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Test eCall
|
||||||
|
if (eCallTestMode == TEST_CALL) {
|
||||||
|
env->MSD_Data.MSD_Control.testCall = 1;
|
||||||
|
}
|
||||||
|
if (eCallTestMode == EMERGENCY_CALL) {
|
||||||
|
env->MSD_Data.MSD_Control.testCall = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdCalcPosDelta(tEraGlonassMsd *env, tEraGlonassMsd_GpsPos lastPos) {
|
||||||
|
int16_t deltaLat = 0, deltaLon = 0;
|
||||||
|
|
||||||
|
deltaLat = (lastPos.lat - env->MSD_Data.pos.lat) / 100;
|
||||||
|
deltaLon = (lastPos.lon - env->MSD_Data.pos.lon) / 100;
|
||||||
|
|
||||||
|
if (deltaLat <= -512) {
|
||||||
|
deltaLat = -512;
|
||||||
|
} else if (deltaLat >= 511) {
|
||||||
|
deltaLat = 511;
|
||||||
|
}
|
||||||
|
deltaLat += 512; // Make offset
|
||||||
|
|
||||||
|
if (deltaLon <= -512) {
|
||||||
|
deltaLon = -512;
|
||||||
|
} else if (deltaLon >= 511) {
|
||||||
|
deltaLon = 511;
|
||||||
|
}
|
||||||
|
deltaLon += 512;
|
||||||
|
|
||||||
|
|
||||||
|
env->MSD_Data.MSD_PosDelta[1].lat = env->MSD_Data.MSD_PosDelta[0].lat;
|
||||||
|
env->MSD_Data.MSD_PosDelta[1].lon = env->MSD_Data.MSD_PosDelta[0].lon;
|
||||||
|
env->MSD_Data.MSD_Control.recentPos2 = env->MSD_Data.MSD_Control.recentPos1;
|
||||||
|
|
||||||
|
env->MSD_Data.MSD_PosDelta[0].lat = deltaLat;
|
||||||
|
env->MSD_Data.MSD_PosDelta[0].lon = deltaLon;
|
||||||
|
env->MSD_Data.MSD_Control.recentPos1 = 0x01;
|
||||||
|
|
||||||
|
//Update to the latest position in order to calculate
|
||||||
|
//correctly the deltas on the next iteration
|
||||||
|
// env->lastPos.lat = env->MSD_Data.pos.lat;
|
||||||
|
// env->lastPos.lon = env->MSD_Data.pos.lon;
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetTimeStamp(tEraGlonassMsd *env, uint32_t timestamp) {
|
||||||
|
env->MSD_Data.timestamp = timestamp;
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetPositionValue(
|
||||||
|
tEraGlonassMsd *env,
|
||||||
|
int32_t lonArc,
|
||||||
|
int32_t latArc,
|
||||||
|
uint16_t track,
|
||||||
|
uint8_t valid
|
||||||
|
) {
|
||||||
|
|
||||||
|
tEraGlonassMsd_GpsPos lastPos = env->MSD_Data.pos;
|
||||||
|
|
||||||
|
env->MSD_Data.pos.lat = latArc;
|
||||||
|
env->MSD_Data.pos.lon = lonArc;
|
||||||
|
|
||||||
|
if (valid == 0) {
|
||||||
|
env->MSD_Data.MSD_Control.posStatus = 0x00; // False if position is not valid
|
||||||
|
env->MSD_Data.direction = 0xFF;
|
||||||
|
} else if (valid == 1){
|
||||||
|
EraGlonassMsdCalcPosDelta(env, lastPos);
|
||||||
|
env->MSD_Data.MSD_Control.posStatus = 0x00;
|
||||||
|
env->MSD_Data.direction = 0xFF;
|
||||||
|
} else if (valid == 2){
|
||||||
|
EraGlonassMsdCalcPosDelta(env, lastPos);
|
||||||
|
env->MSD_Data.MSD_Control.posStatus = 0x01;
|
||||||
|
// env->MSD_Data.direction = (track / 2); //(*255)/2
|
||||||
|
env->MSD_Data.direction = track; //(*255)/2
|
||||||
|
}
|
||||||
|
|
||||||
|
env->MSD_Data.pos.lat += 0x80000000; // Make offset
|
||||||
|
env->MSD_Data.pos.lon += 0x80000000;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
void EraGlonassMsdSetPassengersNumber(tEraGlonassMsd *env, uint16_t value) {
|
||||||
|
// Check passengers number
|
||||||
|
if (value >= 1) {
|
||||||
|
env->MSD_Data.MSD_Control.passengers = value; // Passengers number available
|
||||||
|
} else {
|
||||||
|
env->MSD_Data.MSD_Control.passengers = 0x00; // Passengers number not available
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetVehicleType(tEraGlonassMsd *env, eUveosGostVehicleType value) {
|
||||||
|
env->MSD_Data.MSD_Control.vehicleType = value;
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetVIN(tEraGlonassMsd *env, char *vin, uint8_t vinLen) {
|
||||||
|
unsigned char ch = 0, i = 0;
|
||||||
|
// Set VIN
|
||||||
|
for (i = 0; i < 17; i++) {
|
||||||
|
|
||||||
|
if (i < vinLen) {
|
||||||
|
ch = vin[i];
|
||||||
|
} else {
|
||||||
|
ch = '0';
|
||||||
|
}
|
||||||
|
|
||||||
|
if (ch >= '0' && ch <= '9') {
|
||||||
|
ch -= 0x30; // Numbers are encoded with valuese 0x00 to 0x09
|
||||||
|
} else if (ch >= 'A' && ch <= 'H') {
|
||||||
|
ch -= 0x37;
|
||||||
|
} else if (ch >= 'J' && ch <= 'N') {
|
||||||
|
ch -= 0x38;
|
||||||
|
} else if (ch == 'P') {
|
||||||
|
ch = 0x17;
|
||||||
|
} else if (ch >= 'R' && ch <= 'Z') {
|
||||||
|
ch -= 0x3A;
|
||||||
|
} else {
|
||||||
|
ch = '0' - 0x30;
|
||||||
|
}
|
||||||
|
|
||||||
|
env->MSD_Data.vin[i] = ch;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void EraGlonassMsdSetPropulsionStorageType(
|
||||||
|
tEraGlonassMsd *env,
|
||||||
|
eUveosGostVehiclePropulsionStorageType value
|
||||||
|
) {
|
||||||
|
env->MSD_Data.MSD_Control.includedTanks = 0b01111111; // Enable all tank type to be transmitted
|
||||||
|
|
||||||
|
// Set propulsion system storage
|
||||||
|
env->MSD_Data.propulsion = value;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfControl(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->msgId, 8);
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.activation ? 0x01 : 0x00, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.testCall ? 0x01 : 0x00, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.posStatus ? 0x01 : 0x00, 1);
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.vehicleType, 5);
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfVin(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
for (int i = 0; i < 17; ++i) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, ((uint8_t) data->vin[i]), 6);
|
||||||
|
}
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfPropulsion(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
uint8_t maxCountOfTanks;
|
||||||
|
|
||||||
|
if (data->msdId == MSD_V_1) {
|
||||||
|
maxCountOfTanks = 6;
|
||||||
|
} else if (data->msdId == MSD_V_2) {
|
||||||
|
maxCountOfTanks = 7;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t tanksInfoIncluded = !(data->MSD_Control.includedTanks >> maxCountOfTanks) && 0x1;
|
||||||
|
|
||||||
|
if (tanksInfoIncluded) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.includedTanks, maxCountOfTanks + 1);
|
||||||
|
|
||||||
|
for (int i = 0; i < maxCountOfTanks; ++i) {
|
||||||
|
if ((data->MSD_Control.includedTanks >> i) && 0x1) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, (data->propulsion >> i), 1);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x1, 1);
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfTimestamp(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
lastBit += vBitBufferAppendBitsReverseBytes(raw, lastBit, (uint8_t *) &data->timestamp, 32);
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfLocation(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendBitsReverseBytes(raw, lastBit, (uint8_t *) &data->pos.lat, 32);
|
||||||
|
lastBit += vBitBufferAppendBitsReverseBytes(raw, lastBit, (uint8_t *) &data->pos.lon, 32);
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfDirection(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
\
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->direction, 8);
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfRecentPositions(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
\
|
||||||
|
if (data->MSD_Control.recentPos1) {
|
||||||
|
lastBit += vBitBufferAppendBits(raw, lastBit, (uint8_t *) &data->MSD_PosDelta[0].lat, 10);
|
||||||
|
lastBit += vBitBufferAppendBits(raw, lastBit, (uint8_t *) &data->MSD_PosDelta[0].lon, 10);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data->MSD_Control.recentPos2) {
|
||||||
|
lastBit += vBitBufferAppendBits(raw, lastBit, (uint8_t *) &data->MSD_PosDelta[1].lat, 10);
|
||||||
|
lastBit += vBitBufferAppendBits(raw, lastBit, (uint8_t *) &data->MSD_PosDelta[1].lon, 10);
|
||||||
|
}
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfPassengersCount(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
if (data->MSD_Control.passengers) {
|
||||||
|
lastBit += vBitBufferAppendBits(raw, lastBit, (uint8_t *) &data->MSD_Control.passengers, 8);
|
||||||
|
}
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfV1FreeSpaceFix(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
if (data->msdId == MSD_V_1) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x00, 8);
|
||||||
|
}
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t
|
||||||
|
sEraGlonassMsdEncodeOfAdditionalDataOID(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x03, 8);//lent of OID
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x01, 8);//OID 1
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x04, 8);//OID 2
|
||||||
|
|
||||||
|
if (data->msdId == MSD_V_1) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x01, 8);//OID 3
|
||||||
|
} else if (data->msdId == MSD_V_2) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0x02, 8);//OID 3
|
||||||
|
}
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(FLAG) lastBit += vBitBufferAppendByte(raw, lastBit, (FLAG) == ERA_GLONASS_MSD_OPTIONAL_FLAG_ABSENT ? 0b0 : 0b1, 1);
|
||||||
|
|
||||||
|
#define MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(FLAG) \
|
||||||
|
if((FLAG) == ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_TRUE) { lastBit += vBitBufferAppendByte(raw, lastBit, 0b1 , 1);} \
|
||||||
|
else if((FLAG) == ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_FALSE) { lastBit += vBitBufferAppendByte(raw, lastBit, 0b0, 1);}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfAdditionalDataPayload(
|
||||||
|
tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit
|
||||||
|
) {
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0b0, 1); // enable extendable
|
||||||
|
//enable what present
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalData.asi15Present ? 0b1 : 0b0, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalData.diagnosticResult ? 0b1 : 0b0, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalData.crashInfoPresent ? 0b1 : 0b0, 1);
|
||||||
|
|
||||||
|
if (data->msdId == MSD_V_2) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalData.coordSystem ? 0b1 : 0b0,
|
||||||
|
1); // enable extendable
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data->additionalData.asi15Present) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, ((uint8_t *) &data->additionalData.asi15)[1], 3);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, ((uint8_t *) &data->additionalData.asi15)[0], 8);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data->additionalData.diagnosticResult) {
|
||||||
|
tMSD_DiagnosticResult *diagRes = data->additionalData.diagnosticResult;
|
||||||
|
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->micConnectionFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->micFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->rightSpeakerFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->leftSpeakerFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->speakersFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->ignitionLineFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->uimFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->statusIndicatorFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->batteryFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->batteryVoltageLow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->crashSensorFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->firmwareImageCorruption);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->commModuleInterfaceFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->gnssReceiverFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->raimProblem);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->gnssAntennaFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->commModuleFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->eventsMemoryOverflow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->crashProfileMemoryOverflow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->otherCriticalFailures);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(diagRes->otherNotCriticalFailures);
|
||||||
|
|
||||||
|
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->micConnectionFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->micFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->rightSpeakerFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->leftSpeakerFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->speakersFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->ignitionLineFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->uimFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->statusIndicatorFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->batteryFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->batteryVoltageLow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->crashSensorFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->firmwareImageCorruption);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->commModuleInterfaceFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->gnssReceiverFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->raimProblem);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->gnssAntennaFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->commModuleFailure);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->eventsMemoryOverflow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->crashProfileMemoryOverflow);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->otherCriticalFailures);
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(diagRes->otherNotCriticalFailures);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data->additionalData.crashInfoPresent) {
|
||||||
|
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashFront)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashLeftSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashRightSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashRear)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashWithRollover)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashFrontOrSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_PRESENT(data->additionalData.crashInfo.CrashOtherType)
|
||||||
|
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashFront)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashLeftSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashRightSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashRear)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashWithRollover)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashFrontOrSide)
|
||||||
|
MSD_TO_RAW_ADD_OPTIONAL_FLAG_VALUE(data->additionalData.crashInfo.CrashOtherType)
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
if (data->msdId == MSD_V_2) {
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalData.coordSystem, 2);
|
||||||
|
}
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfAdditionalDataOctetString(
|
||||||
|
tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit
|
||||||
|
) {
|
||||||
|
|
||||||
|
uint16_t octetStringOffset = lastBit + 8;
|
||||||
|
|
||||||
|
uint16_t octetStringBitsLength =
|
||||||
|
sEraGlonassMsdEncodeOfAdditionalDataPayload(data, raw, octetStringOffset) - (octetStringOffset);
|
||||||
|
|
||||||
|
uint8_t octetsCount = octetStringBitsLength / 8 + (octetStringBitsLength % 8 ? 1 : 0);
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, octetsCount, 8);
|
||||||
|
lastBit += octetsCount * 8;
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfAdditionalData(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfAdditionalDataOID(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfAdditionalDataOctetString(data, raw, lastBit);
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeOfMsdMainBody(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0b0, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->additionalDataPresent ? 0b1 : 0b0, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, 0b0, 1);
|
||||||
|
// lastBit+= vBitBufferAppendByte(raw,lastBit,data->MSD_Control.extraData,3);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.recentPos1 ? 0x01 : 0x00, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.recentPos2 ? 0x01 : 0x00, 1);
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, data->MSD_Control.passengers ? 0x01 : 0x00, 1);
|
||||||
|
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfControl(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfVin(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfPropulsion(data, raw, lastBit);
|
||||||
|
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfV1FreeSpaceFix(data, raw, lastBit);
|
||||||
|
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfTimestamp(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfLocation(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfDirection(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfRecentPositions(data, raw, lastBit);
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfPassengersCount(data, raw, lastBit);
|
||||||
|
|
||||||
|
if (data->additionalDataPresent) {
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfAdditionalData(data, raw, lastBit);
|
||||||
|
}
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
uint16_t sEraGlonassMsdEncodeV2BodyOctetString(tEraGlonassMsd_DataTypedef *data, unsigned char *raw, uint16_t lastBit) {
|
||||||
|
|
||||||
|
//length of msd block
|
||||||
|
uint16_t octetStringOffset = lastBit + 8;
|
||||||
|
uint16_t octetStringBitsLength =
|
||||||
|
sEraGlonassMsdEncodeOfMsdMainBody(data, raw, octetStringOffset) - (octetStringOffset);
|
||||||
|
uint8_t octetsCount = octetStringBitsLength / 8 + (octetStringBitsLength % 8 ? 1 : 0);
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(raw, lastBit, octetsCount, 8);
|
||||||
|
|
||||||
|
lastBit += octetsCount * 8;
|
||||||
|
|
||||||
|
return lastBit;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
uint16_t EraGlonassMsdEncode(tEraGlonassMsd *env, eEraGlonassMsd_Version msdVersion, uint8_t *encoded) {
|
||||||
|
env->MSD_Data.msdId = msdVersion;
|
||||||
|
|
||||||
|
memset(encoded, '\0', ERA_GLONASS_MSD_ENCODED_BUFFER_LENGTH); // Clear
|
||||||
|
|
||||||
|
uint16_t lastBit = 0;
|
||||||
|
|
||||||
|
lastBit += vBitBufferAppendByte(encoded, lastBit, env->MSD_Data.msdId, 8);
|
||||||
|
|
||||||
|
if (env->MSD_Data.msdId == MSD_V_1) {
|
||||||
|
lastBit = sEraGlonassMsdEncodeOfMsdMainBody(&env->MSD_Data, encoded, lastBit);
|
||||||
|
} else if (env->MSD_Data.msdId == MSD_V_2) {
|
||||||
|
lastBit = sEraGlonassMsdEncodeV2BodyOctetString(&env->MSD_Data, encoded, lastBit);
|
||||||
|
}
|
||||||
|
|
||||||
|
size_t byteLength = lastBit / 8 + (lastBit % 8 ? 1 : 0);
|
||||||
|
return byteLength;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -0,0 +1,177 @@
|
||||||
|
/*
|
||||||
|
* msd.h
|
||||||
|
*
|
||||||
|
* Created on: Oct 20, 2020
|
||||||
|
* Author: FICOM-IT LTD
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef INC_MSD_H_
|
||||||
|
#define INC_MSD_H_
|
||||||
|
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <UveosGostSettingsTypes.h>
|
||||||
|
#include "EcallTypes.h"
|
||||||
|
|
||||||
|
|
||||||
|
#define ERA_GLONASS_MSD_ENCODED_BUFFER_LENGTH 128
|
||||||
|
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
MSD_V_1 = 1,
|
||||||
|
MSD_V_2 = 2,
|
||||||
|
} eEraGlonassMsd_Version;
|
||||||
|
|
||||||
|
|
||||||
|
// @brief Control and status data
|
||||||
|
typedef struct {
|
||||||
|
uint16_t extraData; // 000 - additional data excluded, 010 - additional data included
|
||||||
|
uint16_t recentPos1; // True if previous location is available
|
||||||
|
uint16_t recentPos2; // True if previous location is available
|
||||||
|
uint16_t passengers; // True if passangers' number is available
|
||||||
|
uint16_t activation; // True if Automatic, False if manual eCall activation
|
||||||
|
uint16_t testCall; // True if test eCall, Flase if not test eCall
|
||||||
|
uint16_t posStatus; // True if GPS position can be trusted
|
||||||
|
uint16_t vehicleType; // Vehicle identification according to 2007/46/EC, 2002/24/EC
|
||||||
|
uint16_t includedTanks; // if True include status data (present/not present) for the relevant tank
|
||||||
|
} tEraGlonassMsd_Control;
|
||||||
|
|
||||||
|
// @brief Vehicle location stored in milli-arc-second
|
||||||
|
typedef struct {
|
||||||
|
int32_t lat; // Position latitude
|
||||||
|
int32_t lon; // Position longitude
|
||||||
|
} tEraGlonassMsd_GpsPos;
|
||||||
|
|
||||||
|
// @brief Vehicle location difference with the previous location stored in milli-arc-second
|
||||||
|
typedef struct {
|
||||||
|
uint16_t lat;
|
||||||
|
uint16_t lon;
|
||||||
|
} tEraGlonassMsd_PosDelta;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
ERA_GLONASS_MSD_OPTIONAL_FLAG_ABSENT = 0,
|
||||||
|
ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_TRUE = 1,
|
||||||
|
ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_FALSE = 2,
|
||||||
|
} tEraGlonassMsd_OptionalFlagState;
|
||||||
|
|
||||||
|
typedef uint8_t tEraGlonassMsd_OptionalFlag;
|
||||||
|
|
||||||
|
#define EraGlonassMsd_OptionalFlagClear(FLAG) (GLAG) = ERA_GLONASS_MSD_OPTIONAL_FLAG_ABSENT
|
||||||
|
#define EraGlonassMsd_OptionalFlagSet(FLAG, VALUE) (FLAG) = (VALUE) ? ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_TRUE : ERA_GLONASS_MSD_OPTIONAL_FLAG_PRESENT_FALSE
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashFront;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashLeftSide;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashRightSide;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashRear;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashWithRollover;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashSide;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashFrontOrSide;
|
||||||
|
tEraGlonassMsd_OptionalFlag CrashOtherType;
|
||||||
|
} tMSD_CrashInfo;
|
||||||
|
|
||||||
|
#define EraGlonassMsd_CrashInfoClear(ENV) memset(ENV, 0, sizeof(tMSD_CrashInfo))
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
tEraGlonassMsd_OptionalFlag micConnectionFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag micFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag rightSpeakerFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag leftSpeakerFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag speakersFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag ignitionLineFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag uimFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag statusIndicatorFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag batteryFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag batteryVoltageLow;
|
||||||
|
tEraGlonassMsd_OptionalFlag crashSensorFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag firmwareImageCorruption;
|
||||||
|
tEraGlonassMsd_OptionalFlag commModuleInterfaceFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag gnssReceiverFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag raimProblem;
|
||||||
|
tEraGlonassMsd_OptionalFlag gnssAntennaFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag commModuleFailure;
|
||||||
|
tEraGlonassMsd_OptionalFlag eventsMemoryOverflow;
|
||||||
|
tEraGlonassMsd_OptionalFlag crashProfileMemoryOverflow;
|
||||||
|
tEraGlonassMsd_OptionalFlag otherCriticalFailures;
|
||||||
|
tEraGlonassMsd_OptionalFlag otherNotCriticalFailures;
|
||||||
|
} tMSD_DiagnosticResult;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
ERA_GLONASS_MSD_COORDINATE_SYSTEM_TYPE_WGS84 = 0x01,
|
||||||
|
ERA_GLONASS_MSD_COORDINATE_SYSTEM_TYPE_PZ90 = 0x02,
|
||||||
|
} eEraGlonassMsd_CoordinateSystemType;
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
bool asi15Present;
|
||||||
|
bool crashInfoPresent;
|
||||||
|
|
||||||
|
uint16_t asi15;
|
||||||
|
tMSD_CrashInfo crashInfo;
|
||||||
|
eEraGlonassMsd_CoordinateSystemType coordSystem;
|
||||||
|
tMSD_DiagnosticResult *diagnosticResult;
|
||||||
|
} tEraGlonassMsd_AdditionalData;
|
||||||
|
|
||||||
|
|
||||||
|
// @brief MSD data structure
|
||||||
|
typedef struct {
|
||||||
|
uint16_t msdId; // MSD format version set to 1
|
||||||
|
uint16_t msgId; // Message identifier, starting with 1 for each new eCall session
|
||||||
|
tEraGlonassMsd_Control MSD_Control; // Control flags and data
|
||||||
|
uint16_t vin[18]; // VIN
|
||||||
|
uint16_t propulsion; // Vehicle propulsion storage type
|
||||||
|
uint32_t timestamp; // Timestamp
|
||||||
|
tEraGlonassMsd_GpsPos pos; // Vehicle position
|
||||||
|
uint8_t direction; // Vehicle heading, course over ground, course over north
|
||||||
|
tEraGlonassMsd_PosDelta MSD_PosDelta[2]; // Previous position delta
|
||||||
|
|
||||||
|
bool additionalDataPresent;
|
||||||
|
tEraGlonassMsd_AdditionalData additionalData; // Additional data
|
||||||
|
} tEraGlonassMsd_DataTypedef;
|
||||||
|
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
tEraGlonassMsd_DataTypedef MSD_Data;
|
||||||
|
// tEraGlonassMsd_GpsPos lastPos;
|
||||||
|
} tEraGlonassMsd;
|
||||||
|
|
||||||
|
|
||||||
|
//Must be called on create
|
||||||
|
void EraGlonassMsdInit(tEraGlonassMsd *env);
|
||||||
|
|
||||||
|
void EraGlonassMsd_ClearDiagnostic(tMSD_DiagnosticResult *env);
|
||||||
|
|
||||||
|
//Must be called when settings changed
|
||||||
|
void EraGlonassMsdSetPassengersNumber(tEraGlonassMsd *env, uint16_t value);
|
||||||
|
|
||||||
|
void EraGlonassMsdSetVehicleType(tEraGlonassMsd *env, eUveosGostVehicleType value);
|
||||||
|
|
||||||
|
void EraGlonassMsdSetVIN(tEraGlonassMsd *env, char *vin, uint8_t vinLen);
|
||||||
|
|
||||||
|
void EraGlonassMsdSetPropulsionStorageType(tEraGlonassMsd *env, eUveosGostVehiclePropulsionStorageType value);
|
||||||
|
|
||||||
|
//Must be called when gnss data changed
|
||||||
|
void EraGlonassMsdSetTimeStamp(tEraGlonassMsd *env, uint32_t timestamp);
|
||||||
|
|
||||||
|
void EraGlonassMsdSetPositionValue(
|
||||||
|
tEraGlonassMsd *env,
|
||||||
|
int32_t lonArc,
|
||||||
|
int32_t latArc,
|
||||||
|
uint16_t track,
|
||||||
|
uint8_t valid
|
||||||
|
);
|
||||||
|
|
||||||
|
void EraGlonassMsdNoGnssSetDefaults(tEraGlonassMsd *env);
|
||||||
|
|
||||||
|
|
||||||
|
//Called on emergency situation
|
||||||
|
void EraGlonassMsdSetDataEmergencySituationFlags(
|
||||||
|
tEraGlonassMsd *env,
|
||||||
|
int MSD_MSG_ID,
|
||||||
|
eEcallActivationType eCallType,
|
||||||
|
eEcallTestMode eCallTestMode
|
||||||
|
);
|
||||||
|
|
||||||
|
uint16_t EraGlonassMsdEncode(tEraGlonassMsd *env, eEraGlonassMsd_Version msdVersion, uint8_t *encoded);
|
||||||
|
|
||||||
|
|
||||||
|
#endif /* INC_MSD_H_ */
|
||||||
|
|
@ -0,0 +1,104 @@
|
||||||
|
/*
|
||||||
|
* UVEOS_GOST_Settings.h
|
||||||
|
*
|
||||||
|
* Created on: Apr 12, 2021
|
||||||
|
* Author: zemon
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef INC_UVEOS_GOST_SETTINGS_H_
|
||||||
|
#define INC_UVEOS_GOST_SETTINGS_H_
|
||||||
|
|
||||||
|
#include "stdint.h"
|
||||||
|
#include "stdbool.h"
|
||||||
|
#include "BaseTypes.h"
|
||||||
|
#include <UveosGostSettingsTypes.h>
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
bool ECALL_TEST_MODE; //совершать все вызовы на тестовый номер
|
||||||
|
uint8_t FULL_POWER_OFF_TIME;
|
||||||
|
uint16_t BIP_BACKLIGHT_MODE;
|
||||||
|
uint16_t BIP_GREEN_LED_POWER_MODE;
|
||||||
|
uint16_t BIP_RED_LED_POWER_MODE;
|
||||||
|
} tUveosNotGostSettings;
|
||||||
|
|
||||||
|
typedef struct {
|
||||||
|
|
||||||
|
//Radio settings
|
||||||
|
uint16_t RADIO_MUTE_DELAY; //*(МС) Задержка между установкой сигнала «радио mute» и началом проигрывания звука
|
||||||
|
uint16_t RADIO_UNMUTE_DELAY; //*(МС) Задержка между снятием сигнала «радио mute» и окончанием проигрывания звукае
|
||||||
|
|
||||||
|
//настройки сробатывания
|
||||||
|
uint8_t CRASH_SIGNAL_INTERNAL; //* Только транспортные средства категорий М1 и N1 — для определения события аварии используется встроенный измеритель ускорения
|
||||||
|
uint8_t CRASH_SIGNAL_EXTERNAL; //* Только транспортные средства категорий М1 и N1 — для определения факта ДТП используется внешний датчик в транспортном средстве
|
||||||
|
float ASI15_TRESHOLD; //* Только транспортные средства категорий М1 и N1 — порог срабатывания датчика автоматической идентификации события ДТП
|
||||||
|
uint16_t SOS_BUTTON_TIME; //* (МС) Время нажатия на кнопку «Экстренный вызов» для активации режима «Экстренный вызов»
|
||||||
|
uint8_t ECALL_NO_AUTOMATIC_TRIGGERING; //Параметр используется для отмены функции автоматической инициации экстренного вызова
|
||||||
|
|
||||||
|
//Параметры дозвона
|
||||||
|
tString16 ECALL_TEST_NUMBER; //номер для тестового вызова
|
||||||
|
uint16_t CCFT; //(МИН) Длительность счетчика автоматического прекращения звонка (60 м)
|
||||||
|
uint16_t ECALL_DIAL_DURATION; //(МИН) Общая продолжительность дозвона при инициации экстренного вызова
|
||||||
|
uint64_t MSD_MAX_TRANSMISSION_TIME; //(CEK) Максимальная длительность передачи MSD (20 с)
|
||||||
|
uint8_t ECALL_MANUAL_CAN_CANCEL; //TRUE — экстренный вызов, инициированный вручную, может быть прекращен со стороны пользователя
|
||||||
|
|
||||||
|
//Ожидание
|
||||||
|
uint64_t CALL_AUTO_ANSWER_TIME; //(МИН)Промежуток времени после завершения экстренного вызова, в течение которого УСВ автоматически отвечает на входящие звонки
|
||||||
|
|
||||||
|
//Веремя регестрации в сети
|
||||||
|
uint64_t NAD_DEREGISTRATION_TIME; //(МИН) Время, после которого коммуникационный модуль GSM и UMTS прекращает регистрацию в сети
|
||||||
|
uint64_t POST_TEST_REGISTRATION_TIME; //Промежуток времени, в течение которого УСВ остается зарегистрированной в сети после передачи результатов тестирования оператору системы
|
||||||
|
|
||||||
|
//Оптравка экстренных ситуаций из памяти
|
||||||
|
tString16 ECALL_SMS_FALLBACK_NUMBER; //Номер, по которому УСВ посылает SMS с МНД при ошибке передачи МНД посредством in-band модема и по запросу от оператора системы. Определяется оператором национальной системы реагирования на аварии
|
||||||
|
uint64_t INT_MEM_TRANSMIT_INTERVAL; //интервал времени между повторными попытками отправки мнд из памяти
|
||||||
|
uint16_t INT_MEM_TRANSMIT_ATTEMPTS; //количество попыток отпкравки мнд из памяти
|
||||||
|
|
||||||
|
//Попытки дозвона
|
||||||
|
uint16_t ECALL_AUTO_DIAL_ATTEMPTS; //Только транспортные средства категорий М1 и N1 — число попыток дозвона при автоматически инициированном экстренном вызове. Не может быть установлено в «0»
|
||||||
|
uint16_t ECALL_MANUAL_DIAL_ATTEMPTS; //Число попыток дозвона при экстренном вызове, инициированном вручную. Значение не может устанавливаться в «0»
|
||||||
|
|
||||||
|
|
||||||
|
//Testing settings - тестирование и гараж
|
||||||
|
// Если УСВ была зарегистрирована в сети посредством нажатия на кнопку «Дополнительные функции»,
|
||||||
|
// то последующая регистрация УСВ в сети при нажатии на кнопку «Дополнительные функции» возможна
|
||||||
|
// не ранее чем через данный промежуток времени. Если значение установлено в «0»,
|
||||||
|
// то ограничений на последующую регистрацию УСВ в сети не накладывается
|
||||||
|
uint16_t TEST_REGISTRATION_PERIOD;
|
||||||
|
uint16_t TEST_MODE_END_DISTANCE; //(Метры)Дистанция, на которой режим тестирования выключается автоматически
|
||||||
|
uint16_t GARAGE_MODE_END_DISTANCE; //*(Метры) Дистанция, на которой режим «Автосервис» выключается автоматически
|
||||||
|
|
||||||
|
|
||||||
|
//Emergence acceleration profile - полностью используеться в коплектации доп оборудования
|
||||||
|
uint16_t IGNITION_OFF_FOLLOW_UP_TIME1; //* Промежуток времени, в течение которого осуществляется запись профиля ускорения при ДТП при выключенном зажигании
|
||||||
|
uint16_t IGNITION_OFF_FOLLOW_UP_TIME2; //* Промежуток времени, в течение которого осуществляется определение события аварии при выключенном зажигании
|
||||||
|
uint16_t CRASH_RECORD_TIME; //* Время записи информации о профиле ускорения при ДТП
|
||||||
|
uint16_t CRASH_RECORD_RESOLUTION; //* Дискретность записи профиля ускорения при ДТП
|
||||||
|
uint16_t CRASH_PRE_RECORD_TIME; //* Время записи информации о профиле ускорения до того, как событие ДТП наступило
|
||||||
|
uint16_t CRASH_PRE_RECORD_RESOLUTION; //* Продолжительность одного отсчета при записи профиля ускорения до того, как событие ДТП наступило
|
||||||
|
|
||||||
|
|
||||||
|
//Other settings - параметры навигацонного приемника - используються при инициализации приемника, а так же записываются в него после их изменения (все без участия УВЕОС,платформозависомо)
|
||||||
|
uint16_t GNSS_POWER_OFF_TIME; //* Промежуток времени, через который отключается питание приемника ГНСС после выключения зажигания
|
||||||
|
uint16_t GNSS_DATA_RATE; //Темп выдачи данных приемником ГНСС
|
||||||
|
uint16_t GNSS_MIN_ELEVATION; //* Минимальное значение угла возвышения (угла отсечки) навигационных космических аппаратов
|
||||||
|
|
||||||
|
|
||||||
|
//Vehicle parameters - Параметры транспортного средства, записываються в МНД
|
||||||
|
tString32 VIN; //18
|
||||||
|
|
||||||
|
uint16_t VEHICLE_TYPE; //Категория транспортного средства
|
||||||
|
uint8_t VEHICLE_PROPULSION_STORAGE_TYPE; //Тип энергоносителя
|
||||||
|
uint8_t VEHICLE_PASSENGERS_NUMBER; //Количество пасажиров
|
||||||
|
|
||||||
|
|
||||||
|
//неиспользуються, у нас пины определены заранее
|
||||||
|
uint16_t GARAGE_MODE_PIN; //*номер пина на котором поднимаеться сигнал в случае прехода в режим гараж
|
||||||
|
uint16_t ECALL_MODE_PIN; //*номер пина на котором поднимаеться сигнал в случае прехода в режим ecall
|
||||||
|
|
||||||
|
tUveosNotGostSettings notGost;
|
||||||
|
|
||||||
|
} tUveosGostSettings;
|
||||||
|
|
||||||
|
void vUveosGostSettingsInitDefaults(tUveosGostSettings *gostSettings);
|
||||||
|
|
||||||
|
#endif /* INC_UVEOS_GOST_SETTINGS_H_ */
|
||||||
|
|
@ -0,0 +1,50 @@
|
||||||
|
/*
|
||||||
|
* UVEOS_GOST_SettingsEnums.h
|
||||||
|
*
|
||||||
|
* Created on: Apr 12, 2021
|
||||||
|
* Author: zemon
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef INC_UVEOS_GOST_SETTINGSENUMS_H_
|
||||||
|
#define INC_UVEOS_GOST_SETTINGSENUMS_H_
|
||||||
|
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
UVEOS_GOST_NONE,
|
||||||
|
UVEOS_GOST_PIN_1,
|
||||||
|
UVEOS_GOST_PIN_2,
|
||||||
|
UVEOS_GOST_PIN_3,
|
||||||
|
UVEOS_GOST_PIN_4,
|
||||||
|
UVEOS_GOST_PIN_5,
|
||||||
|
UVEOS_GOST_PIN_6,
|
||||||
|
UVEOS_GOST_PIN_7,
|
||||||
|
UVEOS_GOST_PIN_8
|
||||||
|
} eUveosGostPin;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
UVEOS_GOST_PASSENGER_VEHICLE_CLASS_M1 = 1,
|
||||||
|
UVEOS_GOST_BUSES_AND_COACHES_CLASS_M2 = 2,
|
||||||
|
UVEOS_GOST_BUSES_AND_COACHES_CLASS_M3 = 3,
|
||||||
|
UVEOS_GOST_LIGHT_COMMERCIAL_VEHICLES_CLASS_N1 = 4,
|
||||||
|
UVEOS_GOST_HEAVY_DUTY_VEHICLES_CLASS_N2 = 5,
|
||||||
|
UVEOS_GOST_HEAVY_DUTY_VEHICLES_CLASS_N3 = 6,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L1E = 7,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L2E = 8,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L3E = 9,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L4E = 10,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L5E = 11,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L6E = 12,
|
||||||
|
UVEOS_GOST_MOTORCYCLE_CLASS_L7E = 13
|
||||||
|
} eUveosGostVehicleType;
|
||||||
|
|
||||||
|
typedef enum {
|
||||||
|
UVEOS_GOST_GASOLINE_TANK_PRESENT = 32,
|
||||||
|
UVEOS_GOST_DIESEL_TANK_PRESENT = 16,
|
||||||
|
UVEOS_GOST_COMPRESSED_NATURAL_GAS = 8,
|
||||||
|
UVEOS_GOST_LIQUID_PROPANE_GAS = 4,
|
||||||
|
UVEOS_GOST_ELECTRIC_ENERGY_STORAGE = 2,
|
||||||
|
UVEOS_GOST_HYDROGEN_STORAGE = 1
|
||||||
|
} eUveosGostVehiclePropulsionStorageType;
|
||||||
|
|
||||||
|
|
||||||
|
#endif /* INC_UVEOS_GOST_SETTINGSENUMS_H_ */
|
||||||
File diff suppressed because it is too large
Load Diff
|
|
@ -0,0 +1,306 @@
|
||||||
|
/*
|
||||||
|
Copyright (c) 2009-2017 Dave Gamble and cJSON contributors
|
||||||
|
|
||||||
|
Permission is hereby granted, free of charge, to any person obtaining a copy
|
||||||
|
of this software and associated documentation files (the "Software"), to deal
|
||||||
|
in the Software without restriction, including without limitation the rights
|
||||||
|
to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
||||||
|
copies of the Software, and to permit persons to whom the Software is
|
||||||
|
furnished to do so, subject to the following conditions:
|
||||||
|
|
||||||
|
The above copyright notice and this permission notice shall be included in
|
||||||
|
all copies or substantial portions of the Software.
|
||||||
|
|
||||||
|
THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
||||||
|
IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
||||||
|
FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
||||||
|
AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
||||||
|
LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
||||||
|
OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
||||||
|
THE SOFTWARE.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#ifndef cJSON__h
|
||||||
|
#define cJSON__h
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
extern "C"
|
||||||
|
{
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if !defined(__WINDOWS__) && (defined(WIN32) || defined(WIN64) || defined(_MSC_VER) || defined(_WIN32))
|
||||||
|
#define __WINDOWS__
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#ifdef __WINDOWS__
|
||||||
|
|
||||||
|
/* When compiling for windows, we specify a specific calling convention to avoid issues where we are being called from a project with a different default calling convention. For windows you have 3 define options:
|
||||||
|
|
||||||
|
CJSON_HIDE_SYMBOLS - Define this in the case where you don't want to ever dllexport symbols
|
||||||
|
CJSON_EXPORT_SYMBOLS - Define this on library build when you want to dllexport symbols (default)
|
||||||
|
CJSON_IMPORT_SYMBOLS - Define this if you want to dllimport symbol
|
||||||
|
|
||||||
|
For *nix builds that support visibility attribute, you can define similar behavior by
|
||||||
|
|
||||||
|
setting default visibility to hidden by adding
|
||||||
|
-fvisibility=hidden (for gcc)
|
||||||
|
or
|
||||||
|
-xldscope=hidden (for sun cc)
|
||||||
|
to CFLAGS
|
||||||
|
|
||||||
|
then using the CJSON_API_VISIBILITY flag to "export" the same symbols the way CJSON_EXPORT_SYMBOLS does
|
||||||
|
|
||||||
|
*/
|
||||||
|
|
||||||
|
#define CJSON_CDECL __cdecl
|
||||||
|
#define CJSON_STDCALL __stdcall
|
||||||
|
|
||||||
|
/* export symbols by default, this is necessary for copy pasting the C and header file */
|
||||||
|
#if !defined(CJSON_HIDE_SYMBOLS) && !defined(CJSON_IMPORT_SYMBOLS) && !defined(CJSON_EXPORT_SYMBOLS)
|
||||||
|
#define CJSON_EXPORT_SYMBOLS
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#if defined(CJSON_HIDE_SYMBOLS)
|
||||||
|
#define CJSON_PUBLIC(type) type CJSON_STDCALL
|
||||||
|
#elif defined(CJSON_EXPORT_SYMBOLS)
|
||||||
|
#define CJSON_PUBLIC(type) __declspec(dllexport) type CJSON_STDCALL
|
||||||
|
#elif defined(CJSON_IMPORT_SYMBOLS)
|
||||||
|
#define CJSON_PUBLIC(type) __declspec(dllimport) type CJSON_STDCALL
|
||||||
|
#endif
|
||||||
|
#else /* !__WINDOWS__ */
|
||||||
|
#define CJSON_CDECL
|
||||||
|
#define CJSON_STDCALL
|
||||||
|
|
||||||
|
#if (defined(__GNUC__) || defined(__SUNPRO_CC) || defined (__SUNPRO_C)) && defined(CJSON_API_VISIBILITY)
|
||||||
|
#define CJSON_PUBLIC(type) __attribute__((visibility("default"))) type
|
||||||
|
#else
|
||||||
|
#define CJSON_PUBLIC(type) type
|
||||||
|
#endif
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* project version */
|
||||||
|
#define CJSON_VERSION_MAJOR 1
|
||||||
|
#define CJSON_VERSION_MINOR 7
|
||||||
|
#define CJSON_VERSION_PATCH 18
|
||||||
|
|
||||||
|
#include <stddef.h>
|
||||||
|
|
||||||
|
/* cJSON Types: */
|
||||||
|
#define cJSON_Invalid (0)
|
||||||
|
#define cJSON_False (1 << 0)
|
||||||
|
#define cJSON_True (1 << 1)
|
||||||
|
#define cJSON_NULL (1 << 2)
|
||||||
|
#define cJSON_Number (1 << 3)
|
||||||
|
#define cJSON_String (1 << 4)
|
||||||
|
#define cJSON_Array (1 << 5)
|
||||||
|
#define cJSON_Object (1 << 6)
|
||||||
|
#define cJSON_Raw (1 << 7) /* raw json */
|
||||||
|
|
||||||
|
#define cJSON_IsReference 256
|
||||||
|
#define cJSON_StringIsConst 512
|
||||||
|
|
||||||
|
/* The cJSON structure: */
|
||||||
|
typedef struct cJSON
|
||||||
|
{
|
||||||
|
/* next/prev allow you to walk array/object chains. Alternatively, use GetArraySize/GetArrayItem/GetObjectItem */
|
||||||
|
struct cJSON *next;
|
||||||
|
struct cJSON *prev;
|
||||||
|
/* An array or object item will have a child pointer pointing to a chain of the items in the array/object. */
|
||||||
|
struct cJSON *child;
|
||||||
|
|
||||||
|
/* The type of the item, as above. */
|
||||||
|
int type;
|
||||||
|
|
||||||
|
/* The item's string, if type==cJSON_String and type == cJSON_Raw */
|
||||||
|
char *valuestring;
|
||||||
|
/* writing to valueint is DEPRECATED, use cJSON_SetNumberValue instead */
|
||||||
|
int valueint;
|
||||||
|
/* The item's number, if type==cJSON_Number */
|
||||||
|
double valuedouble;
|
||||||
|
|
||||||
|
/* The item's name string, if this item is the child of, or is in the list of subitems of an object. */
|
||||||
|
char *string;
|
||||||
|
} cJSON;
|
||||||
|
|
||||||
|
typedef struct cJSON_Hooks
|
||||||
|
{
|
||||||
|
/* malloc/free are CDECL on Windows regardless of the default calling convention of the compiler, so ensure the hooks allow passing those functions directly. */
|
||||||
|
void *(CJSON_CDECL *malloc_fn)(size_t sz);
|
||||||
|
void (CJSON_CDECL *free_fn)(void *ptr);
|
||||||
|
} cJSON_Hooks;
|
||||||
|
|
||||||
|
typedef int cJSON_bool;
|
||||||
|
|
||||||
|
/* Limits how deeply nested arrays/objects can be before cJSON rejects to parse them.
|
||||||
|
* This is to prevent stack overflows. */
|
||||||
|
#ifndef CJSON_NESTING_LIMIT
|
||||||
|
#define CJSON_NESTING_LIMIT 1000
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* Limits the length of circular references can be before cJSON rejects to parse them.
|
||||||
|
* This is to prevent stack overflows. */
|
||||||
|
#ifndef CJSON_CIRCULAR_LIMIT
|
||||||
|
#define CJSON_CIRCULAR_LIMIT 10000
|
||||||
|
#endif
|
||||||
|
|
||||||
|
/* returns the version of cJSON as a string */
|
||||||
|
CJSON_PUBLIC(const char*) cJSON_Version(void);
|
||||||
|
|
||||||
|
/* Supply malloc, realloc and free functions to cJSON */
|
||||||
|
CJSON_PUBLIC(void) cJSON_InitHooks(cJSON_Hooks* hooks);
|
||||||
|
|
||||||
|
/* Memory Management: the caller is always responsible to free the results from all variants of cJSON_Parse (with cJSON_Delete) and cJSON_Print (with stdlib free, cJSON_Hooks.free_fn, or cJSON_free as appropriate). The exception is cJSON_PrintPreallocated, where the caller has full responsibility of the buffer. */
|
||||||
|
/* Supply a block of JSON, and this returns a cJSON object you can interrogate. */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_Parse(const char *value);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_ParseWithLength(const char *value, size_t buffer_length);
|
||||||
|
/* ParseWithOpts allows you to require (and check) that the JSON is null terminated, and to retrieve the pointer to the final byte parsed. */
|
||||||
|
/* If you supply a ptr in return_parse_end and parsing fails, then return_parse_end will contain a pointer to the error so will match cJSON_GetErrorPtr(). */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_ParseWithOpts(const char *value, const char **return_parse_end, cJSON_bool require_null_terminated);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_ParseWithLengthOpts(const char *value, size_t buffer_length, const char **return_parse_end, cJSON_bool require_null_terminated);
|
||||||
|
|
||||||
|
/* Render a cJSON entity to text for transfer/storage. */
|
||||||
|
CJSON_PUBLIC(char *) cJSON_Print(const cJSON *item);
|
||||||
|
/* Render a cJSON entity to text for transfer/storage without any formatting. */
|
||||||
|
CJSON_PUBLIC(char *) cJSON_PrintUnformatted(const cJSON *item);
|
||||||
|
/* Render a cJSON entity to text using a buffered strategy. prebuffer is a guess at the final size. guessing well reduces reallocation. fmt=0 gives unformatted, =1 gives formatted */
|
||||||
|
CJSON_PUBLIC(char *) cJSON_PrintBuffered(const cJSON *item, int prebuffer, cJSON_bool fmt);
|
||||||
|
/* Render a cJSON entity to text using a buffer already allocated in memory with given length. Returns 1 on success and 0 on failure. */
|
||||||
|
/* NOTE: cJSON is not always 100% accurate in estimating how much memory it will use, so to be safe allocate 5 bytes more than you actually need */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_PrintPreallocated(cJSON *item, char *buffer, const int length, const cJSON_bool format);
|
||||||
|
/* Delete a cJSON entity and all subentities. */
|
||||||
|
CJSON_PUBLIC(void) cJSON_Delete(cJSON *item);
|
||||||
|
|
||||||
|
/* Returns the number of items in an array (or object). */
|
||||||
|
CJSON_PUBLIC(int) cJSON_GetArraySize(const cJSON *array);
|
||||||
|
/* Retrieve item number "index" from array "array". Returns NULL if unsuccessful. */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_GetArrayItem(const cJSON *array, int index);
|
||||||
|
/* Get item "string" from object. Case insensitive. */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_GetObjectItem(const cJSON * const object, const char * const string);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_GetObjectItemCaseSensitive(const cJSON * const object, const char * const string);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_HasObjectItem(const cJSON *object, const char *string);
|
||||||
|
/* For analysing failed parses. This returns a pointer to the parse error. You'll probably need to look a few chars back to make sense of it. Defined when cJSON_Parse() returns 0. 0 when cJSON_Parse() succeeds. */
|
||||||
|
CJSON_PUBLIC(const char *) cJSON_GetErrorPtr(void);
|
||||||
|
|
||||||
|
/* Check item type and return its value */
|
||||||
|
CJSON_PUBLIC(char *) cJSON_GetStringValue(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(double) cJSON_GetNumberValue(const cJSON * const item);
|
||||||
|
|
||||||
|
/* These functions check the type of an item */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsInvalid(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsFalse(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsTrue(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsBool(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsNull(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsNumber(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsString(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsArray(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsObject(const cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_IsRaw(const cJSON * const item);
|
||||||
|
|
||||||
|
/* These calls create a cJSON item of the appropriate type. */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateNull(void);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateTrue(void);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateFalse(void);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateBool(cJSON_bool boolean);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateNumber(double num);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateString(const char *string);
|
||||||
|
/* raw json */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateRaw(const char *raw);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateArray(void);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateObject(void);
|
||||||
|
|
||||||
|
/* Create a string where valuestring references a string so
|
||||||
|
* it will not be freed by cJSON_Delete */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateStringReference(const char *string);
|
||||||
|
/* Create an object/array that only references it's elements so
|
||||||
|
* they will not be freed by cJSON_Delete */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateObjectReference(const cJSON *child);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateArrayReference(const cJSON *child);
|
||||||
|
|
||||||
|
/* These utilities create an Array of count items.
|
||||||
|
* The parameter count cannot be greater than the number of elements in the number array, otherwise array access will be out of bounds.*/
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateIntArray(const int *numbers, int count);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateFloatArray(const float *numbers, int count);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateDoubleArray(const double *numbers, int count);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_CreateStringArray(const char *const *strings, int count);
|
||||||
|
|
||||||
|
/* Append item to the specified array/object. */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_AddItemToArray(cJSON *array, cJSON *item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_AddItemToObject(cJSON *object, const char *string, cJSON *item);
|
||||||
|
/* Use this when string is definitely const (i.e. a literal, or as good as), and will definitely survive the cJSON object.
|
||||||
|
* WARNING: When this function was used, make sure to always check that (item->type & cJSON_StringIsConst) is zero before
|
||||||
|
* writing to `item->string` */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_AddItemToObjectCS(cJSON *object, const char *string, cJSON *item);
|
||||||
|
/* Append reference to item to the specified array/object. Use this when you want to add an existing cJSON to a new cJSON, but don't want to corrupt your existing cJSON. */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_AddItemReferenceToArray(cJSON *array, cJSON *item);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_AddItemReferenceToObject(cJSON *object, const char *string, cJSON *item);
|
||||||
|
|
||||||
|
/* Remove/Detach items from Arrays/Objects. */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_DetachItemViaPointer(cJSON *parent, cJSON * const item);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_DetachItemFromArray(cJSON *array, int which);
|
||||||
|
CJSON_PUBLIC(void) cJSON_DeleteItemFromArray(cJSON *array, int which);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_DetachItemFromObject(cJSON *object, const char *string);
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_DetachItemFromObjectCaseSensitive(cJSON *object, const char *string);
|
||||||
|
CJSON_PUBLIC(void) cJSON_DeleteItemFromObject(cJSON *object, const char *string);
|
||||||
|
CJSON_PUBLIC(void) cJSON_DeleteItemFromObjectCaseSensitive(cJSON *object, const char *string);
|
||||||
|
|
||||||
|
/* Update array items. */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_InsertItemInArray(cJSON *array, int which, cJSON *newitem); /* Shifts pre-existing items to the right. */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_ReplaceItemViaPointer(cJSON * const parent, cJSON * const item, cJSON * replacement);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_ReplaceItemInArray(cJSON *array, int which, cJSON *newitem);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_ReplaceItemInObject(cJSON *object,const char *string,cJSON *newitem);
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_ReplaceItemInObjectCaseSensitive(cJSON *object,const char *string,cJSON *newitem);
|
||||||
|
|
||||||
|
/* Duplicate a cJSON item */
|
||||||
|
CJSON_PUBLIC(cJSON *) cJSON_Duplicate(const cJSON *item, cJSON_bool recurse);
|
||||||
|
/* Duplicate will create a new, identical cJSON item to the one you pass, in new memory that will
|
||||||
|
* need to be released. With recurse!=0, it will duplicate any children connected to the item.
|
||||||
|
* The item->next and ->prev pointers are always zero on return from Duplicate. */
|
||||||
|
/* Recursively compare two cJSON items for equality. If either a or b is NULL or invalid, they will be considered unequal.
|
||||||
|
* case_sensitive determines if object keys are treated case sensitive (1) or case insensitive (0) */
|
||||||
|
CJSON_PUBLIC(cJSON_bool) cJSON_Compare(const cJSON * const a, const cJSON * const b, const cJSON_bool case_sensitive);
|
||||||
|
|
||||||
|
/* Minify a strings, remove blank characters(such as ' ', '\t', '\r', '\n') from strings.
|
||||||
|
* The input pointer json cannot point to a read-only address area, such as a string constant,
|
||||||
|
* but should point to a readable and writable address area. */
|
||||||
|
CJSON_PUBLIC(void) cJSON_Minify(char *json);
|
||||||
|
|
||||||
|
/* Helper functions for creating and adding items to an object at the same time.
|
||||||
|
* They return the added item or NULL on failure. */
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddNullToObject(cJSON * const object, const char * const name);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddTrueToObject(cJSON * const object, const char * const name);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddFalseToObject(cJSON * const object, const char * const name);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddBoolToObject(cJSON * const object, const char * const name, const cJSON_bool boolean);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddNumberToObject(cJSON * const object, const char * const name, const double number);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddStringToObject(cJSON * const object, const char * const name, const char * const string);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddRawToObject(cJSON * const object, const char * const name, const char * const raw);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddObjectToObject(cJSON * const object, const char * const name);
|
||||||
|
CJSON_PUBLIC(cJSON*) cJSON_AddArrayToObject(cJSON * const object, const char * const name);
|
||||||
|
|
||||||
|
/* When assigning an integer value, it needs to be propagated to valuedouble too. */
|
||||||
|
#define cJSON_SetIntValue(object, number) ((object) ? (object)->valueint = (object)->valuedouble = (number) : (number))
|
||||||
|
/* helper for the cJSON_SetNumberValue macro */
|
||||||
|
CJSON_PUBLIC(double) cJSON_SetNumberHelper(cJSON *object, double number);
|
||||||
|
#define cJSON_SetNumberValue(object, number) ((object != NULL) ? cJSON_SetNumberHelper(object, (double)number) : (number))
|
||||||
|
/* Change the valuestring of a cJSON_String object, only takes effect when type of object is cJSON_String */
|
||||||
|
CJSON_PUBLIC(char*) cJSON_SetValuestring(cJSON *object, const char *valuestring);
|
||||||
|
|
||||||
|
/* If the object is not a boolean type this does nothing and returns cJSON_Invalid else it returns the new type*/
|
||||||
|
#define cJSON_SetBoolValue(object, boolValue) ( \
|
||||||
|
(object != NULL && ((object)->type & (cJSON_False|cJSON_True))) ? \
|
||||||
|
(object)->type=((object)->type &(~(cJSON_False|cJSON_True)))|((boolValue)?cJSON_True:cJSON_False) : \
|
||||||
|
cJSON_Invalid\
|
||||||
|
)
|
||||||
|
|
||||||
|
/* Macro for iterating over an array or object */
|
||||||
|
#define cJSON_ArrayForEach(element, array) for(element = (array != NULL) ? (array)->child : NULL; element != NULL; element = element->next)
|
||||||
|
|
||||||
|
/* malloc/free objects using the malloc/free functions that have been set with cJSON_InitHooks */
|
||||||
|
CJSON_PUBLIC(void *) cJSON_malloc(size_t size);
|
||||||
|
CJSON_PUBLIC(void) cJSON_free(void *object);
|
||||||
|
|
||||||
|
#ifdef __cplusplus
|
||||||
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
|
#endif
|
||||||
|
|
@ -0,0 +1,243 @@
|
||||||
|
//
|
||||||
|
// Created by cfif on 09.09.2025.
|
||||||
|
//
|
||||||
|
#include <stdio.h>
|
||||||
|
#include <string.h>
|
||||||
|
#include <time.h>
|
||||||
|
#include "cJSON.h"
|
||||||
|
#include "EraGlonassMsd.h"
|
||||||
|
#include "AsciiStringAssmeblingUtils.h"
|
||||||
|
|
||||||
|
char cConvertDecToMilliArcSec(double dec, int32_t *mArcs, double *gradus) {
|
||||||
|
int deg = 0, min = 0;
|
||||||
|
double sec = 0.0;
|
||||||
|
double _dec = dec;
|
||||||
|
|
||||||
|
deg = (int) (_dec / 100);
|
||||||
|
min = (int) (_dec) - (deg * 100);
|
||||||
|
|
||||||
|
sec = (double) (_dec - min - 100 * deg) * 60.0;
|
||||||
|
|
||||||
|
if (gradus != NULL) *gradus = deg + min / 60.0 + sec / 3600.0;
|
||||||
|
|
||||||
|
if (mArcs != NULL) *mArcs = (int) (deg * 3600 + min * 60) * 1000 + (int) (sec * 1000); // mArcseconds
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
char cConvertDecToMilliArcSecFromDegMin(double deg, double min, int32_t *mArcs, double *gradus) {
|
||||||
|
double sec = 0.0;
|
||||||
|
|
||||||
|
if (gradus != NULL) *gradus = deg + min / 60.0 + sec / 3600.0;
|
||||||
|
|
||||||
|
if (mArcs != NULL) *mArcs = (int) (deg * 3600 + min * 60) * 1000 + (int) (sec * 1000); // mArcseconds
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
int main(int argc, char *argv[]) {
|
||||||
|
|
||||||
|
// const char *json_string = "{\"timestamp\": \"2024-06-26T09:36:42+05:06\", \"coordinate\": \"56 33.13N 060 54.13E\", \"phone\": \"88312622039\", \"id\": \"00182\" }";
|
||||||
|
|
||||||
|
if (argc != 3) {
|
||||||
|
printf("Usage: conv fileIn fileOut\n");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
FILE *input_file = fopen(argv[1], "r");
|
||||||
|
if (input_file == NULL) {
|
||||||
|
printf("Error: Failed to open file %s\n", argv[1]);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
#define BUFFER_SIZE 4096
|
||||||
|
char json_string[BUFFER_SIZE] = {0};
|
||||||
|
|
||||||
|
size_t bytes_read = fread(json_string, 1, BUFFER_SIZE, input_file);
|
||||||
|
|
||||||
|
printf("Read %zu bytes:\n", bytes_read);
|
||||||
|
printf("%.*s\n", (int)bytes_read, json_string);
|
||||||
|
|
||||||
|
fclose(input_file);
|
||||||
|
|
||||||
|
tEraGlonassMsd msd;
|
||||||
|
|
||||||
|
EraGlonassMsdInit(&msd);
|
||||||
|
EraGlonassMsdSetDataEmergencySituationFlags(&msd, 1, MANUAL_ACTIVATION, EMERGENCY_CALL);
|
||||||
|
EraGlonassMsdSetVehicleType(&msd, 0);
|
||||||
|
EraGlonassMsdSetPassengersNumber(&msd, 1);
|
||||||
|
EraGlonassMsdSetPropulsionStorageType(&msd, 0);
|
||||||
|
|
||||||
|
cJSON *json = cJSON_Parse(json_string);
|
||||||
|
|
||||||
|
if (json == NULL) {
|
||||||
|
printf("Error parsing JSON\n");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
cJSON *timestampJS = cJSON_GetObjectItemCaseSensitive(json, "timestamp");
|
||||||
|
cJSON *coordinateJS = cJSON_GetObjectItemCaseSensitive(json, "coordinate");
|
||||||
|
cJSON *phoneJS = cJSON_GetObjectItemCaseSensitive(json, "phone");
|
||||||
|
cJSON *idJS = cJSON_GetObjectItemCaseSensitive(json, "id");
|
||||||
|
|
||||||
|
if (cJSON_IsString(timestampJS) && (timestampJS->valuestring != NULL)) {
|
||||||
|
printf("timestamp (JSON): %s\n", timestampJS->valuestring);
|
||||||
|
|
||||||
|
struct tm timeinfo = {0};
|
||||||
|
int timezone_hour_offset;
|
||||||
|
int timezone_min_offset;
|
||||||
|
char timezone_sign;
|
||||||
|
|
||||||
|
int result = sscanf(timestampJS->valuestring, "%d-%d-%dT%d:%d:%d%c%d:%d",
|
||||||
|
&timeinfo.tm_year, &timeinfo.tm_mon, &timeinfo.tm_mday,
|
||||||
|
&timeinfo.tm_hour, &timeinfo.tm_min, &timeinfo.tm_sec,
|
||||||
|
&timezone_sign, &timezone_hour_offset, &timezone_min_offset);
|
||||||
|
|
||||||
|
if (result >= 6) {
|
||||||
|
timeinfo.tm_year -= 1900;
|
||||||
|
timeinfo.tm_mon -= 1;
|
||||||
|
|
||||||
|
time_t timestamp = mktime(&timeinfo);
|
||||||
|
|
||||||
|
if (result >= 9) {
|
||||||
|
int offset_seconds = timezone_hour_offset * 3600 + timezone_min_offset * 60;
|
||||||
|
if (timezone_sign == '-') {
|
||||||
|
timestamp += offset_seconds;
|
||||||
|
} else if (timezone_sign == '+') {
|
||||||
|
timestamp -= offset_seconds;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
printf("Parsing timestamp (UTC) error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
EraGlonassMsdSetTimeStamp(&msd, timestamp);
|
||||||
|
|
||||||
|
printf("timestamp: %u\n", msd.MSD_Data.timestamp);
|
||||||
|
|
||||||
|
} else {
|
||||||
|
printf("Parsing timestamp error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
} else {
|
||||||
|
printf("Parsing JSON timestamp error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cJSON_IsString(coordinateJS) && (coordinateJS->valuestring != NULL)) {
|
||||||
|
printf("coordinate (JSON): %s\n", coordinateJS->valuestring);
|
||||||
|
|
||||||
|
int lat_deg, lon_deg;
|
||||||
|
double lat_min, lon_min;
|
||||||
|
char lat_dir, lon_dir;
|
||||||
|
|
||||||
|
char tmp[1024] = {0};
|
||||||
|
int len = 0;
|
||||||
|
|
||||||
|
for (int i = 0; i < strlen(coordinateJS->valuestring); ++i) {
|
||||||
|
|
||||||
|
if ((coordinateJS->valuestring[i + 1] == 'N') || (coordinateJS->valuestring[i + 1] == 'S') ||
|
||||||
|
(coordinateJS->valuestring[i + 1] == 'W') || (coordinateJS->valuestring[i + 1] == 'E')) {
|
||||||
|
tmp[len] = coordinateJS->valuestring[i];
|
||||||
|
++len;
|
||||||
|
tmp[len] = ' ';
|
||||||
|
++len;
|
||||||
|
} else {
|
||||||
|
tmp[len] = coordinateJS->valuestring[i];
|
||||||
|
++len;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
int result = sscanf(tmp,
|
||||||
|
"%d %lf %c %d %lf %c",
|
||||||
|
&lat_deg, &lat_min, &lat_dir,
|
||||||
|
&lon_deg, &lon_min, &lon_dir);
|
||||||
|
|
||||||
|
if (result == 6) {
|
||||||
|
|
||||||
|
double lat_decimal = 0;
|
||||||
|
double lon_decimal = 0;
|
||||||
|
cConvertDecToMilliArcSecFromDegMin(lat_deg, lat_min, &msd.MSD_Data.pos.lat, &lat_decimal);
|
||||||
|
cConvertDecToMilliArcSecFromDegMin(lon_deg, lon_min, &msd.MSD_Data.pos.lon, &lon_decimal);
|
||||||
|
|
||||||
|
if (lat_dir == 'S') {
|
||||||
|
lat_decimal = -lat_decimal;
|
||||||
|
msd.MSD_Data.pos.lat = -msd.MSD_Data.pos.lat;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (lon_dir == 'W') {
|
||||||
|
lon_decimal = -lon_decimal;
|
||||||
|
msd.MSD_Data.pos.lon = -msd.MSD_Data.pos.lon;
|
||||||
|
}
|
||||||
|
|
||||||
|
printf("Latitude (degrees): %lf; dir: %c\n", lat_decimal, lat_dir);
|
||||||
|
printf("Longitude (degrees): %lf; dir: %c\n", lon_decimal, lon_dir);
|
||||||
|
|
||||||
|
printf("Latitude (mArcs): %d\n", msd.MSD_Data.pos.lat);
|
||||||
|
printf("Longitude (mArcs): %d\n", msd.MSD_Data.pos.lon);
|
||||||
|
|
||||||
|
EraGlonassMsdSetPositionValue(&msd, msd.MSD_Data.pos.lon, msd.MSD_Data.pos.lat, 0, 2);
|
||||||
|
|
||||||
|
} else {
|
||||||
|
printf("Parsing coordinate error (1)");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
} else {
|
||||||
|
printf("Parsing JSON coordinate error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cJSON_IsString(phoneJS) && (phoneJS->valuestring != NULL)) {
|
||||||
|
printf("phone (JSON): %s\n", phoneJS->valuestring);
|
||||||
|
} else {
|
||||||
|
printf("Parsing JSON phone error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (cJSON_IsString(idJS) && (idJS->valuestring != NULL)) {
|
||||||
|
printf("id (JSON): %s\n", idJS->valuestring);
|
||||||
|
|
||||||
|
char VIN[17] = {0};
|
||||||
|
|
||||||
|
memcpy(VIN, idJS->valuestring, 5);
|
||||||
|
memcpy(&VIN[5], "1111111111", 10);
|
||||||
|
|
||||||
|
EraGlonassMsdSetVIN(&msd, VIN, sizeof(VIN));
|
||||||
|
|
||||||
|
printf("id (VIN): %s\n", VIN);
|
||||||
|
|
||||||
|
} else {
|
||||||
|
printf("Parsing JSON id error");
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
cJSON_Delete(json);
|
||||||
|
|
||||||
|
|
||||||
|
uint8_t msdEncoded[512] = {0};
|
||||||
|
size_t msdEncodedSize = EraGlonassMsdEncode(&msd, MSD_V_2, msdEncoded);
|
||||||
|
|
||||||
|
char egtsHexStr[1024] = {0};
|
||||||
|
size_t egtsHexStrLen = 0;
|
||||||
|
vAsciiStringAddBytesAsHex(egtsHexStr, &egtsHexStrLen, msdEncoded, msdEncodedSize);
|
||||||
|
|
||||||
|
|
||||||
|
FILE *output_file = fopen(argv[2], "w");
|
||||||
|
if (output_file == NULL) {
|
||||||
|
printf("Error: Failed to open file %s\n", argv[1]);
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
size_t bytes_written = fwrite(egtsHexStr, 1, egtsHexStrLen, output_file);
|
||||||
|
|
||||||
|
printf("Write %zu bytes:\n", bytes_written);
|
||||||
|
printf("%.*s\n", (int)bytes_written, egtsHexStr);
|
||||||
|
|
||||||
|
fclose(output_file);
|
||||||
|
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,12 @@
|
||||||
|
{
|
||||||
|
|
||||||
|
"cmake": {
|
||||||
|
"inc_dirs": [
|
||||||
|
"./"
|
||||||
|
],
|
||||||
|
"srcs": [
|
||||||
|
"./ert_main.c",
|
||||||
|
"./*.c"
|
||||||
|
]
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
@ -0,0 +1,22 @@
|
||||||
|
cmake_minimum_required(VERSION 3.17)
|
||||||
|
project(simulink)
|
||||||
|
|
||||||
|
set(CMAKE_CXX_STANDARD 17)
|
||||||
|
|
||||||
|
include(modular.cmake)
|
||||||
|
|
||||||
|
#link_directories(/usr/local/opt/libpq/lib/)
|
||||||
|
#include_directories(/usr/local/opt/libpq/include)
|
||||||
|
#link_directories(/usr/lib/x86_64-linux-gnu/)
|
||||||
|
#include_directories(/usr/include/postgresql)
|
||||||
|
|
||||||
|
#link_libraries(pq)
|
||||||
|
#link_libraries(tcp)
|
||||||
|
#link_libraries(pthread)
|
||||||
|
|
||||||
|
set(CMAKE_CXX_FLAGS_DEBUG "${CMAKE_CXX_FLAGS_DEBUG} -funsigned-char -pipe -Wl,-O0 -std=gnu++2a -Wall -Wextra")
|
||||||
|
|
||||||
|
add_executable(conv ${SOURCES})
|
||||||
|
target_link_libraries(conv PRIVATE m)
|
||||||
|
|
||||||
|
|
||||||
|
|
@ -0,0 +1,11 @@
|
||||||
|
function(add_sources FILE_LIST FILES_PATH)
|
||||||
|
file(GLOB_RECURSE ADD_FILES_LIST ${FILES_PATH})
|
||||||
|
list(APPEND ${FILE_LIST} ${ADD_FILES_LIST})
|
||||||
|
set(${FILE_LIST} ${${FILE_LIST}} PARENT_SCOPE)
|
||||||
|
endfunction()
|
||||||
|
|
||||||
|
include_directories("APP/")
|
||||||
|
|
||||||
|
add_sources(SOURCES "APP/ert_main.c")
|
||||||
|
add_sources(SOURCES "APP/*.c")
|
||||||
|
|
||||||
|
|
@ -0,0 +1,14 @@
|
||||||
|
{
|
||||||
|
"dep": [
|
||||||
|
{
|
||||||
|
"type": "local",
|
||||||
|
"dir": "APP"
|
||||||
|
}
|
||||||
|
],
|
||||||
|
"cmake": {
|
||||||
|
"inc_dirs": [
|
||||||
|
],
|
||||||
|
"srcs": [
|
||||||
|
]
|
||||||
|
}
|
||||||
|
}
|
||||||
Loading…
Reference in New Issue