INT32
wmt_plat_init (UINT32 co_clock_en)
{
CMB_STUB_CB stub_cb;
INT32 iret;
/*init wmt function ctrl wakelock if wake lock is supported by host platform*/
if(co_clock_en)
{
wmt_plat_soc_co_clock_flag_set(1);
}else
{
wmt_plat_soc_co_clock_flag_set(0);
}
stub_cb.aif_ctrl_cb = wmt_plat_audio_ctrl;
stub_cb.func_ctrl_cb = wmt_plat_func_ctrl;
stub_cb.thermal_query_cb = wmt_plat_thermal_ctrl;
stub_cb.deep_idle_ctrl_cb = wmt_plat_deep_idle_ctrl;
stub_cb.size = sizeof(stub_cb);
/* register to cmb_stub */
iret = mtk_wcn_cmb_stub_reg(&stub_cb);
#ifdef CFG_WMT_WAKELOCK_SUPPORT
wake_lock_init(&wmtWakeLock, WAKE_LOCK_SUSPEND, "wmtFuncCtrl");
osal_sleepable_lock_init(&gOsSLock);
#endif
iret += mtk_wcn_consys_hw_init();
osal_unsleepable_lock_init(&gbgfIrqBle.lock);
WMT_DBG_FUNC("WMT-PLAT: ALPS platform init (%d)\n", iret);
return 0;
}
MTKSTP_BTM_T *stp_btm_init(void)
{
INT32 i = 0x0;
INT32 ret =-1;
osal_unsleepable_lock_init(&stp_btm->wq_spinlock);
osal_event_init(&stp_btm->STPd_event);
stp_btm->wmt_notify = wmt_lib_btm_cb;
RB_INIT(&stp_btm->rFreeOpQ, STP_BTM_OP_BUF_SIZE);
RB_INIT(&stp_btm->rActiveOpQ, STP_BTM_OP_BUF_SIZE);
/* Put all to free Q */
for (i = 0; i < STP_BTM_OP_BUF_SIZE; i++)
{
osal_signal_init(&(stp_btm->arQue[i].signal));
_stp_btm_put_op(stp_btm, &stp_btm->rFreeOpQ, &(stp_btm->arQue[i]));
}
/*Generate PSM thread, to servie STP-CORE for packet retrying and core dump receiving*/
stp_btm->BTMd.pThreadData = (VOID *)stp_btm;
stp_btm->BTMd.pThreadFunc = (VOID *)_stp_btm_proc;
osal_memcpy(stp_btm->BTMd.threadName, BTM_THREAD_NAME , osal_strlen(BTM_THREAD_NAME));
ret = osal_thread_create(&stp_btm->BTMd);
if (ret < 0)
{
STP_BTM_ERR_FUNC("osal_thread_create fail...\n");
goto ERR_EXIT1;
}
/* Start STPd thread*/
ret = osal_thread_run(&stp_btm->BTMd);
if(ret < 0)
{
STP_BTM_ERR_FUNC("osal_thread_run FAILS\n");
goto ERR_EXIT1;
}
return stp_btm;
ERR_EXIT1:
return NULL;
}
MTKSTP_DBG_T *stp_dbg_init(VOID *btm_half)
{
MTKSTP_DBG_T *stp_dbg= NULL;
STP_DBG_INFO_FUNC("stp-dbg init\n");
stp_dbg = osal_kzalloc_sleep(osal_sizeof(MTKSTP_DBG_T));
if (!stp_dbg){
STP_DBG_ERR_FUNC("-ENOMEM\n");
goto ERR_EXIT1;
}
stp_dbg->logsys = osal_malloc(osal_sizeof(MTKSTP_LOG_SYS_T));
if (!stp_dbg->logsys){
STP_DBG_ERR_FUNC("-ENOMEM stp_gdb->logsys\n");
goto ERR_EXIT2;
}
osal_memset(stp_dbg->logsys, 0, osal_sizeof(MTKSTP_LOG_SYS_T));
osal_unsleepable_lock_init(&(stp_dbg->logsys->lock));
stp_dbg->pkt_trace_no = 0;
stp_dbg->is_enable = 0;
if (btm_half != NULL){
stp_dbg->btm = btm_half;
} else {
stp_dbg->btm = NULL;
}
return stp_dbg;
ERR_EXIT2:
osal_kfree(stp_dbg);
return NULL;
ERR_EXIT1:
return NULL;
}