FreeCalypso > hg > freecalypso-sw
comparison nuc-fw/riviera/rvt/rvt_api.c @ 118:21de8d8e6ea7
checking in Riviera code from the Sotomodem version
author | Michael Spacefalcon <msokolov@ivan.Harhan.ORG> |
---|---|
date | Tue, 29 Oct 2013 07:03:45 +0000 |
parents | |
children | 28f967578233 |
comparison
equal
deleted
inserted
replaced
117:e40d8661ecab | 118:21de8d8e6ea7 |
---|---|
1 /************************************************************************** | |
2 * | |
3 * rvt_api.c | |
4 * | |
5 * This module defines the interface of Trace Module | |
6 * | |
7 * (C) Texas Instruments, all rights reserved | |
8 * | |
9 * Version number : 0.1 | |
10 * | |
11 * History : 0.1 (7/5/2000) - Created | |
12 * | |
13 * Date : 7/5/2000 | |
14 * | |
15 * Author : Guido Pagana g-pagana@ti.com * | |
16 ***************************************************************************/ | |
17 | |
18 | |
19 | |
20 #include "rv/general.h" | |
21 #include "rv/rv_general.h" | |
22 #include "rvf/rvf_api.h" | |
23 #include "rvm/rvm_use_id_list.h" | |
24 | |
25 #include "rvt/rvt_gen.h" | |
26 #include "rvt/rvt_def_i.h" | |
27 #include "rvt/rvt_env.h" | |
28 #include "rvt/rvt_env_i.h" | |
29 | |
30 #include <string.h> | |
31 | |
32 | |
33 /* | |
34 ** Trace User data base global variable | |
35 */ | |
36 T_RVT_USER_DB rvt_user_db [] = RVT_USER_ID_MAPPING; | |
37 | |
38 /* | |
39 ** Number of messages lost | |
40 */ | |
41 T_RVT_LOST_MSG rvt_lost_msg_cpt = {0}; | |
42 | |
43 extern UINT8 rvf_trace_level; | |
44 | |
45 extern UINT32 rvf_layer_mask; | |
46 | |
47 | |
48 /********************************************************************************/ | |
49 /* */ | |
50 /* Function Name: rvt_set_trace_level */ | |
51 /* */ | |
52 /* Purpose: Updating the level of filtering, as well as the 32-bit */ | |
53 /* mask related to the software entities to be monitored, */ | |
54 /* according to the PC. */ | |
55 /* */ | |
56 /* Note: None. */ | |
57 /* */ | |
58 /********************************************************************************/ | |
59 void rvt_set_trace_level (T_RVT_BUFFER p_msg, UINT16 msg_length) | |
60 { | |
61 | |
62 /* Checking for an invalid PDU. */ | |
63 if ((p_msg == NULL) || \ | |
64 (msg_length != (sizeof (UINT8) + sizeof (UINT32)))) | |
65 { | |
66 return; | |
67 } | |
68 | |
69 /* Update the level of filtering. */ | |
70 if (*p_msg <= RV_TRACE_LEVEL_DEBUG_LOW) | |
71 { | |
72 rvf_trace_level = *p_msg; | |
73 } | |
74 | |
75 /* Update the 32-bit mask related to the software entities to be monitored. | |
76 Note that the 32-bit mask is transmitted LSB first. */ | |
77 rvf_layer_mask = *(++p_msg); | |
78 rvf_layer_mask |= *(++p_msg) << 8; | |
79 rvf_layer_mask |= *(++p_msg) << 16; | |
80 rvf_layer_mask |= *(++p_msg) << 24; | |
81 } | |
82 | |
83 | |
84 /********************************************************************************/ | |
85 /* */ | |
86 /* Function Name: rvt_send_trace_no_copy */ | |
87 /* */ | |
88 /* Purpose: This function is used send trace messages without */ | |
89 /* copying. */ | |
90 /* */ | |
91 /* Note: */ | |
92 /* WARNING!!!! The buffer containing the message has been allocated */ | |
93 /* by the trace module!!! */ | |
94 /* */ | |
95 /********************************************************************************/ | |
96 | |
97 T_RVT_RET | |
98 rvt_send_trace_no_cpy( T_RVT_BUFFER msg, | |
99 T_RVT_USER_ID user_id, | |
100 T_RVT_MSG_LG msg_length, | |
101 T_RVT_FORMAT msg_format) | |
102 { | |
103 /* Shift the pointer back to write control values */ | |
104 T_RVT_TRACE_RQST * req_msg = (T_RVT_TRACE_RQST * )((UINT8*)msg - RVT_HEADER_SIZE); | |
105 | |
106 /* Check is Trace Module is running */ | |
107 if (rvt_module_state != RVT_STARTED) | |
108 { | |
109 (rvt_lost_msg_cpt.bit_mask).count++; | |
110 (rvt_lost_msg_cpt.bit_mask).not_started = 1; | |
111 return RVT_NOT_READY; | |
112 } | |
113 | |
114 | |
115 /* Add the id, size and format of the msg at the beginning */ | |
116 | |
117 req_msg->header.msg_id = RVT_TRACE_RQST_ID; | |
118 req_msg->format = msg_format; | |
119 req_msg->user_id = user_id; | |
120 req_msg->msg_length = msg_length; | |
121 | |
122 if (rvf_send_msg(rvt_addr_id, (void *) req_msg) != RVF_OK) | |
123 { | |
124 (rvt_lost_msg_cpt.bit_mask).count++; | |
125 (rvt_lost_msg_cpt.bit_mask).message_not_sent = 1; | |
126 return RVT_INTERNAL_ERR; | |
127 } | |
128 return RVT_OK; | |
129 } | |
130 | |
131 | |
132 /********************************************************************************/ | |
133 /* */ | |
134 /* Function Name: send trace copy */ | |
135 /* */ | |
136 /* Purpose: this function sends traces with copy */ | |
137 /* */ | |
138 /* Note: */ | |
139 /* No check on id parameter !!!! Must be done in PC. */ | |
140 /* */ | |
141 /********************************************************************************/ | |
142 T_RVT_RET rvt_send_trace_cpy (T_RVT_BUFFER msg, | |
143 T_RVT_USER_ID user_id, | |
144 T_RVT_MSG_LG msg_length, | |
145 T_RVT_FORMAT msg_format) | |
146 | |
147 | |
148 | |
149 { | |
150 T_RVT_TRACE_RQST * req ; | |
151 | |
152 /* Check is Trace Module is running */ | |
153 if (rvt_module_state != RVT_STARTED) | |
154 { | |
155 (rvt_lost_msg_cpt.bit_mask).count++; | |
156 (rvt_lost_msg_cpt.bit_mask).not_started = 1; | |
157 return RVT_NOT_READY; | |
158 } | |
159 | |
160 /* Allocate memory (msg_length + necessary room for the header) */ | |
161 if ((rvf_get_buf (rvt_mb_id, (UINT32) msg_length + RVT_HEADER_SIZE, (T_RVF_BUFFER**) &req)) == RVF_RED) | |
162 { | |
163 (rvt_lost_msg_cpt.bit_mask).count++; | |
164 (rvt_lost_msg_cpt.bit_mask).insufficient_resources = 1; | |
165 return RVT_MEMORY_ERR; | |
166 } | |
167 | |
168 /* Add the id, size and format of the msg at the beginning */ | |
169 req->header.msg_id = RVT_TRACE_RQST_ID; | |
170 req->format = msg_format; | |
171 req->user_id = user_id; | |
172 req->msg_length = msg_length; | |
173 | |
174 /* Copy the message */ | |
175 memcpy( (UINT8*)req + RVT_HEADER_SIZE, msg, msg_length); | |
176 | |
177 /* | |
178 ** Send it as a message to Trace Task | |
179 */ | |
180 if (rvf_send_msg(rvt_addr_id, (void *) req) != RVF_OK) | |
181 { | |
182 (rvt_lost_msg_cpt.bit_mask).count++; | |
183 (rvt_lost_msg_cpt.bit_mask).message_not_sent = 1; | |
184 rvf_free_buf (req); | |
185 return RVT_INTERNAL_ERR; | |
186 } | |
187 return RVT_OK; | |
188 } | |
189 | |
190 | |
191 | |
192 /********************************************************************************/ | |
193 /* */ | |
194 /* Function Name: rvt_register_id */ | |
195 /* */ | |
196 /* Purpose: function rvt_register id */ | |
197 /* returns 0 if string not found, else the number */ | |
198 /* stocked in the array */ | |
199 /* */ | |
200 /* Note: */ | |
201 /* uses two arrays, one that stockes the messages,and another for the */ | |
202 /* correspondent values. */ | |
203 /* */ | |
204 /********************************************************************************/ | |
205 | |
206 T_RVT_RET rvt_register_id(T_RVT_NAME name[], T_RVT_USER_ID *rvt_id, RVT_CALLBACK_FUNC callback) | |
207 { | |
208 UINT8 i; | |
209 | |
210 /*looks in the array if the message is stocked */ | |
211 for (i=0;rvt_user_db[i].user_id!=RVT_INVALID_HEADER;i++) | |
212 { | |
213 if (rvt_name_cmp(rvt_user_db[i].user_name,name)) | |
214 { | |
215 *rvt_id = rvt_user_db[i].user_id; | |
216 rvt_user_db[i].rx_callback_func = callback; | |
217 return(RVT_OK); | |
218 } | |
219 } | |
220 | |
221 /*else returns zero */ | |
222 return (RVT_INVALID_PARAMETER); | |
223 | |
224 } | |
225 | |
226 | |
227 | |
228 | |
229 /********************************************************************************/ | |
230 /* */ | |
231 /* Function Name: rvt_mem_alloc */ | |
232 /* */ | |
233 /* Purpose: this function allocates a buffer for tracing. */ | |
234 /* */ | |
235 /* Note: */ | |
236 /* None. */ | |
237 /* */ | |
238 /********************************************************************************/ | |
239 T_RVT_RET rvt_mem_alloc(T_RVT_USER_ID user_id, T_RVT_MSG_LG buffer_length, T_RVT_BUFFER * buff) | |
240 { | |
241 if (rvt_module_state != RVT_STARTED) | |
242 { | |
243 *buff = NULL; | |
244 (rvt_lost_msg_cpt.bit_mask).count++; | |
245 (rvt_lost_msg_cpt.bit_mask).not_started = 1; | |
246 return RVT_NOT_READY; | |
247 } | |
248 | |
249 if (rvf_get_buf (rvt_mb_id, (UINT32) buffer_length + RVT_HEADER_SIZE, (T_RVF_BUFFER**) buff) == RVF_RED) | |
250 { | |
251 *buff = NULL; | |
252 (rvt_lost_msg_cpt.bit_mask).count++; | |
253 (rvt_lost_msg_cpt.bit_mask).insufficient_resources = 1; | |
254 return RVT_MEMORY_ERR; | |
255 } | |
256 *buff = *buff + RVT_HEADER_SIZE; | |
257 return RVT_OK; | |
258 } | |
259 | |
260 | |
261 /********************************************************************************/ | |
262 /* */ | |
263 /* Function Name: rvt_mem_free */ | |
264 /* */ | |
265 /* Purpose: this function frees an allocated buffer for the trace task */ | |
266 /* */ | |
267 /* Note: */ | |
268 /* None. */ | |
269 /* */ | |
270 /********************************************************************************/ | |
271 T_RVT_RET rvt_mem_free(T_RVT_BUFFER msg) | |
272 { | |
273 | |
274 /* | |
275 ** Shift the pointer back to write control values | |
276 */ | |
277 char *buff = (char*) msg - RVT_HEADER_SIZE; | |
278 | |
279 // Deallocates the buffer | |
280 if (rvf_free_buf((T_RVF_BUFFER*) buff) == RVF_MEMORY_ERR) | |
281 { | |
282 return RVT_MEMORY_ERR; | |
283 } | |
284 return RVT_OK; | |
285 } | |
286 | |
287 | |
288 /* | |
289 ** User function used to compare name | |
290 */ | |
291 BOOLEAN rvt_name_cmp( char * str1, char * str2) | |
292 { | |
293 UINT8 i; | |
294 | |
295 for ( i = 0; (str1[i] == str2[i]) && (str1[i] != 0) && (str2[i] != 0) && (i < RVT_NAME_MAX_LEN); i++ ); | |
296 if ( i == RVT_NAME_MAX_LEN) | |
297 { return TRUE; | |
298 } | |
299 if ( (str1[i] == 0) && (str2[i] == 0) ) | |
300 { return TRUE; | |
301 } | |
302 return FALSE; | |
303 } |