diff options
Diffstat (limited to 'vehicleservice/positioning/server/src/Sensor/DeadReckoning_Common.cpp')
-rwxr-xr-x | vehicleservice/positioning/server/src/Sensor/DeadReckoning_Common.cpp | 127 |
1 files changed, 0 insertions, 127 deletions
diff --git a/vehicleservice/positioning/server/src/Sensor/DeadReckoning_Common.cpp b/vehicleservice/positioning/server/src/Sensor/DeadReckoning_Common.cpp deleted file mode 100755 index 9503b34..0000000 --- a/vehicleservice/positioning/server/src/Sensor/DeadReckoning_Common.cpp +++ /dev/null @@ -1,127 +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 :DeadReckoning_Common.cpp - * System name :PastModel002 - * Subsystem name :DeadReckoning processes - * Program name :DeadReckoning shared process(DEADRECKONING_COMMON) - * Module configuration DeadReckoningMemcmp() Functions for Common Processing Memory Block Comparisons - * DeadReckoningCheckDid() Common Processing Data ID Check Function - * DeadReckoningGetDataMasterOffset() Get function for common processing data master offset value - ******************************************************************************/ -#include "DeadReckoning_Common.h" -#include <vehicle_service/positioning_base_library.h> - -/*************************************************/ -/* Global variable */ -/*************************************************/ -static const DEADRECKONING_DID_OFFSET_TBL kGstDidListS[] = { - /* Data ID Offset size Reserved */ - { VEHICLE_DID_DR_LONGITUDE, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_LATITUDE, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_ALTITUDE, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_SPEED, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_HEADING, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_GYRO_OFFSET, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_GYRO_SCALE_FACTOR, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_GYRO_SCALE_FACTOR_LEVEL, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_SPEED_PULSE_SCALE_FACTOR, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { VEHICLE_DID_DR_SPEED_PULSE_SCALE_FACTOR_LEVEL, DEADRECKONING_OFFSET_NORMAL, {0, 0} }, - { 0, 0, {0, 0} } /* Termination code */ -}; - -/******************************************************************************* -* MODULE : DeadReckoningMemcmp -* ABSTRACT : Functions for Common Processing Memory Block Comparisons -* FUNCTION : Memory block comparison processing -* ARGUMENT : *vp_data1 : Comparison target address 1 -* : *vp_data2 : Comparison target address 2 -* : uc_size : Comparison Size -* NOTE : -* RETURN : DEADRECKONING_EQ : No data change -* : DEADRECKONING_NEQ : Data change -******************************************************************************/ -u_int8 DeadReckoningMemcmp(const void *vp_data1, const void *vp_data2, size_t uc_size) { // LCOV_EXCL_START 8: dead code. // NOLINT(whitespace/line_length) - AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert - u_int8 l_ret = DEADRECKONING_EQ; - const u_int8 *p_data1 = (const u_int8 *)vp_data1; - const u_int8 *p_data2 = (const u_int8 *)vp_data1; - - /* Loop by data size */ - while (uc_size > 0) { - if (*p_data1 != *p_data2) { - /* Data mismatch */ - l_ret = DEADRECKONING_NEQ; - break; - } - p_data1++; - p_data2++; - uc_size--; - } - return(l_ret); -} - -/******************************************************************************* -* MODULE : DeadReckoningCheckDid -* ABSTRACT : Common Processing Data ID Check Function -* FUNCTION : Check if the specified DID corresponds to the vehicle sensor information -* ARGUMENT : ul_did : Data ID -* NOTE : -* RETURN : DEADRECKONING_INVALID :Disabled -* : DEADRECKONING_EFFECTIVE :Enabled -******************************************************************************/ -int32 DeadReckoningCheckDid(DID ul_did) { - AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert - int32 i = 0; - int32 l_ret = DEADRECKONING_INVALID; - - while (0 != kGstDidListS[i].ul_did) { - if (kGstDidListS[i].ul_did == ul_did) { - /* DID enabled */ - l_ret = DEADRECKONING_EFFECTIVE; - break; - } - i++; - } - return(l_ret); -} - -/******************************************************************************* -* MODULE : DeadReckoningGetDataMasterOffset -* ABSTRACT : Get function for common processing data master offset value -* FUNCTION : Get the fixed offset value for a given DID -* ARGUMENT : ul_did : Data ID -* NOTE : -* RETURN : Offset value(Returns 0 if DID is invalid) -* : -******************************************************************************/ -u_int16 DeadReckoningGetDataMasterOffset(DID ul_did) { - AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert - int32 i = 0; /* Generic counters */ - u_int16 us_ret = 0; /* Return value of this function */ - - while (0 != kGstDidListS[i].ul_did) { - if (kGstDidListS[i].ul_did == ul_did) { - /* DID enabled */ - us_ret = kGstDidListS[i].us_offset; - break; - } - i++; - } - return(us_ret); -} -// LCOV_EXCL_STOP |