drivers/staging/rtlwifi/halmac/halmac_88xx/halmac_8822b/halmac_func_8822b.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2016  Realtek Corporation.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * The full GNU General Public License is included in this distribution in the
  15  * file called LICENSE.
  16  *
  17  * Contact Information:
  18  * wlanfae <wlanfae@realtek.com>
  19  * Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
  20  * Hsinchu 300, Taiwan.
  21  *
  22  * Larry Finger <Larry.Finger@lwfinger.net>
  23  *
  24  *****************************************************************************/
  25 #include "halmac_8822b_cfg.h"
  26 #include "halmac_func_8822b.h"
  27
  28 /*SDIO RQPN Mapping*/
  29 static struct halmac_rqpn_ HALMAC_RQPN_SDIO_8822B[] = {
  30         /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */
  31         {HALMAC_TRX_MODE_NORMAL, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  32          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  33         {HALMAC_TRX_MODE_TRXSHARE, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  34          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  35         {HALMAC_TRX_MODE_WMM, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  36          HALMAC_MAP2_NQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  37         {HALMAC_TRX_MODE_P2P, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  38          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  39         {HALMAC_TRX_MODE_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  40          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  41         {HALMAC_TRX_MODE_DELAY_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  42          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  43 };
  44
  45 /*PCIE RQPN Mapping*/
  46 static struct halmac_rqpn_ HALMAC_RQPN_PCIE_8822B[] = {
  47         /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */
  48         {HALMAC_TRX_MODE_NORMAL, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  49          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  50         {HALMAC_TRX_MODE_TRXSHARE, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  51          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  52         {HALMAC_TRX_MODE_WMM, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  53          HALMAC_MAP2_NQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  54         {HALMAC_TRX_MODE_P2P, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  55          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  56         {HALMAC_TRX_MODE_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  57          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  58         {HALMAC_TRX_MODE_DELAY_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  59          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
  60 };
  61
  62 /*USB 2 Bulkout RQPN Mapping*/
  63 static struct halmac_rqpn_ HALMAC_RQPN_2BULKOUT_8822B[] = {
  64         /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */
  65         {HALMAC_TRX_MODE_NORMAL, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  66          HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  67         {HALMAC_TRX_MODE_TRXSHARE, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  68          HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  69         {HALMAC_TRX_MODE_WMM, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  70          HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  71         {HALMAC_TRX_MODE_P2P, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ,
  72          HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  73         {HALMAC_TRX_MODE_LOOPBACK, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ,
  74          HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  75         {HALMAC_TRX_MODE_DELAY_LOOPBACK, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ,
  76          HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  77 };
  78
  79 /*USB 3 Bulkout RQPN Mapping*/
  80 static struct halmac_rqpn_ HALMAC_RQPN_3BULKOUT_8822B[] = {
  81         /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */
  82         {HALMAC_TRX_MODE_NORMAL, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  83          HALMAC_MAP2_LQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  84         {HALMAC_TRX_MODE_TRXSHARE, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
  85          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  86         {HALMAC_TRX_MODE_WMM, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
  87          HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  88         {HALMAC_TRX_MODE_P2P, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ, HALMAC_MAP2_LQ,
  89          HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  90         {HALMAC_TRX_MODE_LOOPBACK, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ,
  91          HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  92         {HALMAC_TRX_MODE_DELAY_LOOPBACK, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ,
  93          HALMAC_MAP2_LQ, HALMAC_MAP2_NQ, HALMAC_MAP2_HQ, HALMAC_MAP2_HQ},
  94 };
  95
  96 /*USB 4 Bulkout RQPN Mapping*/
  97 static struct halmac_rqpn_ HALMAC_RQPN_4BULKOUT_8822B[] = {
  98         /* { mode, vo_map, vi_map, be_map, bk_map, mg_map, hi_map } */
  99         {HALMAC_TRX_MODE_NORMAL, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
 100          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 101         {HALMAC_TRX_MODE_TRXSHARE, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
 102          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 103         {HALMAC_TRX_MODE_WMM, HALMAC_MAP2_HQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
 104          HALMAC_MAP2_NQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 105         {HALMAC_TRX_MODE_P2P, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ, HALMAC_MAP2_LQ,
 106          HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 107         {HALMAC_TRX_MODE_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
 108          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 109         {HALMAC_TRX_MODE_DELAY_LOOPBACK, HALMAC_MAP2_NQ, HALMAC_MAP2_NQ,
 110          HALMAC_MAP2_LQ, HALMAC_MAP2_LQ, HALMAC_MAP2_EXQ, HALMAC_MAP2_HQ},
 111 };
 112
 113 /*SDIO Page Number*/
 114 static struct halmac_pg_num_ HALMAC_PG_NUM_SDIO_8822B[] = {
 115         /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */
 116         {HALMAC_TRX_MODE_NORMAL, 64, 64, 64, 64, 1},
 117         {HALMAC_TRX_MODE_TRXSHARE, 32, 32, 32, 32, 1},
 118         {HALMAC_TRX_MODE_WMM, 64, 64, 64, 64, 1},
 119         {HALMAC_TRX_MODE_P2P, 64, 64, 64, 64, 1},
 120         {HALMAC_TRX_MODE_LOOPBACK, 64, 64, 64, 64, 640},
 121         {HALMAC_TRX_MODE_DELAY_LOOPBACK, 64, 64, 64, 64, 640},
 122 };
 123
 124 /*PCIE Page Number*/
 125 static struct halmac_pg_num_ HALMAC_PG_NUM_PCIE_8822B[] = {
 126         /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */
 127         {HALMAC_TRX_MODE_NORMAL, 64, 64, 64, 64, 1},
 128         {HALMAC_TRX_MODE_TRXSHARE, 64, 64, 64, 64, 1},
 129         {HALMAC_TRX_MODE_WMM, 64, 64, 64, 64, 1},
 130         {HALMAC_TRX_MODE_P2P, 64, 64, 64, 64, 1},
 131         {HALMAC_TRX_MODE_LOOPBACK, 64, 64, 64, 64, 640},
 132         {HALMAC_TRX_MODE_DELAY_LOOPBACK, 64, 64, 64, 64, 640},
 133 };
 134
 135 /*USB 2 Bulkout Page Number*/
 136 static struct halmac_pg_num_ HALMAC_PG_NUM_2BULKOUT_8822B[] = {
 137         /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */
 138         {HALMAC_TRX_MODE_NORMAL, 64, 64, 0, 0, 1},
 139         {HALMAC_TRX_MODE_TRXSHARE, 64, 64, 0, 0, 1},
 140         {HALMAC_TRX_MODE_WMM, 64, 64, 0, 0, 1},
 141         {HALMAC_TRX_MODE_P2P, 64, 64, 0, 0, 1},
 142         {HALMAC_TRX_MODE_LOOPBACK, 64, 64, 0, 0, 1024},
 143         {HALMAC_TRX_MODE_DELAY_LOOPBACK, 64, 64, 0, 0, 1024},
 144 };
 145
 146 /*USB 3 Bulkout Page Number*/
 147 static struct halmac_pg_num_ HALMAC_PG_NUM_3BULKOUT_8822B[] = {
 148         /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */
 149         {HALMAC_TRX_MODE_NORMAL, 64, 64, 64, 0, 1},
 150         {HALMAC_TRX_MODE_TRXSHARE, 64, 64, 64, 0, 1},
 151         {HALMAC_TRX_MODE_WMM, 64, 64, 64, 0, 1},
 152         {HALMAC_TRX_MODE_P2P, 64, 64, 64, 0, 1},
 153         {HALMAC_TRX_MODE_LOOPBACK, 64, 64, 64, 0, 1024},
 154         {HALMAC_TRX_MODE_DELAY_LOOPBACK, 64, 64, 64, 0, 1024},
 155 };
 156
 157 /*USB 4 Bulkout Page Number*/
 158 static struct halmac_pg_num_ HALMAC_PG_NUM_4BULKOUT_8822B[] = {
 159         /* { mode, hq_num, nq_num, lq_num, exq_num, gap_num} */
 160         {HALMAC_TRX_MODE_NORMAL, 64, 64, 64, 64, 1},
 161         {HALMAC_TRX_MODE_TRXSHARE, 64, 64, 64, 64, 1},
 162         {HALMAC_TRX_MODE_WMM, 64, 64, 64, 64, 1},
 163         {HALMAC_TRX_MODE_P2P, 64, 64, 64, 64, 1},
 164         {HALMAC_TRX_MODE_LOOPBACK, 64, 64, 64, 64, 640},
 165         {HALMAC_TRX_MODE_DELAY_LOOPBACK, 64, 64, 64, 64, 640},
 166 };
 167
 168 enum halmac_ret_status
 169 halmac_txdma_queue_mapping_8822b(struct halmac_adapter *halmac_adapter,
 170                                  enum halmac_trx_mode halmac_trx_mode)
 171 {
 172         u16 value16;
 173         void *driver_adapter = NULL;
 174         struct halmac_rqpn_ *curr_rqpn_sel = NULL;
 175         enum halmac_ret_status status;
 176         struct halmac_api *halmac_api;
 177
 178         driver_adapter = halmac_adapter->driver_adapter;
 179         halmac_api = (struct halmac_api *)halmac_adapter->halmac_api;
 180
 181         if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_SDIO) {
 182                 curr_rqpn_sel = HALMAC_RQPN_SDIO_8822B;
 183         } else if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_PCIE) {
 184                 curr_rqpn_sel = HALMAC_RQPN_PCIE_8822B;
 185         } else if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_USB) {
 186                 if (halmac_adapter->halmac_bulkout_num == 2) {
 187                         curr_rqpn_sel = HALMAC_RQPN_2BULKOUT_8822B;
 188                 } else if (halmac_adapter->halmac_bulkout_num == 3) {
 189                         curr_rqpn_sel = HALMAC_RQPN_3BULKOUT_8822B;
 190                 } else if (halmac_adapter->halmac_bulkout_num == 4) {
 191                         curr_rqpn_sel = HALMAC_RQPN_4BULKOUT_8822B;
 192                 } else {
 193                         pr_err("[ERR]interface not support\n");
 194                         return HALMAC_RET_NOT_SUPPORT;
 195                 }
 196         } else {
 197                 return HALMAC_RET_NOT_SUPPORT;
 198         }
 199
 200         status = halmac_rqpn_parser_88xx(halmac_adapter, halmac_trx_mode,
 201                                          curr_rqpn_sel);
 202         if (status != HALMAC_RET_SUCCESS)
 203                 return status;
 204
 205         value16 = 0;
 206         value16 |= BIT_TXDMA_HIQ_MAP(
 207                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_HI]);
 208         value16 |= BIT_TXDMA_MGQ_MAP(
 209                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_MG]);
 210         value16 |= BIT_TXDMA_BKQ_MAP(
 211                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BK]);
 212         value16 |= BIT_TXDMA_BEQ_MAP(
 213                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_BE]);
 214         value16 |= BIT_TXDMA_VIQ_MAP(
 215                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VI]);
 216         value16 |= BIT_TXDMA_VOQ_MAP(
 217                 halmac_adapter->halmac_ptcl_queue[HALMAC_PTCL_QUEUE_VO]);
 218         HALMAC_REG_WRITE_16(halmac_adapter, REG_TXDMA_PQ_MAP, value16);
 219
 220         return HALMAC_RET_SUCCESS;
 221 }
 222
 223 enum halmac_ret_status
 224 halmac_priority_queue_config_8822b(struct halmac_adapter *halmac_adapter,
 225                                    enum halmac_trx_mode halmac_trx_mode)
 226 {
 227         u8 transfer_mode = 0;
 228         u8 value8;
 229         u32 counter;
 230         enum halmac_ret_status status;
 231         struct halmac_pg_num_ *curr_pg_num = NULL;
 232         void *driver_adapter = NULL;
 233         struct halmac_api *halmac_api;
 234
 235         driver_adapter = halmac_adapter->driver_adapter;
 236         halmac_api = (struct halmac_api *)halmac_adapter->halmac_api;
 237
 238         if (halmac_adapter->txff_allocation.la_mode == HALMAC_LA_MODE_DISABLE) {
 239                 if (halmac_adapter->txff_allocation.rx_fifo_expanding_mode ==
 240                     HALMAC_RX_FIFO_EXPANDING_MODE_DISABLE) {
 241                         halmac_adapter->txff_allocation.tx_fifo_pg_num =
 242                                 HALMAC_TX_FIFO_SIZE_8822B >>
 243                                 HALMAC_TX_PAGE_SIZE_2_POWER_8822B;
 244                 } else if (halmac_adapter->txff_allocation
 245                                    .rx_fifo_expanding_mode ==
 246                            HALMAC_RX_FIFO_EXPANDING_MODE_1_BLOCK) {
 247                         halmac_adapter->txff_allocation.tx_fifo_pg_num =
 248                                 HALMAC_TX_FIFO_SIZE_EX_1_BLK_8822B >>
 249                                 HALMAC_TX_PAGE_SIZE_2_POWER_8822B;
 250                         halmac_adapter->hw_config_info.tx_fifo_size =
 251                                 HALMAC_TX_FIFO_SIZE_EX_1_BLK_8822B;
 252                         if (HALMAC_RX_FIFO_SIZE_EX_1_BLK_8822B <=
 253                             HALMAC_RX_FIFO_SIZE_EX_1_BLK_MAX_8822B)
 254                                 halmac_adapter->hw_config_info.rx_fifo_size =
 255                                         HALMAC_RX_FIFO_SIZE_EX_1_BLK_8822B;
 256                         else
 257                                 halmac_adapter->hw_config_info.rx_fifo_size =
 258                                         HALMAC_RX_FIFO_SIZE_EX_1_BLK_MAX_8822B;
 259                 } else {
 260                         halmac_adapter->txff_allocation.tx_fifo_pg_num =
 261                                 HALMAC_TX_FIFO_SIZE_8822B >>
 262                                 HALMAC_TX_PAGE_SIZE_2_POWER_8822B;
 263                         pr_err("[ERR]rx_fifo_expanding_mode = %d not support\n",
 264                                halmac_adapter->txff_allocation
 265                                        .rx_fifo_expanding_mode);
 266                 }
 267         } else {
 268                 halmac_adapter->txff_allocation.tx_fifo_pg_num =
 269                         HALMAC_TX_FIFO_SIZE_LA_8822B >>
 270                         HALMAC_TX_PAGE_SIZE_2_POWER_8822B;
 271         }
 272         halmac_adapter->txff_allocation.rsvd_pg_num =
 273                 (halmac_adapter->txff_allocation.rsvd_drv_pg_num +
 274                  HALMAC_RSVD_H2C_EXTRAINFO_PGNUM_8822B +
 275                  HALMAC_RSVD_H2C_QUEUE_PGNUM_8822B +
 276                  HALMAC_RSVD_CPU_INSTRUCTION_PGNUM_8822B +
 277                  HALMAC_RSVD_FW_TXBUFF_PGNUM_8822B);
 278         if (halmac_adapter->txff_allocation.rsvd_pg_num >
 279             halmac_adapter->txff_allocation.tx_fifo_pg_num)
 280                 return HALMAC_RET_CFG_TXFIFO_PAGE_FAIL;
 281
 282         halmac_adapter->txff_allocation.ac_q_pg_num =
 283                 halmac_adapter->txff_allocation.tx_fifo_pg_num -
 284                 halmac_adapter->txff_allocation.rsvd_pg_num;
 285         halmac_adapter->txff_allocation.rsvd_pg_bndy =
 286                 halmac_adapter->txff_allocation.tx_fifo_pg_num -
 287                 halmac_adapter->txff_allocation.rsvd_pg_num;
 288         halmac_adapter->txff_allocation.rsvd_fw_txbuff_pg_bndy =
 289                 halmac_adapter->txff_allocation.tx_fifo_pg_num -
 290                 HALMAC_RSVD_FW_TXBUFF_PGNUM_8822B;
 291         halmac_adapter->txff_allocation.rsvd_cpu_instr_pg_bndy =
 292                 halmac_adapter->txff_allocation.rsvd_fw_txbuff_pg_bndy -
 293                 HALMAC_RSVD_CPU_INSTRUCTION_PGNUM_8822B;
 294         halmac_adapter->txff_allocation.rsvd_h2c_queue_pg_bndy =
 295                 halmac_adapter->txff_allocation.rsvd_cpu_instr_pg_bndy -
 296                 HALMAC_RSVD_H2C_QUEUE_PGNUM_8822B;
 297         halmac_adapter->txff_allocation.rsvd_h2c_extra_info_pg_bndy =
 298                 halmac_adapter->txff_allocation.rsvd_h2c_queue_pg_bndy -
 299                 HALMAC_RSVD_H2C_EXTRAINFO_PGNUM_8822B;
 300         halmac_adapter->txff_allocation.rsvd_drv_pg_bndy =
 301                 halmac_adapter->txff_allocation.rsvd_h2c_extra_info_pg_bndy -
 302                 halmac_adapter->txff_allocation.rsvd_drv_pg_num;
 303
 304         if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_SDIO) {
 305                 curr_pg_num = HALMAC_PG_NUM_SDIO_8822B;
 306         } else if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_PCIE) {
 307                 curr_pg_num = HALMAC_PG_NUM_PCIE_8822B;
 308         } else if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_USB) {
 309                 if (halmac_adapter->halmac_bulkout_num == 2) {
 310                         curr_pg_num = HALMAC_PG_NUM_2BULKOUT_8822B;
 311                 } else if (halmac_adapter->halmac_bulkout_num == 3) {
 312                         curr_pg_num = HALMAC_PG_NUM_3BULKOUT_8822B;
 313                 } else if (halmac_adapter->halmac_bulkout_num == 4) {
 314                         curr_pg_num = HALMAC_PG_NUM_4BULKOUT_8822B;
 315                 } else {
 316                         pr_err("[ERR]interface not support\n");
 317                         return HALMAC_RET_NOT_SUPPORT;
 318                 }
 319         } else {
 320                 return HALMAC_RET_NOT_SUPPORT;
 321         }
 322
 323         status = halmac_pg_num_parser_88xx(halmac_adapter, halmac_trx_mode,
 324                                            curr_pg_num);
 325         if (status != HALMAC_RET_SUCCESS)
 326                 return status;
 327
 328         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_INFO_1,
 329                             halmac_adapter->txff_allocation.high_queue_pg_num);
 330         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_INFO_2,
 331                             halmac_adapter->txff_allocation.low_queue_pg_num);
 332         HALMAC_REG_WRITE_16(
 333                 halmac_adapter, REG_FIFOPAGE_INFO_3,
 334                 halmac_adapter->txff_allocation.normal_queue_pg_num);
 335         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_INFO_4,
 336                             halmac_adapter->txff_allocation.extra_queue_pg_num);
 337         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_INFO_5,
 338                             halmac_adapter->txff_allocation.pub_queue_pg_num);
 339
 340         halmac_adapter->sdio_free_space.high_queue_number =
 341                 halmac_adapter->txff_allocation.high_queue_pg_num;
 342         halmac_adapter->sdio_free_space.normal_queue_number =
 343                 halmac_adapter->txff_allocation.normal_queue_pg_num;
 344         halmac_adapter->sdio_free_space.low_queue_number =
 345                 halmac_adapter->txff_allocation.low_queue_pg_num;
 346         halmac_adapter->sdio_free_space.public_queue_number =
 347                 halmac_adapter->txff_allocation.pub_queue_pg_num;
 348         halmac_adapter->sdio_free_space.extra_queue_number =
 349                 halmac_adapter->txff_allocation.extra_queue_pg_num;
 350
 351         HALMAC_REG_WRITE_32(
 352                 halmac_adapter, REG_RQPN_CTRL_2,
 353                 HALMAC_REG_READ_32(halmac_adapter, REG_RQPN_CTRL_2) | BIT(31));
 354
 355         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_CTRL_2,
 356                             (u16)(halmac_adapter->txff_allocation.rsvd_pg_bndy &
 357                                   BIT_MASK_BCN_HEAD_1_V1));
 358         HALMAC_REG_WRITE_16(halmac_adapter, REG_BCNQ_BDNY_V1,
 359                             (u16)(halmac_adapter->txff_allocation.rsvd_pg_bndy &
 360                                   BIT_MASK_BCNQ_PGBNDY_V1));
 361         HALMAC_REG_WRITE_16(halmac_adapter, REG_FIFOPAGE_CTRL_2 + 2,
 362                             (u16)(halmac_adapter->txff_allocation.rsvd_pg_bndy &
 363                                   BIT_MASK_BCN_HEAD_1_V1));
 364         HALMAC_REG_WRITE_16(halmac_adapter, REG_BCNQ1_BDNY_V1,
 365                             (u16)(halmac_adapter->txff_allocation.rsvd_pg_bndy &
 366                                   BIT_MASK_BCNQ_PGBNDY_V1));
 367
 368         HALMAC_REG_WRITE_32(halmac_adapter, REG_RXFF_BNDY,
 369                             halmac_adapter->hw_config_info.rx_fifo_size -
 370                                     HALMAC_C2H_PKT_BUF_8822B - 1);
 371
 372         if (halmac_adapter->halmac_interface == HALMAC_INTERFACE_USB) {
 373                 value8 = (u8)(
 374                         HALMAC_REG_READ_8(halmac_adapter, REG_AUTO_LLT_V1) &
 375                         ~(BIT_MASK_BLK_DESC_NUM << BIT_SHIFT_BLK_DESC_NUM));
 376                 value8 = (u8)(value8 | (HALMAC_BLK_DESC_NUM_8822B
 377                                         << BIT_SHIFT_BLK_DESC_NUM));
 378                 HALMAC_REG_WRITE_8(halmac_adapter, REG_AUTO_LLT_V1, value8);
 379
 380                 HALMAC_REG_WRITE_8(halmac_adapter, REG_AUTO_LLT_V1 + 3,
 381                                    HALMAC_BLK_DESC_NUM_8822B);
 382                 HALMAC_REG_WRITE_8(halmac_adapter, REG_TXDMA_OFFSET_CHK + 1,
 383                                    HALMAC_REG_READ_8(halmac_adapter,
 384                                                      REG_TXDMA_OFFSET_CHK + 1) |
 385                                            BIT(1));
 386         }
 387
 388         HALMAC_REG_WRITE_8(
 389                 halmac_adapter, REG_AUTO_LLT_V1,
 390                 (u8)(HALMAC_REG_READ_8(halmac_adapter, REG_AUTO_LLT_V1) |
 391                      BIT_AUTO_INIT_LLT_V1));
 392         counter = 1000;
 393         while (HALMAC_REG_READ_8(halmac_adapter, REG_AUTO_LLT_V1) &
 394                BIT_AUTO_INIT_LLT_V1) {
 395                 counter--;
 396                 if (counter == 0)
 397                         return HALMAC_RET_INIT_LLT_FAIL;
 398         }
 399
 400         if (halmac_trx_mode == HALMAC_TRX_MODE_DELAY_LOOPBACK) {
 401                 transfer_mode = HALMAC_TRNSFER_LOOPBACK_DELAY;
 402                 HALMAC_REG_WRITE_16(
 403                         halmac_adapter, REG_WMAC_LBK_BUF_HD_V1,
 404                         (u16)halmac_adapter->txff_allocation.rsvd_pg_bndy);
 405         } else if (halmac_trx_mode == HALMAC_TRX_MODE_LOOPBACK) {
 406                 transfer_mode = HALMAC_TRNSFER_LOOPBACK_DIRECT;
 407         } else {
 408                 transfer_mode = HALMAC_TRNSFER_NORMAL;
 409         }
 410
 411         HALMAC_REG_WRITE_8(halmac_adapter, REG_CR + 3, (u8)transfer_mode);
 412
 413         return HALMAC_RET_SUCCESS;
 414 }