1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
|
/*
* @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_Did_SpeedKmph_l.cpp
* System name :_CWORD107_
* Subsystem name :Vehicle sensor process
* Program name :Vehicle sensor data master(POSHAL_DID_SPEED_KMPH)
* Module configuration :VehicleSensInitSpeedKmphl() Vehicle sensor SPEED_KMPH initialization function
* :VehicleSensSetSpeedKmphl() Vehicle sensor SPEED_KMPH SET function
* :VehicleSensGetSpeedKmphl() Vehicle Sensor SPEED_KMPH GET Function
******************************************************************************/
#include <vehicle_service/positioning_base_library.h>
#include "VehicleSens_DataMaster.h"
/*************************************************/
/* Global variable */
/*************************************************/
static VEHICLESENS_DATA_MASTER gstSpeedKmph_l; // NOLINT(readability/nolint)
/*******************************************************************************
* MODULE : VehicleSensInitSpeedKmphl
* ABSTRACT : Vehicle sensor SPEED_KMPH initialization function
* FUNCTION : SPEED_KMPH data master initialization processing
* ARGUMENT : void
* NOTE :
* RETURN : void
******************************************************************************/
void VehicleSensInitSpeedKmphl(void) {
u_int16 *pus;
memset(&gstSpeedKmph_l, 0x00, sizeof(VEHICLESENS_DATA_MASTER));
gstSpeedKmph_l.ul_did = POSHAL_DID_SPEED_KMPH;
gstSpeedKmph_l.us_size = VEHICLE_DSIZE_SPEED_KMPH;
pus = reinterpret_cast<u_int16 *>(gstSpeedKmph_l.uc_data);
*pus = VEHICLE_DINIT_SPEED_KMPH;
}
/*******************************************************************************
* MODULE : VehicleSensSetSpeedKmphl
* ABSTRACT : Vehicle sensor SPEED_KMPH SET function
* FUNCTION : Update the SPEED_KMPH data master
* ARGUMENT : *pst_data : Pointer to the message data received by the direct line
* NOTE :
* RETURN : VEHICLESENS_EQ : No data change
* VEHICLESENS_NEQ : Data change
******************************************************************************/
u_int8 VehicleSensSetSpeedKmphl(const LSDRV_LSDATA *pst_data) { // LCOV_EXCL_START 8: dead code.
AGL_ASSERT_NOT_TESTED(); // LCOV_EXCL_LINE 200: test assert
u_int8 uc_ret;
VEHICLESENS_DATA_MASTER *pst_master;
pst_master = &gstSpeedKmph_l;
/* Compare data master and received data */
uc_ret = VehicleSensmemcmp(pst_master->uc_data,
pst_data->uc_data, pst_data->uc_size); /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
/* Received data is set in the data master. */
pst_master->ul_did = pst_data->ul_did;
pst_master->us_size = pst_data->uc_size; /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
pst_master->uc_rcvflag = VEHICLE_RCVFLAG_ON;
memset(pst_master->uc_data, 0x00, sizeof(pst_master->uc_data));
memcpy(pst_master->uc_data, pst_data->uc_data, pst_data->uc_size); /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
return(uc_ret);
}
// LCOV_EXCL_STOP
/*******************************************************************************
* MODULE : VehicleSensSetSpeedKmphlG
* ABSTRACT : Vehicle sensor SPEED_KMPH SET function
* FUNCTION : Update the SPEED_KMPH data master
* ARGUMENT : *pst_data : Pointer to the message data received by the direct line
* NOTE :
* RETURN : VEHICLESENS_EQ : No data change
* VEHICLESENS_NEQ : Data change
******************************************************************************/
u_int8 VehicleSensSetSpeedKmphlG(const LSDRV_LSDATA_G *pst_data) {
u_int8 uc_ret;
VEHICLESENS_DATA_MASTER *pst_master;
static u_int16 pre_speed[2] = {0, 0};
u_int16 cur_speed = 0;
memcpy(&cur_speed, &pst_data->uc_data[0], sizeof(u_int16));
BOOL under2 = TRUE;
BOOL eq_speed = TRUE;
pst_master = &gstSpeedKmph_l;
/* Transition of 0->1km/h and 1->0km/h requires 3 consecutive matches. Compliance with driving regulations */
under2 = ((pre_speed[1] < 2) && (pre_speed[0] < 2) && (cur_speed < 2));
eq_speed = ((pre_speed[1] == pre_speed[0]) && (pre_speed[0] == cur_speed));
if ((under2 == TRUE) && (eq_speed != TRUE) && (pst_master->uc_rcvflag == VEHICLE_RCVFLAG_ON)) {
uc_ret = VEHICLESENS_EQ; /* Return without data change */
/* Received data is set in the data master. */
pst_master->ul_did = pst_data->ul_did;
pst_master->us_size = pst_data->uc_size; /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
pst_master->uc_rcvflag = VEHICLE_RCVFLAG_ON;
} else {
/* Compare data master and received data */
uc_ret = VehicleSensmemcmp(pst_master->uc_data,
pst_data->uc_data, pst_data->uc_size); /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
/* Received data is set in the data master. */
pst_master->ul_did = pst_data->ul_did;
pst_master->us_size = pst_data->uc_size; /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
pst_master->uc_rcvflag = VEHICLE_RCVFLAG_ON;
memcpy(pst_master->uc_data, pst_data->uc_data, pst_data->uc_size); /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
}
/* For the next comparison,Update Speed */
pre_speed[1] = pre_speed[0];
pre_speed[0] = cur_speed;
return(uc_ret);
}
/*******************************************************************************
* MODULE : VehicleSensGetSpeedKmphl
* ABSTRACT : Vehicle Sensor SPEED_KMPH GET Function
* FUNCTION : Provide the SPEED_KMPH data master
* ARGUMENT : *pst_data : Pointer to the data master acquisition destination
* NOTE :
* RETURN : void
******************************************************************************/
void VehicleSensGetSpeedKmphl(VEHICLESENS_DATA_MASTER *pst_data) {
const VEHICLESENS_DATA_MASTER *pst_master;
pst_master = &gstSpeedKmph_l;
/* Store the data master in the specified destination. */
pst_data->ul_did = pst_master->ul_did;
pst_data->us_size = pst_master->us_size;
pst_data->uc_rcvflag = pst_master->uc_rcvflag;
memcpy(pst_data->uc_data, pst_master->uc_data, pst_master->us_size); /* Ignore->MISRA-C++:2008 Rule 5-0-5 */
}
|
