| /***************************************************************************** |
| * Copyright Statement: |
| * -------------------- |
| * This software is protected by Copyright and the information contained |
| * herein is confidential. The software may not be copied and the information |
| * contained herein may not be used or disclosed except with the written |
| * permission of MediaTek Inc. (C) 2005 |
| * |
| * BY OPENING THIS FILE, BUYER HEREBY UNEQUIVOCALLY ACKNOWLEDGES AND AGREES |
| * THAT THE SOFTWARE/FIRMWARE AND ITS DOCUMENTATIONS ("MEDIATEK SOFTWARE") |
| * RECEIVED FROM MEDIATEK AND/OR ITS REPRESENTATIVES ARE PROVIDED TO BUYER ON |
| * AN "AS-IS" BASIS ONLY. MEDIATEK EXPRESSLY DISCLAIMS ANY AND ALL WARRANTIES, |
| * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE IMPLIED WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE OR NONINFRINGEMENT. |
| * NEITHER DOES MEDIATEK PROVIDE ANY WARRANTY WHATSOEVER WITH RESPECT TO THE |
| * SOFTWARE OF ANY THIRD PARTY WHICH MAY BE USED BY, INCORPORATED IN, OR |
| * SUPPLIED WITH THE MEDIATEK SOFTWARE, AND BUYER AGREES TO LOOK ONLY TO SUCH |
| * THIRD PARTY FOR ANY WARRANTY CLAIM RELATING THERETO. MEDIATEK SHALL ALSO |
| * NOT BE RESPONSIBLE FOR ANY MEDIATEK SOFTWARE RELEASES MADE TO BUYER'S |
| * SPECIFICATION OR TO CONFORM TO A PARTICULAR STANDARD OR OPEN FORUM. |
| * |
| * BUYER'S SOLE AND EXCLUSIVE REMEDY AND MEDIATEK'S ENTIRE AND CUMULATIVE |
| * LIABILITY WITH RESPECT TO THE MEDIATEK SOFTWARE RELEASED HEREUNDER WILL BE, |
| * AT MEDIATEK'S OPTION, TO REVISE OR REPLACE THE MEDIATEK SOFTWARE AT ISSUE, |
| * OR REFUND ANY SOFTWARE LICENSE FEES OR SERVICE CHARGE PAID BY BUYER TO |
| * MEDIATEK FOR SUCH MEDIATEK SOFTWARE AT ISSUE. |
| * |
| * THE TRANSACTION CONTEMPLATED HEREUNDER SHALL BE CONSTRUED IN ACCORDANCE |
| * WITH THE LAWS OF THE STATE OF CALIFORNIA, USA, EXCLUDING ITS CONFLICT OF |
| * LAWS PRINCIPLES. ANY DISPUTES, CONTROVERSIES OR CLAIMS ARISING THEREOF AND |
| * RELATED THERETO SHALL BE SETTLED BY ARBITRATION IN SAN FRANCISCO, CA, UNDER |
| * THE RULES OF THE INTERNATIONAL CHAMBER OF COMMERCE (ICC). |
| * |
| *****************************************************************************/ |
| |
| /******************************************************************************* |
| * Filename: |
| * --------- |
| * dispatcher_if.c |
| * |
| * Project: |
| * -------- |
| * VMOLY |
| * |
| * Description: |
| * ------------ |
| * Dispatcher public interface implementation. |
| * |
| * Author: |
| * ------- |
| * ------- |
| * |
| *******************************************************************************/ |
| |
| #include "dispatcher_if.h" |
| #include "dispatcher_struct.h" |
| #include "global_def.h" |
| #include "dispatcher_msgid.h" |
| #include "qmu_bm_util.h" |
| #include "md_sap.h" |
| #include "dispatcher_debug.h" |
| #include "dispatcher_data_path_trace_utmd.h" |
| /** |
| * ipcore registered dl callback to dispatcher |
| */ |
| static dispatcher_dlvr_dl_did_f g_funcptr_ipcore_dl_did_cbk; |
| static kal_bool wtunnel_cbk_set = KAL_FALSE; |
| |
| |
| /** |
| * init function for dispatcher module |
| * init the global control context & register DL callback with wifi tunnel |
| */ |
| kal_bool dispatcher_init(void) |
| { |
| //wtunnel_reg_dl_cbk(dispatcher_on_dl_did_cbk) |
| //DISPATCHER_REGISTER_DL_DID_CBK(dispatcher_on_dl_did_cbk); |
| //memset(g_dispatcher_cntx, 0, sizeof(g_dispatcher_cntx)); |
| dispatcher_init_control_cntx(); |
| MD_TRC_DISPATCHER_TR_INIT_ENTRY(); |
| return KAL_TRUE; |
| } |
| |
| |
| /** |
| * reset function for dispatcher module |
| * reset the global control context & reset globals |
| */ |
| kal_bool dispatcher_reset(void) |
| { |
| //memset(g_dispatcher_cntx, 0, sizeof(g_dispatcher_cntx)); |
| dispatcher_init_control_cntx(); |
| g_funcptr_ipcore_dl_did_cbk = NULL; |
| dispatcher_ctrl_set_current_protoidx(0); |
| MD_TRC_DISPATCHER_TR_RESET_ENTRY(); |
| return KAL_TRUE; |
| } |
| |
| |
| /** |
| * ILM function for dispatcher module |
| * handle corresponding ILM for control path |
| * update the bearer and cid binding status to dispatcher control context |
| */ |
| void dispatcher_on_ilm(ilm_struct *p_ilm) |
| { |
| kal_uint8 curr_protoidx = p_ilm->dest_mod_id - MOD_DISPATCHER; |
| dispatcher_ctrl_set_current_protoidx(curr_protoidx); |
| switch (p_ilm->msg_id) { |
| /*WO->DISPATCHER bearer related*/ |
| case MSG_ID_N3EPC_DISPATCHER_BEARER_ACT_REQ: |
| if(KAL_FALSE == wtunnel_cbk_set) { |
| DISPATCHER_REGISTER_DL_DID_CBK(dispatcher_on_dl_did_cbk); |
| wtunnel_cbk_set = KAL_TRUE; |
| } |
| n3epc_dispatcher_bearer_act_req( |
| (n3epc_dispatcher_bearer_act_req_struct*)p_ilm->local_para_ptr); |
| break; |
| |
| case MSG_ID_N3EPC_DISPATCHER_BEARER_DEACT_REQ: |
| n3epc_dispatcher_bearer_deact_req( |
| (n3epc_dispatcher_bearer_deact_req_struct*)p_ilm->local_para_ptr); |
| break; |
| |
| /*WO->DISPATCHER binding related*/ |
| case MSG_ID_N3EPC_DISPATCHER_PDN_BIND_REQ: |
| n3epc_dispatcher_pdn_bind_req( |
| (n3epc_dispatcher_pdn_bind_req_struct*)p_ilm->local_para_ptr, |
| p_ilm->src_mod_id); |
| break; |
| |
| case MSG_ID_N3EPC_DISPATCHER_PDN_UNBIND_REQ: |
| n3epc_dispatcher_pdn_unbind_req( |
| (n3epc_dispatcher_pdn_unbind_req_struct*)p_ilm->local_para_ptr, |
| p_ilm->src_mod_id); |
| break; |
| |
| /*DISPATCHER->IPCORE binding related*/ |
| case MSG_ID_IPCORE_DISPATCHER_PDN_BIND_RSP: |
| ipcore_dispatcher_pdn_bind_rsp( |
| (ipcore_dispatcher_pdn_bind_rsp_struct*)p_ilm->local_para_ptr); |
| break; |
| #ifdef ATEST_SYS_DISPATCHER |
| case MSG_ID_N3EPC_DISPATCHER_PDN_BIND_CNF: |
| case MSG_ID_N3EPC_DISPATCHER_PDN_UNBIND_CNF: |
| dispatcher_ut_handling_n3epc_ilm(p_ilm); |
| break; |
| #endif |
| default: |
| MD_TRC_DISPATCHER_TR_ILM_WRONG_MSG_ID(p_ilm->msg_id); |
| break; |
| } |
| } |
| |
| |
| /** |
| * DL callback register to Dispatcher module |
| * Ipcore register its DL callback via this API |
| */ |
| void dispatcher_reg_cbk_dlvr_dl_did(dispatcher_dlvr_dl_did_f pf_dlvr_did) |
| { |
| //need to set the ipcore dl callback |
| g_funcptr_ipcore_dl_did_cbk = pf_dlvr_did; |
| |
| } |
| |
| |
| /****************************************************************** |
| ****************Data path functions****************************** |
| *****************************************************************/ |
| |
| /** |
| * DL callback from wifi tunnel (wtunnel->dispatcher->ipcore) |
| * 1. bearer id validataion first & convert to pdn_id |
| * 2. get binding state for pdn_id |
| * 3. forward data to ipcore by pdn_id |
| * 4. drop the DID if anything fails |
| */ |
| void dispatcher_on_dl_did_cbk(kal_uint8 bearer_id, upcm_did* p_head, |
| upcm_did* p_tail, kal_uint8 protocol_idx) |
| { |
| //dispatch to the Ipcore by checking the dlcbk registered or not |
| kal_bool is_bearer_active = KAL_FALSE; |
| MD_TRC_DISPATCHER_DATA_TRACE_RCV_DL_DID(bearer_id, p_head, p_tail, protocol_idx); |
| |
| if (IS_VALID_BEARERID(bearer_id)) |
| { |
| is_bearer_active = dispatcher_check_is_bearer_active_by_bearerid(bearer_id, protocol_idx); |
| if (KAL_TRUE == is_bearer_active) |
| { |
| dispatcher_forward_dl_did_to_ipc(bearer_id, p_head, p_tail, protocol_idx); |
| return; |
| } |
| } |
| /*bearer id is not valid,drop did here*/ |
| //upcm_did_dest_q(p_head, p_tail); |
| MD_TRC_DISPATCHER_TR_DL_DID_DROP_BEARER_STATS(bearer_id, is_bearer_active, p_head, p_tail); |
| DISPATCHER_DROP_DL_DID(bearer_id, p_head, p_tail, protocol_idx); |
| } |
| |
| |
| void dispatcher_forward_dl_did_to_ipc(kal_uint8 bearer_id, upcm_did* p_head, |
| upcm_did* p_tail, kal_uint8 protocol_idx) |
| { |
| kal_uint32 pdn_id = 0; |
| DISPATCHER_CONVERT_BEARERID_TO_PDNID(bearer_id, pdn_id); |
| if (g_funcptr_ipcore_dl_did_cbk) { |
| MD_TRC_DISPATCHER_DATA_TRACE_FORWARD_DL_DID(pdn_id, p_head, p_tail, protocol_idx); |
| g_funcptr_ipcore_dl_did_cbk(pdn_id, p_head, p_tail, protocol_idx); |
| } else { |
| MD_TRC_DISPATCHER_TR_DL_DID_DROP_NULL_CBK(p_head, p_tail); |
| DISPATCHER_DROP_DL_DID(bearer_id, p_head, p_tail, protocol_idx); |
| } |
| } |
| |
| |
| void dispatcher_drop_dl_did(kal_uint8 bearer_id, upcm_did* p_head, |
| upcm_did* p_tail, kal_uint8 protocol_idx) |
| { |
| upcm_did_dest_q_free_buf(p_head, p_tail); |
| } |
| |
| /** |
| * UL GPD flow (ipcore->dispatcher->wtunnel or UPCM) |
| * 1. ebi validataion first, is of wifi bearer, active |
| * 2. get binding state for ebi |
| * 3. forward data to wtunnel by bearerid |
| * 4. if not forward to wifitunnel, forward to UPCM |
| */ |
| void dispatcher_rcv_ul_gpd_by_ebi(kal_uint32 ebi, qbm_gpd* p_head, qbm_gpd* p_tail, kal_uint8 protocol_idx) |
| { |
| kal_bool is_bearer_active = KAL_FALSE; |
| dispatcher_bind_state_enum bind_state; |
| /*bearer id value is of wifi & bearer is bind with dispatcher*/ |
| MD_TRC_DISPATCHER_DATA_TRACE_RCV_UL_GPD_BY_EBI(ebi, p_head, p_tail, protocol_idx); |
| if (IS_VALID_BEARERID(ebi)) |
| { |
| is_bearer_active = dispatcher_check_is_bearer_active_by_bearerid(ebi, protocol_idx); |
| bind_state = dispatcher_get_bind_state_by_bearerid(ebi, protocol_idx); |
| |
| if ((DISPATCHER_PDN_ST_BIND == bind_state) && |
| (KAL_TRUE == is_bearer_active)) |
| { |
| DISPATCHER_FORWARD_UL_GPD_WTUNNEL(ebi, p_head, p_tail, protocol_idx); |
| return; |
| } |
| } |
| |
| DISPATCHER_FORWARD_UL_GPD_UPCM_BY_EBI(ebi, p_head, p_tail, protocol_idx); |
| |
| } |
| |
| |
| /** |
| * UL GPD flow (ipcore->dispatcher->wtunnel or UPCM) |
| * 1. pdn_id validataion first & convert to bearer_id |
| * 2. get binding state for pdn_id |
| * 3. forward data to wtunnel by bearerid |
| * 4. drop the DID if anything fails |
| * 5. if pdn_id not of wifi, forward to UPCM |
| */ |
| void dispatcher_rcv_ul_gpd_by_pdn(ip_type_e ip_type, kal_uint32 pdn_id, |
| qbm_gpd* p_head, qbm_gpd* p_tail, |
| kal_uint8 protocol_idx) |
| { |
| /*pdn_id belong to wifi pdn*/ |
| MD_TRC_DISPATCHER_DATA_TRACE_RCV_UL_GPD(pdn_id, p_head, p_tail, protocol_idx); |
| if (IS_PDNID_OF_WIFI(pdn_id)) |
| { |
| dispatcher_bind_state_enum bind_state = dispatcher_get_bind_state_by_pdnid(pdn_id, protocol_idx); |
| kal_bool is_bearer_active = dispatcher_check_is_bearer_active_by_pdnid(pdn_id, protocol_idx); |
| if ((DISPATCHER_PDN_ST_BIND == bind_state) && |
| (KAL_TRUE == is_bearer_active)) |
| { |
| //wifi tunnel ul gpd interface without ip_type |
| kal_uint8 bearer_id = 0; |
| DISPATCHER_CONVERT_PDNID_TO_BEARERID(pdn_id, bearer_id); |
| DISPATCHER_FORWARD_UL_GPD_WTUNNEL(bearer_id, p_head, p_tail, protocol_idx); |
| } else { |
| //should drop this here |
| MD_TRC_DISPATCHER_TR_UL_GPD_DROP(pdn_id, is_bearer_active, bind_state, p_head, p_tail); |
| DISPATCHER_DROP_UL_GPD(pdn_id, p_head, p_tail, protocol_idx); |
| } |
| } else { |
| //call UPCM UL GPD interface |
| MD_TRC_DISPATCHER_DATA_TRACE_FORWARD_UL_GPD_UPCM(pdn_id, p_head, p_tail, protocol_idx); |
| DISPATCHER_FORWARD_UL_GPD_UPCM(ip_type, pdn_id, p_head, p_tail, protocol_idx); |
| } |
| } |
| |
| |
| void dispatcher_drop_ul_gpd(kal_uint32 pdn_id, qbm_gpd* p_head, |
| qbm_gpd* p_tail, kal_uint8 protocol_idx) |
| { |
| qbmt_dest_q(p_head, p_tail); |
| } |
| |
| |
| /** |
| * dispatcher UL META interface IPCORE->Dispatcher->wtunnel or UPCM) |
| * meta Q query to lhif & process each meta index |
| * if meta belong to wifi pdn then convert to gpd & keep accumulate for same PDN |
| * forward the gpd list to wtunnel |
| * forward the lhif q to upcm to release meta |
| */ |
| void dispatcher_rcv_ul_meta_queue(kal_uint16 start_idx, kal_uint16 end_idx, |
| LHIF_QUEUE_TYPE queue_type) |
| { |
| kal_uint16 read_idx; |
| lhif_meta_tbl_t *meta_tbl; |
| lhif_meta_tbl_t *meta; |
| kal_uint16 tbl_size; |
| |
| qbm_gpd *head_gpd_p = NULL; |
| qbm_gpd *tail_gpd_p = NULL; |
| kal_uint8 previous_bearer_id = 0; |
| kal_uint8 previous_proto_idx = 0; |
| |
| read_idx = start_idx; |
| MD_TRC_DISPATCHER_DATA_TRACE_RCV_UL_META(queue_type, start_idx, end_idx); |
| //Query meta table |
| DIPSTACHER_QUERY_META_TBL((kal_uint32 **)&meta_tbl, &tbl_size, queue_type); |
| //check each meta index and process |
| do { |
| meta = &meta_tbl[read_idx]; |
| //meta is not ignore & pdn state is bind |
| |
| if (!meta->ignore && IS_PDNID_OF_WIFI(meta->pdn)) |
| { |
| //check bind & bearer status both |
| dispatcher_bind_state_enum bind_state = dispatcher_get_bind_state_by_pdnid(meta->pdn, meta->protocol_idx); |
| kal_bool is_bearer_active = dispatcher_check_is_bearer_active_by_pdnid(meta->pdn, meta->protocol_idx); |
| |
| if ((DISPATCHER_PDN_ST_BIND == bind_state) && |
| (KAL_TRUE == is_bearer_active)) |
| { |
| kal_uint8 curr_bearer_id; |
| kal_uint8 curr_proto_idx; |
| kal_uint8 *ip_packet = NULL; |
| kal_uint32 length = 0; |
| qbm_gpd *curr_gpd_p; |
| kal_uint8 *gpd_data_p; |
| DISPATCHER_CONVERT_PDNID_TO_BEARERID(meta->pdn, curr_bearer_id); |
| curr_proto_idx = meta->protocol_idx; |
| length = meta->length; |
| ip_packet = meta->vrb_addr; |
| if (1 != qbmt_alloc_q_no_tail(QBM_TYPE_NET_UL_SHRD, |
| 1, |
| (void**) &curr_gpd_p, |
| (void**) &curr_gpd_p)) |
| { |
| //gpd allocation failed |
| MD_TRC_DISPATCHER_TR_GPD_ALLOC_FAILED(read_idx); |
| meta->ignore = KAL_TRUE; |
| DISPATCHER_FREE_META_VRB(meta); |
| goto drop; |
| } |
| MD_TRC_DISPATCHER_DATA_TRACE_ALLOC_GPD_INFO(read_idx, meta->pdn, curr_gpd_p); |
| QBM_CACHE_INVALID(ip_packet, length); |
| //find the data ptr |
| dispatcher_utils_set_gpd_datalen(curr_gpd_p, length, (void**) &gpd_data_p); |
| kal_mem_cpy(gpd_data_p, ip_packet, length); |
| QBM_CACHE_FLUSH(gpd_data_p, length); |
| |
| meta->ignore = KAL_TRUE; |
| //dpcopro_rbuf_release(meta->vrb_addr, meta->length); |
| DISPATCHER_FREE_META_VRB(meta); |
| |
| if ((NULL == head_gpd_p) && (NULL == tail_gpd_p)) |
| { |
| head_gpd_p = tail_gpd_p = curr_gpd_p; |
| previous_bearer_id = curr_bearer_id; |
| previous_proto_idx = curr_proto_idx; |
| } |
| else |
| { |
| if ((previous_bearer_id == curr_bearer_id) && |
| (previous_proto_idx == curr_proto_idx)) |
| { |
| //prev & current gpd can be clubbed together so update tail gpd |
| QBM_DES_SET_NEXT(tail_gpd_p, curr_gpd_p); |
| tail_gpd_p = curr_gpd_p; |
| MD_TRC_DISPATCHER_DATA_TRACE_CLUB_GPD_INFO(head_gpd_p, tail_gpd_p); |
| } |
| else |
| { |
| //previous GPD & curr gpd are of different bearer or proto |
| //call made to wtunnel for previous gpd head tail |
| DISPATCHER_FORWARD_UL_GPD_WTUNNEL(previous_bearer_id, |
| head_gpd_p, tail_gpd_p, previous_proto_idx); |
| //now update the variable |
| previous_bearer_id = curr_bearer_id; |
| previous_proto_idx = curr_proto_idx; |
| head_gpd_p = tail_gpd_p = curr_gpd_p; |
| } |
| } |
| } /*PDN state is not bind and by any how the ipcore has send this to Dispatcher*/ |
| else |
| { |
| /*PDN is in range of wifi PDN & not bind*/ |
| MD_TRC_DISPATCHER_TR_IGR_META_INDEX(read_idx, meta->pdn, bind_state, is_bearer_active); |
| meta->ignore = KAL_TRUE; |
| //dpcopro_rbuf_release(meta->vrb_addr, meta->length); |
| DISPATCHER_FREE_META_VRB(meta); |
| } |
| } |
| |
| drop: |
| read_idx ++; |
| if (read_idx == tbl_size) { |
| read_idx = 0; |
| } |
| } while (read_idx != end_idx); |
| |
| /*if any allocated gpd is there*/ |
| if(head_gpd_p) { |
| DISPATCHER_FORWARD_UL_GPD_WTUNNEL(previous_bearer_id, head_gpd_p, |
| tail_gpd_p, previous_proto_idx); |
| } |
| /*forward to upcm to release meta & process non wifi pdn meta idxs*/ |
| MD_TRC_DISPATCHER_DATA_TRACE_FORWARD_UL_META(queue_type, start_idx, end_idx); |
| DISPATCHER_FORWARD_UL_META_UPCM(start_idx, end_idx, queue_type); |
| } |
| |
| |
| kal_bool dispatcher_wtunnel_ul_send(kal_uint8 bearer_id, qbm_gpd *head, |
| qbm_gpd *tail, kal_uint8 proto_idx) |
| { |
| MD_TRC_DISPATCHER_DATA_TRACE_FORWARD_UL_GPD_WTUNNEL(bearer_id, head, tail, proto_idx); |
| //actual wtunnel cbk here |
| wtunnel_upp_ul_send(bearer_id, head, tail, proto_idx); |
| return KAL_TRUE; |
| } |
| |
| |
| |
| void dispatcher_utils_set_gpd_datalen(void *p_gpd, kal_uint32 datalen, |
| void **p_payload) |
| { |
| kal_uint8* p_data = NULL; |
| |
| ASSERT(p_gpd && p_payload); |
| |
| if (QBM_DES_GET_BDP(p_gpd)) { |
| void* p_bd = NULL; |
| |
| /* set p_bd data ptr */ |
| p_bd = QBM_DES_GET_DATAPTR(p_gpd); |
| |
| p_data = (kal_uint8*) QBM_DES_GET_DATAPTR(p_bd); |
| |
| /* set p_bd data len */ |
| QBM_DES_SET_DATALEN(p_bd, datalen); |
| |
| /* set p_bd checksum */ |
| qbm_cal_set_checksum(p_bd); |
| } else { |
| p_data = (kal_uint8*) QBM_DES_GET_DATAPTR(p_gpd); |
| } |
| |
| /* set p_gpd data len */ |
| QBM_DES_SET_DATALEN(p_gpd, datalen); |
| |
| /* set p_gpd checksum */ |
| qbm_cal_set_checksum(p_gpd); |
| |
| *p_payload = (void*)(p_data); |
| } |
| |
| |
| /*adding for mini dump , reset sensitive data*/ |
| #if defined(__SENSITIVE_DATA_MOSAIC__) |
| void dispatcher_module_clean(void) |
| { |
| dispatcher_clean_private_data(); |
| } |
| #endif |