comparison src/g23m-aci/aci/psa_psis.c @ 162:53929b40109c

src/g23m-aci: initial import from TCS3.2/LoCosto
author Mychaela Falconia <falcon@freecalypso.org>
date Tue, 11 Oct 2016 02:02:43 +0000
parents
children
comparison
equal deleted inserted replaced
161:4557e2a9c18e 162:53929b40109c
1 /*
2 +-----------------------------------------------------------------------------
3 | Project : GSM-PS (6147)
4 | Modul : PSA_PSIS
5 +-----------------------------------------------------------------------------
6 | Copyright 2002 Texas Instruments Berlin, AG
7 | All rights reserved.
8 |
9 | This file is confidential and a trade secret of Texas
10 | Instruments Berlin, AG
11 | The receipt of or possession of this file does not convey
12 | any rights to reproduce or disclose its contents or to
13 | manufacture, use, or sell anything it may describe, in
14 | whole, or in part, without the specific written consent of
15 | Texas Instruments Berlin, AG.
16 +-----------------------------------------------------------------------------
17 | Purpose : This module defines the processing functions for the
18 | primitives sent to the protocol stack adapter by the DTI
19 | interface.
20 +-----------------------------------------------------------------------------
21 */
22
23 #ifdef FF_PSI
24 #define PSA_PSIS_C
25
26
27 #include "aci_all.h"
28
29 /*==== INCLUDES ===================================================*/
30 #include "aci_cmh.h"
31 #include "ati_cmd.h"
32 #include "aci_cmd.h"
33 #include "dti.h" /* functionality of the dti library */
34
35 #include "aci.h"
36 #include "aci_lst.h"
37 #include "dti_conn_mng.h"
38 #include "dti_cntrl_mng.h"
39 #include "psa_psi.h"
40 #include "cmh_psi.h"
41
42 #include "aci_mem.h"
43
44 #include "aci_io.h"
45
46 #include "sap_dti.h"
47
48
49
50 /*==== CONSTANTS ==================================================*/
51
52
53 /*==== TYPES ======================================================*/
54
55
56 /*==== EXPORT =====================================================*/
57
58 /*==== VARIABLES ==================================================*/
59
60
61 /*==== FUNCTIONS ==================================================*/
62
63 LOCAL USHORT psi_get_desc_size (T_desc2 *data)
64 {
65 USHORT size = 0;
66 T_desc2 *next_data;
67
68 next_data = data;
69 while (next_data NEQ NULL)
70 {
71 size += next_data->len;
72 next_data = (T_desc2*)next_data->next;
73 }
74
75 return (size);
76 }
77
78 #ifdef DTI
79
80 /*
81 +-------------------------------------------------------------------+
82 | PROJECT : GPRS (8441) MODULE : PSA_PSIS |
83 | STATE : finished ROUTINE : psaPSI_ConnectRej |
84 +-------------------------------------------------------------------+
85
86 PURPOSE : Indicates that ACI can not handle a DTI connection with PSI
87
88 */
89 GLOBAL void psaPSI_ConnRej ( U32 devId)
90 {
91 TRACE_FUNCTION ("psaPSI_ConnRej()");
92 {
93 PALLOC ( psi_conn_rej, PSI_CONN_REJ);
94 psi_conn_rej->devId = devId;
95 PSENDX (PSI, psi_conn_rej);
96 }
97 }
98
99 /*
100 +-------------------------------------------------------------------+
101 | PROJECT : GPRS (8441) MODULE : PSA_PSIS |
102 | STATE : finished ROUTINE : psaPSI_ConnectRes |
103 +-------------------------------------------------------------------+
104
105 PURPOSE : Response to PSI_CONN_IND sent by PSI with confirmed
106 DIO capabilities
107
108 */
109 GLOBAL void psaPSI_ConnRes ( U32 devId)
110 {
111 TRACE_FUNCTION ("psaPSI_ConnRes()");
112 {
113 PALLOC ( psi_conn_res, PSI_CONN_RES);
114 psi_conn_res->devId = devId;
115 PSENDX (PSI, psi_conn_res);
116 }
117 }
118
119 /*
120 +-------------------------------------------------------------------+
121 | PROJECT : GPRS (8441) MODULE : PSA_PSIS |
122 | STATE : finished ROUTINE : psaPSI_CloseReq |
123 +-------------------------------------------------------------------+
124
125 PURPOSE : Request closing of DTI connection with PSI
126
127 */
128 GLOBAL void psaPSI_CloseReq ( U32 devId)
129 {
130 TRACE_FUNCTION ("psaPSI_DTICloseReq()");
131 {
132 PALLOC ( psi_close_req, PSI_CLOSE_REQ);
133 psi_close_req->devId = devId;
134 PSENDX (PSI, psi_close_req);
135 }
136 }
137
138 /*
139 +-------------------------------------------------------------------+
140 | PROJECT : GPRS (8441) MODULE : PSA_PSIS |
141 | STATE : finished ROUTINE : psaPSI_DTICloseReq |
142 +-------------------------------------------------------------------+
143
144 PURPOSE : Request closing of DTI connection with PSI
145
146 */
147 GLOBAL void psaPSI_DTICloseReq ( U32 devId, U32 link_id)
148 {
149 TRACE_FUNCTION ("psaPSI_DTICloseReq()");
150 {
151 PALLOC ( psi_dti_close_req, PSI_DTI_CLOSE_REQ);
152 psi_dti_close_req->devId = devId;
153 psi_dti_close_req->link_id = link_id;
154 PSENDX (PSI, psi_dti_close_req);
155 }
156 }
157
158 /*
159 +-------------------------------------------------------------------+
160 | PROJECT : GPRS (8441) MODULE : PSA_PKTIOS |
161 | STATE : finished ROUTINE : psaPSI_DTIOpenReq |
162 +-------------------------------------------------------------------+
163
164 PURPOSE : Request opening of DTI connection with PSI
165
166 */
167 GLOBAL void psaPSI_DTIOpenReq ( U32 devId, char* peer_name,
168 ULONG link_id, UBYTE dti_direction)
169 {
170 TRACE_FUNCTION ("psaPSI_DTIOpenReq()");
171
172 /* if (dti_cntrl_set_conn_parms(link_id, DTI_ENTITY_PSI, (UBYTE)(devId&DIO_DEVICE_MASK),
173 UART_DLCI_NOT_MULTIPLEXED) EQ FALSE)
174 {
175 return;
176 }*/
177 {
178 PALLOC ( psi_dti_open_req, PSI_DTI_OPEN_REQ);
179 psi_dti_open_req->devId = devId;
180 memcpy( &(psi_dti_open_req->peer.name), peer_name, strlen(peer_name) + 1 );
181 psi_dti_open_req->link_id = link_id;
182 psi_dti_open_req->dti_direction = dti_direction;
183
184 PSENDX (PSI, psi_dti_open_req);
185 }
186 }
187
188 /*
189 +-------------------------------------------------------------------+
190 | PROJECT : GPRS (8441) MODULE : PSA_PSIS |
191 | STATE : finished ROUTINE : psaPSI_Dti_Req |
192 +-------------------------------------------------------------------+
193
194 PURPOSE : Request for DTI connection by DTI managment
195
196 */
197 GLOBAL void psaPSI_Dti_Req ( ULONG link_id, UBYTE peer,
198 T_DTI_MNG_PSI_MODE con_mode)
199 {
200 UBYTE device_no;
201 U32 devId;
202 char* peer_name;
203 T_DTI_CNTRL device_info;
204 U32 cpblty = DTI_CPBLTY_NO;
205
206 TRACE_FUNCTION ("psaPSI_Dti_Req()");
207
208 dti_cntrl_get_info_from_dti_id(EXTRACT_DTI_ID(link_id), &device_info);
209
210 device_no = device_info.dev_no;
211 switch (device_info.capability-DTI_CPBLTY_CMD )
212 {
213 case DTI_CPBLTY_CMD:
214 cpblty = DTI_CPBLTY_CMD;
215 break;
216 case DTI_CPBLTY_SER:
217 if (device_info.sub_no EQ 0)
218 {
219 cpblty = DIO_DATA_SER;
220 }
221 else
222 {
223 cpblty = DIO_DATA_SER_MUX;
224 }
225 break;
226 case DTI_CPBLTY_PKT:
227 cpblty = DIO_DATA_PKT;
228 break;
229 default:
230 break;
231 }
232 /*the mapping of capability between DTI and PSI should be done here, since devId relates
233 to the device type */
234 devId = ((device_info.driver_id & 0xff)<<24|
235 cpblty|
236 (device_info.dio_ctrl_id & 0xff)<<8|
237 device_no);
238 peer_name = dti_entity_name[peer].name;
239
240 if(con_mode EQ PSI_CONNECT_DTI)
241 {
242 dti_cntrl_set_conn_parms((T_DTI_CONN_LINK_ID)link_id, DTI_ENTITY_PSI,
243 device_info.dev_no, UART_DLCI_NOT_MULTIPLEXED);
244
245 psaPSI_DTIOpenReq (devId, peer_name, link_id, DTI_CHANNEL_TO_HIGHER_LAYER);
246 }
247 else
248 {
249 psaPSI_DTICloseReq(devId, link_id);
250 }
251 }
252 #endif /* DTI */
253
254 /*
255 +-------------------------------------------------------------------+
256 | PROJECT : GSM-PS (6147) MODULE : PSA_PSIS |
257 | ROUTINE : psa_psi_DTI_data_req |
258 +-------------------------------------------------------------------+
259
260 PURPOSE :
261
262 */
263
264 GLOBAL void psa_psi_DTI_data_req (
265 T_desc2 *data,
266 T_ACI_DTI_PRC_PSI *src_infos,
267 T_DTI_ENTITY_ID peer_id
268 )
269 {
270 USHORT data_len = 0;
271
272 TRACE_FUNCTION("psa_psi_DTI_data_req()");
273
274 {
275 PALLOC_DESC2(dti_data_ind, DTI2_DATA_IND);
276
277 data_len = psi_get_desc_size (data);
278
279 dti_data_ind->desc_list2.list_len = data_len;
280 dti_data_ind->desc_list2.first = (ULONG)data;
281
282 dti_data_ind->parameters.p_id = 0; /*dummy_ubyte; */
283
284 if (BITFIELD_CHECK (src_infos->data_cntr, PSI_DTI_FLOW_OFF))
285 {
286 dti_data_ind->parameters.st_lines.st_flow = DTI_FLOW_OFF;
287 }
288 else
289 {
290 dti_data_ind->parameters.st_lines.st_flow = DTI_FLOW_ON;
291 }
292
293 if (BITFIELD_CHECK (src_infos->data_cntr, PSI_DTI_SB_BIT))
294 {
295 TRACE_EVENT("SB is ON");
296 dti_data_ind->parameters.st_lines.st_line_sb = DTI_SB_ON;
297 }
298 else
299 {
300 TRACE_EVENT("SB is OFF");
301 dti_data_ind->parameters.st_lines.st_line_sb = DTI_SB_OFF;
302 }
303
304 dti_data_ind->parameters.st_lines.st_line_sa = DTI_SA_ON;
305 dti_data_ind->parameters.st_lines.st_break_len = DTI_BREAK_OFF;
306
307 dti_send_data
308 (
309 aci_hDTI,
310 src_infos->srcId,
311 (UBYTE)peer_id,
312 ACI_DTI_DN_CHANNEL,
313 dti_data_ind
314 );
315 }
316 }
317
318 /*
319 +-------------------------------------------------------------------+
320 | PROJECT : GSM-PS (6147) MODULE : PSA_PSI |
321 | ROUTINE : psa_psi_DTI_getdata |
322 +-------------------------------------------------------------------+
323
324 PURPOSE :
325
326 */
327
328 GLOBAL void psa_psi_DTI_getdata( UBYTE src_id, T_DTI_ENTITY_ID peer_id)
329 {
330 T_ACI_DTI_PRC_PSI *src_infos = NULL;
331
332 TRACE_FUNCTION("psaDTI_getdata");
333
334 src_infos = find_element (psi_src_params, src_id, cmhPSItest_srcId);
335 if (src_infos EQ NULL)
336 {
337 TRACE_EVENT_P1("[ERR] psaDTI_getdata: link_id=%d not found", src_id) ;
338 return ;
339 }
340
341 if( src_infos->RecState NEQ RECEIVING)
342 {
343 src_infos->RecState = READY_REC;
344 }
345
346 {
347 dti_start
348 (
349 aci_hDTI,
350 src_id,
351 (UBYTE)peer_id,
352 ACI_DTI_DN_CHANNEL
353 );
354 }
355 }
356
357 #ifdef DTI
358 /*
359 +-------------------------------------------------------------------+
360 | PROJECT : GSM-PS (6147) MODULE : PSA_PSI |
361 | ROUTINE : psaPSI_DCDreq |
362 +-------------------------------------------------------------------+
363
364 PURPOSE :
365
366 */
367
368 GLOBAL void psaPSI_DCDreq( UBYTE c_Id, UBYTE line_state )
369 {
370 T_ACI_DTI_PRC_PSI *cmd = NULL;
371
372 TRACE_FUNCTION("psaPSI_DCDreq()");
373
374 cmd = find_element (psi_src_params, c_Id, cmhPSItest_srcId);
375 if (cmd EQ NULL)
376 {
377 TRACE_EVENT_P1("[ERR] psaPSI_DCDreq: c_Id=%d not found", c_Id) ;
378 return ;
379 }
380
381 {
382 PALLOC( psi_line_state_req, PSI_LINE_STATE_REQ);
383 psi_line_state_req -> devId = cmd->devId;
384 if( line_state EQ IO_DCD_ON )
385 {
386 psi_line_state_req -> line_state = LINE_STD_DCD_ON;
387 }
388 else if ( line_state EQ IO_DCD_OFF )
389 {
390 psi_line_state_req -> line_state = LINE_STD_DCD_OFF;
391 }
392
393 PSENDX( PSI, psi_line_state_req );
394 }
395 }
396
397 /*
398 +-------------------------------------------------------------------+
399 | PROJECT : GSM-PS (6147) MODULE : PSA_PSI |
400 | ROUTINE : psaPSI_ESCAPEreq |
401 +-------------------------------------------------------------------+
402
403 PURPOSE :
404
405 */
406
407 GLOBAL BOOL psaPSI_ESCAPEreq( UBYTE c_Id, UBYTE detection )
408 {
409 T_ACI_DEVICE_DCB_ENTRY *device_entry = cmhPSI_GetDeviceParOverSrcID( c_Id );
410 U32 device_type;
411 if ( device_entry EQ NULL )
412 {
413 TRACE_EVENT_P1("[ERR] cmhPSI_SetDataRate: device for source ID = %d not found", c_Id);
414 return (FALSE);
415 }
416
417 TRACE_FUNCTION("psaPSI_ESCAPEreq()");
418
419 device_type = device_entry->devId & DIO_TYPE_DAT_MASK;
420 cmhPSI_SetDcbParToUnchanged( device_entry );
421 if (device_type EQ DIO_DATA_SER)
422 {
423 if( detection EQ ESC_DETECTION_ON)
424 {
425 device_entry->dcbPar.dio_dcb_ser.guard_period = DIO_GUARD_PER_DEFAULT;
426 }
427 else
428 {
429 device_entry->dcbPar.dio_dcb_ser.guard_period = 0;
430 }
431 }
432 else if (device_type EQ DIO_DATA_MUX)
433 {
434 if( detection EQ ESC_DETECTION_ON)
435 {
436 device_entry->dcbPar.dio_dcb_ser_mux.guard_period = DIO_GUARD_PER_DEFAULT;
437 }
438 else
439 {
440 device_entry->dcbPar.dio_dcb_ser_mux.guard_period = 0;
441 }
442 }
443
444 else /* if (device_type EQ DIO_DATA_PKT)*/
445 {
446 return (FALSE);
447 }
448
449 psaPSI_SetConfReq(device_entry);
450
451 return (TRUE);
452
453 }
454
455 /*
456 +-------------------------------------------------------------------+
457 | PROJECT : GSM-PS (6147) MODULE : PSA_PSI |
458 | ROUTINE : psaPSI_RINGreq |
459 +-------------------------------------------------------------------+
460
461 PURPOSE :
462
463 */
464
465 GLOBAL void psaPSI_RINGreq( UBYTE c_Id, UBYTE line_state )
466 {
467 T_ACI_DTI_PRC_PSI *cmd = NULL;
468
469 TRACE_FUNCTION("psaPSI_RINGreq");
470
471 cmd = find_element (psi_src_params, c_Id, cmhPSItest_srcId);
472 if (cmd EQ NULL)
473 {
474 TRACE_EVENT_P1("[ERR] psaPSI_RINGreq: c_Id=%d not found", c_Id) ;
475 return ;
476 }
477
478 if (BITFIELD_CHECK (cmd->data_cntr, PSI_RING_RUNNING))
479 {
480 TRACE_EVENT_P2 ("[WRN] psaPSI_RINGreq(): no CNF for previous REQ (device: %d; dlci=%d)",
481 cmd->devId, cmd->dlci);
482 return;
483 }
484
485 /*
486 store that PSI_RING_REQ was send
487 this is important so that the primitive queue in the PSI entity not
488 overloaded if no PC is connected
489 */
490 BITFIELD_SET (cmd->data_cntr, PSI_RING_RUNNING);
491
492 {
493 PALLOC( psi_line_state_req, PSI_LINE_STATE_REQ);
494 psi_line_state_req -> devId = cmd->devId;
495
496 if( line_state EQ IO_RING_ON)
497 {
498 psi_line_state_req -> line_state = LINE_STD_RING_ON;
499 }
500 else if( line_state EQ IO_RING_OFF )
501 {
502 psi_line_state_req -> line_state = LINE_STD_RING_OFF;
503 }
504
505 PSENDX( PSI, psi_line_state_req);
506 }
507 }
508
509 /*
510 +------------------------------------------------------------------------+
511 | PROJECT : GSM-PS (6147) MODULE : PSA_PSI |
512 | ROUTINE : psaPSI_SetConfReq |
513 +------------------------------------------------------------------------+
514
515 PURPOSE :
516
517 */
518
519 GLOBAL void psaPSI_SetConfReq( T_ACI_DEVICE_DCB_ENTRY *dcbPar )
520 {
521 U32 device_type;
522 #ifdef _SIMULATION_
523 PALLOC(psi_setconf_req_test, PSI_SETCONF_REQ_TEST);
524
525 device_type = dcbPar->devId & DIO_TYPE_DAT_MASK;
526 psi_setconf_req_test->devId = dcbPar->devId;
527 switch (device_type)
528 {
529 case DIO_DATA_SER:
530 memcpy(&psi_setconf_req_test->DIO_DCB_UN.DIO_DCB_SER,&dcbPar->dcbPar.dio_dcb_ser,sizeof(T_DIO_DCB_SER));
531 break;
532 case DIO_DATA_PKT:
533 memcpy(&psi_setconf_req_test->DIO_DCB_UN.DIO_DCB_PKT,&dcbPar->dcbPar.dio_dcb_pkt,sizeof(T_DIO_DCB_PKT));
534 break;
535 case DIO_DATA_SER_MUX:
536 memcpy(&psi_setconf_req_test->DIO_DCB_UN.DIO_DCB_SER_MUX,&dcbPar->dcbPar.dio_dcb_ser_mux,sizeof(T_DIO_DCB_SER_MUX));
537 break;
538 default:
539 break;
540 }
541 PSENDX( PSI, psi_setconf_req_test );
542 #else
543 PALLOC(psi_setconf_req, PSI_SETCONF_REQ);
544
545 device_type = dcbPar->devId & DIO_TYPE_DAT_MASK;
546 psi_setconf_req->devId = dcbPar->devId;
547 switch (device_type)
548 {
549 case DIO_DATA_SER:
550 psi_setconf_req->ptr_DIO_DCB = (T_DIO_DCB *) &dcbPar->dcbPar.dio_dcb_ser;
551 break;
552 case DIO_DATA_PKT:
553 psi_setconf_req->ptr_DIO_DCB =(T_DIO_DCB *) &dcbPar->dcbPar.dio_dcb_pkt;
554 break;
555 case DIO_DATA_SER_MUX:
556 psi_setconf_req->ptr_DIO_DCB =(T_DIO_DCB *) &dcbPar->dcbPar.dio_dcb_ser_mux;
557 break;
558 default:
559 break;
560 }
561 PSENDX( PSI, psi_setconf_req );
562 #endif /* _SIMULATION_ */
563 }
564 #endif /* DTI */
565 #endif /*FF_PSI*/
566 /*==== EOF =======================================================*/
567