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