mirror of
https://github.com/RinCat/RTL88x2BU-Linux-Driver.git
synced 2024-12-27 10:31:35 +00:00
451 lines
12 KiB
C
451 lines
12 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2015 - 2017 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 _RTL8822BU_HALINIT_C_
|
|
|
|
#include <hal_data.h> /* HAL DATA */
|
|
#include "../../hal_halmac.h" /* HALMAC API */
|
|
#include "../rtl8822b.h" /* rtl8822b hal common define */
|
|
#include "rtl8822bu.h"
|
|
|
|
#ifndef CONFIG_USB_HCI
|
|
|
|
#error "CONFIG_USB_HCI shall be on!\n"
|
|
|
|
#endif
|
|
|
|
|
|
static void _dbg_dump_macreg(PADAPTER padapter)
|
|
{
|
|
u32 offset = 0;
|
|
u32 val32 = 0;
|
|
u32 index = 0;
|
|
|
|
for (index = 0; index < 64; index++) {
|
|
offset = index * 4;
|
|
val32 = rtw_read32(padapter, offset);
|
|
RTW_INFO("offset : 0x%02x ,val:0x%08x\n", offset, val32);
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_FWLPS_IN_IPS
|
|
u8 rtl8822bu_fw_ips_init(_adapter *padapter)
|
|
{
|
|
struct sreset_priv *psrtpriv = &GET_HAL_DATA(padapter)->srestpriv;
|
|
struct debug_priv *pdbgpriv = &adapter_to_dvobj(padapter)->drv_dbg;
|
|
struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
|
|
|
|
if (pwrctl->bips_processing == _TRUE && psrtpriv->silent_reset_inprogress == _FALSE
|
|
&& GET_HAL_DATA(padapter)->bFWReady == _TRUE && pwrctl->pre_ips_type == 0) {
|
|
systime start_time;
|
|
u8 cpwm_orig, cpwm_now, rpwm;
|
|
u8 bMacPwrCtrlOn = _TRUE;
|
|
|
|
RTW_INFO("%s: Leaving FW_IPS\n", __func__);
|
|
#ifdef CONFIG_LPS_LCLK
|
|
/* for polling cpwm */
|
|
cpwm_orig = 0;
|
|
rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_orig);
|
|
|
|
/* set rpwm */
|
|
rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &rpwm);
|
|
rpwm += 0x80;
|
|
rpwm |= PS_ACK;
|
|
rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm));
|
|
|
|
|
|
RTW_INFO("%s: write rpwm=%02x\n", __func__, rpwm);
|
|
|
|
pwrctl->tog = (rpwm + 0x80) & 0x80;
|
|
|
|
/* do polling cpwm */
|
|
start_time = rtw_get_current_time();
|
|
do {
|
|
|
|
rtw_mdelay_os(1);
|
|
|
|
rtw_hal_get_hwreg(padapter, HW_VAR_CPWM, &cpwm_now);
|
|
if ((cpwm_orig ^ cpwm_now) & 0x80) {
|
|
#ifdef DBG_CHECK_FW_PS_STATE
|
|
RTW_INFO("%s: polling cpwm ok when leaving IPS in FWLPS state, cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n"
|
|
, __func__, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR));
|
|
#endif /* DBG_CHECK_FW_PS_STATE */
|
|
break;
|
|
}
|
|
|
|
if (rtw_get_passing_time_ms(start_time) > 100) {
|
|
RTW_INFO("%s: polling cpwm timeout when leaving IPS in FWLPS state, cpwm_orig=%02x, cpwm_now=%02x, 0x100=0x%x\n",
|
|
__func__, cpwm_orig, cpwm_now, rtw_read8(padapter, REG_CR));
|
|
break;
|
|
}
|
|
} while (1);
|
|
#endif /* CONFIG_LPS_LCLK */
|
|
rtl8822b_set_FwPwrModeInIPS_cmd(padapter, 0);
|
|
|
|
rtw_hal_set_hwreg(padapter, HW_VAR_APFM_ON_MAC, &bMacPwrCtrlOn);
|
|
#ifdef CONFIG_LPS_LCLK
|
|
#ifdef DBG_CHECK_FW_PS_STATE
|
|
if (rtw_fw_ps_state(padapter) == _FAIL) {
|
|
RTW_INFO("after hal init, fw ps state in 32k\n");
|
|
pdbgpriv->dbg_ips_drvopen_fail_cnt++;
|
|
}
|
|
#endif /* DBG_CHECK_FW_PS_STATE */
|
|
#endif /* CONFIG_LPS_LCLK */
|
|
return _SUCCESS;
|
|
}
|
|
return _FAIL;
|
|
}
|
|
|
|
u8 rtl8822bu_fw_ips_deinit(_adapter *padapter)
|
|
{
|
|
struct sreset_priv *psrtpriv = &GET_HAL_DATA(padapter)->srestpriv;
|
|
struct debug_priv *pdbgpriv = &adapter_to_dvobj(padapter)->drv_dbg;
|
|
struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
|
|
|
|
if (pwrctl->bips_processing == _TRUE && psrtpriv->silent_reset_inprogress == _FALSE
|
|
&& GET_HAL_DATA(padapter)->bFWReady == _TRUE && padapter->netif_up == _TRUE) {
|
|
int cnt = 0;
|
|
u8 val8 = 0, rpwm;
|
|
|
|
RTW_INFO("%s: issue H2C to FW when entering IPS\n", __func__);
|
|
|
|
rtl8822b_set_FwPwrModeInIPS_cmd(padapter, 0x1);
|
|
#ifdef CONFIG_LPS_LCLK
|
|
/* poll 0x1cc to make sure H2C command already finished by FW; MAC_0x1cc=0 means H2C done by FW. */
|
|
do {
|
|
val8 = rtw_read8(padapter, REG_HMETFR);
|
|
cnt++;
|
|
RTW_INFO("%s polling REG_HMETFR=0x%x, cnt=%d\n", __func__, val8, cnt);
|
|
rtw_mdelay_os(10);
|
|
} while (cnt < 100 && (val8 != 0));
|
|
|
|
/* H2C done, enter 32k */
|
|
if (val8 == 0) {
|
|
/* set rpwm to enter 32k */
|
|
rtw_hal_get_hwreg(padapter, HW_VAR_RPWM_TOG, &rpwm);
|
|
rpwm += 0x80;
|
|
rpwm |= BIT_SYS_CLK_8822B;
|
|
rtw_hal_set_hwreg(padapter, HW_VAR_SET_RPWM, (u8 *)(&rpwm));
|
|
RTW_INFO("%s: write rpwm=%02x\n", __func__, rpwm);
|
|
pwrctl->tog = (val8 + 0x80) & 0x80;
|
|
|
|
cnt = val8 = 0;
|
|
do {
|
|
val8 = rtw_read8(padapter, REG_CR);
|
|
cnt++;
|
|
RTW_INFO("%s polling 0x100=0x%x, cnt=%d\n", __func__, val8, cnt);
|
|
rtw_mdelay_os(10);
|
|
} while (cnt < 100 && (val8 != 0xEA));
|
|
|
|
#ifdef DBG_CHECK_FW_PS_STATE
|
|
if (val8 != 0xEA)
|
|
RTW_INFO("MAC_1C0=%08x, MAC_1C4=%08x, MAC_1C8=%08x, MAC_1CC=%08x\n"
|
|
, rtw_read32(padapter, 0x1c0), rtw_read32(padapter, 0x1c4)
|
|
, rtw_read32(padapter, 0x1c8), rtw_read32(padapter, REG_HMETFR));
|
|
#endif /* DBG_CHECK_FW_PS_STATE */
|
|
} else {
|
|
RTW_INFO("MAC_1C0=%08x, MAC_1C4=%08x, MAC_1C8=%08x, MAC_1CC=%08x\n"
|
|
, rtw_read32(padapter, 0x1c0), rtw_read32(padapter, 0x1c4)
|
|
, rtw_read32(padapter, 0x1c8), rtw_read32(padapter, REG_HMETFR));
|
|
}
|
|
|
|
RTW_INFO("polling done when entering IPS, check result : 0x100=0x%x, cnt=%d, MAC_1cc=0x%02x\n"
|
|
, rtw_read8(padapter, REG_CR), cnt, rtw_read8(padapter, REG_HMETFR));
|
|
|
|
pwrctl->pre_ips_type = 0;
|
|
#endif /* CONFIG_LPS_LCLK */
|
|
return _SUCCESS;
|
|
}
|
|
|
|
pdbgpriv->dbg_carddisable_cnt++;
|
|
pwrctl->pre_ips_type = 1;
|
|
|
|
return _FAIL;
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_RTW_LED
|
|
static void init_hwled(PADAPTER adapter, u8 enable)
|
|
{
|
|
u8 mode = 0;
|
|
struct led_priv *ledpriv = adapter_to_led(adapter);
|
|
|
|
if (ledpriv->LedStrategy != HW_LED)
|
|
return;
|
|
|
|
rtw_halmac_led_cfg(adapter_to_dvobj(adapter), enable, mode);
|
|
}
|
|
#endif
|
|
|
|
static void hal_init_misc(PADAPTER adapter)
|
|
{
|
|
#ifdef CONFIG_RTW_LED
|
|
struct led_priv *ledpriv = adapter_to_led(adapter);
|
|
|
|
init_hwled(adapter, 1);
|
|
#ifdef CONFIG_RTW_SW_LED
|
|
if (ledpriv->bRegUseLed == _TRUE)
|
|
rtw_halmac_led_cfg(adapter_to_dvobj(adapter), _TRUE, 3);
|
|
#endif
|
|
#endif /* CONFIG_RTW_LED */
|
|
|
|
}
|
|
|
|
u32 rtl8822bu_init(PADAPTER padapter)
|
|
{
|
|
u8 status = _SUCCESS;
|
|
systime init_start_time = rtw_get_current_time();
|
|
|
|
#ifdef CONFIG_FWLPS_IN_IPS
|
|
if (_SUCCESS == rtl8822bu_fw_ips_init(padapter))
|
|
goto exit;
|
|
#endif
|
|
|
|
rtl8822b_init(padapter);
|
|
|
|
hal_init_misc(padapter);
|
|
|
|
exit:
|
|
RTW_INFO("%s in %dms\n", __func__, rtw_get_passing_time_ms(init_start_time));
|
|
|
|
return status;
|
|
}
|
|
|
|
static void hal_deinit_misc(PADAPTER adapter)
|
|
{
|
|
#ifdef CONFIG_RTW_LED
|
|
struct led_priv *ledpriv = adapter_to_led(adapter);
|
|
|
|
init_hwled(adapter, 0);
|
|
#ifdef CONFIG_RTW_SW_LED
|
|
if (ledpriv->bRegUseLed == _TRUE)
|
|
rtw_halmac_led_cfg(adapter_to_dvobj(adapter), _FALSE, 3);
|
|
#endif
|
|
#endif /* CONFIG_RTW_LED */
|
|
}
|
|
|
|
u32 rtl8822bu_deinit(PADAPTER padapter)
|
|
{
|
|
struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
struct dvobj_priv *pobj_priv = adapter_to_dvobj(padapter);
|
|
u8 status = _TRUE;
|
|
|
|
RTW_INFO("==> %s\n", __func__);
|
|
|
|
#ifdef CONFIG_FWLPS_IN_IPS
|
|
if (_SUCCESS == rtl8822bu_fw_ips_deinit(padapter))
|
|
goto exit;
|
|
#endif
|
|
|
|
hal_deinit_misc(padapter);
|
|
status = rtl8822b_deinit(padapter);
|
|
if (status == _FALSE) {
|
|
RTW_INFO("%s: rtl8822b_hal_deinit fail\n", __func__);
|
|
return _FAIL;
|
|
}
|
|
|
|
exit:
|
|
RTW_INFO("%s <==\n", __func__);
|
|
return _SUCCESS;
|
|
}
|
|
|
|
|
|
u32 rtl8822bu_inirp_init(PADAPTER padapter)
|
|
{
|
|
u8 i, status;
|
|
struct recv_buf *precvbuf;
|
|
struct dvobj_priv *pdev = adapter_to_dvobj(padapter);
|
|
struct intf_hdl *pintfhdl = &padapter->iopriv.intf;
|
|
struct recv_priv *precvpriv = &(padapter->recvpriv);
|
|
u32(*_read_port)(struct intf_hdl *pintfhdl, u32 addr, u32 cnt, u8 *pmem);
|
|
#ifdef CONFIG_USB_INTERRUPT_IN_PIPE
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
u32(*_read_interrupt)(struct intf_hdl *pintfhdl, u32 addr);
|
|
#endif
|
|
|
|
#ifdef CONFIG_FWLPS_IN_IPS
|
|
/* Do not sumbit urb repeat */
|
|
struct pwrctrl_priv *pwrctl = adapter_to_pwrctl(padapter);
|
|
|
|
if (pwrctl->bips_processing == _TRUE) {
|
|
status = _SUCCESS;
|
|
goto exit;
|
|
}
|
|
#endif /* CONFIG_FWLPS_IN_IPS */
|
|
|
|
_read_port = pintfhdl->io_ops._read_port;
|
|
|
|
status = _SUCCESS;
|
|
|
|
|
|
precvpriv->ff_hwaddr = RECV_BULK_IN_ADDR;
|
|
|
|
/* issue Rx irp to receive data */
|
|
precvbuf = (struct recv_buf *)precvpriv->precv_buf;
|
|
for (i = 0; i < NR_RECVBUFF; i++) {
|
|
if (_read_port(pintfhdl, precvpriv->ff_hwaddr, 0, (u8 *)precvbuf) == _FALSE) {
|
|
status = _FAIL;
|
|
goto exit;
|
|
}
|
|
|
|
precvbuf++;
|
|
precvpriv->free_recv_buf_queue_cnt--;
|
|
}
|
|
|
|
#ifdef CONFIG_USB_INTERRUPT_IN_PIPE
|
|
if (pdev->RtInPipe[REALTEK_USB_IN_INT_EP_IDX] != 0x05) {
|
|
status = _FAIL;
|
|
RTW_INFO("%s =>Warning !! Have not USB Int-IN pipe, RtIntInPipe(%d)!!!\n", __func__, pdev->RtInPipe[REALTEK_USB_IN_INT_EP_IDX]);
|
|
goto exit;
|
|
}
|
|
_read_interrupt = pintfhdl->io_ops._read_interrupt;
|
|
if (_read_interrupt(pintfhdl, RECV_INT_IN_ADDR) == _FALSE) {
|
|
status = _FAIL;
|
|
}
|
|
#endif
|
|
|
|
exit:
|
|
|
|
|
|
|
|
return status;
|
|
|
|
}
|
|
|
|
u32 rtl8822bu_inirp_deinit(PADAPTER padapter)
|
|
{
|
|
|
|
rtw_read_port_cancel(padapter);
|
|
|
|
|
|
return _SUCCESS;
|
|
}
|
|
|
|
void rtl8822bu_update_interrupt_mask(PADAPTER padapter, u8 bHIMR0 , u32 AddMSR, u32 RemoveMSR)
|
|
{
|
|
HAL_DATA_TYPE *pHalData;
|
|
u32 *himr;
|
|
|
|
pHalData = GET_HAL_DATA(padapter);
|
|
|
|
if (bHIMR0)
|
|
himr = &(pHalData->IntrMask[0]);
|
|
else
|
|
himr = &(pHalData->IntrMask[1]);
|
|
|
|
if (AddMSR)
|
|
*himr |= AddMSR;
|
|
|
|
if (RemoveMSR)
|
|
*himr &= (~RemoveMSR);
|
|
|
|
if (bHIMR0)
|
|
rtw_write32(padapter, REG_HIMR0_8822B, *himr);
|
|
else
|
|
rtw_write32(padapter, REG_HIMR1_8822B, *himr);
|
|
|
|
}
|
|
|
|
static void config_chip_out_EP(PADAPTER padapter, u8 NumOutPipe)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
|
|
|
|
pHalData->OutEpQueueSel = 0;
|
|
pHalData->OutEpNumber = 0;
|
|
|
|
switch (NumOutPipe) {
|
|
case 4:
|
|
pHalData->OutEpQueueSel = TX_SELE_HQ | TX_SELE_LQ | TX_SELE_NQ;
|
|
pHalData->OutEpNumber = 4;
|
|
break;
|
|
case 3:
|
|
pHalData->OutEpQueueSel = TX_SELE_HQ | TX_SELE_LQ | TX_SELE_NQ;
|
|
pHalData->OutEpNumber = 3;
|
|
break;
|
|
case 2:
|
|
pHalData->OutEpQueueSel = TX_SELE_HQ | TX_SELE_NQ;
|
|
pHalData->OutEpNumber = 2;
|
|
break;
|
|
case 1:
|
|
pHalData->OutEpQueueSel = TX_SELE_HQ;
|
|
pHalData->OutEpNumber = 1;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
RTW_INFO("%s OutEpQueueSel(0x%02x), OutEpNumber(%d)\n", __func__, pHalData->OutEpQueueSel, pHalData->OutEpNumber);
|
|
|
|
}
|
|
|
|
static u8 usb_set_queue_pipe_mapping(PADAPTER padapter, u8 NumInPipe, u8 NumOutPipe)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
u8 result = _FALSE;
|
|
|
|
config_chip_out_EP(padapter, NumOutPipe);
|
|
|
|
/* Normal chip with one IN and one OUT doesn't have interrupt IN EP. */
|
|
if (1 == pHalData->OutEpNumber) {
|
|
if (1 != NumInPipe)
|
|
return result;
|
|
}
|
|
|
|
result = Hal_MappingOutPipe(padapter, NumOutPipe);
|
|
|
|
return result;
|
|
|
|
}
|
|
|
|
void rtl8822bu_interface_configure(PADAPTER padapter)
|
|
{
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
|
|
|
|
if (IS_SUPER_SPEED_USB(padapter))
|
|
pHalData->UsbBulkOutSize = USB_SUPER_SPEED_BULK_SIZE;
|
|
else if (IS_HIGH_SPEED_USB(padapter))
|
|
pHalData->UsbBulkOutSize = USB_HIGH_SPEED_BULK_SIZE;
|
|
else
|
|
pHalData->UsbBulkOutSize = USB_FULL_SPEED_BULK_SIZE;
|
|
|
|
pHalData->interfaceIndex = pdvobjpriv->InterfaceNumber;
|
|
|
|
#ifdef CONFIG_USB_TX_AGGREGATION
|
|
/* according to value defined by halmac */
|
|
pHalData->UsbTxAggMode = 1;
|
|
rtw_halmac_usb_get_txagg_desc_num(pdvobjpriv, &pHalData->UsbTxAggDescNum);
|
|
#endif /* CONFIG_USB_TX_AGGREGATION */
|
|
|
|
#ifdef CONFIG_USB_RX_AGGREGATION
|
|
/* according to value defined by halmac */
|
|
pHalData->rxagg_mode = RX_AGG_USB;
|
|
#ifdef CONFIG_PLATFORM_NOVATEK_NT72668
|
|
pHalData->rxagg_usb_size = 0x03;
|
|
pHalData->rxagg_usb_timeout = 0x20;
|
|
#elif defined(CONFIG_PLATFORM_HISILICON)
|
|
/* use 16k to workaround for HISILICON platform */
|
|
pHalData->rxagg_usb_size = 3;
|
|
pHalData->rxagg_usb_timeout = 8;
|
|
#endif /* CONFIG_PLATFORM_NOVATEK_NT72668 */
|
|
#endif /* CONFIG_USB_RX_AGGREGATION */
|
|
|
|
usb_set_queue_pipe_mapping(padapter,
|
|
pdvobjpriv->RtNumInPipes, pdvobjpriv->RtNumOutPipes);
|
|
}
|