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
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
|
/*
* @copyright Copyright (c) 2016-2019 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 DR_API.cpp
@detail DR_API Functions
@lib libDR_API.so
******************************************************************************/
/*****************************************************************************
* Include *
*****************************************************************************/
#include <vehicle_service/positioning_base_library.h>
#include "DR_API.h"
#include "DR_API_private.h"
#define DR_API_DEBUG 0
static EventID DrCreateEvent(PNO pno);
static RET_API DrDeleteEvent(EventID event_id);
static RET_API DrSndMsg(PNO pno_src, PNO pno_dest, CID cid, u_int16 msg_len, const void *msg_data);
/******************************************************************************
@brief DrSetMapMatchingData<BR>
Map matching information setting
@outline Set up map matching information.
@param[in] PNO pno : Thread ID
@param[in] MAP_MATCHING_DATA* map_matching_data : Map matching information<BR>
@param[out] none
@return DR_EXT_RET_API
@retval DR_EXT_RET_NORMAL : Normal completion
@retval DR_EXT_RET_ERROR : Parameter error
*******************************************************************************/
DR_EXT_RET_API DrSetMapMatchingData(PNO pno, MAP_MATCHING_DATA* map_matching_data) {
DR_EXT_RET_API ret = DR_EXT_RET_NORMAL; /* Return value of this function */
RET_API ret_api = RET_NORMAL; /* System API return value */
#if DR_API_DEBUG
FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "DR_API : DrSetMapMatchingData \r\n");
FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "\r\n lat[0x%08X] lon[0x%08X] sts[0x%02X] \r\n",
map_matching_data->position_info.latitude,
map_matching_data->position_info.longitude,
map_matching_data->position_info.status);
FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "rate[0x%04X] sts[0x%02X] ort[0x%04X] sts[0x%02X] \r\n Sts[0x%08X] \r\n",
map_matching_data->rate_info.rate,
map_matching_data->rate_info.status,
map_matching_data->orient_info.orient,
map_matching_data->orient_info.status,
map_matching_data->status);
#endif
/*--------------------------------------------------------------*
* Send map matching information *
*--------------------------------------------------------------*/
/* Messaging */
ret_api = DrSndMsg(pno,
PNO_VEHICLE_SENSOR,
CID_DR_MAP_MATCHING_DATA,
(u_int16)sizeof(MAP_MATCHING_DATA), (const void *)map_matching_data);
if (RET_NORMAL == ret_api) {
ret = DR_EXT_RET_NORMAL;
} else {
ret = DR_EXT_RET_ERROR;
}
#if DR_API_DEBUG
FRAMEWORKUNIFIEDLOG(ZONE_INFO, __FUNCTION__, "DR_API : DrSetMapMatchingData return[0x%X] \r\n", ret);
#endif
return ret;
}
/******************************************************************************
@brief DrClearBackupData<BR>
DR backup data initialization
@outline Initialize the DR backup data.
@param[in] PNO pno : Thread ID
@param[out] none
@return DR_EXT_RET_API
@retval DR_EXT_RET_NORMAL : Clear success
@retval DR_EXT_RET_ERROR : Clear failed
*******************************************************************************/
DR_EXT_RET_API DrClearBackupData(PNO pno) {
EventID event_id = 0; /* Event ID */
int32 event_val = 0; /* Event value */
RET_API ret_api = RET_NORMAL; /* System API return value */
DR_EXT_RET_API ret = DR_EXT_RET_NORMAL; /* Return value */
u_char data; /* Message data(Dummy) */
/* Event Generation */
event_id = DrCreateEvent(pno);
if (event_id != 0) {
/* Successful event generation */
/* Messaging(Notify VehicleSens_thread) */
ret_api = DrSndMsg(pno,
PNO_VEHICLE_SENSOR,
CID_DR_CLEAR_BACKUP_DATA,
0U, /* Message size is set to 0 */
(const void *)&data); /* Message data(Dummy) -> Errors by NULL */
if (ret_api == RET_NORMAL) {
/* Message transmission process succeeded */
/* Waiting for completion event from vehicle sensor thread */
ret_api = _pb_WaitEvent(event_id,
SAPI_EVWAIT_VAL,
DR_RET_ERROR_MIN, DR_EXT_RET_NORMAL, &event_val, INFINITE);
if (ret_api == RET_NORMAL) {
/* Return from Event Wait */
if (event_val == RET_NORMAL) {
/* Clear success */
ret = DR_EXT_RET_NORMAL;
} else {
/* Clear failed */
ret = DR_EXT_RET_ERROR;
}
} else {
/* Failed to wait for event */
ret = DR_EXT_RET_ERROR;
FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "_pb_WaitEvent Failed");
}
} else {
/* Message transmission failure */
ret = DR_EXT_RET_ERROR;
FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "DrSndMsg Failed");
}
/* Event deletion */
(void)DrDeleteEvent(event_id);
} else {
/* Event generation failure */
ret = DR_EXT_RET_ERROR;
FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "DrCreateEvent Failed");
}
return ret;
}
/*******************************************************************************
* MODULE : DrSndMsg
* ABSTRACT : Message transmission processing
* FUNCTION : Send a message to the specified PNO
* ARGUMENT : pno_src : Source PNO
* : pno_dest : Destination PNO
* : cid : Command ID
* : msg_len : Message data body length
* : *msg_data : Pointer to message data
* NOTE :
* RETURN : RET_NORMAL : Normal completion
* : RET_ERRNOTRDY : Destination process is not wakeup
* : RET_ERRMSGFULL : Message queue overflows
* : RET_ERRPARAM : Buffer size error
******************************************************************************/
static RET_API DrSndMsg(PNO pno_src, PNO pno_dest, CID cid, u_int16 msg_len, const void *msg_data) {
DR_MSG_BUF msg_buf;
RET_API ret_api;
if (msg_data != NULL) {
/* Initialization message buffe */
(void)memset(reinterpret_cast<void *>(&msg_buf), 0, sizeof(DR_MSG_BUF));
/*--------------------------------------------------------------*
* Create a message header *
*--------------------------------------------------------------*/
msg_buf.stHdr.hdr.sndpno = pno_src; /* source PNO */
msg_buf.stHdr.hdr.cid = cid; /* Command ID */
msg_buf.stHdr.hdr.msgbodysize = msg_len; /* Data size */
/*--------------------------------------------------------------*
* Create a message data *
*--------------------------------------------------------------*/
if (msg_len != 0) {
(void)memcpy(reinterpret_cast<void *>(msg_buf.ucData), msg_data, (size_t)msg_len);
}
/*--------------------------------------------------------------*
* Send messages *
*--------------------------------------------------------------*/
ret_api = _pb_SndMsg(pno_dest, /* destination PNO */
(u_int16)(sizeof(T_APIMSG_MSGBUF_HEADER) + msg_len), /* message size */
reinterpret_cast<void *>(&msg_buf), /* message buffer */
0); /* Unused Argument */
} else {
/* Argument error(Pointer to the data buffer) */
ret_api = RET_ERRPARAM;
}
return ret_api;
}
/*******************************************************************************
* MODULE : DrCreateEvent
* ABSTRACT : Event creation process
* FUNCTION : Generate an event
* ARGUMENT : pno : Thread ID
* NOTE :
* RETURN : Non-zero : Event ID
* : Zero : Event generation failure
******************************************************************************/
static EventID DrCreateEvent(PNO pno) {
EventID event_id; /* Event ID */
int8 event_name[32]; /* Event name character string buffer */
/* Initialization of event name character string buffer */
(void)memset(reinterpret_cast<void *>(event_name), 0, sizeof(event_name));
/* Event name creation */
snprintf(event_name, sizeof(event_name), "DR_API_%X", pno);
/* Event Generation */
event_id = _pb_CreateEvent(_CWORD64_EVENT_MANUALRESET_OFF, DR_EVENT_VAL_INIT, event_name);
if (event_id == 0) {
FRAMEWORKUNIFIEDLOG(ZONE_ERR, __FUNCTION__, "_pb_CreateEvent");
}
return event_id;
}
/*******************************************************************************
* MODULE : DrDeleteEvent
* ABSTRACT : Event deletion processing
* FUNCTION : Delete events
* ARGUMENT : event_id : Event ID of the event to delete
* NOTE :
* RETURN : RET_NORMAL : Normal completion
* : RET_EV_NONE : Specified event does not exist
******************************************************************************/
static RET_API DrDeleteEvent(EventID event_id) {
return (_pb_DeleteEvent(event_id));
}
|
