[Feature]Upload Modem source code
Change-Id: Id4294f30faced84d3e6fd6d5e61e1111bf287a37
diff --git a/mcu/service/mtf/base/mt_dispatcher.c b/mcu/service/mtf/base/mt_dispatcher.c
new file mode 100644
index 0000000..d9a37dd
--- /dev/null
+++ b/mcu/service/mtf/base/mt_dispatcher.c
@@ -0,0 +1,154 @@
+/*****************************************************************************
+* 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) 2012
+*
+* 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:
+ * ---------
+ * mt_task.c
+ *
+ * Project:
+ * --------
+ * UMOLYA
+ *
+ * Description:
+ * ------------
+ * MT_Framework task implement
+ *
+ * Author:
+ * -------
+ * -------
+ *
+ *
+ * ==========================================================================
+ * $Log$
+ *
+ *
+ ****************************************************************************/
+
+/*****************************************************************************/
+/* Includes */
+/*****************************************************************************/
+
+#include "mt.h"
+#include "mt_dispatcher.h"
+
+/*****************************************************************************/
+/* Define */
+/*****************************************************************************/
+
+/*****************************************************************************/
+/* Global variables */
+/*****************************************************************************/
+
+/*****************************************************************************/
+/* External functions */
+/*****************************************************************************/
+
+/*****************************************************************************/
+/* Internal functions */
+/*****************************************************************************/
+
+/*****************************************************************************/
+/* Function Body */
+/*****************************************************************************/
+
+int
+mt_dispatcher_entry_init(void* entry, kal_uint16 magic, kal_uint32 dispatch_key, kal_uint32 dispatch_key_mask)
+{
+ mt_dispatcher_entry_head_t *h = entry;
+ if (h->inited) {
+ return -1;
+ }
+
+ h->magic = magic;
+ h->inited = KAL_TRUE;
+ h->dispatch_key = dispatch_key;
+ h->next = NULL;
+ h->dispatch_key_mask= dispatch_key_mask;
+
+ return 0;
+}
+
+int
+mt_dispatcher_add_entry(mt_dispatcher_list_t *list, kal_uint32 code, void* entry)
+{
+ mt_dispatcher_entry_head_t *e = entry;
+ e->next = NULL;
+ e->dispatch_key = code;
+ if (list->tail == NULL) {
+ list->head = list->tail = e;
+ } else {
+ list->tail = ((mt_dispatcher_entry_head_t *)list->tail)->next = e;
+ }
+
+ return 0;
+}
+
+void*
+mt_dispatcher_find_entry(mt_dispatcher_list_t *list, kal_uint32 code, void* last_entry)
+{
+ mt_dispatcher_entry_head_t *e = (last_entry?((mt_dispatcher_entry_head_t *)last_entry)->next:list->head);
+ while(e) {
+ if (e->dispatch_key_mask == RULE_CODE_MASK_FLAG_ALL_ON && e->dispatch_key == code)
+ {
+ return e;
+ }
+ else if (e->dispatch_key_mask == RULE_CODE_MASK_FLAG_ALL_OFF)
+ {
+ return e;
+ }
+ else if(((e->dispatch_key_mask & RULE_CODE_MASK_ICD_TYPE_FLAG_ON)?(GET_ICD_TYPE_FROM_RULE_CODE(e->dispatch_key) == GET_ICD_TYPE_FROM_RULE_CODE(code)):KAL_TRUE)
+ && ((e->dispatch_key_mask & RULE_CODE_MASK_ICD_CODE_FLAG_ON)?(GET_ICD_CODE_FROM_RULE_CODE(e->dispatch_key) == GET_ICD_CODE_FROM_RULE_CODE(code)):KAL_TRUE)
+ && ((e->dispatch_key_mask & RULE_CODE_MASK_ICD_PROTOCOL_FLAG_ON)?(GET_ICD_PROTOCOL_FROM_RULE_CODE(e->dispatch_key) == GET_ICD_PROTOCOL_FROM_RULE_CODE(code)):KAL_TRUE))
+ {
+ return e;
+ }
+ e = e->next;
+ }
+ return NULL;
+}
+void
+mt_dispatcher_verify(void* d, kal_uint16 magic)
+{
+ mt_dispatcher_entry_head_t *e = d;
+ EXT_ASSERT(e->magic == magic, e->magic, magic, 0);
+}
+
+void
+mt_dispatcher_init()
+{
+ EXT_ASSERT(MT_DISPATCHER_ENTRY_RESERVED_SIZE >= sizeof(mt_dispatcher_entry_head_t), MT_DISPATCHER_ENTRY_RESERVED_SIZE, sizeof(mt_dispatcher_entry_head_t), 0);
+}