drivers/net/wireless/realtek/rtlwifi/rtl8723ae/fw.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2009-2012  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
  26 #include "../wifi.h"
  27 #include "../pci.h"
  28 #include "../base.h"
  29 #include "../core.h"
  30 #include "reg.h"
  31 #include "def.h"
  32 #include "fw.h"
  33 #include "../rtl8723com/fw_common.h"
  34
  35 static bool _rtl8723e_check_fw_read_last_h2c(struct ieee80211_hw *hw,
  36                                              u8 boxnum)
  37 {
  38         struct rtl_priv *rtlpriv = rtl_priv(hw);
  39         u8 val_hmetfr, val_mcutst_1;
  40         bool result = false;
  41
  42         val_hmetfr = rtl_read_byte(rtlpriv, REG_HMETFR);
  43         val_mcutst_1 = rtl_read_byte(rtlpriv, (REG_MCUTST_1 + boxnum));
  44
  45         if (((val_hmetfr >> boxnum) & BIT(0)) == 0 && val_mcutst_1 == 0)
  46                 result = true;
  47         return result;
  48 }
  49
  50 static void _rtl8723e_fill_h2c_command(struct ieee80211_hw *hw, u8 element_id,
  51                                        u32 cmd_len, u8 *cmdbuffer)
  52 {
  53         struct rtl_priv *rtlpriv = rtl_priv(hw);
  54         struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
  55         u8 boxnum;
  56         u16 box_reg = 0, box_extreg = 0;
  57         u8 u1b_tmp;
  58         bool isfw_read = false;
  59         u8 buf_index = 0;
  60         bool bwrite_sucess = false;
  61         u8 wait_h2c_limmit = 100;
  62         u8 wait_writeh2c_limmit = 100;
  63         u8 boxcontent[4], boxextcontent[2];
  64         u32 h2c_waitcounter = 0;
  65         unsigned long flag;
  66         u8 idx;
  67
  68         RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD, "come in\n");
  69
  70         while (true) {
  71                 spin_lock_irqsave(&rtlpriv->locks.h2c_lock, flag);
  72                 if (rtlhal->h2c_setinprogress) {
  73                         RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
  74                                  "H2C set in progress! Wait to set..element_id(%d).\n",
  75                                  element_id);
  76
  77                         while (rtlhal->h2c_setinprogress) {
  78                                 spin_unlock_irqrestore(&rtlpriv->locks.h2c_lock,
  79                                                        flag);
  80                                 h2c_waitcounter++;
  81                                 RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
  82                                          "Wait 100 us (%d times)...\n",
  83                                           h2c_waitcounter);
  84                                 udelay(100);
  85
  86                                 if (h2c_waitcounter > 1000)
  87                                         return;
  88                                 spin_lock_irqsave(&rtlpriv->locks.h2c_lock,
  89                                                   flag);
  90                         }
  91                         spin_unlock_irqrestore(&rtlpriv->locks.h2c_lock, flag);
  92                 } else {
  93                         rtlhal->h2c_setinprogress = true;
  94                         spin_unlock_irqrestore(&rtlpriv->locks.h2c_lock, flag);
  95                         break;
  96                 }
  97         }
  98
  99         while (!bwrite_sucess) {
 100                 wait_writeh2c_limmit--;
 101                 if (wait_writeh2c_limmit == 0) {
 102                         pr_err("Write H2C fail because no trigger for FW INT!\n");
 103                         break;
 104                 }
 105
 106                 boxnum = rtlhal->last_hmeboxnum;
 107                 switch (boxnum) {
 108                 case 0:
 109                         box_reg = REG_HMEBOX_0;
 110                         box_extreg = REG_HMEBOX_EXT_0;
 111                         break;
 112                 case 1:
 113                         box_reg = REG_HMEBOX_1;
 114                         box_extreg = REG_HMEBOX_EXT_1;
 115                         break;
 116                 case 2:
 117                         box_reg = REG_HMEBOX_2;
 118                         box_extreg = REG_HMEBOX_EXT_2;
 119                         break;
 120                 case 3:
 121                         box_reg = REG_HMEBOX_3;
 122                         box_extreg = REG_HMEBOX_EXT_3;
 123                         break;
 124                 default:
 125                         pr_err("switch case %#x not processed\n",
 126                                boxnum);
 127                         break;
 128                 }
 129
 130                 isfw_read = _rtl8723e_check_fw_read_last_h2c(hw, boxnum);
 131                 while (!isfw_read) {
 132
 133                         wait_h2c_limmit--;
 134                         if (wait_h2c_limmit == 0) {
 135                                 RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
 136                                          "Waiting too long for FW read clear HMEBox(%d)!\n",
 137                                          boxnum);
 138                                 break;
 139                         }
 140
 141                         udelay(10);
 142
 143                         isfw_read = _rtl8723e_check_fw_read_last_h2c(hw,
 144                                                                 boxnum);
 145                         u1b_tmp = rtl_read_byte(rtlpriv, 0x1BF);
 146                         RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
 147                                  "Waiting for FW read clear HMEBox(%d)!!! 0x1BF = %2x\n",
 148                                  boxnum, u1b_tmp);
 149                 }
 150
 151                 if (!isfw_read) {
 152                         RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
 153                                  "Write H2C register BOX[%d] fail!!!!! Fw do not read.\n",
 154                                  boxnum);
 155                         break;
 156                 }
 157
 158                 memset(boxcontent, 0, sizeof(boxcontent));
 159                 memset(boxextcontent, 0, sizeof(boxextcontent));
 160                 boxcontent[0] = element_id;
 161                 RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
 162                          "Write element_id box_reg(%4x) = %2x\n",
 163                           box_reg, element_id);
 164
 165                 switch (cmd_len) {
 166                 case 1:
 167                         boxcontent[0] &= ~(BIT(7));
 168                         memcpy((u8 *)(boxcontent) + 1,
 169                                cmdbuffer + buf_index, 1);
 170
 171                         for (idx = 0; idx < 4; idx++) {
 172                                 rtl_write_byte(rtlpriv, box_reg + idx,
 173                                                boxcontent[idx]);
 174                         }
 175                         break;
 176                 case 2:
 177                         boxcontent[0] &= ~(BIT(7));
 178                         memcpy((u8 *)(boxcontent) + 1,
 179                                cmdbuffer + buf_index, 2);
 180
 181                         for (idx = 0; idx < 4; idx++) {
 182                                 rtl_write_byte(rtlpriv, box_reg + idx,
 183                                                boxcontent[idx]);
 184                         }
 185                         break;
 186                 case 3:
 187                         boxcontent[0] &= ~(BIT(7));
 188                         memcpy((u8 *)(boxcontent) + 1,
 189                                cmdbuffer + buf_index, 3);
 190
 191                         for (idx = 0; idx < 4; idx++) {
 192                                 rtl_write_byte(rtlpriv, box_reg + idx,
 193                                                boxcontent[idx]);
 194                         }
 195                         break;
 196                 case 4:
 197                         boxcontent[0] |= (BIT(7));
 198                         memcpy((u8 *)(boxextcontent),
 199                                cmdbuffer + buf_index, 2);
 200                         memcpy((u8 *)(boxcontent) + 1,
 201                                cmdbuffer + buf_index + 2, 2);
 202
 203                         for (idx = 0; idx < 2; idx++) {
 204                                 rtl_write_byte(rtlpriv, box_extreg + idx,
 205                                                boxextcontent[idx]);
 206                         }
 207
 208                         for (idx = 0; idx < 4; idx++) {
 209                                 rtl_write_byte(rtlpriv, box_reg + idx,
 210                                                boxcontent[idx]);
 211                         }
 212                         break;
 213                 case 5:
 214                         boxcontent[0] |= (BIT(7));
 215                         memcpy((u8 *)(boxextcontent),
 216                                cmdbuffer + buf_index, 2);
 217                         memcpy((u8 *)(boxcontent) + 1,
 218                                cmdbuffer + buf_index + 2, 3);
 219
 220                         for (idx = 0; idx < 2; idx++) {
 221                                 rtl_write_byte(rtlpriv, box_extreg + idx,
 222                                                boxextcontent[idx]);
 223                         }
 224
 225                         for (idx = 0; idx < 4; idx++) {
 226                                 rtl_write_byte(rtlpriv, box_reg + idx,
 227                                                boxcontent[idx]);
 228                         }
 229                         break;
 230                 default:
 231                         pr_err("switch case %#x not processed\n",
 232                                cmd_len);
 233                         break;
 234                 }
 235
 236                 bwrite_sucess = true;
 237
 238                 rtlhal->last_hmeboxnum = boxnum + 1;
 239                 if (rtlhal->last_hmeboxnum == 4)
 240                         rtlhal->last_hmeboxnum = 0;
 241
 242                 RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD,
 243                          "pHalData->last_hmeboxnum  = %d\n",
 244                           rtlhal->last_hmeboxnum);
 245         }
 246
 247         spin_lock_irqsave(&rtlpriv->locks.h2c_lock, flag);
 248         rtlhal->h2c_setinprogress = false;
 249         spin_unlock_irqrestore(&rtlpriv->locks.h2c_lock, flag);
 250
 251         RT_TRACE(rtlpriv, COMP_CMD, DBG_LOUD, "go out\n");
 252 }
 253
 254 void rtl8723e_fill_h2c_cmd(struct ieee80211_hw *hw,
 255                            u8 element_id, u32 cmd_len, u8 *cmdbuffer)
 256 {
 257         struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
 258         u32 tmp_cmdbuf[2];
 259
 260         if (!rtlhal->fw_ready) {
 261                 WARN_ONCE(true,
 262                           "rtl8723ae: error H2C cmd because of Fw download fail!!!\n");
 263                 return;
 264         }
 265         memset(tmp_cmdbuf, 0, 8);
 266         memcpy(tmp_cmdbuf, cmdbuffer, cmd_len);
 267         _rtl8723e_fill_h2c_command(hw, element_id, cmd_len,
 268                                    (u8 *)&tmp_cmdbuf);
 269 }
 270
 271 void rtl8723e_set_fw_pwrmode_cmd(struct ieee80211_hw *hw, u8 mode)
 272 {
 273         struct rtl_priv *rtlpriv = rtl_priv(hw);
 274         u8 u1_h2c_set_pwrmode[3] = { 0 };
 275         struct rtl_ps_ctl *ppsc = rtl_psc(rtl_priv(hw));
 276
 277         RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD, "FW LPS mode = %d\n", mode);
 278
 279         SET_H2CCMD_PWRMODE_PARM_MODE(u1_h2c_set_pwrmode, mode);
 280         SET_H2CCMD_PWRMODE_PARM_SMART_PS(u1_h2c_set_pwrmode,
 281                 (rtlpriv->mac80211.p2p) ? ppsc->smart_ps : 1);
 282         SET_H2CCMD_PWRMODE_PARM_BCN_PASS_TIME(u1_h2c_set_pwrmode,
 283                                               ppsc->reg_max_lps_awakeintvl);
 284
 285         RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_DMESG,
 286                       "rtl8723e_set_fw_rsvdpagepkt(): u1_h2c_set_pwrmode\n",
 287                       u1_h2c_set_pwrmode, 3);
 288         rtl8723e_fill_h2c_cmd(hw, H2C_SETPWRMODE, 3, u1_h2c_set_pwrmode);
 289 }
 290
 291 #define BEACON_PG               0 /* ->1 */
 292 #define PSPOLL_PG               2
 293 #define NULL_PG                 3
 294 #define PROBERSP_PG             4 /* ->5 */
 295
 296 #define TOTAL_RESERVED_PKT_LEN  768
 297
 298 static u8 reserved_page_packet[TOTAL_RESERVED_PKT_LEN] = {
 299         /* page 0 beacon */
 300         0x80, 0x00, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF,
 301         0xFF, 0xFF, 0x00, 0xE0, 0x4C, 0x76, 0x00, 0x42,
 302         0x00, 0x40, 0x10, 0x10, 0x00, 0x03, 0x50, 0x08,
 303         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 304         0x64, 0x00, 0x00, 0x04, 0x00, 0x0C, 0x6C, 0x69,
 305         0x6E, 0x6B, 0x73, 0x79, 0x73, 0x5F, 0x77, 0x6C,
 306         0x61, 0x6E, 0x01, 0x04, 0x82, 0x84, 0x8B, 0x96,
 307         0x03, 0x01, 0x01, 0x06, 0x02, 0x00, 0x00, 0x2A,
 308         0x01, 0x00, 0x32, 0x08, 0x24, 0x30, 0x48, 0x6C,
 309         0x0C, 0x12, 0x18, 0x60, 0x2D, 0x1A, 0x6C, 0x18,
 310         0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 311         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 312         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 313         0x3D, 0x00, 0xDD, 0x06, 0x00, 0xE0, 0x4C, 0x02,
 314         0x01, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 315         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 316
 317         /* page 1 beacon */
 318         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 319         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 320         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 321         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 322         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 323         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 324         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 325         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 326         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 327         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 328         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 329         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 330         0x10, 0x00, 0x20, 0x8C, 0x00, 0x12, 0x10, 0x00,
 331         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 332         0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 333         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 334
 335         /* page 2  ps-poll */
 336         0xA4, 0x10, 0x01, 0xC0, 0x00, 0x40, 0x10, 0x10,
 337         0x00, 0x03, 0x00, 0xE0, 0x4C, 0x76, 0x00, 0x42,
 338         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 339         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 340         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 341         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 342         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 343         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 344         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 345         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 346         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 347         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 348         0x18, 0x00, 0x20, 0x8C, 0x00, 0x12, 0x00, 0x00,
 349         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80,
 350         0x80, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 351         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 352
 353         /* page 3  null */
 354         0x48, 0x01, 0x00, 0x00, 0x00, 0x40, 0x10, 0x10,
 355         0x00, 0x03, 0x00, 0xE0, 0x4C, 0x76, 0x00, 0x42,
 356         0x00, 0x40, 0x10, 0x10, 0x00, 0x03, 0x00, 0x00,
 357         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 358         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 359         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 360         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 361         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 362         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 363         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 364         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 365         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 366         0x72, 0x00, 0x20, 0x8C, 0x00, 0x12, 0x00, 0x00,
 367         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80,
 368         0x80, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 369         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 370
 371         /* page 4  probe_resp */
 372         0x50, 0x00, 0x00, 0x00, 0x00, 0x40, 0x10, 0x10,
 373         0x00, 0x03, 0x00, 0xE0, 0x4C, 0x76, 0x00, 0x42,
 374         0x00, 0x40, 0x10, 0x10, 0x00, 0x03, 0x00, 0x00,
 375         0x9E, 0x46, 0x15, 0x32, 0x27, 0xF2, 0x2D, 0x00,
 376         0x64, 0x00, 0x00, 0x04, 0x00, 0x0C, 0x6C, 0x69,
 377         0x6E, 0x6B, 0x73, 0x79, 0x73, 0x5F, 0x77, 0x6C,
 378         0x61, 0x6E, 0x01, 0x04, 0x82, 0x84, 0x8B, 0x96,
 379         0x03, 0x01, 0x01, 0x06, 0x02, 0x00, 0x00, 0x2A,
 380         0x01, 0x00, 0x32, 0x08, 0x24, 0x30, 0x48, 0x6C,
 381         0x0C, 0x12, 0x18, 0x60, 0x2D, 0x1A, 0x6C, 0x18,
 382         0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 383         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 384         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 385         0x3D, 0x00, 0xDD, 0x06, 0x00, 0xE0, 0x4C, 0x02,
 386         0x01, 0x70, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 387         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 388
 389         /* page 5  probe_resp */
 390         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 391         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 392         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 393         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 394         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 395         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 396         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 397         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 398         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 399         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 400         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 401         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 402         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 403         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 404         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 405         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
 406 };
 407
 408 void rtl8723e_set_fw_rsvdpagepkt(struct ieee80211_hw *hw, bool b_dl_finished)
 409 {
 410         struct rtl_priv *rtlpriv = rtl_priv(hw);
 411         struct rtl_mac *mac = rtl_mac(rtl_priv(hw));
 412         struct sk_buff *skb = NULL;
 413         u32 totalpacketlen;
 414         bool rtstatus;
 415         u8 u1rsvdpageloc[3] = { 0 };
 416         bool b_dlok = false;
 417         u8 *beacon;
 418         u8 *p_pspoll;
 419         u8 *nullfunc;
 420         u8 *p_probersp;
 421
 422         /*---------------------------------------------------------
 423          *                      (1) beacon
 424          *---------------------------------------------------------
 425          */
 426         beacon = &reserved_page_packet[BEACON_PG * 128];
 427         SET_80211_HDR_ADDRESS2(beacon, mac->mac_addr);
 428         SET_80211_HDR_ADDRESS3(beacon, mac->bssid);
 429
 430         /*-------------------------------------------------------
 431          *                      (2) ps-poll
 432          *--------------------------------------------------------
 433          */
 434         p_pspoll = &reserved_page_packet[PSPOLL_PG * 128];
 435         SET_80211_PS_POLL_AID(p_pspoll, (mac->assoc_id | 0xc000));
 436         SET_80211_PS_POLL_BSSID(p_pspoll, mac->bssid);
 437         SET_80211_PS_POLL_TA(p_pspoll, mac->mac_addr);
 438
 439         SET_H2CCMD_RSVDPAGE_LOC_PSPOLL(u1rsvdpageloc, PSPOLL_PG);
 440
 441         /*--------------------------------------------------------
 442          *                      (3) null data
 443          *---------------------------------------------------------
 444          */
 445         nullfunc = &reserved_page_packet[NULL_PG * 128];
 446         SET_80211_HDR_ADDRESS1(nullfunc, mac->bssid);
 447         SET_80211_HDR_ADDRESS2(nullfunc, mac->mac_addr);
 448         SET_80211_HDR_ADDRESS3(nullfunc, mac->bssid);
 449
 450         SET_H2CCMD_RSVDPAGE_LOC_NULL_DATA(u1rsvdpageloc, NULL_PG);
 451
 452         /*---------------------------------------------------------
 453          *                      (4) probe response
 454          *----------------------------------------------------------
 455          */
 456         p_probersp = &reserved_page_packet[PROBERSP_PG * 128];
 457         SET_80211_HDR_ADDRESS1(p_probersp, mac->bssid);
 458         SET_80211_HDR_ADDRESS2(p_probersp, mac->mac_addr);
 459         SET_80211_HDR_ADDRESS3(p_probersp, mac->bssid);
 460
 461         SET_H2CCMD_RSVDPAGE_LOC_PROBE_RSP(u1rsvdpageloc, PROBERSP_PG);
 462
 463         totalpacketlen = TOTAL_RESERVED_PKT_LEN;
 464
 465         RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_LOUD,
 466                       "rtl8723e_set_fw_rsvdpagepkt(): HW_VAR_SET_TX_CMD: ALL\n",
 467                       &reserved_page_packet[0], totalpacketlen);
 468         RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_DMESG,
 469                       "rtl8723e_set_fw_rsvdpagepkt(): HW_VAR_SET_TX_CMD: ALL\n",
 470                       u1rsvdpageloc, 3);
 471
 472         skb = dev_alloc_skb(totalpacketlen);
 473         memcpy((u8 *)skb_put(skb, totalpacketlen),
 474                &reserved_page_packet, totalpacketlen);
 475
 476         rtstatus = rtl_cmd_send_packet(hw, skb);
 477
 478         if (rtstatus)
 479                 b_dlok = true;
 480
 481         if (b_dlok) {
 482                 RT_TRACE(rtlpriv, COMP_POWER, DBG_LOUD,
 483                          "Set RSVD page location to Fw.\n");
 484                 RT_PRINT_DATA(rtlpriv, COMP_CMD, DBG_DMESG,
 485                               "H2C_RSVDPAGE:\n",
 486                               u1rsvdpageloc, 3);
 487                 rtl8723e_fill_h2c_cmd(hw, H2C_RSVDPAGE,
 488                                       sizeof(u1rsvdpageloc), u1rsvdpageloc);
 489         } else
 490                 RT_TRACE(rtlpriv, COMP_ERR, DBG_WARNING,
 491                          "Set RSVD page location to Fw FAIL!!!!!!.\n");
 492 }
 493
 494 void rtl8723e_set_fw_joinbss_report_cmd(struct ieee80211_hw *hw, u8 mstatus)
 495 {
 496         u8 u1_joinbssrpt_parm[1] = { 0 };
 497
 498         SET_H2CCMD_JOINBSSRPT_PARM_OPMODE(u1_joinbssrpt_parm, mstatus);
 499
 500         rtl8723e_fill_h2c_cmd(hw, H2C_JOINBSSRPT, 1, u1_joinbssrpt_parm);
 501 }
 502
 503 static void rtl8723e_set_p2p_ctw_period_cmd(struct ieee80211_hw *hw,
 504                                             u8 ctwindow)
 505 {
 506         u8 u1_ctwindow_period[1] = { ctwindow};
 507
 508         rtl8723e_fill_h2c_cmd(hw, H2C_P2P_PS_CTW_CMD, 1, u1_ctwindow_period);
 509
 510 }
 511
 512 void rtl8723e_set_p2p_ps_offload_cmd(struct ieee80211_hw *hw, u8 p2p_ps_state)
 513 {
 514         struct rtl_priv *rtlpriv = rtl_priv(hw);
 515         struct rtl_ps_ctl *rtlps = rtl_psc(rtl_priv(hw));
 516         struct rtl_hal *rtlhal = rtl_hal(rtl_priv(hw));
 517         struct rtl_p2p_ps_info *p2pinfo = &(rtlps->p2p_ps_info);
 518         struct p2p_ps_offload_t *p2p_ps_offload = &rtlhal->p2p_ps_offload;
 519         u8      i;
 520         u16     ctwindow;
 521         u32     start_time, tsf_low;
 522
 523         switch (p2p_ps_state) {
 524         case P2P_PS_DISABLE:
 525                 RT_TRACE(rtlpriv, COMP_FW, DBG_LOUD, "P2P_PS_DISABLE\n");
 526                 memset(p2p_ps_offload, 0, sizeof(*p2p_ps_offload));
 527                 break;
 528         case P2P_PS_ENABLE:
 529                 RT_TRACE(rtlpriv, COMP_FW, DBG_LOUD, "P2P_PS_ENABLE\n");
 530                 /* update CTWindow value. */
 531                 if (p2pinfo->ctwindow > 0) {
 532                         p2p_ps_offload->ctwindow_en = 1;
 533                         ctwindow = p2pinfo->ctwindow;
 534                         rtl8723e_set_p2p_ctw_period_cmd(hw, ctwindow);
 535                 }
 536
 537                 /* hw only support 2 set of NoA */
 538                 for (i = 0 ; i < p2pinfo->noa_num ; i++) {
 539                         /* To control the register setting for which NOA*/
 540                         rtl_write_byte(rtlpriv, 0x5cf, (i << 4));
 541                         if (i == 0)
 542                                 p2p_ps_offload->noa0_en = 1;
 543                         else
 544                                 p2p_ps_offload->noa1_en = 1;
 545
 546                         /* config P2P NoA Descriptor Register */
 547                         rtl_write_dword(rtlpriv, 0x5E0,
 548                                         p2pinfo->noa_duration[i]);
 549                         rtl_write_dword(rtlpriv, 0x5E4,
 550                                         p2pinfo->noa_interval[i]);
 551
 552                         /*Get Current TSF value */
 553                         tsf_low = rtl_read_dword(rtlpriv, REG_TSFTR);
 554
 555                         start_time = p2pinfo->noa_start_time[i];
 556                         if (p2pinfo->noa_count_type[i] != 1) {
 557                                 while (start_time <=
 558                                         (tsf_low+(50*1024))) {
 559                                         start_time +=
 560                                                 p2pinfo->noa_interval[i];
 561                                         if (p2pinfo->noa_count_type[i] != 255)
 562                                                 p2pinfo->noa_count_type[i]--;
 563                                 }
 564                         }
 565                         rtl_write_dword(rtlpriv, 0x5E8, start_time);
 566                         rtl_write_dword(rtlpriv, 0x5EC,
 567                                 p2pinfo->noa_count_type[i]);
 568
 569                 }
 570
 571                 if ((p2pinfo->opp_ps == 1) || (p2pinfo->noa_num > 0)) {
 572                         /* rst p2p circuit */
 573                         rtl_write_byte(rtlpriv, REG_DUAL_TSF_RST, BIT(4));
 574
 575                         p2p_ps_offload->offload_en = 1;
 576
 577                         if (P2P_ROLE_GO == rtlpriv->mac80211.p2p) {
 578                                 p2p_ps_offload->role = 1;
 579                                 p2p_ps_offload->allstasleep = 0;
 580                         } else {
 581                                 p2p_ps_offload->role = 0;
 582                         }
 583
 584                         p2p_ps_offload->discovery = 0;
 585                 }
 586                 break;
 587         case P2P_PS_SCAN:
 588                 RT_TRACE(rtlpriv, COMP_FW, DBG_LOUD, "P2P_PS_SCAN\n");
 589                 p2p_ps_offload->discovery = 1;
 590                 break;
 591         case P2P_PS_SCAN_DONE:
 592                 RT_TRACE(rtlpriv, COMP_FW, DBG_LOUD, "P2P_PS_SCAN_DONE\n");
 593                 p2p_ps_offload->discovery = 0;
 594                 p2pinfo->p2p_ps_state = P2P_PS_ENABLE;
 595                 break;
 596         default:
 597                 break;
 598         }
 599
 600         rtl8723e_fill_h2c_cmd(hw, H2C_P2P_PS_OFFLOAD, 1, (u8 *)p2p_ps_offload);
 601
 602 }