FreeCalypso > hg > fc-tourmaline
view src/g23m-fad/ra/ra_rlp.c @ 46:09cdd5bf04e4
Condat display driver fix for 96x64 BW framebuffer
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Sat, 17 Oct 2020 22:50:15 +0000 |
parents | fa8dc04885d8 |
children |
line wrap: on
line source
/* +----------------------------------------------------------------------------- | Project : GSM-F&D (8411) | Modul : RA_RLP +----------------------------------------------------------------------------- | Copyright 2002 Texas Instruments Berlin, AG | All rights reserved. | | This file is confidential and a trade secret of Texas | Instruments Berlin, AG | The receipt of or possession of this file does not convey | any rights to reproduce or disclose its contents or to | manufacture, use, or sell anything it may describe, in | whole, or in part, without the specific written consent of | Texas Instruments Berlin, AG. +----------------------------------------------------------------------------- | Purpose : This Modul defines the functions for the non-transparent | data model (RLP) for the component RA of the mobile | station +----------------------------------------------------------------------------- */ #ifndef RA_RLP_C #define RA_RLP_C #endif #define ENTITY_RA /*==== INCLUDES ===================================================*/ #include <string.h> #include "typedefs.h" #include "vsi.h" #include "macdef.h" #include "pconst.cdg" #include "custom.h" #include "gsm.h" #include "cnf_ra.h" #include "prim.h" #include "pei.h" #include "tok.h" #include "ccdapi.h" #include "ra.h" /*==== CONST ======================================================*/ /*==== TYPES ======================================================*/ /*==== VARIABLES ==================================================*/ /*==== FUNCTIONS ==================================================*/ /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_init | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void rlp_init(void) { TRACE_FUNCTION("rlp_init()"); memset(ra_data->rlp, 0, sizeof(T_RLP)); hCommRLP = vsi_c_open ( VSI_CALLER RLP_NAME ); hCommMMI = vsi_c_open ( VSI_CALLER ACI_NAME ); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_idle | +--------------------------------------------------------------------+ PURPOSE : IDLE processing fpr uplink and downlink non-transparent mode */ GLOBAL void rlp_idle(void) { TRACE_FUNCTION("rlp_idle()"); } /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_ul_null | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void rlp_ul_null(void) { T_RLP *drlp = ra_data->rlp; UBYTE i; TRACE_FUNCTION("rlp_ul_null()"); if (ra_data->activated) { #ifdef TRACE_RA_RLP drlp->fcs_error = 0L; #endif /* * setup the communication parameters */ shm_set_dsp_value (conf_b_itc, V_ITC_DATA); shm_set_dsp_value (conf_b_ce, V_CE_NON_TRANSP); switch (ra_data->tra_rate) { case TRA_FULLRATE_14400: shm_set_dsp_value (conf_b_ur, V_UR_14400); shm_set_dsp_value (conf_b_ct, V_CT_FR); break; case TRA_FULLRATE_9600: shm_set_dsp_value (conf_b_ur, V_UR_9600); shm_set_dsp_value (conf_b_ct, V_CT_FR); break; case TRA_FULLRATE_4800: shm_set_dsp_value (conf_b_ur, V_UR_4800); shm_set_dsp_value (conf_b_ct, V_CT_FR); break; case TRA_HALFRATE_4800: shm_set_dsp_value (conf_b_ur, V_UR_4800); shm_set_dsp_value (conf_b_ct, V_CT_HR); break; default: break; } shm_set_dsp_value (ntu_M1, 0); shm_set_dsp_value (ntu_M2, 0); shm_set_dsp_value (ntu_empty, 1); shm_set_dsp_value (ntu_byte_cnt, 2); /* * initialize the non-transparent mode data */ drlp->ul_data_pending = FALSE; drlp->m1 = 0; ra_data->ra_data_ind.fr_type = FR_RLP; ra_data->ra_data_ind.sdu.o_buf = 0; ra_data->ra_data_ind.sdu.l_buf = 0; ra_data->ra_ready_ind[0].req_frames = 1; cl_ribu_init(&drlp->ulq, RLP_UL_QSIZE); for (i = 0; i < drlp->ulq.depth; i++) { cl_set_frame_desc_0(&drlp->ul_frame_desc[i], NULL, 0); } cl_set_frame_desc_0(&ra_data->rlp->dl_frame_desc, NULL, 0); shm_set_dsp_value (act_b_init, 1); INIT_STATE (KER, RLP_INIT_L1); #ifdef HO_WORKAROUND /* rlp_ul_null */ _act_d_ra_conf = *ra_data->shm.shm_addr[d_ra_conf]; TRACE_EVENT("d_ra_conf saved"); #endif } } /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_ul_init_l1 | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void rlp_ul_init_l1(void) { TRACE_FUNCTION("rlp_ul_init_l1()"); if (shm_get_dsp_value (act_b_init) EQ 0) { /* * initialisation finished -> enter the data transmission state */ l1i_ra_activate_cnf(); SET_STATE (KER, RLP_DATA_TRANS); } } /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_ul_data_trans | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void rlp_ul_data_trans(void) { T_RLP *drlp = ra_data->rlp; TRACE_FUNCTION("rlp_ul_data_trans()"); if (drlp->ul_data_pending) /* a frame is ready to be sent */ { USHORT len = 0; switch (ra_data->tra_rate) { case TRA_FULLRATE_9600: case TRA_HALFRATE_4800: len = NT_DATA_SIZE; drlp->ul_data_pending = FALSE; break; case TRA_FULLRATE_4800: /* S844: 1=1st half, 0=2nd half */ if (shm_get_dsp_value (act_b_f48blk_ul) EQ 1) { TRACE_FUNCTION("send 4800 first half"); len = NT_DATA_SIZE_4800_FR_A; drlp->ul_48_first_half_sent = TRUE; } else { if (drlp->ul_48_first_half_sent) { TRACE_FUNCTION("send 4800 second half"); len = NT_DATA_SIZE_4800_FR_B; drlp->ul_data_pending = FALSE; drlp->ul_frame_desc[drlp->ulq.ri].Adr[0] += NT_DATA_SIZE_4800_FR_A; } else { TRACE_FUNCTION("wait for 4800 first half"); len = 0; } } break; case TRA_FULLRATE_14400: shm_set_dsp_value (ntu_M1, drlp->m1); /* S844: 0 = first half, 1 = second half */ if (drlp->m1 EQ 0) { len = NT_DATA_SIZE_14400_A; drlp->m1 = 1; } else { len = NT_DATA_SIZE_14400_B; drlp->ul_data_pending = FALSE; drlp->ul_frame_desc[drlp->ulq.ri].Adr[0] += NT_DATA_SIZE_14400_A; } break; } if (len > 0) { shm_set_dsp_buffer(&drlp->ul_frame_desc[drlp->ulq.ri], ra_data->shm.shm_addr[adr_ntu_data]+wof_ntu_data, 0, len); shm_set_dsp_value (ntu_empty, 0); shm_set_dsp_value (ntu_byte_cnt, (len+2)); if (!drlp->ul_data_pending) { cl_ribu_read_index(&drlp->ulq); /* PZ 22.7.99 */ drlp->ul_data_pending = (drlp->ulq.ri NEQ drlp->ulq.wi); /* PZ 22.7.99 */ } } else { shm_set_dsp_value (ntu_M1, 0); shm_set_dsp_value (ntu_empty, 1); shm_set_dsp_value (ntu_byte_cnt, 2); } } else { /* no frame is ready to be sent */ shm_set_dsp_value (ntu_M1, 0); shm_set_dsp_value (ntu_empty, 1); shm_set_dsp_value (ntu_byte_cnt, 2); } if (!drlp->ul_data_pending) { l1i_ra_ready_ind(hCommRLP, 0); } } /* +--------------------------------------------------------------------+ | PROJECT : GSM-F&D (8411) MODULE : RA_RLP | | STATE : code ROUTINE : rlp_dl_data_trans | +--------------------------------------------------------------------+ PURPOSE : */ GLOBAL void rlp_dl_data_trans(void) { BOOL frame_complete = FALSE; TRACE_FUNCTION("rlp_dl_data_trans()"); #ifdef HO_WORKAROUND /* rlp_dl_data_trans */ if (*ra_data->shm.shm_addr[d_ra_conf] NEQ _act_d_ra_conf) { *ra_data->shm.shm_addr[d_ra_conf] = _act_d_ra_conf; /* rlp_dl_data_trans */ TRACE_EVENT("HO_REFRESH rlp_dl_data_trans"); } #endif /* * read out the received downlink data */ if (shm_get_dsp_value (ntd_byte_cnt) > 0) { USHORT len = 0; switch (ra_data->tra_rate) { case TRA_FULLRATE_9600: case TRA_HALFRATE_4800: if (shm_get_dsp_value (ntd_fcs_ok) EQ 0) { frame_complete = TRUE; len = NT_DATA_SIZE; #ifdef _SIMULATION_ cl_set_frame_desc_0(&ra_data->rlp->dl_frame_desc, ra_data->rlp->dl_buf, NT_DATA_SIZE); ra_data->ra_data_ind.sdu.l_buf = NT_DATA_SIZE << 3; #else rlp_rbm_get_next_buffer(&ra_data->rlp->dl_frame_desc); #endif } else { #ifdef TRACE_RA_RLP TRACE_EVENT("FCS-Error"); ra_data->rlp->fcs_error++; #endif frame_complete = FALSE; len = 0; } break; case TRA_FULLRATE_4800: /* S844: 0=1st half, 1=2nd half */ if (shm_get_dsp_value (act_b_f48blk_dl) EQ 0) { len = NT_DATA_SIZE_4800_FR_A; frame_complete = FALSE; #ifdef _SIMULATION_ cl_set_frame_desc_0(&ra_data->rlp->dl_frame_desc, ra_data->rlp->dl_buf, NT_DATA_SIZE_4800_FR_A+NT_DATA_SIZE_4800_FR_B); ra_data->ra_data_ind.sdu.l_buf = (NT_DATA_SIZE_4800_FR_A+NT_DATA_SIZE_4800_FR_B) << 3; #else rlp_rbm_get_next_buffer(&ra_data->rlp->dl_frame_desc); #endif } else if (shm_get_dsp_value (ntd_fcs_ok) EQ 0) { frame_complete = TRUE; len = NT_DATA_SIZE_4800_FR_B; ra_data->rlp->dl_frame_desc.Adr[0] += NT_DATA_SIZE_4800_FR_A; } else { #ifdef TRACE_RA_RLP TRACE_EVENT("FCS-Error"); ra_data->rlp->fcs_error++; #endif frame_complete = FALSE; len = 0; } break; case TRA_FULLRATE_14400: /* S844: 0 = first half, 1 = second half */ if (shm_get_dsp_value (ntd_M1) EQ 0) { frame_complete = FALSE; len = NT_DATA_SIZE_14400_A; #ifdef _SIMULATION_ cl_set_frame_desc_0(&ra_data->rlp->dl_frame_desc, ra_data->rlp->dl_buf, NT_DATA_SIZE_14400_A + NT_DATA_SIZE_14400_B); ra_data->ra_data_ind.sdu.l_buf = (NT_DATA_SIZE_14400_A + NT_DATA_SIZE_14400_B) << 3; #else rlp_rbm_get_next_buffer(&ra_data->rlp->dl_frame_desc); #endif } else if (shm_get_dsp_value (ntd_fcs_ok) EQ 0) { frame_complete = TRUE; len = NT_DATA_SIZE_14400_B; ra_data->rlp->dl_frame_desc.Adr[0] += NT_DATA_SIZE_14400_A; } else { #ifdef TRACE_RA_RLP TRACE_EVENT("FCS-Error"); ra_data->rlp->fcs_error++; #endif frame_complete = FALSE; len = 0; } break; } if (len > 0) { shm_get_dsp_buffer(&ra_data->rlp->dl_frame_desc, ra_data->shm.shm_addr[adr_ntd_data]+wof_ntd_data, len); shm_set_dsp_value (ntd_byte_cnt, 0); if (frame_complete) { l1i_ra_data_ind(hCommRLP); } } } }