2 * @copyright Copyright (c) 2016-2020 TOYOTA MOTOR CORPORATION.
4 * Licensed under the Apache License, Version 2.0 (the "License");
5 * you may not use this file except in compliance with the License.
6 * You may obtain a copy of the License at
8 * http://www.apache.org/licenses/LICENSE-2.0
10 * Unless required by applicable law or agreed to in writing, software
11 * distributed under the License is distributed on an "AS IS" BASIS,
12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13 * See the License for the specific language governing permissions and
14 * limitations under the License.
19 * VehicleSens_Did_GpsClockDrift_g.cpp
23 /*---------------------------------------------------------------------------------*
25 *---------------------------------------------------------------------------------*/
26 #include <vehicle_service/positioning_base_library.h>
27 #include "VehicleSens_DataMaster.h"
29 /*---------------------------------------------------------------------------------*
31 *---------------------------------------------------------------------------------*/
32 static VEHICLESENS_DATA_MASTER gGpsClockDrift_g; // NOLINT(readability/nolint)
34 /*---------------------------------------------------------------------------------*
36 *---------------------------------------------------------------------------------*/
39 * GPS clock drift data master initialization process
41 void VehicleSensInitGpsClockDriftG(void) {
42 int32_t l_gps_clock_drift;
44 memset(&gGpsClockDrift_g, 0x00, sizeof(VEHICLESENS_DATA_MASTER));
46 /** Data ID setting */
47 gGpsClockDrift_g.ul_did = POSHAL_DID_GPS_CLOCK_DRIFT;
48 /** Data size setting */
49 gGpsClockDrift_g.us_size = sizeof(int32_t);
50 /** Data content setting */
51 l_gps_clock_drift = 0xFFFFFFFF;
52 memcpy(&gGpsClockDrift_g.uc_data[0], &l_gps_clock_drift, sizeof(l_gps_clock_drift));
59 * GPS clock drift data master SET process
65 u_int8 VehicleSensSetGpsClockDriftG(const int32_t *p_data) {
67 VEHICLESENS_DATA_MASTER *pst_master;
69 pst_master = &gGpsClockDrift_g;
71 /** With the contents of the current data master,Compare received data */
72 uc_ret = VehicleSensmemcmp(pst_master->uc_data, p_data, sizeof(int32_t));
74 /** Received data is set in the data master. */
75 pst_master->ul_did = POSHAL_DID_GPS_CLOCK_DRIFT;
76 pst_master->us_size = sizeof(int32_t);
77 pst_master->uc_rcvflag = VEHICLE_RCVFLAG_ON;
78 memset(pst_master->uc_data, 0x00, sizeof(pst_master->uc_data));
79 memcpy(pst_master->uc_data, p_data, sizeof(int32_t));
86 * GPS clock drift data master GET processing
88 * @param[out] SENSOR_MSG_GPSDATA_DAT*
90 void VehicleSensGetGpsClockDriftG(SENSOR_MSG_GPSDATA_DAT *pst_data) {
91 const VEHICLESENS_DATA_MASTER *pst_master;
93 pst_master = &gGpsClockDrift_g;
95 /* Store the data master in the specified destination. */
96 pst_data->ul_did = pst_master->ul_did;
97 pst_data->us_size = pst_master->us_size;
98 pst_data->uc_rcv_flag = pst_master->uc_rcvflag;
99 memcpy(pst_data->uc_data, pst_master->uc_data, pst_master->us_size);