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_SEC_C_
#include "phl_headers.h"

#define RTW_PHL_EXT_KEY_LEN 32
#define RTW_SEC_KEY_TYPE_NUM 3

static enum rtw_phl_status
_phl_set_key(struct phl_info_t *phl_info,
             struct rtw_phl_stainfo_t *sta,
             struct phl_sec_param_h *crypt,
             u8 *keybuf)
{
	enum rtw_hal_status hal_status = RTW_HAL_STATUS_FAILURE;
	enum rtw_phl_status phl_status = RTW_PHL_STATUS_FAILURE;

	if(keybuf)
		PHL_INFO("Add_key:: enc_type(%d) key_id(%d) key_type(%d)\n",
			 crypt->enc_type, crypt->keyid, crypt->key_type);
	hal_status = rtw_hal_set_key(phl_info->hal,
	                             sta,
	                             crypt->enc_type,
	                             (crypt->key_len==RTW_PHL_EXT_KEY_LEN)?1:0,
	                             crypt->spp,
	                             crypt->keyid,
	                             crypt->key_type,
	                             keybuf);
	if (hal_status == RTW_HAL_STATUS_SUCCESS)
		phl_status = RTW_PHL_STATUS_SUCCESS;

	return phl_status;
}

#ifdef CONFIG_CMD_DISP
struct cmd_sec_param {
	struct rtw_phl_stainfo_t *sta;
	struct phl_sec_param_h *crypt;
	u8 *keybuf;
};

static void
_phl_cmd_set_key_done(void *drv_priv,
                      u8 *cmd,
                      u32 cmd_len,
                      enum rtw_phl_status status)
{
	struct cmd_sec_param *param = (struct cmd_sec_param *)cmd;

	if (param) {
		if (param->keybuf)
			_os_kmem_free(drv_priv,
			             param->keybuf,
			             param->crypt->key_len);

		if (param->crypt)
			_os_kmem_free(drv_priv,
			             param->crypt,
			             sizeof(struct phl_sec_param_h));

		_os_kmem_free(drv_priv, param, cmd_len);
	}
}

enum rtw_phl_status
_phl_cmd_set_key(void *phl,
                 struct rtw_phl_stainfo_t *sta,
                 struct phl_sec_param_h *crypt,
                 u8 *keybuf,
                 enum phl_cmd_type cmd_type,
                 u32 cmd_timeout)
{
	struct phl_info_t *phl_info = (struct phl_info_t *)phl;
	void *drv = phl_to_drvpriv(phl_info);
	enum rtw_phl_status psts = RTW_PHL_STATUS_FAILURE;

	struct cmd_sec_param *param = NULL;
	u32 param_len = 0, crypt_len = 0;

	if (cmd_type == PHL_CMD_DIRECTLY) {
		psts = _phl_set_key(phl_info, sta, crypt, keybuf);
		goto _exit;
	}

	param_len = sizeof(struct cmd_sec_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->sta = sta;

	crypt_len = sizeof(struct phl_sec_param_h);
	param->crypt = _os_kmem_alloc(drv, crypt_len);
	if (param->crypt == NULL) {
		PHL_ERR("%s: alloc param->crypt failed!\n", __func__);
		psts = RTW_PHL_STATUS_RESOURCE;
		goto error_crypt;
	}
	_os_mem_set(drv, param->crypt, 0, crypt_len);
	_os_mem_cpy(drv, param->crypt, crypt, crypt_len);

	if (keybuf) { /* set key */
		param->keybuf = _os_kmem_alloc(drv, param->crypt->key_len);
		if (param->keybuf == NULL) {
			PHL_ERR("%s: alloc param->keybuf failed!\n", __func__);
			psts = RTW_PHL_STATUS_RESOURCE;
			goto error_key_buf;
		}
		_os_mem_cpy(drv, param->keybuf, keybuf, param->crypt->key_len);
	}

	psts = phl_cmd_enqueue(phl_info,
	                       sta->wrole->hw_band,
	                       MSG_EVT_SEC_KEY,
	                       (u8 *)param,
	                       param_len,
	                       _phl_cmd_set_key_done,
	                       cmd_type,
	                       cmd_timeout);

	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 */
		psts = RTW_PHL_STATUS_FAILURE;
		goto error_cmd;
	}

	return psts;

error_cmd:
	if (param->keybuf)
		_os_kmem_free(drv, param->keybuf, param->crypt->key_len);
error_key_buf:
	if (param->crypt)
		_os_kmem_free(drv, param->crypt, crypt_len);

error_crypt:
	if (param)
		_os_kmem_free(drv, param, param_len);

error_param:
_exit:
	return psts;
}

