/******************************************************************************
|
*
|
* Copyright(c) 2019 Realtek Corporation. All rights reserved.
|
*
|
* 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.
|
*
|
******************************************************************************/
|
#include "hw_seq.h"
|
|
#if MAC_AX_FW_REG_OFLD
|
u32 mac_set_hwseq_reg(struct mac_ax_adapter *adapter,
|
u8 idx,
|
u16 val)
|
{
|
u32 ret = 0;
|
u8 *buf;
|
#if MAC_AX_PHL_H2C
|
struct rtw_h2c_pkt *h2cb;
|
#else
|
struct h2c_buf *h2cb;
|
#endif
|
struct mac_ax_set_hwseq_reg *content;
|
|
h2cb = h2cb_alloc(adapter, H2CB_CLASS_CMD);
|
if (!h2cb)
|
return MACNPTR;
|
|
buf = h2cb_put(h2cb, sizeof(struct mac_ax_set_hwseq_reg));
|
if (!buf) {
|
ret = MACNOBUF;
|
goto fail;
|
}
|
|
content = (struct mac_ax_set_hwseq_reg *)buf;
|
|
content->reg_idx = idx;
|
content->seq_val = val;
|
|
ret = h2c_pkt_set_hdr(adapter, h2cb,
|
FWCMD_TYPE_H2C,
|
FWCMD_H2C_CAT_MAC,
|
FWCMD_H2C_CL_FW_OFLD,
|
FWCMD_H2C_FUNC_SET_HWSEQ_REG,
|
0,
|
1);
|
|
if (ret)
|
goto fail;
|
|
ret = h2c_pkt_build_txd(adapter, h2cb);
|
if (ret)
|
goto fail;
|
|
#if MAC_AX_PHL_H2C
|
ret = PLTFM_TX(h2cb);
|
#else
|
ret = PLTFM_TX(h2cb->data, h2cb->len);
|
#endif
|
fail:
|
h2cb_free(adapter, h2cb);
|
|
return ret;
|
}
|
#else
|
u32 mac_set_hwseq_reg(struct mac_ax_adapter *adapter,
|
u8 idx,
|
u16 val)
|
{
|
u32 reg_val;
|
struct mac_ax_intf_ops *ops = adapter_to_intf_ops(adapter);
|
|
switch (idx) {
|
case R_AX_HW_SEQ_0:
|
reg_val = MAC_REG_R32(R_AX_HW_SEQ_0_1);
|
reg_val &= ~((u32)B_AX_HW_SEQ0_MSK << B_AX_HW_SEQ0_SH);
|
reg_val |= (val << B_AX_HW_SEQ0_SH);
|
MAC_REG_W32(R_AX_HW_SEQ_0_1, reg_val);
|
break;
|
case R_AX_HW_SEQ_1:
|
reg_val = MAC_REG_R32(R_AX_HW_SEQ_0_1);
|
reg_val &= ~((u32)B_AX_HW_SEQ1_MSK << B_AX_HW_SEQ1_SH);
|
reg_val |= (val << B_AX_HW_SEQ1_SH);
|
MAC_REG_W32(R_AX_HW_SEQ_0_1, reg_val);
|
break;
|
case R_AX_HW_SEQ_2:
|
reg_val = MAC_REG_R32(R_AX_HW_SEQ_2_3);
|
reg_val &= ~((u32)B_AX_HW_SEQ2_MSK << B_AX_HW_SEQ2_SH);
|
reg_val |= (val << B_AX_HW_SEQ2_SH);
|
MAC_REG_W32(R_AX_HW_SEQ_2_3, reg_val);
|
break;
|
case R_AX_HW_SEQ_3:
|
reg_val = MAC_REG_R32(R_AX_HW_SEQ_2_3);
|
reg_val &= ~((u32)B_AX_HW_SEQ3_MSK << B_AX_HW_SEQ3_SH);
|
reg_val |= (val << B_AX_HW_SEQ3_SH);
|
MAC_REG_W32(R_AX_HW_SEQ_2_3, reg_val);
|
break;
|
default:
|
return MACNOITEM;
|
}
|
|
return MACSUCCESS;
|
}
|
#endif
|
