summaryrefslogtreecommitdiffstats
path: root/video_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp
diff options
context:
space:
mode:
Diffstat (limited to 'video_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp')
-rwxr-xr-xvideo_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp1880
1 files changed, 0 insertions, 1880 deletions
diff --git a/video_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp b/video_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp
deleted file mode 100755
index 7bf40d1..0000000
--- a/video_in_hal/vehicleservice/positioning/server/src/Sensor/VehicleSens_DataMasterMain.cpp
+++ /dev/null
@@ -1,1880 +0,0 @@
-/*
- * @copyright Copyright (c) 2016-2020 TOYOTA MOTOR CORPORATION.
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- */
-
-/*******************************************************************************
- * File name :VehicleSens_DataMasterMain.cpp
- * System name :_CWORD107_
- * Subsystem name :Vehicle sensor process
- * Program name :Vehicle sensor data master
- * Module configuration :VehicleSensInitDataMaster() Vehicle data master initialization function
- * :VehicleSensSetDataMasterCan() Vehicle sensor data master CAN data set processing
- * :VehicleSensSetDataMasterLineSens() Vehicle sensor data master LineSensor data set process
- * :VehicleSensSetDataMasterGps() Vehicle Sensor Data Master GPS Data Set Processing
- * :VehicleSensGetDataMaster() Vehicle Sensor Data Master Get Processing
- * :VehicleSensGetGpsDataMaster() Vehicle Sensor Data Master GPS Data Get Processing
- * :VehicleSensGetGps_CWORD82_NmeaSensorCnt() Vehicle sensor GPS_sensor counter GET function
- * :VehicleSensSetDataMaster_CWORD82_() Vehicle sensor data master GPS data (_CWORD82_) set processing
- ******************************************************************************/
-
-#include <vehicle_service/positioning_base_library.h>
-#include "VehicleSens_DataMaster.h"
-#include "gps_hal.h"
-#include "POS_private.h"
-#include "DeadReckoning_main.h"
-#include "VehicleSens_DeliveryCtrl.h"
-#include "Vehicle_API.h"
-#include "CommonDefine.h"
-#include <vehicle_service/POS_common_API.h>
-#include "SensorMotion_API.h"
-#include "SensorLog.h"
-#include "ClockIf.h"
-#include "DiagSrvIf.h"
-
-/*************************************************/
-/* Global variable */
-/*************************************************/
-#if CONFIG_SENSOR_EXT_VALID /* Initial Sensor Support */
-VEHICLESENS_PKG_DELIVERY_TEMP_EXT gstPkgTempExt; // NOLINT(readability/nolint)
-#endif
-
-#define DR_DEBUG 0
-#define GPS_DEBUG 0
-
-/*************************************************/
-/* Function prototype */
-/*************************************************/
-static uint8_t VehicleSensGetSensorCnt(void);
-
-
-/*******************************************************************************
-* MODULE : VehicleSensInitDataMaster
-* ABSTRACT : Vehicle sensor data master initialization
-* FUNCTION : Initializing Vehicle Sensor Data Master
-* ARGUMENT : void
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensInitDataMaster(void) {
- /* Vehicle sensor data master initialization */
-
- VehicleSensInitSpeedPulsel();
- VehicleSensInitSpeedKmphl();
- VehicleSensInitGyroXl();
- VehicleSensInitGyroYl();
- VehicleSensInitGyroZl();
- VehicleSensInitGsnsXl();
- VehicleSensInitGsnsYl();
- VehicleSensInitGsnsZl();
- VehicleSensInitRevl();
- VehicleSensInitGpsAntennal();
- VehicleSensInitSnsCounterl();
- VehicleSensInitGpsCounterg();
-#if CONFIG_SENSOR_EXT_VALID /* Initial Sensor Support */
- VehicleSensInitGyroRevl();
- VehicleSensInitSnsCounterExtl();
- VehicleSensInitGyroExtl();
- VehicleSensInitGyroYExtl();
- VehicleSensInitGyroZExtl();
- VehicleSensInitSpeedPulseExtl();
- VehicleSensInitRevExtl();
- VehicleSensInitGsnsXExtl();
- VehicleSensInitGsnsYExtl();
- VehicleSensInitGsnsZExtl();
- VehicleSensInitGsnsXFstl();
- VehicleSensInitGsnsYFstl();
- VehicleSensInitGsnsZFstl();
- VehicleSensInitGyroXFstl();
- VehicleSensInitGyroYFstl();
- VehicleSensInitGyroZFstl();
- VehicleSensInitSpeedPulseFstl();
- VehicleSensInitSpeedPulseFlagFstl();
- VehicleSensInitRevFstl();
-#endif
- /* ++ GPS _CWORD82_ support */
- VehicleSensInitGps_CWORD82_FullBinaryG();
- VehicleSensInitGps_CWORD82_NmeaG();
- VehicleSensInitGps_CWORD82__CWORD44_Gp4G();
- VehicleSensInitGpsNmeaG();
- /* -- GPS _CWORD82_ support */
-
- /* ++ PastModel002 support */
- VehicleSensInitNavVelnedG();
- VehicleSensInitNavTimeUtcG();
- VehicleSensInitNavTimeGpsG();
- VehicleSensInitNavSvInfoG();
- VehicleSensInitNavStatusG();
- VehicleSensInitNavPosllhG();
- VehicleSensInitNavClockG();
- VehicleSensInitNavDopG();
- VehicleSensInitMonHwG();
-
- VehicleSensInitSpeedPulseFlag();
- VehicleSensInitGpsInterruptFlag();
-
- VehicleSensInitGyroTrouble();
- VehicleSensInitMainGpsInterruptSignal();
- VehicleSensInitSysGpsInterruptSignal();
- VehicleSensInitGyroConnectStatus();
- VehicleSensInitGpsAntennaStatus();
- /* -- PastModel002 support */
-
- VehicleSensInitGyroTempFstl();
- VehicleSensInitGyroTempExtl();
- VehicleSensInitGyroTempl();
- VehicleSensInitPulseTimeExtl();
- VehicleSensInitPulseTimel();
-
- VehicleSensInitLocationLonLatG();
- VehicleSensInitLocationAltitudeG();
- VehicleSensInitMotionSpeedG();
- VehicleSensInitMotionHeadingG();
- VehicleSensInitNaviinfoDiagGPSg();
- VehicleSensInitGpsTimeG();
- VehicleSensInitGpsTimeRawG();
- VehicleSensInitWknRolloverG();
- VehicleSensInitLocationLonLatN();
- VehicleSensInitLocationAltitudeN();
- VehicleSensInitMotionSpeedN();
- VehicleSensInitMotionHeadingN();
- VehicleSensInitSettingTimeclock();
- VehicleSensInitMotionSpeedI();
- VehicleSensInitGpsClockDriftG();
- VehicleSensInitGpsClockFreqG();
-
- VehicleSens_InitLocationInfoNmea_n();
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterLineSens
-* ABSTRACT : Vehicle sensor data master LineSensor data set process
-* FUNCTION : Set LineSensor data
-* ARGUMENT : *pst_data : LineSensor Vehicle Signal Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterLineSens(const LSDRV_LSDATA *pst_data,
- PFUNC_DMASTER_SET_N p_data_master_set_n,
- BOOL b_sens_ext) {
- u_int8 uc_chg_type;
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pst_data->ul_did) {
- case POSHAL_DID_SPEED_PULSE:
- {
- uc_chg_type = VehicleSensSetSpeedPulsel(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-
- break;
- }
-// case POSHAL_DID_GYRO_X:
-// {
-// uc_chg_type = VehicleSensSetGyroXl(pst_data);
-// (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-// break;
-// }
- case POSHAL_DID_GYRO_Y:
- {
- uc_chg_type = VehicleSensSetGyroYl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_Z:
- {
- uc_chg_type = VehicleSensSetGyroZl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_REV:
- {
- uc_chg_type = VehicleSensSetRevl(pst_data);
-#if (DR_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_REV \r\n");
-#endif
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* -- PastModel002 support DR */
- break;
- }
- case POSHAL_DID_GPS_ANTENNA:
- {
- uc_chg_type = VehicleSensSetGpsAntennal(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_X:
- case POSHAL_DID_GYRO_EXT: /* 3 to 14bit A/D value,0bit:REV */
- {
- uc_chg_type = VehicleSensSetGyroRevl(pst_data);
-// if (b_sens_ext == TRUE) {
-// VehicleSensSetGyroExtl(pst_data);
-// }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- default:
- break;
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterLineSensG
-* ABSTRACT : Vehicle sensor data master LineSensor data set process
-* FUNCTION : Set LineSensor data
-* ARGUMENT : *pst_data : LineSensor Vehicle Signal Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterLineSensG(const LSDRV_LSDATA_G *pst_data,
- PFUNC_DMASTER_SET_N p_data_master_set_n,
- BOOL b_sens_ext) {
- u_int8 uc_chg_type;
- SENSORMOTION_SPEEDINFO_DAT stSpeed;
- const VEHICLESENS_DATA_MASTER* pst_master;
- u_int16 usSP_KMPH = 0; /* Vehicle speed(km/h) */
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pst_data->ul_did) {
- case POSHAL_DID_SPEED_PULSE:
- {
- uc_chg_type = VehicleSensSetSpeedPulselG(pst_data);
-#if (DR_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_SPEED_PULSE \r\n");
-#endif
- if (b_sens_ext == TRUE) {
- VehicleSensSetSpeedPulseExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* -- PastModel002 support DR */
- break;
- }
- case POSHAL_DID_SPEED_KMPH:
- {
- uc_chg_type = VehicleSensSetSpeedKmphlG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-
- /* Set the data master of Motion Seepd (Internal) */
- pst_master = (const VEHICLESENS_DATA_MASTER*)pst_data;
- memset(&stSpeed, 0x00, sizeof(SENSORMOTION_SPEEDINFO_DAT));
- /* When the notified size is ""0"",The vehicle speed cannot be calculated with the line sensor. */
- if (pst_master->us_size == 0) {
- stSpeed.isEnable = FALSE;
- } else {
- stSpeed.isEnable = TRUE;
- memcpy(&usSP_KMPH, pst_master->uc_data, sizeof(u_int16));
- }
- stSpeed.getMethod = SENSOR_GET_METHOD_POS;
- /* Unit conversion [0.01km/h] -> [0.01m/s] */
- stSpeed.Speed = static_cast<uint16_t>((1000 * usSP_KMPH) / 3600);
-
- uc_chg_type = VehicleSensSetMotionSpeedI(&stSpeed);
- (*p_data_master_set_n)(VEHICLE_DID_MOTION_SPEED_INTERNAL, uc_chg_type, VEHICLESENS_GETMETHOD_INTERNAL);
- break;
- }
-// case POSHAL_DID_GYRO_X:
-// {
-// uc_chg_type = VehicleSensSetGyroXlG(pst_data);
-//#if (DR_DEBUG == 1) /* PastModel002_DR_VEHICLE */
-// FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_GYRO_X \r\n");
-//#endif
-// (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-// /* ++ PastModel002 support DR */
-// VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-// /* -- PastModel002 support DR */
-// break;
-// }
- case POSHAL_DID_GYRO_Y:
- {
- uc_chg_type = VehicleSensSetGyroYlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGyroYExtlG(pst_data);
- }
-#if (DR_DEBUG == 1)
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_GYRO_Y \r\n");
-#endif
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_Z:
- {
- uc_chg_type = VehicleSensSetGyroZlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGyroZExtlG(pst_data);
- }
-#if (DR_DEBUG == 1)
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_GYRO_Z \r\n");
-#endif
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_SNS_COUNTER:
- {
-#if (DR_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster POSHAL_DID_SNS_COUNTER \r\n");
-#endif
- uc_chg_type = VehicleSensSetSnsCounterlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetSnsCounterExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* -- PastModel002 support DR */
- break;
- }
- case POSHAL_DID_GYRO_X:
- case POSHAL_DID_GYRO_EXT: /* 3 to 14bit A/D value,0bit:REV */
- {
- uc_chg_type = VehicleSensSetGyroRevlG(pst_data);
-
- if (b_sens_ext == TRUE) {
- VehicleSensSetGyroExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-
- break;
- }
-
- case POSHAL_DID_SPEED_PULSE_FLAG:
- {
- uc_chg_type = VehicleSensSetSpeedPulseFlag((const LSDRV_LSDATA_G *)pst_data);
-
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- /* -- PastModel002 support DR */
-
- break;
- }
- case POSHAL_DID_GPS_INTERRUPT_FLAG:
- {
- uc_chg_type = VehicleSensSetGpsInterruptFlag((const LSDRV_LSDATA_G *)pst_data);
-
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
-
- break;
- }
- case POSHAL_DID_REV:
- {
- uc_chg_type = VehicleSensSetRevlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetRevExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_TEMP:
- {
- uc_chg_type = VehicleSensSetGyroTemplG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGyroTempExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GSNS_X:
- {
- uc_chg_type = VehicleSensSetGsnsXlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGsnsXExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GSNS_Y:
- {
- uc_chg_type = VehicleSensSetGsnsYlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGsnsYExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GSNS_Z:
- {
- uc_chg_type = VehicleSensSetGsnsZlG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetGsnsZExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_PULSE_TIME:
- {
- uc_chg_type = VehicleSensSetPulseTimelG(pst_data);
- if (b_sens_ext == TRUE) {
- VehicleSensSetPulseTimeExtlG(pst_data);
- }
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- default:
- break;
- }
-}
-
-#if CONFIG_SENSOR_EXT_VALID /* Initial Sensor Support */
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterLineSensFst
-* ABSTRACT : Vehicle sensor data master LineSensor data set process
-* FUNCTION : Set LineSensor data
-* ARGUMENT : *pst_data : LineSensor Vehicle Signal Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterLineSensFst(const LSDRV_LSDATA_FST *pst_data, PFUNC_DMASTER_SET_N p_data_master_set_n) { // LCOV_EXCL_START 8: dead code // // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pst_data->ul_did) {
- case POSHAL_DID_GYRO_X_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- uc_chg_type = VehicleSensSetGyroXFstl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_Y_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- uc_chg_type = VehicleSensSetGyroYFstl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_GYRO_Z_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- uc_chg_type = VehicleSensSetGyroZFstl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- case POSHAL_DID_SPEED_PULSE_FST:
- {
- uc_chg_type = VehicleSensSetSpeedPulseFstl(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- break;
- }
- default:
- break;
- }
-}
-// LCOV_EXCL_STOP
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterLineSensFstG
-* ABSTRACT : Vehicle sensor data master LineSensor data set process
-* FUNCTION : Set LineSensor data
-* ARGUMENT : *pst_data : LineSensor Vehicle Signal Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterLineSensFstG(const LSDRV_MSG_LSDATA_DAT_FST *pst_data,
- PFUNC_DMASTER_SET_N p_data_master_set_n) {
- u_int8 uc_chg_type;
-
- /* Internal debug log output */
- FRAMEWORKUNIFIEDLOG(ZONE_26, __FUNCTION__, "+");
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pst_data->st_gyro_x.ul_did) {
- case POSHAL_DID_GYRO_X_FST:
- {
- uc_chg_type = VehicleSensSetGyroXFstG(&(pst_data->st_gyro_x));
- if (pst_data->st_gyro_x.uc_partition_max == pst_data->st_gyro_x.uc_partition_num)
- {
- (*p_data_master_set_n)(pst_data->st_gyro_x.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gyro_y.ul_did) {
- case POSHAL_DID_GYRO_Y_FST:
- {
- uc_chg_type = VehicleSensSetGyroYFstG(&(pst_data->st_gyro_y));
- if (pst_data->st_gyro_y.uc_partition_max == pst_data->st_gyro_y.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gyro_y.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gyro_z.ul_did) {
- case POSHAL_DID_GYRO_Z_FST:
- {
- uc_chg_type = VehicleSensSetGyroZFstG(&(pst_data->st_gyro_z));
- if (pst_data->st_gyro_z.uc_partition_max == pst_data->st_gyro_z.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gyro_z.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_speed.ul_did) {
- case POSHAL_DID_SPEED_PULSE_FST:
- {
- uc_chg_type = VehicleSensSetSpeedPulseFstG(&(pst_data->st_speed));
- if (pst_data->st_speed.uc_partition_max == pst_data->st_speed.uc_partition_num)
- {
- (*p_data_master_set_n)(pst_data->st_speed.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_spd_pulse_flg.ul_did) {
- case POSHAL_DID_SPEED_PULSE_FLAG_FST:
- {
- uc_chg_type = VehicleSensSetSpeedPulseFlagFstG(&(pst_data->st_spd_pulse_flg));
- if (pst_data->st_spd_pulse_flg.uc_partition_max == pst_data->st_spd_pulse_flg.uc_partition_num)
- {
- (*p_data_master_set_n)(pst_data->st_spd_pulse_flg.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_rev.ul_did) {
- case POSHAL_DID_REV_FST:
- {
- uc_chg_type = VehicleSensSetRevFstG(&(pst_data->st_rev));
- if (pst_data->st_rev.uc_partition_max == pst_data->st_rev.uc_partition_num)
- {
- (*p_data_master_set_n)(pst_data->st_rev.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gyro_temp.ul_did) {
- case POSHAL_DID_GYRO_TEMP_FST:
- {
- uc_chg_type = VehicleSensSetGyroTempFstG(&(pst_data->st_gyro_temp));
-
- if (pst_data->st_gyro_temp.uc_partition_max == pst_data->st_gyro_temp.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gyro_temp.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gsns_x.ul_did) {
- case POSHAL_DID_GSNS_X_FST:
- {
- uc_chg_type = VehicleSensSetGsnsXFstG(&(pst_data->st_gsns_x));
-
- if (pst_data->st_gsns_x.uc_partition_max == pst_data->st_gsns_x.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gsns_x.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gsns_y.ul_did) {
- case POSHAL_DID_GSNS_Y_FST:
- {
- uc_chg_type = VehicleSensSetGsnsYFstG(&(pst_data->st_gsns_y));
-
- if (pst_data->st_gsns_y.uc_partition_max == pst_data->st_gsns_y.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gsns_y.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- switch (pst_data->st_gsns_z.ul_did) {
- case POSHAL_DID_GSNS_Z_FST:
- {
- uc_chg_type = VehicleSensSetGsnsZFstG(&(pst_data->st_gsns_z));
-
- if (pst_data->st_gsns_z.uc_partition_max == pst_data->st_gsns_z.uc_partition_num) {
- (*p_data_master_set_n)(pst_data->st_gsns_z.ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- }
- break;
- }
- default:
- break;
- }
-
- /* Internal debug log output */
- FRAMEWORKUNIFIEDLOG(ZONE_26, __FUNCTION__, "-");
-}
-#endif
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterGps
-* ABSTRACT : Vehicle Sensor Data Master GPS Data Set Processing
-* FUNCTION : Set GPS data
-* ARGUMENT : *pst_data : GPS received message data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterGps(SENSOR_MSG_GPSDATA_DAT *pst_data,
- PFUNC_DMASTER_SET_N p_data_master_set_n) {
- u_int8 uc_chg_type;
- SENSORLOCATION_LONLATINFO_DAT lstLonLat;
- SENSORLOCATION_ALTITUDEINFO_DAT lstAltitude;
- SENSORMOTION_HEADINGINFO_DAT lstHeading;
- MDEV_GPS_CUSTOMDATA *pstCustomData;
-
- VEHICLESENS_DATA_MASTER st_data;
- u_int8 antennaState = 0;
- u_int8 sensCount = 0;
- u_int8 ucResult = SENSLOG_RES_SUCCESS;
-
- EFrameworkunifiedStatus eStatus = eFrameworkunifiedStatusFail;
- BOOL bIsAvailable;
- PNO us_pno;
-
- /* Antenna Connection Information */
- (void)memset(reinterpret_cast<void *>(&st_data), 0, sizeof(st_data));
- VehicleSensGetGpsAntennal(&st_data);
- antennaState = st_data.uc_data[0];
-
- /* Sensor Counter */
- (void)memset(reinterpret_cast<void *>(&st_data), 0, sizeof(st_data));
- VehicleSensGetSnsCounterl(&st_data);
- /** Sensor Counter Value Calculation */
- /** Subtract sensor counter according to data amount from sensor counter.(Rounded off) */
- /** Communication speed9600bps = 1200byte/s,Sensor counter is 1 count at 100ms. */
- sensCount = st_data.uc_data[0];
-
- FRAMEWORKUNIFIEDLOG(ZONE_27, __FUNCTION__,
- "antennaState = %d, sensCount = %d", antennaState, sensCount);
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pst_data->ul_did) { // LCOV_EXCL_BR_LINE 6:some DID is not used
- case VEHICLE_DID_GPS_UBLOX_NAV_VELNED:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_VELNED \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavVelnedG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_TIMEUTC:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_TIMEUTC \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavTimeUtcG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_TIMEGPS:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_TIMEGPS \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavTimeGpsG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_SVINFO:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_SVINFO \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavSvInfoG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_STATUS:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_STATUS \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavStatusG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_POSLLH:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_POSLLH \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavPosllhG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_CLOCK:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_CLOCK \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavClockG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_DOP:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__,
- "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_NAV_DOP \r\n");
-#endif
- uc_chg_type = VehicleSensSetNavDopG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* ++ PastModel002 support DR */
- VehicleSensDeliveryProcDR(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- /* -- PastModel002 support DR */
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_MON_HW:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
-#if (GPS_DEBUG == 1) /* PastModel002_DR_VEHICLE */
- FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "VehicleSens_SetDataMaster VEHICLE_DID_GPS_UBLOX_MON_HW \r\n");
-#endif
- uc_chg_type = VehicleSensSetMonHwG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_COUNTER:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- uc_chg_type = VehicleSensSetGpsCounterg(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- // LCOV_EXCL_STOP
- }
- /* GPS raw data(_CWORD82_ NMEA) */
- case VEHICLE_DID_GPS__CWORD82__NMEA:
- {
- /* NMEA data */
- FRAMEWORKUNIFIEDLOG(ZONE_27, __FUNCTION__,
- "VehicleSens_GpsDataDelivery VEHICLE_DID_GPS__CWORD82__NMEA -->");
-
- /* Insert Antenna Connection Status and Sensor Counter */
- pst_data->uc_data[1] = antennaState; /* Insert Antennas into 2byte Eyes */
- /* Place counters at 3byte */
- pst_data->uc_data[2] = static_cast<u_int8>(sensCount - (u_int8)(((GPS_NMEA_SZ * 10) / 1200) + 1));
-
- uc_chg_type = VehicleSensSetGps_CWORD82_NmeaG(pst_data); /* Ignore->MISRA-C++:2008 Rule 5-2-5 */
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- FRAMEWORKUNIFIEDLOG(ZONE_27, __FUNCTION__,
- "VehicleSens_GpsDataDelivery VEHICLE_DID_GPS__CWORD82__NMEA <--");
- break;
- }
- /* GPS raw data(FullBinary) */
- case POSHAL_DID_GPS__CWORD82__FULLBINARY:
- {
- /* FullBin data */
- FRAMEWORKUNIFIEDLOG(ZONE_27, __FUNCTION__,
- "VehicleSens_GpsDataDelivery POSHAL_DID_GPS__CWORD82__FULLBINARY -->");
-
- /* Insert Antenna Connection Status and Sensor Counter */
- pst_data->uc_data[0] = antennaState; /* Insert Antennas into 1byte Eyes */
- /* Place counters at 2byte */
- pst_data->uc_data[1] = static_cast<u_int8>(sensCount - (u_int8)(((GPS_CMD_FULLBIN_SZ * 10) / 1200) + 1));
-
- uc_chg_type = VehicleSensSetGps_CWORD82_FullBinaryG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- FRAMEWORKUNIFIEDLOG(ZONE_27, __FUNCTION__,
- "VehicleSens_GpsDataDelivery POSHAL_DID_GPS__CWORD82__FULLBINARY <--");
- break;
- }
- /* GPS raw data(Specific information) */
- case POSHAL_DID_GPS__CWORD82___CWORD44_GP4:
- {
- /* GPS-specific information */
- uc_chg_type = VehicleSensSetGps_CWORD82__CWORD44_Gp4G(pst_data); /* Ignore->MISRA-C++:2008 Rule 5-2-5 */
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
- case POSHAL_DID_GPS_CUSTOMDATA:
- {
- pstCustomData = reinterpret_cast<MDEV_GPS_CUSTOMDATA*>(pst_data->uc_data);
- /* Latitude/LongitudeInformation */
- (void)memcpy(&lstLonLat, &(pstCustomData->st_lonlat), sizeof(SENSORLOCATION_LONLATINFO_DAT));
- lstLonLat.SyncCnt = VehicleSensGetSensorCnt(); /* Synchronization counter setting */
- uc_chg_type = VehicleSensSetLocationLonLatG(&lstLonLat);
- (*p_data_master_set_n)(VEHICLE_DID_LOCATION_LONLAT, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
-
- /* Altitude information */
- (void)memcpy(&lstAltitude, &(pstCustomData->st_altitude), sizeof(SENSORLOCATION_ALTITUDEINFO_DAT));
- lstAltitude.SyncCnt = VehicleSensGetSensorCnt(); /* Synchronization counter setting */
- uc_chg_type = VehicleSensSetLocationAltitudeG(&lstAltitude);
- (*p_data_master_set_n)(VEHICLE_DID_LOCATION_ALTITUDE, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
-
- /* Bearing information */
- (void)memcpy(&lstHeading, &(pstCustomData->st_heading), sizeof(SENSORMOTION_HEADINGINFO_DAT));
- lstHeading.SyncCnt = VehicleSensGetSensorCnt(); /* Synchronization counter setting */
- uc_chg_type = VehicleSensSetMotionHeadingG(&lstHeading);
- (*p_data_master_set_n)(VEHICLE_DID_MOTION_HEADING, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
-
- /* GPS time information */
- uc_chg_type = VehicleSensSetGpsTimeG(&(pstCustomData->st_gps_time));
- (*p_data_master_set_n)(POSHAL_DID_GPS_TIME, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
-
- /* Set GPS time to CLOCK */
- eStatus = ClockIfDtimeSetGpsTime(&(pstCustomData->st_gps_time), &bIsAvailable);
- if ((bIsAvailable == TRUE) && (eStatus != eFrameworkunifiedStatusOK)) {
- ucResult = SENSLOG_RES_FAIL;
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__,
- "ClockIfDtimeSetGpsTime ERROR!! [ret=%d, y=%d, m=%d, d=%d, h=%d, n=%d, s=%d, sts=%d]",
- eStatus, pstCustomData->st_gps_time.utc.year, pstCustomData->st_gps_time.utc.month,
- pstCustomData->st_gps_time.utc.date,
- pstCustomData->st_gps_time.utc.hour, pstCustomData->st_gps_time.utc.minute,
- pstCustomData->st_gps_time.utc.second, pstCustomData->st_gps_time.tdsts);
- }
- us_pno = _pb_CnvName2Pno(SENSLOG_PNAME_CLOCK);
- SensLogWriteOutputData(SENSLOG_DATA_O_TIME_CS, 0, us_pno,
- reinterpret_cast<uint8_t *>(&(pstCustomData->st_gps_time)),
- sizeof(pstCustomData->st_gps_time), ucResult);
-
- /* Diag Info */
- uc_chg_type = VehicleSensSetNaviinfoDiagGPSg(&(pstCustomData->st_diag_gps));
- (*p_data_master_set_n)(VEHICLE_DID_NAVIINFO_DIAG_GPS, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
- /* GPS raw data(NMEA except _CWORD82_) */
- case POSHAL_DID_GPS_NMEA:
- {
- /* NMEA data */
- uc_chg_type = VehicleSensSetGpsNmeaG(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
- /* GPS version(except _CWORD82_) */
- case POSHAL_DID_GPS_VERSION:
- {
- VehicleSensSetGpsVersion(pst_data);
- break;
- }
- /* Raw GPS time data */
- case POSHAL_DID_GPS_TIME_RAW:
- {
- (void)VehicleSensSetGpsTimeRawG(reinterpret_cast<SENSOR_GPSTIME_RAW*>(pst_data->uc_data));
- break;
- }
- case POSHAL_DID_GPS_TIME:
- {
- uc_chg_type = VehicleSensSetGpsTimeG(reinterpret_cast<SENSOR_MSG_GPSTIME*>(pst_data->uc_data));
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
- case POSHAL_DID_GPS_WKNROLLOVER:
- {
- (void)VehicleSensSetWknRolloverG(reinterpret_cast<SENSOR_WKNROLLOVER*>(pst_data->uc_data));
- break;
- }
- /* GPS clock drift */
- case POSHAL_DID_GPS_CLOCK_DRIFT:
- {
- uc_chg_type = VehicleSensSetGpsClockDriftG(reinterpret_cast<int32_t*>(pst_data->uc_data));
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
- /* GPS clock frequency */
- case POSHAL_DID_GPS_CLOCK_FREQ:
- {
- uc_chg_type = VehicleSensSetGpsClockFreqG(reinterpret_cast<uint32_t*>(pst_data->uc_data));
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
- break;
- }
-
- default:
- break;
- }
-}
-
-/*******************************************************************************
- * MODULE : VehicleSensSetDataMasterData
- * ABSTRACT : Vehicle sensor data master common data set processing
- * FUNCTION : Set vehicle data
- * ARGUMENT : *pstMsg : Received message data
- * : p_data_master_set_n : Data Master Set Notification(Callback function)
- * NOTE :
- * RETURN : void
- ******************************************************************************/
-void VehicleSensSetDataMasterData(const POS_MSGINFO *pstMsg,
- PFUNC_DMASTER_SET_N p_data_master_set_n) {
- u_int8 uc_chg_type = 0;
- const POS_POSDATA *pstPosData = NULL;
- const u_int16 *pucSpeed = 0;
- SENSORLOCATION_LONLATINFO_DAT stLonLat;
- SENSORLOCATION_ALTITUDEINFO_DAT stAltitude;
- SENSORMOTION_SPEEDINFO_DAT stSpeed;
- SENSORMOTION_HEADINGINFO_DAT stHeading;
- const SENSOR_MSG_GPSTIME *pstGpsTime;
-
-// RET_API ret;
-
-// char* pEnvPositioning_CWORD86_ = NULL;
-// BOOL sndFlg;
-
-
- EFrameworkunifiedStatus eStatus = eFrameworkunifiedStatusFail;
- BOOL bIsAvailable;
- u_int8 ucResult = SENSLOG_RES_SUCCESS;
- PNO us_pno;
-
- /*------------------------------------------------------*/
- /* Call the data set processing associated with the DID */
- /* Call the data master set notification process */
- /*------------------------------------------------------*/
- switch (pstMsg->did) {
- case POSHAL_DID_GPS_CUSTOMDATA_NAVI:
- {
- pstPosData = (const POS_POSDATA *) & (pstMsg->data);
-
- /* Latitude/LongitudeInformation */
- if (((pstPosData->status & POS_LOC_INFO_LAT) == POS_LOC_INFO_LAT) ||
- ((pstPosData->status & POS_LOC_INFO_LON) == POS_LOC_INFO_LON)) {
- memset(&stLonLat, 0x00, sizeof(stLonLat));
- stLonLat.getMethod = SENSOR_GET_METHOD_NAVI;
- stLonLat.SyncCnt = VehicleSensGetSensorCnt();
- stLonLat.isEnable = SENSORLOCATION_STATUS_ENABLE;
- stLonLat.posSts = pstPosData->posSts;
- stLonLat.posAcc = pstPosData->posAcc;
- stLonLat.Longitude = pstPosData->longitude;
- stLonLat.Latitude = pstPosData->latitude;
- uc_chg_type = VehicleSensSetLocationLonLatN((const SENSORLOCATION_LONLATINFO_DAT *)&stLonLat);
- (*p_data_master_set_n)(VEHICLE_DID_LOCATION_LONLAT_NAVI, uc_chg_type, VEHICLESENS_GETMETHOD_NAVI);
- }
-
- /* Altitude information */
- if ((pstPosData->status & POS_LOC_INFO_ALT) == POS_LOC_INFO_ALT) {
- memset(&stAltitude, 0x00, sizeof(stAltitude));
- stAltitude.getMethod = SENSOR_GET_METHOD_NAVI;
- stAltitude.SyncCnt = VehicleSensGetSensorCnt();
- stAltitude.isEnable = SENSORLOCATION_STATUS_ENABLE;
- stAltitude.Altitude = pstPosData->altitude;
- uc_chg_type = VehicleSensSetLocationAltitudeN((const SENSORLOCATION_ALTITUDEINFO_DAT *)&stAltitude);
- (*p_data_master_set_n)(VEHICLE_DID_LOCATION_ALTITUDE_NAVI, uc_chg_type, VEHICLESENS_GETMETHOD_NAVI);
- }
-
- /* Bearing information */
- if ((pstPosData->status & POS_LOC_INFO_HEAD) == POS_LOC_INFO_HEAD) {
- memset(&stHeading, 0x00, sizeof(stHeading));
- stHeading.getMethod = SENSOR_GET_METHOD_NAVI;
- stHeading.SyncCnt = VehicleSensGetSensorCnt();
- stHeading.isEnable = SENSORMOTION_STATUS_ENABLE;
- stHeading.posSts = pstPosData->posSts;
- stHeading.Heading = pstPosData->heading;
- uc_chg_type = VehicleSensSetMotionHeadingN((const SENSORMOTION_HEADINGINFO_DAT *)&stHeading);
- (*p_data_master_set_n)(VEHICLE_DID_MOTION_HEADING_NAVI, uc_chg_type, VEHICLESENS_GETMETHOD_NAVI);
- }
-
- ( *p_data_master_set_n )( POSHAL_DID_GPS_CUSTOMDATA_NAVI, VEHICLESENS_NEQ, VEHICLESENS_GETMETHOD_NAVI );
-
- break;
- }
- case VEHICLE_DID_MOTION_SPEED_NAVI:
- {
- pucSpeed = (const u_int16 *) & (pstMsg->data);
-
- /* Vehicle speed information */
- memset(&stSpeed, 0x00, sizeof(stSpeed));
- stSpeed.getMethod = SENSOR_GET_METHOD_NAVI;
- stSpeed.SyncCnt = VehicleSensGetSensorCnt();
- stSpeed.isEnable = SENSORMOTION_STATUS_ENABLE;
- stSpeed.Speed = *pucSpeed;
- uc_chg_type = VehicleSensSetMotionSpeedN((const SENSORMOTION_SPEEDINFO_DAT *)&stSpeed);
- (*p_data_master_set_n)(VEHICLE_DID_MOTION_SPEED_NAVI, uc_chg_type, VEHICLESENS_GETMETHOD_NAVI);
- break;
- }
- case POSHAL_DID_GPS_TIME:
- {
- pstGpsTime = (const SENSOR_MSG_GPSTIME*)(pstMsg->data);
- uc_chg_type = VehicleSensSetGpsTimeG((const SENSOR_MSG_GPSTIME *)pstGpsTime);
- (*p_data_master_set_n)(POSHAL_DID_GPS_TIME, uc_chg_type, VEHICLESENS_GETMETHOD_GPS);
-
- /* Set GPS time to CLOCK */
- eStatus = ClockIfDtimeSetGpsTime(pstGpsTime, &bIsAvailable);
- if ((bIsAvailable == TRUE) && (eStatus != eFrameworkunifiedStatusOK)) {
- ucResult = SENSLOG_RES_FAIL;
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__,
- "ClockIfDtimeSetGpsTime ERROR!! [ret=%d, y=%d, m=%d, d=%d, h=%d, n=%d, s=%d, sts=%d]",
- eStatus, pstGpsTime->utc.year, pstGpsTime->utc.month, pstGpsTime->utc.date,
- pstGpsTime->utc.hour, pstGpsTime->utc.minute, pstGpsTime->utc.second, pstGpsTime->tdsts);
- }
- us_pno = _pb_CnvName2Pno(SENSLOG_PNAME_CLOCK);
- SensLogWriteOutputData(SENSLOG_DATA_O_TIME_CS, 0, us_pno,
- (uint8_t *)(pstGpsTime), // NOLINT(readability/casting)
- sizeof(SENSOR_MSG_GPSTIME), ucResult);
- break;
- }
- case VEHICLE_DID_SETTINGTIME:
- {
- /* GPS time information */
- uc_chg_type = VehicleSensSetSettingTimeclock((const POS_DATETIME *) & (pstMsg->data));
- (*p_data_master_set_n)(VEHICLE_DID_SETTINGTIME, uc_chg_type, VEHICLESENS_GETMETHOD_OTHER);
- break;
- }
-
- case VEHICLE_DID_LOCATIONINFO_NMEA_NAVI:
- {
- uc_chg_type = VehicleSens_SetLocationInfoNmea_n((const POS_LOCATIONINFO_NMEA*)&(pstMsg->data));
- (*p_data_master_set_n)(VEHICLE_DID_LOCATIONINFO_NMEA_NAVI, uc_chg_type, VEHICLESENS_GETMETHOD_NAVI );
- break;
- }
-
- default:
- break;
- }
- return;
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterGyroTrouble
-* ABSTRACT : Vehicle Sensor Data Master Gyro Failure Status Setting Process
-* FUNCTION : Set a gyro fault condition
-* ARGUMENT : *pst_data : Gyro Failure Status Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterGyroTrouble(const LSDRV_MSG_LSDATA_DAT_GYRO_TROUBLE *pst_data, PFUNC_DMASTER_SET_N p_data_master_set_n) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
-
- if ((pst_data != NULL) && (p_data_master_set_n != NULL)) {
- if (pst_data->ul_did == VEHICLE_DID_GYRO_TROUBLE) {
- uc_chg_type = VehicleSensSetGyroTrouble(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", pst_data->ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "ARGUMENT is NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterSysGpsInterruptSignal
-* ABSTRACT : Vehicle Sensor Data Master SYS GPS Interrupt Signal Setting
-* FUNCTION : Setting SYS GPS Interrupt Signals
-* ARGUMENT : *pst_data : SYS GPS interrupt notification
-* : p_data_master_set_shared_memory : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterSysGpsInterruptSignal(const LSDRV_MSG_LSDATA_DAT_GPS_INTERRUPT_SIGNAL *pst_data, PFUNC_DMASTER_SET_SHARED_MEMORY p_data_master_set_shared_memory) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
- if ((pst_data != NULL) && (p_data_master_set_shared_memory != NULL)) {
- if (pst_data->ul_did == VEHICLE_DID_SYS_GPS_INTERRUPT_SIGNAL) {
- uc_chg_type = VehicleSensSetSysGpsInterruptSignal(pst_data);
- /* As SYS GPS interrupt signals are not registered for delivery, */
- /* Disposal quantity,To avoid risks,DeliveryProc shall not be called. */
- (*p_data_master_set_shared_memory)(pst_data->ul_did, uc_chg_type);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", pst_data->ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "ARGUMENT is NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterMainGpsInterruptSignal
-* ABSTRACT : Vehicle Sensor Data Master MAIN GPS Interrupt Signal Setting
-* FUNCTION : Setting MAIN GPS Interrupt Signals
-* ARGUMENT : *pst_data : MAIN GPS interrupt notification
-* : p_data_master_set_shared_memory : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterMainGpsInterruptSignal(const SENSOR_MSG_GPSDATA_DAT *pst_data, PFUNC_DMASTER_SET_SHARED_MEMORY p_data_master_set_shared_memory) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
-
- if ((pst_data != NULL) &&
- (p_data_master_set_shared_memory != NULL)) {
- if (pst_data->ul_did == VEHICLE_DID_MAIN_GPS_INTERRUPT_SIGNAL) {
- uc_chg_type = VehicleSensSetMainGpsInterruptSignal(pst_data);
- /* As MAIN GPS interrupt signals are not registered for delivery, */
- /* Disposal quantity,To avoid risks,DeliveryProc shall not be called. */
- (*p_data_master_set_shared_memory)(pst_data->ul_did, uc_chg_type);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", pst_data->ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "ARGUMENT is NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterGyroConnectStatus
-* ABSTRACT : Vehicle Sensor Data Master Gyro Connection Status Setting Processing
-* FUNCTION : Set the state of the gyro connection
-* ARGUMENT : *pst_data : Gyro Connect Status Notification Data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterGyroConnectStatus(const LSDRV_MSG_LSDATA_DAT_GYRO_CONNECT_STATUS *pst_data, PFUNC_DMASTER_SET_SHARED_MEMORY p_data_master_set_shared_memory) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
-
- if ((pst_data != NULL) &&
- (p_data_master_set_shared_memory != NULL)) {
- if (pst_data->ul_did == VEHICLE_DID_GYRO_CONNECT_STATUS) {
- uc_chg_type = VehicleSensSetGyroConnectStatus(pst_data);
- /* As MAIN GPS interrupt signals are not registered for delivery, */
- /* Disposal quantity,To avoid risks,DeliveryProc shall not be called. */
- (*p_data_master_set_shared_memory)(pst_data->ul_did, uc_chg_type);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", pst_data->ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "ARGUMENT is NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-
-/*******************************************************************************
-* MODULE : VehicleSensSetDataMasterGpsAntennaStatus
-* ABSTRACT : Vehicle Sensor Data Master GPS Antenna Connection Status Setting Processing
-* FUNCTION : Setting the GPS Antenna Connection Status
-* ARGUMENT : *pst_data : GPS antenna connection status notification data
-* : p_data_master_set_n : Data Master Set Notification(Callback function)
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensSetDataMasterGpsAntennaStatus(const LSDRV_MSG_LSDATA_DAT_GPS_ANTENNA_STATUS *pst_data, PFUNC_DMASTER_SET_N p_data_master_set_n) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- u_int8 uc_chg_type;
-
- if ((pst_data != NULL) && (p_data_master_set_n != NULL)) {
- if (pst_data->ul_did == POSHAL_DID_GPS_ANTENNA) {
- uc_chg_type = VehicleSensSetGpsAntennaStatus(pst_data);
- (*p_data_master_set_n)(pst_data->ul_did, uc_chg_type, VEHICLESENS_GETMETHOD_LINE);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", pst_data->ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "ARGUMENT is NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMaster
-* ABSTRACT : Vehicle Sensor Data Master Get Processing
-* FUNCTION : Provide vehicle sensor data master
-* ARGUMENT : ul_did : Data ID corresponding to the vehicle information
-* : uc_get_method : Data collection way
-* : VEHICLESENS_GETMETHOD_CAN: CAN communication
-* : VEHICLESENS_GETMETHOD_LINE: LineSensor drivers
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMaster(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER *pst_data) {
- /*------------------------------------------------------*/
- /* Call the data Get processing associated with the DID */
- /*------------------------------------------------------*/
- switch (ul_did) { // LCOV_EXCL_BR_LINE 6:some DID is not used
- /*------------------------------------------------------*/
- /* Vehicle sensor data group */
- /*------------------------------------------------------*/
- case POSHAL_DID_SPEED_PULSE:
- {
- VehicleSensGetSpeedPulse(pst_data, uc_get_method);
- break;
- }
-// case POSHAL_DID_GYRO_X:
-// {
-// VehicleSensGetGyroX(pst_data, uc_get_method);
-// break;
-// }
- case POSHAL_DID_GYRO_Y:
- {
- VehicleSensGetGyroY(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_Z:
- {
- VehicleSensGetGyroZ(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_X:
- case POSHAL_DID_GYRO_EXT: /* 3 to 14bit A/D value,0bit:REV */
- {
- VehicleSensGetGyroRev(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_X:
- {
- VehicleSensGetGsnsX(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Y:
- {
- VehicleSensGetGsnsY(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Z:
- {
- VehicleSensGetGsnsZ(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_REV:
- {
- VehicleSensGetRev(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_SPEED_PULSE_FLAG:
- {
- /* Data acquisition not selected */
- VehicleSensGetSpeedPulseFlag(pst_data);
- break;
- }
- case POSHAL_DID_GPS_ANTENNA:
- {
- VehicleSensGetGpsAntenna(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_SNS_COUNTER:
- {
- VehicleSensGetSnsCounter(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GPS_INTERRUPT_FLAG:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- /* Data acquisition not selected */
- VehicleSensGetGpsInterruptFlag(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case POSHAL_DID_SPEED_KMPH:
- {
- VehicleSensGetSpeedKmph(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_TEMP:
- {
- VehicleSensGetGyroTemp(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_PULSE_TIME:
- {
- VehicleSensGetPulseTime(pst_data, uc_get_method);
- break;
- }
- case VEHICLE_DID_LOCATION_LONLAT:
- case VEHICLE_DID_LOCATION_LONLAT_NAVI:
- {
- VehicleSensGetLocationLonLat(pst_data, uc_get_method);
- break;
- }
- case VEHICLE_DID_LOCATION_ALTITUDE:
- case VEHICLE_DID_LOCATION_ALTITUDE_NAVI:
- {
- VehicleSensGetLocationAltitude(pst_data, uc_get_method);
- break;
- }
- case VEHICLE_DID_MOTION_SPEED_NAVI:
- case VEHICLE_DID_MOTION_SPEED_INTERNAL:
- {
- VehicleSensGetMotionSpeed(pst_data, uc_get_method);
- break;
- }
- case VEHICLE_DID_MOTION_HEADING:
- case VEHICLE_DID_MOTION_HEADING_NAVI:
- {
- VehicleSensGetMotionHeading(pst_data, uc_get_method);
- break;
- }
- case VEHICLE_DID_SETTINGTIME:
- {
- VehicleSensGetSettingTime(pst_data, uc_get_method);
- break;
- }
-
- default:
- break;
- }
-}
-
-#if CONFIG_SENSOR_EXT_VALID /* Initial Sensor Support */
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterExt
-* ABSTRACT : Vehicle Sensor Data Master Get Processing(Initial delivery)
-* FUNCTION : Provide vehicle sensor data master
-* ARGUMENT : ul_did : Data ID corresponding to the vehicle information
-* : uc_get_method : Data collection way
-* : VEHICLESENS_GETMETHOD_CAN: CAN communication
-* : VEHICLESENS_GETMETHOD_LINE: LineSensor drivers
-* : VEHICLESENS_GETMETHOD_NAVI: Navi
-* : VEHICLESENS_GETMETHOD_CLOCK:Clock
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterExt(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_EXT *pst_data) {
- /*------------------------------------------------------*/
- /* Call the data Get processing associated with the DID */
- /*------------------------------------------------------*/
- switch (ul_did) {
- /*------------------------------------------------------*/
- /* Vehicle sensor data group */
- /*------------------------------------------------------*/
- case POSHAL_DID_SPEED_PULSE:
- {
- VehicleSensGetSpeedPulseExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_X:
- {
- VehicleSensGetGsnsXExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Y:
- {
- VehicleSensGetGsnsYExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Z:
- {
- VehicleSensGetGsnsZExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_SNS_COUNTER:
- {
- VehicleSensGetSnsCounterExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_X:
- case POSHAL_DID_GYRO_EXT: /* 3 to 14bit A/D value,0bit:REV */
- {
- VehicleSensGetGyroExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_Y:
- {
- VehicleSensGetGyroYExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_Z:
- {
- VehicleSensGetGyroZExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_REV:
- {
- VehicleSensGetRevExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_TEMP:
- {
- VehicleSensGetGyroTempExt(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_PULSE_TIME:
- {
- VehicleSensGetPulseTimeExt(pst_data, uc_get_method);
- break;
- }
- default: /* Ignore->MISRA-C++:2008 Rule 6-3-1, 6-4-1 */
- break;
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterFst
-* ABSTRACT : Vehicle Sensor Data Master Get Processing(Initial transmission data)
-* FUNCTION : Provide vehicle sensor data master
-* ARGUMENT : ul_did : Data ID corresponding to the vehicle information
-* : uc_get_method : Data collection way
-* : VEHICLESENS_GETMETHOD_CAN: CAN communication
-* : VEHICLESENS_GETMETHOD_LINE: LineSensor drivers
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterFst(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_FST *pst_data) {
- /*------------------------------------------------------*/
- /* Call the data Get processing associated with the DID */
- /*------------------------------------------------------*/
- switch (ul_did) {
- /*------------------------------------------------------*/
- /* Vehicle sensor data group */
- /*------------------------------------------------------*/
- case POSHAL_DID_GYRO_X_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- VehicleSensGetGyroXFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_Y_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- VehicleSensGetGyroYFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_Z_FST: /* 3 to 14bit A/D value,0bit:REV */
- {
- VehicleSensGetGyroZFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_SPEED_PULSE_FST:
- {
- VehicleSensGetSpeedPulseFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_SPEED_PULSE_FLAG_FST:
- {
- VehicleSensGetSpeedPulseFlagFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_REV_FST:
- {
- VehicleSensGetRevFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GYRO_TEMP_FST:
- {
- VehicleSensGetGyroTempFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_X_FST:
- {
- VehicleSensGetGsnsXFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Y_FST:
- {
- VehicleSensGetGsnsYFst(pst_data, uc_get_method);
- break;
- }
- case POSHAL_DID_GSNS_Z_FST:
- {
- VehicleSensGetGsnsZFst(pst_data, uc_get_method);
- break;
- }
- default:
- break;
- }
-}
-#endif
-
-/*******************************************************************************
-* MODULE : VehicleSensGetGpsDataMaster
-* ABSTRACT : Vehicle Sensor Data Master GPS Data Get Processing
-* FUNCTION : Provide vehicle sensor data master GPS data
-* ARGUMENT : ul_did : Data ID corresponding to the vehicle information
-* : uc_get_method : Data collection way
-* : VEHICLESENS_GETMETHOD_GPS: GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetGpsDataMaster(DID ul_did,
- u_int8 uc_get_method,
- SENSOR_MSG_GPSDATA_DAT *pst_data) {
- /*------------------------------------------------------*/
- /* Call the data Get processing associated with the DID */
- /*------------------------------------------------------*/
- switch (ul_did) { // LCOV_EXCL_BR_LINE 6:some DID is not used
- /*------------------------------------------------------*/
- /* GPS data group */
- /*------------------------------------------------------*/
-
- case VEHICLE_DID_GPS_UBLOX_NAV_VELNED:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavVelnedG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_TIMEUTC:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavTimeUtcG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_TIMEGPS:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavTimeGpsG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_SVINFO:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavSvInfoG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_STATUS:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavStatusG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_POSLLH:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavPosllhG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_CLOCK:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetNavClockG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_NAV_DOP:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED();
- VehicleSensGetNavDopG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_UBLOX_MON_HW:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED();
- VehicleSensGetMonHwG(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS_COUNTER:
- {
- // LCOV_EXCL_START 8 : dead code
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- VehicleSensGetGpsCounterg(pst_data);
- break;
- // LCOV_EXCL_STOP
- }
- case VEHICLE_DID_GPS__CWORD82__NMEA:
- {
- VehicleSensGetGps_CWORD82_NmeaG(pst_data);
- break;
- }
- case POSHAL_DID_GPS__CWORD82__FULLBINARY:
- {
- VehicleSensGetGps_CWORD82_FullBinaryG(pst_data);
- break;
- }
- case POSHAL_DID_GPS__CWORD82___CWORD44_GP4:
- {
- VehicleSensGetGps_CWORD82__CWORD44_Gp4G(pst_data);
- break;
- }
- case VEHICLE_DID_NAVIINFO_DIAG_GPS:
- {
- VehicleSensGetNaviinfoDiagGPSg(pst_data);
- break;
- }
- case POSHAL_DID_GPS_TIME:
- {
- VehicleSensGetGpsTimeG(pst_data);
- break;
- }
- case POSHAL_DID_GPS_TIME_RAW:
- {
- VehicleSensGetGpsTimeRawG(pst_data);
- break;
- }
- case POSHAL_DID_GPS_NMEA:
- {
- VehicleSensGetGpsNmeaG(pst_data);
- break;
- }
- case POSHAL_DID_GPS_WKNROLLOVER:
- {
- VehicleSensGetWknRolloverG(pst_data);
- break;
- }
- case POSHAL_DID_GPS_CLOCK_DRIFT:
- {
- VehicleSensGetGpsClockDriftG(pst_data);
- break;
- }
- case POSHAL_DID_GPS_CLOCK_FREQ:
- {
- VehicleSensGetGpsClockFreqG(pst_data);
- break;
- }
- default:
- break;
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterGyroTrouble
-* ABSTRACT : Vehicle Sensor Data Master Gyro Failure Status Get Processing
-* FUNCTION : Provide a gyro fault condition
-* ARGUMENT : ul_did : Data ID
-* : uc_get_method : Data collection way(Not used)
-* : VEHICLESENS_GETMETHOD_CAN : CAN communication
-* : VEHICLESENS_GETMETHOD_LINE : LineSensor drivers
-* : VEHICLESENS_GETMETHOD_GPS : GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterGyroTrouble(DID ul_did, u_int8 uc_get_method, VEHICLESENS_DATA_MASTER_GYRO_TROUBLE *pst_data) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length)
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- if (pst_data != NULL) {
- if (ul_did == VEHICLE_DID_GYRO_TROUBLE) {
- VehicleSensGetGyroTrouble(pst_data);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "pst_data == NULL\r\n");
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterSysGpsInterruptSignal
-* ABSTRACT : Vehicle Sensor Data Master SYS GPS Interrupt Signal Get Processing
-* FUNCTION : Provide SYS GPS interrupt signals
-* ARGUMENT : ul_did : Data ID
-* : uc_get_method : Data collection way(Not used)
-* : VEHICLESENS_GETMETHOD_CAN : CAN communication
-* : VEHICLESENS_GETMETHOD_LINE : LineSensor drivers
-* : VEHICLESENS_GETMETHOD_GPS : GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterSysGpsInterruptSignal(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_GPS_INTERRUPT_SIGNAL *pst_data) {
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- if (pst_data != NULL) {
- if (ul_did == VEHICLE_DID_SYS_GPS_INTERRUPT_SIGNAL) {
- VehicleSensGetSysGpsInterruptSignal(pst_data);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "pst_data == NULL\r\n");
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterMainGpsInterruptSignal
-* ABSTRACT : Vehicle Sensor Data Master MAIN GPS Interrupt Signal Get Processing
-* FUNCTION : Provide MAIN GPS interrupt signals
-* ARGUMENT : ul_did : Data ID
-* : uc_get_method : Data collection way(Not used)
-* : VEHICLESENS_GETMETHOD_CAN : CAN communication
-* : VEHICLESENS_GETMETHOD_LINE : LineSensor drivers
-* : VEHICLESENS_GETMETHOD_GPS : GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterMainGpsInterruptSignal(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_GPS_INTERRUPT_SIGNAL *pst_data) {
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- if (pst_data != NULL) {
- if (ul_did == VEHICLE_DID_MAIN_GPS_INTERRUPT_SIGNAL) {
- VehicleSensGetMainGpsInterruptSignal(pst_data);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "pst_data == NULL\r\n");
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterGyroConnectStatus
-* ABSTRACT : Vehicle Sensor Data Master Gyro Connection Status Get Processing
-* FUNCTION : Provide the status of the gyro connection
-* ARGUMENT : ul_did : Data ID
-* : uc_get_method : Data collection way(Not used)
-* : VEHICLESENS_GETMETHOD_CAN : CAN communication
-* : VEHICLESENS_GETMETHOD_LINE : LineSensor drivers
-* : VEHICLESENS_GETMETHOD_GPS : GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterGyroConnectStatus(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_GYRO_CONNECT_STATUS *pst_data) {
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- if (pst_data != NULL) {
- if (ul_did == VEHICLE_DID_GYRO_CONNECT_STATUS) {
- VehicleSensGetGyroConnectStatus(pst_data);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x)\r\n", ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "pst_data == NULL\r\n");
- }
-}
-
-/*******************************************************************************
-* MODULE : VehicleSensGetDataMasterGpsAntennaStatus
-* ABSTRACT : Vehicle Sensor Data Master GPS Antenna Connection Status Get Processing
-* FUNCTION : Provide GPS antenna connection status
-* ARGUMENT : ul_did : Data ID
-* : uc_get_method : Data collection way(Not used)
-* : VEHICLESENS_GETMETHOD_CAN : CAN communication
-* : VEHICLESENS_GETMETHOD_LINE : LineSensor drivers
-* : VEHICLESENS_GETMETHOD_GPS : GPS
-* : *pst_data : Pointer to the data master provider
-* NOTE :
-* RETURN : void
-******************************************************************************/
-void VehicleSensGetDataMasterGpsAntennaStatus(DID ul_did,
- u_int8 uc_get_method,
- VEHICLESENS_DATA_MASTER_GPS_ANTENNA_STATUS *pst_data) {
- AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
- if (pst_data != NULL) {
- if (ul_did == POSHAL_DID_GPS_ANTENNA) {
- VehicleSensGetGpsAntennaStatus(pst_data);
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "UNKNOWN DID(%x) \r\n", ul_did);
- }
- } else {
- FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "pst_data == NULL\r\n");
- }
-}
-// LCOV_EXCL_STOP
-
-/**
- * @brief
- * Sensor counter acquisition
- *
- * @return Sensor Counter
- *
- */
-static uint8_t VehicleSensGetSensorCnt(void) {
- VEHICLESENS_DATA_MASTER st_data;
- uint8_t sensCnt;
-
- /* Synchronous counter acquisition */
- VehicleSensGetSnsCounterl(&st_data);
-
- sensCnt = st_data.uc_data[0];
-
- return sensCnt;
-}