enum rtw_phl_status
phl_cmd_set_key_hdl(struct phl_info_t *phl_info, u8 *param)
{
	struct cmd_sec_param *cmd_sec_param = (struct cmd_sec_param *)param;

	return _phl_set_key(phl_info,
	                    cmd_sec_param->sta,
	                    cmd_sec_param->crypt,
	                    cmd_sec_param->keybuf);
}
#endif /* CONFIG_CMD_DISP */

enum rtw_phl_status
rtw_phl_cmd_add_key(void *phl,
                    struct rtw_phl_stainfo_t *sta,
                    struct phl_sec_param_h *crypt,
                    u8 *keybuf,
                    enum phl_cmd_type cmd_type,
                    u32 cmd_timeout)
{
#ifdef CONFIG_CMD_DISP
	return _phl_cmd_set_key(phl, sta, crypt, keybuf, cmd_type, cmd_timeout);
#else
	PHL_TRACE(COMP_PHL_DBG, _PHL_INFO_, "%s: not support add key cmd\n",
	          __func__);

	return _phl_set_key((struct phl_info_t *)phl, sta, crypt, keybuf);
#endif /* CONFIG_CMD_DISP */
}

enum rtw_phl_status
rtw_phl_cmd_del_key(void *phl,
                    struct rtw_phl_stainfo_t *sta,
                    struct phl_sec_param_h *crypt,
                    enum phl_cmd_type cmd_type,
                    u32 cmd_timeout)
{
#ifdef CONFIG_CMD_DISP
	return _phl_cmd_set_key(phl, sta, crypt, NULL, cmd_type, cmd_timeout);
#else
	PHL_TRACE(COMP_PHL_DBG, _PHL_INFO_, "%s: not support del key cmd\n",
	          __func__);

	return _phl_set_key((struct phl_info_t *)phl, sta, crypt, NULL);
#endif /* CONFIG_CMD_DISP */
}

u8 rtw_phl_trans_sec_mode(u8 unicast, u8 multicast)
{
	u8	ret = RTW_SEC_ENT_MODE_0;

	if (RTW_ENC_NONE == unicast && RTW_ENC_NONE == multicast) {
		ret = RTW_SEC_ENT_MODE_0;
	} else if ((RTW_ENC_WEP40 == unicast && RTW_ENC_WEP40 == multicast) ||
		(RTW_ENC_WEP104 == unicast && RTW_ENC_WEP104 == multicast)) {
		ret = RTW_SEC_ENT_MODE_1;
	} else if (RTW_ENC_WEP40 == multicast || RTW_ENC_WEP104 == multicast) {
		ret = RTW_SEC_ENT_MODE_3;
	} else {
		ret = RTW_SEC_ENT_MODE_2;
	}

	return ret;
}

u8 rtw_phl_get_sec_cam_idx(void *phl,
                           struct rtw_phl_stainfo_t *sta,
                           u8 keyid,
                           u8 key_type)
{
	u8 ret = 0;
	struct phl_info_t *phl_info = (struct phl_info_t *)phl;

	ret = (u8) rtw_hal_search_key_idx(phl_info->hal, sta, keyid, key_type);

	return ret;
}