Orange Pi5 kernel

/******************************************************************************
 *
 * 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)
{
	struct phl_info_t *phl_info = (struct phl_info_t *)phl;

#ifdef CONFIG_CMD_DISP
	rtw_phl_cmd_notify(phl_info->phl_com, event, NULL, wrole->hw_band);
#else
	PHL_TRACE(COMP_PHL_DBG, _PHL_INFO_, "%s: not support cmd notify\n",
	          __func__);

	rtw_hal_notification(phl_info->hal, event, wrole->hw_band);
#endif /* CONFIG_CMD_DISP */
}

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);
}