/* SPDX-License-Identifier: GPL-2.0 */
|
#include "halmac_8822b_cfg.h"
|
|
/**
|
* halmac_mac_power_switch_8822b_sdio() - change mac power
|
* @pHalmac_adapter
|
* @halmac_power
|
* Author : KaiYuan Chang/Ivan Lin
|
* Return : HALMAC_RET_STATUS
|
*/
|
HALMAC_RET_STATUS
|
halmac_mac_power_switch_8822b_sdio(
|
IN PHALMAC_ADAPTER pHalmac_adapter,
|
IN HALMAC_MAC_POWER halmac_power
|
)
|
{
|
u8 interface_mask;
|
u8 rpwm;
|
VOID *pDriver_adapter = NULL;
|
PHALMAC_API pHalmac_api;
|
|
if (HALMAC_RET_SUCCESS != halmac_adapter_validate(pHalmac_adapter))
|
return HALMAC_RET_ADAPTER_INVALID;
|
|
if (HALMAC_RET_SUCCESS != halmac_api_validate(pHalmac_adapter))
|
return HALMAC_RET_API_INVALID;
|
|
halmac_api_record_id_88xx(pHalmac_adapter, HALMAC_API_MAC_POWER_SWITCH);
|
|
pDriver_adapter = pHalmac_adapter->pDriver_adapter;
|
pHalmac_api = (PHALMAC_API)pHalmac_adapter->pHalmac_api;
|
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_PWR, HALMAC_DBG_ERR, "halmac_mac_power_switch_88xx_sdio halmac_power = %x ==========>\n", halmac_power);
|
|
interface_mask = HALMAC_PWR_INTF_SDIO_MSK;
|
|
pHalmac_adapter->rpwm_record = HALMAC_REG_READ_8(pHalmac_adapter, REG_SDIO_HRPWM1);
|
|
/* Check FW still exist or not */
|
if (0xC078 == HALMAC_REG_READ_16(pHalmac_adapter, REG_MCUFW_CTRL)) {
|
/* Leave 32K */
|
rpwm = (u8)((pHalmac_adapter->rpwm_record ^ BIT(7)) & 0x80);
|
HALMAC_REG_WRITE_8(pHalmac_adapter, REG_SDIO_HRPWM1, rpwm);
|
}
|
|
if (0xEA == HALMAC_REG_READ_8(pHalmac_adapter, REG_CR))
|
pHalmac_adapter->halmac_state.mac_power = HALMAC_MAC_POWER_OFF;
|
|
/*Check if power switch is needed*/
|
if (halmac_power == pHalmac_adapter->halmac_state.mac_power) {
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_PWR, HALMAC_DBG_WARN, "halmac_mac_power_switch power state unchange!\n");
|
} else {
|
if (HALMAC_MAC_POWER_OFF == halmac_power) {
|
if (HALMAC_RET_SUCCESS != halmac_pwr_seq_parser_88xx(pHalmac_adapter, HALMAC_PWR_CUT_TESTCHIP_MSK, HALMAC_PWR_FAB_TSMC_MSK,
|
interface_mask, halmac_8822b_card_disable_flow)) {
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_PWR, HALMAC_DBG_ERR, "Handle power off cmd error\n");
|
return HALMAC_RET_POWER_OFF_FAIL;
|
}
|
|
pHalmac_adapter->halmac_state.mac_power = HALMAC_MAC_POWER_OFF;
|
pHalmac_adapter->halmac_state.ps_state = HALMAC_PS_STATE_UNDEFINE;
|
pHalmac_adapter->halmac_state.dlfw_state = HALMAC_DLFW_NONE;
|
} else {
|
if (HALMAC_RET_SUCCESS != halmac_pwr_seq_parser_88xx(pHalmac_adapter, HALMAC_PWR_CUT_TESTCHIP_MSK, HALMAC_PWR_FAB_TSMC_MSK,
|
interface_mask, halmac_8822b_card_enable_flow)) {
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_PWR, HALMAC_DBG_ERR, "Handle power on cmd error\n");
|
return HALMAC_RET_POWER_ON_FAIL;
|
}
|
|
pHalmac_adapter->halmac_state.mac_power = HALMAC_MAC_POWER_ON;
|
pHalmac_adapter->halmac_state.ps_state = HALMAC_PS_STATE_ACT;
|
}
|
}
|
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_PWR, HALMAC_DBG_ERR, "halmac_mac_power_switch_88xx_sdio <==========\n");
|
|
return HALMAC_RET_SUCCESS;
|
}
|
|
/**
|
* halmac_tx_allowed_sdio_8822b() - check sdio tx reserved page
|
* @pHalmac_adapter
|
* @pHalmac_buf
|
* @halmac_size
|
* Author : Ivan Lin
|
* Return : HALMAC_RET_STATUS
|
*/
|
HALMAC_RET_STATUS
|
halmac_tx_allowed_sdio_8822b(
|
IN PHALMAC_ADAPTER pHalmac_adapter,
|
IN u8 *pHalmac_buf,
|
IN u32 halmac_size
|
)
|
{
|
u8 *pCurr_packet;
|
u16 *pCurr_free_space;
|
u32 i, counter;
|
u32 tx_agg_num, packet_size;
|
u32 tx_required_page_num, total_required_page_num = 0;
|
VOID *pDriver_adapter = NULL;
|
HALMAC_DMA_MAPPING dma_mapping;
|
|
if (HALMAC_RET_SUCCESS != halmac_adapter_validate(pHalmac_adapter))
|
return HALMAC_RET_ADAPTER_INVALID;
|
|
if (HALMAC_RET_SUCCESS != halmac_api_validate(pHalmac_adapter))
|
return HALMAC_RET_API_INVALID;
|
|
halmac_api_record_id_88xx(pHalmac_adapter, HALMAC_API_TX_ALLOWED_SDIO);
|
|
pDriver_adapter = pHalmac_adapter->pDriver_adapter;
|
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_INIT, HALMAC_DBG_TRACE, "halmac_tx_allowed_sdio_8822b ==========>\n");
|
|
tx_agg_num = GET_TX_DESC_DMA_TXAGG_NUM(pHalmac_buf);
|
pCurr_packet = pHalmac_buf;
|
|
tx_agg_num = (tx_agg_num == 0) ? 1 : tx_agg_num;
|
|
switch ((HALMAC_QUEUE_SELECT)GET_TX_DESC_QSEL(pCurr_packet)) {
|
case HALMAC_QUEUE_SELECT_VO:
|
case HALMAC_QUEUE_SELECT_VO_V2:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VO];
|
break;
|
case HALMAC_QUEUE_SELECT_VI:
|
case HALMAC_QUEUE_SELECT_VI_V2:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VI];
|
break;
|
case HALMAC_QUEUE_SELECT_BE:
|
case HALMAC_QUEUE_SELECT_BE_V2:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BE];
|
break;
|
case HALMAC_QUEUE_SELECT_BK:
|
case HALMAC_QUEUE_SELECT_BK_V2:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BK];
|
break;
|
case HALMAC_QUEUE_SELECT_MGNT:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_MG];
|
break;
|
case HALMAC_QUEUE_SELECT_HIGH:
|
dma_mapping = pHalmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_HI];
|
break;
|
case HALMAC_QUEUE_SELECT_BCN:
|
case HALMAC_QUEUE_SELECT_CMD:
|
return HALMAC_RET_SUCCESS;
|
default:
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_INIT, HALMAC_DBG_ERR, "Qsel is out of range\n");
|
return HALMAC_RET_QSEL_INCORRECT;
|
}
|
|
switch (dma_mapping) {
|
case HALMAC_DMA_MAPPING_HIGH:
|
pCurr_free_space = &(pHalmac_adapter->sdio_free_space.high_queue_number);
|
break;
|
case HALMAC_DMA_MAPPING_NORMAL:
|
pCurr_free_space = &(pHalmac_adapter->sdio_free_space.normal_queue_number);
|
break;
|
case HALMAC_DMA_MAPPING_LOW:
|
pCurr_free_space = &(pHalmac_adapter->sdio_free_space.low_queue_number);
|
break;
|
case HALMAC_DMA_MAPPING_EXTRA:
|
pCurr_free_space = &(pHalmac_adapter->sdio_free_space.extra_queue_number);
|
break;
|
default:
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_INIT, HALMAC_DBG_ERR, "DmaMapping is out of range\n");
|
return HALMAC_RET_DMA_MAP_INCORRECT;
|
}
|
|
for (i = 0; i < tx_agg_num; i++) {
|
packet_size = GET_TX_DESC_TXPKTSIZE(pCurr_packet) + GET_TX_DESC_OFFSET(pCurr_packet);
|
tx_required_page_num = (packet_size >> HALMAC_TX_PAGE_SIZE_2_POWER_8822B) + ((packet_size & (HALMAC_TX_PAGE_SIZE_8822B - 1)) ? 1 : 0);
|
total_required_page_num += tx_required_page_num;
|
|
packet_size = HALMAC_ALIGN(packet_size, 8);
|
|
pCurr_packet += packet_size;
|
}
|
|
counter = 10;
|
while (1) {
|
if ((u32)(*pCurr_free_space + pHalmac_adapter->sdio_free_space.public_queue_number) >= total_required_page_num) {
|
if (*pCurr_free_space >= total_required_page_num) {
|
*pCurr_free_space -= (u16)total_required_page_num;
|
} else {
|
pHalmac_adapter->sdio_free_space.public_queue_number -= (u16)(total_required_page_num - *pCurr_free_space);
|
*pCurr_free_space = 0;
|
}
|
break;
|
} else {
|
halmac_update_sdio_free_page_88xx(pHalmac_adapter);
|
}
|
|
counter--;
|
if (0 == counter)
|
return HALMAC_RET_FREE_SPACE_NOT_ENOUGH;
|
}
|
|
counter = 10;
|
while (pHalmac_adapter->sdio_free_space.ac_oqt_number < tx_agg_num) {
|
halmac_update_oqt_free_space_88xx(pHalmac_adapter);
|
|
counter--;
|
if (0 == counter)
|
return HALMAC_RET_FREE_SPACE_NOT_ENOUGH;
|
}
|
pHalmac_adapter->sdio_free_space.ac_oqt_number -= (u8)tx_agg_num;
|
|
PLATFORM_MSG_PRINT(pDriver_adapter, HALMAC_MSG_INIT, HALMAC_DBG_TRACE, "halmac_tx_allowed_sdio_8822b <==========\n");
|
|
return HALMAC_RET_SUCCESS;
|
}
|
