/******************************************************************************
|
*
|
* Copyright(c) 2019 Realtek Corporation.
|
*
|
* This program is free software; you can redistribute it and/or modify it
|
* under the terms of version 2 of the GNU General Public License as
|
* published by the Free Software Foundation.
|
*
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
* more details.
|
*
|
*****************************************************************************/
|
#define _PHL_NOTIFY_C_
|
#include "phl_headers.h"
|
|
#ifdef CONFIG_CMD_DISP
|
struct cmd_notify_param {
|
u8 hw_idx;
|
void *hal_cmd;
|
enum phl_msg_evt_id event;
|
};
|
|
static void _phl_notify_done(void *drv_priv, u8 *cmd, u32 cmd_len, enum rtw_phl_status status)
|
{
|
if (cmd) {
|
_os_kmem_free(drv_priv, cmd, cmd_len);
|
cmd = NULL;
|
PHL_INFO("%s.....\n", __func__);
|
}
|
}
|
|
enum rtw_phl_status
|
phl_notify_cmd_hdl(struct phl_info_t *phl_info, u8 *param)
|
{
|
struct cmd_notify_param *cmd_notify = (struct cmd_notify_param *)param;
|
|
if (cmd_notify->event == MSG_EVT_NOTIFY_BB ||
|
cmd_notify->event == MSG_EVT_NOTIFY_RF ||
|
cmd_notify->event == MSG_EVT_NOTIFY_MAC)
|
rtw_hal_cmd_notification(phl_info->hal,
|
cmd_notify->event,
|
cmd_notify->hal_cmd,
|
cmd_notify->hw_idx);
|
else
|
rtw_hal_notification(phl_info->hal, cmd_notify->event, cmd_notify->hw_idx);
|
|
return RTW_PHL_STATUS_SUCCESS;
|
}
|
|
enum rtw_phl_status
|
rtw_phl_cmd_notify(struct rtw_phl_com_t *phl_com,
|
enum phl_msg_evt_id event,
|
void *hal_cmd,
|
u8 hw_idx)
|
{
|
void *drv = phlcom_to_drvpriv(phl_com);
|
enum rtw_phl_status psts = RTW_PHL_STATUS_FAILURE;
|
|
struct cmd_notify_param *param = NULL;
|
u32 param_len = 0;
|
|
param_len = sizeof(struct cmd_notify_param);
|
param = _os_kmem_alloc(drv, param_len);
|
if (param == NULL) {
|
PHL_ERR("%s: alloc param failed!\n", __func__);
|
psts = RTW_PHL_STATUS_RESOURCE;
|
goto error_param;
|
}
|
_os_mem_set(drv, param, 0, param_len);
|
|
param->event = event;
|
param->hw_idx = hw_idx;
|
param->hal_cmd = hal_cmd;
|
psts = phl_cmd_enqueue(phl_com->phl_priv,
|
hw_idx,
|
MSG_EVT_NOTIFY_HAL,
|
(u8 *)param,
|
param_len,
|
_phl_notify_done,
|
PHL_CMD_NO_WAIT,
|
0);
|
|
if (is_cmd_failure(psts)) {
|
/* Send cmd success, but wait cmd fail*/
|
psts = RTW_PHL_STATUS_FAILURE;
|
} else if (psts != RTW_PHL_STATUS_SUCCESS) {
|
/* Send cmd fail */
|
_os_kmem_free(drv, param, param_len);
|
psts = RTW_PHL_STATUS_FAILURE;
|
}
|
|
error_param:
|
return psts;
|
}
|
#endif /* CONFIG_CMD_DISP */
|
|
void rtw_phl_notification(void *phl,
|
enum phl_msg_evt_id event,
|
struct rtw_wifi_role_t *wrole,
|
bool direct)
|
{
|
struct phl_info_t *phl_info = (struct phl_info_t *)phl;
|
struct rtw_wifi_role_link_t *rlink = NULL;
|
u8 idx = 0;
|
|
for (idx = 0; idx < wrole->rlink_num; idx++) {
|
rlink = get_rlink(wrole, idx);
|
/**
|
* caller must make sure the current power state is I/O allowable or the
|
* notification have nothing to do with I/O when "direct" is set to true.
|
*/
|
if (direct)
|
rtw_hal_notification(phl_info->hal, event, rlink->hw_band);
|
else
|
rtw_phl_cmd_notify(phl_info->phl_com, event, NULL, rlink->hw_band);
|
}
|
}
|
|
void rtw_phl_dev_terminate_ntf(void *phl)
|
{
|
struct phl_info_t *phl_info = (struct phl_info_t *)phl;
|
|
SET_STATUS_FLAG(phl_info->phl_com->dev_state, RTW_DEV_SURPRISE_REMOVAL);
|
phl_disp_eng_notify_shall_stop(phl_info);
|
rtw_hal_notification(phl_info->hal, MSG_EVT_SURPRISE_REMOVE, HW_BAND_MAX);
|
}
|
