147 lines
5.4 KiB
C
147 lines
5.4 KiB
C
//
|
|
// Created by cfif on 05.06.2024.
|
|
//
|
|
#ifdef UVEOS_ADD_TELEMATICA
|
|
|
|
#include "Network.h"
|
|
#include "EgtsOutputCommands.h"
|
|
#include "SystemDelayInterface.h"
|
|
#include "AtGsmQuerySignalQuality.h"
|
|
#include "AtGsmGNSS.h"
|
|
|
|
#define LOG_SIGN "EGTS_INFO"
|
|
#define LOGGER &env->slog->logger
|
|
|
|
uint8_t QuerySignalQuality(tEgtsProcessing *env) {
|
|
|
|
uint8_t rssi = 0;
|
|
|
|
if (osMutexAcquire(env->gsm->gsmAt.access, 2000) == osOK) {
|
|
|
|
AtGsm_QuerySignalQuality(
|
|
&env->gsm->gsmAt,
|
|
&rssi
|
|
);
|
|
|
|
osMutexRelease(env->gsm->gsmAt.access);
|
|
} else {
|
|
LoggerInfoStatic(LOGGER, LOG_SIGN, "Ошибка доступа (QuerySignalQuality)")
|
|
}
|
|
|
|
return rssi;
|
|
}
|
|
|
|
void ResetGPS(tEgtsProcessing *env) {
|
|
if (osMutexAcquire(env->gsm->gsmAt.access, 5000) == osOK) {
|
|
AtGsm_ReceiverGnssResetColdstart(&env->gsm->gsmAt);
|
|
osMutexRelease(env->gsm->gsmAt.access);
|
|
} else {
|
|
LoggerInfoStatic(LOGGER, LOG_SIGN, "Ошибка доступа (ResetGPS)")
|
|
}
|
|
}
|
|
|
|
void _Noreturn EgtsProcessing_InfoTask(tEgtsProcessing *env) {
|
|
|
|
uint32_t timeOutCheckNetworkStatus = 0;
|
|
uint32_t timeNavUpdate = 0;
|
|
char status = 'V';
|
|
uint32_t timeStampCheck = 0;
|
|
|
|
bool oneOn = true;
|
|
bool oneOff = true;
|
|
|
|
while (1) {
|
|
|
|
if (onOffTelematica(env, &oneOn, &oneOff, "Задача информации"))
|
|
continue;
|
|
|
|
// env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_Voltage12Volts].value = *EXT_ENV_TELE.vBoardVoltage;
|
|
|
|
if (osMutexAcquire(env->gsm->gsmAt.access, 1000) == osOK) {
|
|
AtGsm_Gsnss_GetNMEA_Pack(env->gsm, 400);
|
|
osMutexRelease(env->gsm->gsmAt.access);
|
|
|
|
///---начало------------------------------------Проверка навигации на сбой приемника------------------------------------
|
|
if (timeNavUpdate < SystemGetMs()) {
|
|
timeNavUpdate = SystemGetMs() + 10000;
|
|
|
|
tNmeaRmc nmeaRmc;
|
|
Gnss_GetFullNavData(env->gsm, &nmeaRmc);
|
|
|
|
uint32_t timestamp = iNmea0183TimestampFromRmc(&nmeaRmc);
|
|
|
|
if (nmeaRmc.status == 'A') {
|
|
|
|
if (timeStampCheck == timestamp) {
|
|
ResetGPS(env);
|
|
LoggerInfoStatic(LOGGER, LOG_SIGN, "Обнаружена остановка времени навигации")
|
|
timeStampCheck = 0;
|
|
} else {
|
|
timeStampCheck = timestamp;
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
///---конец-------------------------------------Проверка навигации на сбой приемника------------------------------------
|
|
|
|
|
|
|
|
} else {
|
|
LoggerTraceStatic(LOGGER, LOG_SIGN, "Ошибка доступа (EgtsProcessing_InfoTask)")
|
|
}
|
|
|
|
//начало ---------------------------------Обновление RSSI NETWORK SAT-------------------------------------------
|
|
//начало ---------------------------------Обновление RSSI NETWORK SAT-------------------------------------------
|
|
//начало ---------------------------------Обновление RSSI NETWORK SAT-------------------------------------------
|
|
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_Uptime].value =
|
|
SystemGetMs() / 60000; // Uptime
|
|
|
|
// По умолчанию в SLEEP, до этого было в TS_STATUS_STANDBY
|
|
eEgtsTsStatus SENSORS_AN_VehicleStatus_loc = TS_STATUS_SLEEP;
|
|
|
|
// Поднят пин зажигания
|
|
if (GpioPinGet(env->ignition)) {
|
|
SENSORS_AN_VehicleStatus_loc = TS_STATUS_IGNITION;
|
|
|
|
} else {
|
|
}
|
|
|
|
// Установка значения сенсора состояния
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_VehicleStatus].value = SENSORS_AN_VehicleStatus_loc;
|
|
|
|
|
|
if (timeOutCheckNetworkStatus < SystemGetMs()) {
|
|
timeOutCheckNetworkStatus = SystemGetMs() + AURUS_CHECK_NETWORK_STATUS;
|
|
|
|
/*
|
|
uint8_t status = EpsNetworkRegistrationStatus(env->gsm);
|
|
|
|
if (status == 0)
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_NetworkType].value = 0;
|
|
|
|
if ((status > 0) && (status <= 3)) {
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_NetworkType].value = 44; // 2G
|
|
}
|
|
|
|
if ((status >= 4) && (status <= 7)) {
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_NetworkType].value = 60; // 3G
|
|
}
|
|
|
|
if (status >= 8) {
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_NetworkType].value = 76; // LTE
|
|
}
|
|
*/
|
|
uint8_t rssi = QuerySignalQuality(env);
|
|
env->egtsTeledataEdit.egtsSensorsAnArgs.sensorsAnState[SENSORS_AN_RSSI].value = rssi;
|
|
}
|
|
//конец ---------------------------------Обновление RSSI NETWORK SAT--------------------------------------------
|
|
//конец ---------------------------------Обновление RSSI NETWORK SAT--------------------------------------------
|
|
//конец ---------------------------------Обновление RSSI NETWORK SAT--------------------------------------------
|
|
|
|
SystemDelayMs(1000);
|
|
}
|
|
}
|
|
|
|
#endif |