mirror of
https://github.com/RinCat/RTL88x2BU-Linux-Driver.git
synced 2024-12-26 18:11:35 +00:00
2537 lines
75 KiB
C
2537 lines
75 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2007 - 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.
|
|
*
|
|
* The full GNU General Public License is included in this distribution in the
|
|
* file called LICENSE.
|
|
*
|
|
* Contact Information:
|
|
* wlanfae <wlanfae@realtek.com>
|
|
* Realtek Corporation, No. 2, Innovation Road II, Hsinchu Science Park,
|
|
* Hsinchu 300, Taiwan.
|
|
*
|
|
* Larry Finger <Larry.Finger@lwfinger.net>
|
|
*
|
|
*****************************************************************************/
|
|
#include "mp_precomp.h"
|
|
#include "../phydm_precomp.h"
|
|
|
|
#if (RTL8822B_SUPPORT == 1)
|
|
#if (PHYDM_FW_API_ENABLE_8822B == 1)
|
|
/* @======================================================================== */
|
|
/* @These following functions can be used for PHY DM only*/
|
|
|
|
enum channel_width bw_8822b;
|
|
u8 central_ch_8822b;
|
|
u8 central_ch_8822b_drp;
|
|
|
|
u32 cca_ifem_ccut[3][4] = {
|
|
{0x75C97010, 0x75C97010, 0x75C97010, 0x75C97010}, /*Reg82C*/
|
|
{0x79a0eaaa, 0x79A0EAAC, 0x79a0eaaa, 0x79a0eaaa}, /*Reg830*/
|
|
{0x87765541, 0x87746341, 0x87765541, 0x87746341} /*Reg838*/
|
|
};
|
|
|
|
u32 cca_efem_ccut[3][4] = {
|
|
{0x75B86010, 0x75B76010, 0x75B86010, 0x75B76010}, /*Reg82C*/
|
|
{0x79A0EAA8, 0x79A0EAAC, 0x79A0EAA8, 0x79a0eaaa}, /*Reg830*/
|
|
{0x87766451, 0x87766431, 0x87766451, 0x87766431} /*Reg838*/
|
|
};
|
|
|
|
u32 cca_ifem_ccut_rfe[3][4] = {
|
|
{0x75da8010, 0x75da8010, 0x75da8010, 0x75da8010}, /*Reg82C*/
|
|
{0x79a0eaaa, 0x97A0EAAC, 0x79a0eaaa, 0x79a0eaaa}, /*Reg830*/
|
|
{0x87765541, 0x86666341, 0x87765561, 0x86666361} /*Reg838*/
|
|
};
|
|
|
|
__iram_odm_func__
|
|
void phydm_igi_toggle_8822b(struct dm_struct *dm)
|
|
{
|
|
u32 igi = 0x20;
|
|
|
|
igi = odm_get_bb_reg(dm, R_0xc50, 0x7f);
|
|
odm_set_bb_reg(dm, R_0xc50, 0x7f, (igi - 2));
|
|
odm_set_bb_reg(dm, R_0xc50, 0x7f, igi);
|
|
odm_set_bb_reg(dm, R_0xe50, 0x7f, (igi - 2));
|
|
odm_set_bb_reg(dm, R_0xe50, 0x7f, igi);
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_8822b_type18_rfe(struct dm_struct *dm, u8 channel)
|
|
{
|
|
if (channel <= 14) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
} else if ((channel > 35) && (channel <= 64)) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKLWORD, 0x7557);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKLWORD, 0x7557);
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(5), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(5), 0);
|
|
} else if (channel > 64) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKLWORD, 0x7575);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKLWORD, 0x7575);
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(5), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(5), 0);
|
|
}
|
|
|
|
/* invertor and antenna switch */
|
|
if (channel <= 14) {
|
|
/* inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x8);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x2);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x8);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x2);
|
|
|
|
/* antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* 2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf050);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf050);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf055);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf055);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf550);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf550);
|
|
}
|
|
|
|
} else if (channel > 35) {
|
|
/* inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10) | BIT(9)
|
|
| BIT(8)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10) | BIT(9)
|
|
| BIT(8)), 0x0);
|
|
|
|
/* delay 400ns for PAPE */
|
|
/* odm_set_bb_reg(p_dm, 0x810, MASKBYTE3|BIT20|BIT21*/
|
|
/* |BIT22|BIT23, 0x211); */
|
|
|
|
/* antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* 2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0x5501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0x5501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0x5500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0x5500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0x5005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0x5005);
|
|
}
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_8822b_type15_rfe(struct dm_struct *dm, u8 channel)
|
|
{
|
|
if (channel <= 14) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x77);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x77);
|
|
|
|
} else if ((channel > 35) && (channel <= 64)) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777747);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777747);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE0, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE0, 0x57);
|
|
|
|
} else if (channel > 64) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777747);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777747);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE0, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE0, 0x75);
|
|
|
|
} else {
|
|
return;
|
|
}
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(11) | BIT(10) | BIT(9) | BIT(8), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, BIT(11) | BIT(10) | BIT(9) | BIT(8), 0x0);
|
|
|
|
/* @antenna switch table */
|
|
if (channel <= 14) {
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa005);
|
|
}
|
|
} else if (channel > 35) {
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa5a5);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa5a5);
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
u32 phydm_check_bit_mask(u32 bit_mask, u32 data_original, u32 data)
|
|
{
|
|
u8 bit_shift;
|
|
|
|
if (bit_mask != 0xfffff) {
|
|
for (bit_shift = 0; bit_shift <= 19; bit_shift++) {
|
|
if (((bit_mask >> bit_shift) & 0x1) == 1)
|
|
break;
|
|
}
|
|
return ((data_original) & (~bit_mask)) | (data << bit_shift);
|
|
}
|
|
|
|
return data;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_8822b_setting(void *dm_void, u8 rfe_n, u8 mux_sel,
|
|
u8 inv_en, u8 source_sel)
|
|
{
|
|
struct dm_struct *dm = (struct dm_struct *)dm_void;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======>\n", __func__);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"RFE[%d]:{Path=0x%x}{inv_en=%d}{source=0x%x}\n", rfe_n,
|
|
mux_sel, inv_en, source_sel);
|
|
|
|
if (rfe_n > 11) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Wrong RFE=%d}\n", rfe_n);
|
|
return;
|
|
}
|
|
|
|
/*@[Path_mux_sel]*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(rfe_n),
|
|
((mux_sel == BB_PATH_A) ? 0 : 1));
|
|
|
|
/*@[Inv_en]*/
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(rfe_n), (u32)inv_en);
|
|
odm_set_bb_reg(dm, R_0xebc, BIT(rfe_n), (u32)inv_en);
|
|
|
|
/*@[Output Source Signal Selection]*/
|
|
if (rfe_n <= 7) {
|
|
odm_set_bb_reg(dm, R_0xcb0, ((0xf) << (rfe_n * 4)),
|
|
(u32)source_sel);
|
|
odm_set_bb_reg(dm, R_0xeb0, ((0xf) << (rfe_n * 4)),
|
|
(u32)source_sel);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb4, ((0xf) << ((rfe_n - 8) * 4)),
|
|
(u32)source_sel);
|
|
odm_set_bb_reg(dm, R_0xeb4, ((0xf) << ((rfe_n - 8) * 4)),
|
|
(u32)source_sel);
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_8822b_init(struct dm_struct *dm)
|
|
{
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "8822B RFE_Init, RFE_type=((%d))\n",
|
|
dm->rfe_type);
|
|
|
|
/* @chip top mux */
|
|
odm_set_bb_reg(dm, R_0x64, BIT(29) | BIT(28), 0x3);
|
|
odm_set_bb_reg(dm, R_0x4c, BIT(26) | BIT(25), 0x0);
|
|
odm_set_bb_reg(dm, R_0x40, BIT(2), 0x1);
|
|
|
|
/* @from s0 or s1 */
|
|
odm_set_bb_reg(dm, R_0x1990, 0x3f, 0x30);
|
|
odm_set_bb_reg(dm, R_0x1990, (BIT(11) | BIT(10)), 0x3);
|
|
|
|
/* @input or output */
|
|
odm_set_bb_reg(dm, R_0x974, 0x3f, 0x3f);
|
|
odm_set_bb_reg(dm, R_0x974, (BIT(11) | BIT(10)), 0x3);
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_4_11(struct dm_struct *dm, u8 channel)
|
|
{
|
|
boolean is_channel_2g = (channel <= 14) ? true : false;
|
|
u8 rfe_type = dm->rfe_type;
|
|
|
|
/*TRSW=trsw_forced_BT ? 0x804[0]:(0xCB8[2]?0xCB8[0]:trsw_lut);*/
|
|
/*trsw_lut = TXON*/
|
|
/*TRSWB = trsw_forced_BT ? (~0x804[0]) :*/
|
|
/*@(0xCB8[2] ? 0xCB8[1] : trswb_lut); trswb_lut = TXON*/
|
|
/*trsw_forced_BT = 0x804[1] ? 0 : (~GNT_WL); */
|
|
#if 0
|
|
/*odm_set_bb_reg(dm, R_0x804, (BIT(1)|BIT(0)), 0x0);*/
|
|
#endif
|
|
/* @Default setting is in PHY parameters */
|
|
|
|
if (is_channel_2g) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x8);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x2);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x8);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x2);
|
|
|
|
/* @antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf050);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf050);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf055);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf055);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xf550);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xf550);
|
|
}
|
|
|
|
} else {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x75);
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0);
|
|
|
|
/* @antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa005);
|
|
}
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_efem(struct dm_struct *dm, u8 channel)
|
|
{
|
|
boolean is_channel_2g = (channel <= 14) ? true : false;
|
|
u8 rfe_type = dm->rfe_type;
|
|
|
|
if (dm->cut_version == ODM_CUT_B && rfe_type < 2) {
|
|
if (is_channel_2g) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x704570);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x704570);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x45);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x45);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x174517);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x174517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x45);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x45);
|
|
}
|
|
|
|
/* @delay 400ns for PAPE */
|
|
odm_set_bb_reg(dm, R_0x810, 0xfff00000, 0x211);
|
|
|
|
/* @antenna switch table */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa555);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa555);
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0);
|
|
} else {
|
|
if (is_channel_2g) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(4), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(4), 0);
|
|
} else {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(5), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(5), 0);
|
|
}
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0);
|
|
|
|
/* @delay 400ns for PAPE */
|
|
/* odm_set_bb_reg(dm, R_0x810, MASKBYTE3|BIT20|BIT21|BIT22|*/
|
|
/*@BIT23, 0x211); */
|
|
|
|
/* @antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa005);
|
|
}
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_ifem(struct dm_struct *dm, u8 channel)
|
|
{
|
|
boolean is_channel_2g = (channel <= 14) ? true : false;
|
|
u8 rfe_type = dm->rfe_type;
|
|
|
|
if (is_channel_2g) {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
} else {
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x75);
|
|
}
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0);
|
|
|
|
/* @antenna switch table */
|
|
if (is_channel_2g) {
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa005);
|
|
}
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa5a5);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa5a5);
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_2t3r(struct dm_struct *dm, u8 channel)
|
|
{
|
|
#if 0
|
|
/* @[MAC] */
|
|
odm_set_mac_reg(dm, R_0x4c, BIT(23), 0);/* path-A, RFE_CTRL_8 */
|
|
odm_set_mac_reg(dm, R_0x4c, BIT(24), 1);/* path-A, RFE_CTRL_9 */
|
|
/* @[BB] */
|
|
odm_set_bb_reg(dm, R_0x970, BIT(9) | BIT(8), 0x3);/* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(8), 0x0);
|
|
/* r_rfe_path_sel_ (RFE_CTRL_8) */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(9), 0x0);
|
|
/* r_rfe_path_sel_ (RFE_CTRL_9) */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(19), 0x0);/* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(8), 0x0);/* rfe_inv (RFE_CTRL_8) */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(9), 0x1);/* rfe_inv (RFE_CTRL_9) */
|
|
odm_set_bb_reg(dm, R_0xcb4, 0xF, 0x8);/* path-A, RFE_CTRL_8 */
|
|
odm_set_bb_reg(dm, R_0xcb4, 0xF0, 0x8);/* path-A, RFE_CTRL_9 */
|
|
#endif
|
|
odm_set_mac_reg(dm, R_0x40, BIT(2), 1);
|
|
odm_set_bb_reg(dm, R_0x970, BIT(5), 1); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0x970, BIT(10), 1); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(5), 0x0);
|
|
/*@r_rfe_path_sel_ (RFE_CTRL_5) */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(10), 0x0);
|
|
/*@r_rfe_path_sel_ (RFE_CTRL_10) */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(19), 0x0); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(5), 0x0); /* rfe_inv (RFE_CTRL_5) */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(10), 0x1); /* rfe_inv (RFE_CTRL_10) */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xF00000, 0x8); /* path-A, RFE_CTRL_5 */
|
|
odm_set_bb_reg(dm, R_0xcb4, 0xF00, 0x8); /* path-A, RFE_CTRL_10 */
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_2t4r(struct dm_struct *dm, u8 channel)
|
|
{
|
|
odm_set_mac_reg(dm, R_0x40, BIT(2), 1);
|
|
odm_set_bb_reg(dm, R_0x970, BIT(5), 1); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0x970, BIT(10), 1); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(5), 0x0);
|
|
/*@r_rfe_path_sel_ (RFE_CTRL_5) */
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(10), 0x1);
|
|
/*@r_rfe_path_sel_ Path B (RFE_CTRL_10) */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(19), 0x0); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0xebc, BIT(19), 0x0); /* RFE_buffer */
|
|
odm_set_bb_reg(dm, R_0xcbc, BIT(5), 0x0); /* rfe_inv (RFE_CTRL_5) */
|
|
odm_set_bb_reg(dm, R_0xebc, BIT(10), 0x0); /* rfe_inv (RFE_CTRL_10) */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xF00000, 0x8); /* path-A, RFE_CTRL_5 */
|
|
odm_set_bb_reg(dm, R_0xeb4, 0xF00, 0x8); /* path-B, RFE_CTRL_10 */
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rfe_smtant(struct dm_struct *dm, u8 channel)
|
|
{
|
|
boolean is_channel_2g = (channel <= 14) ? true : false;
|
|
|
|
if (is_channel_2g) {
|
|
#if 0
|
|
/* signal source */
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(4), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(4), 0);
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xcbc, (BIT(11) | BIT(10)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0x3f, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, (BIT(11) | BIT(10)), 0x0);
|
|
#endif
|
|
} else {
|
|
/* signal source */
|
|
#if 1
|
|
/*path A*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(3), 0); /*RFE_CTRL_3*/ /*A_0*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(0), 0); /*RFE_CTRL_0*/ /*A_1*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(8), 0); /*RFE_CTRL_8*/ /*A_2*/
|
|
|
|
/*path B*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(4), 1); /*RFE_CTRL_4*/ /*B_0*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(11), 1); /*RFE_CTRL_11*//*B_1*/
|
|
odm_set_bb_reg(dm, R_0x1990, BIT(9), 1); /*RFE_CTRL_9*/ /*B_2*/
|
|
|
|
odm_set_bb_reg(dm, R_0xcb0, MASKDWORD, 0x77178519);
|
|
#if 0
|
|
/* odm_set_bb_reg(dm, R_0xeb0, MASKDWORD, 0x77177517); */
|
|
#endif
|
|
odm_set_bb_reg(dm, R_0xeb0, MASKDWORD, 0x771c7517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKDWORD, 0x757a);
|
|
#if 0
|
|
/* odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x7577); */
|
|
#endif
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKDWORD, 0xd5e7);
|
|
|
|
/* @inverse or not */
|
|
odm_set_bb_reg(dm, R_0xcbc, 0xfff, 0x0);
|
|
odm_set_bb_reg(dm, R_0xebc, 0xfff, 0x0);
|
|
#else
|
|
phydm_rfe_8822b_setting(dm, 1, BB_PATH_A, 0, PAPE_5G);
|
|
phydm_rfe_8822b_setting(dm, 2, BB_PATH_A, 0, TRSW_B);
|
|
phydm_rfe_8822b_setting(dm, 5, BB_PATH_B, 0, PAPE_5G);
|
|
phydm_rfe_8822b_setting(dm, 10, BB_PATH_B, 0, TRSW_B);
|
|
#endif
|
|
|
|
odm_set_bb_reg(dm, R_0xcb8, BIT(5), 0);
|
|
odm_set_bb_reg(dm, R_0xeb8, BIT(5), 0);
|
|
}
|
|
|
|
/* @delay 400ns for PAPE */
|
|
/* @odm_set_bb_reg(dm, R_0x810, MASKBYTE3|BIT20|BIT21|BIT22|*/
|
|
/* @BIT23, 0x211); */
|
|
|
|
/* @antenna switch table */
|
|
if (dm->rx_ant_status == BB_PATH_AB ||
|
|
dm->tx_ant_status == BB_PATH_AB) {
|
|
/* @2TX or 2RX */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa501);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa501);
|
|
} else if (dm->rx_ant_status == dm->tx_ant_status) {
|
|
/* TXA+RXA or TXB+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa500);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa500);
|
|
} else {
|
|
/* TXB+RXA or TXA+RXB */
|
|
odm_set_bb_reg(dm, R_0xca0, MASKLWORD, 0xa005);
|
|
odm_set_bb_reg(dm, R_0xea0, MASKLWORD, 0xa005);
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
phydm_rfe_8822b(struct dm_struct *dm, u8 channel)
|
|
{
|
|
boolean is_channel_2g = (channel <= 14) ? true : false;
|
|
u8 rfe_type = dm->rfe_type;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"[8822B] Update RFE PINs: CH:%d, T/RX_path:{ 0x%x, 0x%x}, cut_ver:%d, rfe_type:%d\n",
|
|
channel, dm->tx_ant_status, dm->rx_ant_status,
|
|
dm->cut_version, rfe_type);
|
|
|
|
if ((channel > 14 && channel < 36) || channel == 0)
|
|
return false;
|
|
|
|
/* @Distinguish the setting band */
|
|
dm->rfe_hwsetting_band = (is_channel_2g) ? 1 : 2;
|
|
|
|
/* @HW Setting for each RFE type */
|
|
if (rfe_type == 4 || rfe_type == 11)
|
|
phydm_rfe_4_11(dm, channel);
|
|
else if ((rfe_type == 1) || (rfe_type == 2) || (rfe_type == 6) ||
|
|
(rfe_type == 7) || (rfe_type == 9))
|
|
/* @eFem */
|
|
phydm_rfe_efem(dm, channel);
|
|
else if ((rfe_type == 0) || (rfe_type == 3) || (rfe_type == 5) ||
|
|
(rfe_type == 8) || (rfe_type == 10) || (rfe_type == 12) ||
|
|
(rfe_type == 13) || (rfe_type == 14) || (rfe_type == 16) ||
|
|
(rfe_type == 17))
|
|
/* @iFEM */
|
|
phydm_rfe_ifem(dm, channel);
|
|
else if (rfe_type == 15)
|
|
/* @iFEM for Microsoft, 5G low/high band at S0 */
|
|
phydm_8822b_type15_rfe(dm, channel);
|
|
else if (rfe_type == 18)
|
|
/* @eFEM for Roku, 5G low/high band at S0/S1 */
|
|
phydm_8822b_type18_rfe(dm, channel);
|
|
|
|
#if (defined(CONFIG_2T3R_ANTENNA))
|
|
else if (rfe_type == ANT_2T3R_RFE_TYPE)
|
|
phydm_rfe_2t3r(dm, channel);
|
|
|
|
#endif
|
|
#if (defined(CONFIG_2T4R_ANTENNA))
|
|
else if (rfe_type == ANT_2T4R_RFE_TYPE)
|
|
phydm_rfe_2t4r(dm, channel);
|
|
|
|
#endif
|
|
#if (defined(CONFIG_CUMITEK_SMART_ANTENNA))
|
|
else if (rfe_type == SMTANT_TMP_RFE_TYPE) {
|
|
/*@modify from RFE_TYPE = 1*/
|
|
phydm_rfe_smtant(dm, channel);
|
|
}
|
|
#endif
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
phydm_rfe_8822b_lps(struct dm_struct *dm, boolean enable_sw_rfe)
|
|
{
|
|
u8 rfe_type = dm->rfe_type;
|
|
u32 rf_reg18_ch = 0;
|
|
|
|
rf_reg18_ch = config_phydm_read_rf_reg_8822b(dm, RF_PATH_A, 0x18, 0xff);
|
|
|
|
/* @HW Setting for each RFE type */
|
|
if (rfe_type == 4) {
|
|
if (rf_reg18_ch <= 14) {
|
|
/* signal source */
|
|
if (!enable_sw_rfe) {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x745774);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x77);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x77);
|
|
}
|
|
} else if (rf_reg18_ch > 35) {
|
|
/* signal source */
|
|
if (!enable_sw_rfe) {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x477547);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x75);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x77);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x77);
|
|
}
|
|
} else {
|
|
return false;
|
|
}
|
|
} else if ((rfe_type == 1) || (rfe_type == 2) ||
|
|
(rfe_type == 6) || (rfe_type == 7) ||
|
|
(rfe_type == 9) || (rfe_type == 11)) {
|
|
/* @eFem */
|
|
if (rf_reg18_ch <= 14) {
|
|
/* signal source */
|
|
if (!enable_sw_rfe) {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x705770);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x57);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x57);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x77);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x77);
|
|
}
|
|
} else if (rf_reg18_ch > 35) {
|
|
/* signal source */
|
|
if (!enable_sw_rfe) {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x177517);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x75);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x75);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xcb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xeb0, 0xffffff, 0x777777);
|
|
odm_set_bb_reg(dm, R_0xcb4, MASKBYTE1, 0x77);
|
|
odm_set_bb_reg(dm, R_0xeb4, MASKBYTE1, 0x77);
|
|
}
|
|
} else {
|
|
return false;
|
|
}
|
|
} else {
|
|
return true;
|
|
}
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
u8 phydm_is_dfs_channel(u8 channel_num)
|
|
{
|
|
if (channel_num >= 52 && channel_num <= 140)
|
|
return 1;
|
|
else
|
|
return 0;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_ccapar_by_rfe_8822b(struct dm_struct *dm)
|
|
{
|
|
u32 cca_ifem[3][4], cca_efem[3][4];
|
|
u8 col;
|
|
u32 reg82c, reg830, reg838;
|
|
boolean is_efem_cca = false, is_ifem_cca = false, is_rfe_type = false;
|
|
u8 bw_40 = CHANNEL_WIDTH_40;
|
|
|
|
odm_move_memory(dm, cca_efem, cca_efem_ccut, 12 * 4);
|
|
if (dm->rfe_type == 3 || dm->rfe_type == 5 ||
|
|
dm->rfe_type == 12 || dm->rfe_type == 15 ||
|
|
dm->rfe_type == 16 || dm->rfe_type == 17) {
|
|
odm_move_memory(dm, cca_ifem, cca_ifem_ccut_rfe, 12 * 4);
|
|
is_rfe_type = true;
|
|
} else {
|
|
odm_move_memory(dm, cca_ifem, cca_ifem_ccut, 12 * 4);
|
|
}
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Update CCA para for Ccut\n");
|
|
|
|
if (central_ch_8822b <= 14) {
|
|
if (dm->rx_ant_status == BB_PATH_A ||
|
|
dm->rx_ant_status == BB_PATH_B)
|
|
col = 0; /*@1R 2G*/
|
|
else
|
|
col = 1; /*@2R 2G*/
|
|
} else {
|
|
if (dm->rx_ant_status == BB_PATH_A ||
|
|
dm->rx_ant_status == BB_PATH_B)
|
|
col = 2; /*@1R 5G*/
|
|
else
|
|
col = 3; /*@2R 5G*/
|
|
}
|
|
|
|
if (dm->rfe_type == 1 || dm->rfe_type == 4 || dm->rfe_type == 6 ||
|
|
dm->rfe_type == 7 || dm->rfe_type == 11) {
|
|
/* @eFEM */
|
|
reg82c = cca_efem[0][col]; reg830 = cca_efem[1][col];
|
|
reg838 = cca_efem[2][col]; is_efem_cca = true;
|
|
} else if ((dm->rfe_type == 2) || (dm->rfe_type == 9)) {
|
|
/*@5G eFEM, 2G iFEM => RFE type 2, 5G eFEM => RFE type 9 */
|
|
if (central_ch_8822b <= 14) {
|
|
reg82c = cca_ifem[0][col]; reg830 = cca_ifem[1][col];
|
|
reg838 = cca_ifem[2][col];
|
|
is_ifem_cca = true;
|
|
} else {
|
|
reg82c = cca_efem[0][col]; reg830 = cca_efem[1][col];
|
|
reg838 = cca_efem[2][col]; is_efem_cca = true;
|
|
}
|
|
} else {
|
|
/* @iFEM */
|
|
reg82c = cca_ifem[0][col]; reg830 = cca_ifem[1][col];
|
|
reg838 = cca_ifem[2][col]; is_ifem_cca = true;
|
|
}
|
|
odm_set_bb_reg(dm, R_0x82c, MASKDWORD, reg82c);
|
|
|
|
if (is_ifem_cca) {
|
|
if ((dm->cut_version == ODM_CUT_B && (col == 1 || col == 3) &&
|
|
bw_8822b == bw_40) ||
|
|
(!is_rfe_type && col == 3 && bw_8822b == bw_40) ||
|
|
(dm->rfe_type == 5 && col == 3))
|
|
odm_set_bb_reg(dm, R_0x830, MASKDWORD, 0x79a0ea28);
|
|
else
|
|
odm_set_bb_reg(dm, R_0x830, MASKDWORD, reg830);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0x830, MASKDWORD, reg830);
|
|
}
|
|
odm_set_bb_reg(dm, R_0x838, MASKDWORD, reg838);
|
|
|
|
if (is_efem_cca && !(dm->cut_version == ODM_CUT_B))
|
|
odm_set_bb_reg(dm, R_0x83c, MASKDWORD, 0x9194b2b9);
|
|
/* @enlarge big jump size in type 16 for MS case */
|
|
if (dm->rfe_type == 16 && central_ch_8822b <= 14)
|
|
odm_set_bb_reg(dm, R_0x8c8, BIT(3) | BIT(2) | BIT(1), 0x3);
|
|
/* @CCA parameters adjust for 20MHz on DFS channel */
|
|
if ((*dm->band_width == CHANNEL_WIDTH_20) &&
|
|
(((*dm->channel >= 52) && (*dm->channel <= 64)) ||
|
|
((*dm->channel >= 100) && (*dm->channel <= 144))))
|
|
odm_set_bb_reg(dm, 0x838, 0xf0, 0x4);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "(Pkt%d, Intf%d, RFE%d), col=%d\n",
|
|
dm->package_type, dm->support_interface, dm->rfe_type, col);
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rxdfirpar_by_bw_8822b(struct dm_struct *dm,
|
|
enum channel_width bandwidth)
|
|
{
|
|
if (bandwidth == CHANNEL_WIDTH_40) {
|
|
/* RX DFIR for BW40 */
|
|
odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x1);
|
|
odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x0);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(31), 0x0);
|
|
} else if (bandwidth == CHANNEL_WIDTH_80) {
|
|
/* RX DFIR for BW80 */
|
|
odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x2);
|
|
odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(31), 0x0);
|
|
} else {
|
|
/* RX DFIR for BW20, BW10 and BW5*/
|
|
odm_set_bb_reg(dm, R_0x948, BIT(29) | BIT(28), 0x2);
|
|
odm_set_bb_reg(dm, R_0x94c, BIT(29) | BIT(28), 0x2);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(31), 0x1);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(31), 0x1);
|
|
}
|
|
#if 0
|
|
/* PHYDM_DBG(dm, ODM_PHY_CONFIG, "phydm_rxdfirpar_by_bw_8822b\n");*/
|
|
#endif
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
phydm_write_txagc_1byte_8822b(struct dm_struct *dm,
|
|
u32 pw_idx, enum rf_path path, u8 hw_rate)
|
|
{
|
|
#if (PHYDM_FW_API_FUNC_ENABLE_8822B == 1)
|
|
u32 offset_txagc[2] = {0x1d00, 0x1d80};
|
|
u8 rate_idx = (hw_rate & 0xfc), i;
|
|
u8 rate_offset = (hw_rate & 0x3);
|
|
u8 ret = 0;
|
|
u32 txagc_idx = 0x0;
|
|
|
|
/* @For debug command only!!!! */
|
|
|
|
/* @Error handling */
|
|
if (path > RF_PATH_B || hw_rate > 0x53) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "unsupported path (%d)\n", path);
|
|
return false;
|
|
}
|
|
|
|
/* @For HW limitation, We can't write TXAGC once a byte. */
|
|
for (i = 0; i < 4; i++) {
|
|
if (i != rate_offset) {
|
|
ret = config_phydm_read_txagc_8822b(dm, path,
|
|
rate_idx + i);
|
|
txagc_idx = txagc_idx | (ret << (i << 3));
|
|
} else {
|
|
txagc_idx = txagc_idx | ((pw_idx & 0x3f) << (i << 3));
|
|
}
|
|
}
|
|
odm_set_bb_reg(dm, (offset_txagc[path] + rate_idx), MASKDWORD,
|
|
txagc_idx);
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "path-%d rate_idx 0x%x (0x%x) = 0x%x\n",
|
|
path, hw_rate, (offset_txagc[path] + hw_rate), pw_idx);
|
|
return true;
|
|
#else
|
|
return false;
|
|
#endif
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_get_condi_num_acc_8822b(void *dm_void)
|
|
{
|
|
struct dm_struct *dm = (struct dm_struct *)dm_void;
|
|
struct odm_phy_dbg_info *dbg = &dm->phy_dbg_info;
|
|
u8 i = 0;
|
|
|
|
for (i = 0; i < CN_CNT_MAX; i++) {
|
|
odm_set_bb_reg(dm, R_0x1988, 0x3fff00, (i << 4));
|
|
dbg->condi_num_cdf[i] = odm_read_1byte(dm, R_0xf87);
|
|
}
|
|
|
|
#if 0
|
|
/*@disable report condition number*/
|
|
/*odm_set_bb_reg(dm, R_0x1988, BIT(22), 0x0);*/
|
|
#endif
|
|
}
|
|
|
|
__iram_odm_func__
|
|
u32 phydm_get_condi_num_8822b(struct dm_struct *dm)
|
|
{
|
|
u32 val = 0;
|
|
u32 condi_num_avg_fine = 0;
|
|
|
|
odm_set_bb_reg(dm, R_0x1988, BIT(22), 0x1);
|
|
|
|
/*@get condi_num_avg U(18,4)*/
|
|
val = odm_get_bb_reg(dm, R_0xf84, (BIT(17) | BIT(16) | MASKLWORD));
|
|
|
|
if (bw_8822b == CHANNEL_WIDTH_80) {
|
|
/*@CN_avg_fine = val*(256/234) ~= val*1.0941 ~= val*(1+2^-4+2^-5)*/
|
|
condi_num_avg_fine = val + (val >> 4) + (val >> 5);
|
|
|
|
} else if (bw_8822b == CHANNEL_WIDTH_40) {
|
|
/*@CN_avg_fine = val*(128/108) ~= val*1.185 ~= val*(1+2^-3)*/
|
|
condi_num_avg_fine = val + (val >> 3);
|
|
} else if (bw_8822b == CHANNEL_WIDTH_20) {
|
|
/*@CN_avg_fine = val*(64/52) ~= val*1.23 ~= val*(1+2^-3)*/
|
|
condi_num_avg_fine = val + (val >> 3);
|
|
}
|
|
|
|
return condi_num_avg_fine;/*U(18,4)*/
|
|
}
|
|
|
|
/* @======================================================================== */
|
|
|
|
/* @======================================================================== */
|
|
/* @These following functions can be used by driver*/
|
|
|
|
__iram_odm_func__
|
|
u32 config_phydm_read_rf_reg_8822b(struct dm_struct *dm,
|
|
enum rf_path path, u32 reg_addr,
|
|
u32 bit_mask)
|
|
{
|
|
u32 readback_value, direct_addr;
|
|
u32 offset_read_rf[2] = {0x2800, 0x2c00};
|
|
|
|
/* @Error handling.*/
|
|
if (path > RF_PATH_B) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "unsupported path (%d)\n", path);
|
|
return INVALID_RF_DATA;
|
|
}
|
|
|
|
/* @Calculate offset */
|
|
reg_addr &= 0xff;
|
|
direct_addr = offset_read_rf[path] + (reg_addr << 2);
|
|
|
|
/* RF register only has 20bits */
|
|
bit_mask &= RFREGOFFSETMASK;
|
|
|
|
/* Read RF register directly */
|
|
readback_value = odm_get_bb_reg(dm, direct_addr, bit_mask);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "RF-%d 0x%x = 0x%x, bit mask = 0x%x\n",
|
|
path, reg_addr, readback_value, bit_mask);
|
|
return readback_value;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_write_rf_reg_8822b(struct dm_struct *dm,
|
|
enum rf_path path, u32 reg_addr, u32 bit_mask,
|
|
u32 data)
|
|
{
|
|
u32 data_and_addr = 0, data_original = 0, ret = 0;
|
|
u32 offset_write_rf[2] = {0xc90, 0xe90};
|
|
|
|
/* @Error handling.*/
|
|
if (path > RF_PATH_B) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "unsupported path (%d)\n", path);
|
|
return false;
|
|
}
|
|
|
|
/* Read RF register content first */
|
|
reg_addr &= 0xff;
|
|
bit_mask = bit_mask & RFREGOFFSETMASK;
|
|
|
|
if (bit_mask != RFREGOFFSETMASK) {
|
|
ret = config_phydm_read_rf_reg_8822b(dm, path, reg_addr,
|
|
RFREGOFFSETMASK);
|
|
data_original = ret;
|
|
|
|
/* @Error handling. RF is disabled */
|
|
if (config_phydm_read_rf_check_8822b(data_original) == false) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Write fail, RF is disable\n");
|
|
return false;
|
|
}
|
|
|
|
/* @check bit mask */
|
|
data = phydm_check_bit_mask(bit_mask, data_original, data);
|
|
}
|
|
|
|
/* Put write addr in [27:20] and write data in [19:00] */
|
|
data_and_addr = ((reg_addr << 20) | (data & 0x000fffff)) & 0x0fffffff;
|
|
|
|
/* Write operation */
|
|
odm_set_bb_reg(dm, offset_write_rf[path], MASKDWORD, data_and_addr);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"RF-%d 0x%x = 0x%x (original: 0x%x), bit mask = 0x%x\n", path,
|
|
reg_addr, data, data_original, bit_mask);
|
|
|
|
#if (defined(CONFIG_RUN_IN_DRV))
|
|
if (dm->support_interface == ODM_ITRF_PCIE)
|
|
ODM_delay_us(13);
|
|
#elif (defined(CONFIG_RUN_IN_FW))
|
|
ODM_delay_us(13);
|
|
#endif
|
|
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_write_txagc_8822b(struct dm_struct *dm,
|
|
u32 pw_idx, enum rf_path path, u8 hw_rate)
|
|
{
|
|
u32 offset_txagc[2] = {0x1d00, 0x1d80};
|
|
u8 rate_idx = (hw_rate & 0xfc);
|
|
|
|
/* @Input need to be HW rate index, not driver rate index!!!! */
|
|
|
|
if (dm->is_disable_phy_api) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "disable PHY API for dbg\n");
|
|
return true;
|
|
}
|
|
|
|
/* @Error handling */
|
|
if (path > RF_PATH_B || hw_rate > 0x53) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "unsupported path (%d)\n", path);
|
|
return false;
|
|
}
|
|
|
|
/* @driver need to construct a 4-byte power index */
|
|
odm_set_bb_reg(dm, (offset_txagc[path] + rate_idx), MASKDWORD, pw_idx);
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "path-%d rate_idx 0x%x (0x%x) = 0x%x\n",
|
|
path, hw_rate, (offset_txagc[path] + hw_rate), pw_idx);
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
u8 config_phydm_read_txagc_8822b(struct dm_struct *dm,
|
|
enum rf_path path, u8 hw_rate)
|
|
{
|
|
#if (PHYDM_FW_API_FUNC_ENABLE_8822B == 1)
|
|
u8 read_back_data;
|
|
|
|
/* @Input need to be HW rate index, not driver rate index!!!! */
|
|
|
|
/* @Error handling */
|
|
if (path > RF_PATH_B || hw_rate > 0x53) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "unsupported path (%d)\n", path);
|
|
return INVALID_TXAGC_DATA;
|
|
}
|
|
|
|
/* @Disable TX AGC report */
|
|
odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x0); /* need to check */
|
|
|
|
/* Set data rate index (bit0~6) and path index (bit7) */
|
|
odm_set_bb_reg(dm, R_0x1998, MASKBYTE0, (hw_rate | (path << 7)));
|
|
|
|
/* @Enable TXAGC report */
|
|
odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x1);
|
|
|
|
/* Read TX AGC report */
|
|
read_back_data = (u8)odm_get_bb_reg(dm, R_0xd30, 0x7f0000);
|
|
|
|
/* @Driver have to disable TXAGC report after reading TXAGC */
|
|
/* @(ref. user guide v11) */
|
|
odm_set_bb_reg(dm, R_0x1998, BIT(16), 0x0);
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "path-%d rate index 0x%x = 0x%x\n", path,
|
|
hw_rate, read_back_data);
|
|
return read_back_data;
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_dsde_init(struct dm_struct *dm)
|
|
{
|
|
/* Reset NBI/CSI everytime after changing channel/BW/band */
|
|
odm_set_bb_reg(dm, R_0x880, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x884, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x888, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x88c, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x890, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x894, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x898, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x89c, MASKDWORD, 0);
|
|
odm_set_bb_reg(dm, R_0x874, BIT(0), 0x0);
|
|
}
|
|
|
|
__iram_odm_func__
|
|
u8 phydm_dsde_ch_idx(struct dm_struct *dm)
|
|
{
|
|
u8 idx = 0;
|
|
|
|
/* @2G Channel Setting > 20M: 5, 6, 7, 8, 13; 40M: 3~11 */
|
|
if ((*dm->channel >= 1) && (*dm->channel <= 14)) {
|
|
if (*dm->band_width == CHANNEL_WIDTH_20) {
|
|
if (*dm->channel >= 5 && *dm->channel <= 8)
|
|
idx = *dm->channel - 5;
|
|
else if (*dm->channel == 13)
|
|
idx = 4;
|
|
else
|
|
idx = 16;
|
|
} else {
|
|
if (*dm->channel >= 3 && *dm->channel <= 11)
|
|
idx = *dm->channel + 2;
|
|
else
|
|
idx = 16;
|
|
}
|
|
} else {
|
|
/* @5G Channel Setting > 20M: 153, 161; */
|
|
/* @40M: 54, 118, 151, 159 */
|
|
/* @80M: 58, 122, 155, 155 */
|
|
switch (*dm->channel) {
|
|
case 153:
|
|
idx = 0;
|
|
break;
|
|
case 161:
|
|
idx = 1;
|
|
break;
|
|
case 54:
|
|
idx = 2;
|
|
break;
|
|
case 118:
|
|
idx = 3;
|
|
break;
|
|
case 151:
|
|
idx = 4;
|
|
break;
|
|
case 159:
|
|
idx = 5;
|
|
break;
|
|
case 58:
|
|
idx = 6;
|
|
break;
|
|
case 122:
|
|
idx = 7;
|
|
break;
|
|
case 155:
|
|
idx = 8;
|
|
break;
|
|
default:
|
|
idx = 16;
|
|
break;
|
|
}
|
|
}
|
|
return idx;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_dsde_nbi(struct dm_struct *dm)
|
|
{
|
|
u8 set_nbi = PHYDM_SET_NO_NEED;
|
|
|
|
/* Modify CCA parameters due to NBI */
|
|
if (dm->rfe_type == 15 || dm->rfe_type == 16)
|
|
odm_set_bb_reg(dm, 0x82c, 0xff000, 0x86);
|
|
else
|
|
odm_set_bb_reg(dm, 0x82c, 0xff000, 0x97);
|
|
if (dm->rfe_type == 12) {
|
|
if (*dm->band_width == CHANNEL_WIDTH_20) {
|
|
if (*dm->channel >= 5 && *dm->channel <= 7)
|
|
odm_set_bb_reg(dm, 0x82c, 0xf000, 0x3);
|
|
}
|
|
} else {
|
|
odm_set_bb_reg(dm, 0x82c, 0xf000, 0x7);
|
|
}
|
|
if (*dm->band_width == CHANNEL_WIDTH_20) {
|
|
if (*dm->channel == 153)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 20, 5760,
|
|
PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 161)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 20, 5800,
|
|
PHYDM_DONT_CARE);
|
|
else if (*dm->channel >= 5 && *dm->channel <= 8)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 20, 2440,
|
|
PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 13)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 20, 2480,
|
|
PHYDM_DONT_CARE);
|
|
else
|
|
set_nbi = PHYDM_SET_NO_NEED;
|
|
} else if (*dm->band_width == CHANNEL_WIDTH_40) {
|
|
if (*dm->channel == 54) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 5280,
|
|
PHYDM_DONT_CARE);
|
|
} else if (*dm->channel == 118) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 5600,
|
|
PHYDM_DONT_CARE);
|
|
} else if (*dm->channel == 151) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 5760,
|
|
PHYDM_DONT_CARE);
|
|
} else if (*dm->channel == 159) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 5800,
|
|
PHYDM_DONT_CARE);
|
|
/* @2.4G */
|
|
} else if ((*dm->channel >= 4) && (*dm->channel <= 6)) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 2440,
|
|
PHYDM_DONT_CARE);
|
|
} else if (*dm->channel == 11) {
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 40, 2480,
|
|
PHYDM_DONT_CARE);
|
|
} else {
|
|
set_nbi = PHYDM_SET_NO_NEED;
|
|
}
|
|
} else if (*dm->band_width == CHANNEL_WIDTH_80) {
|
|
if (*dm->channel == 58)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 80, 5280,
|
|
PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 122)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 80, 5600,
|
|
PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 155)
|
|
set_nbi = phydm_nbi_setting(dm, FUNC_ENABLE,
|
|
*dm->channel, 80, 5760,
|
|
PHYDM_DONT_CARE);
|
|
else
|
|
set_nbi = PHYDM_SET_NO_NEED;
|
|
} else {
|
|
set_nbi = PHYDM_SET_NO_NEED;
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_dsde_csi(struct dm_struct *dm)
|
|
{
|
|
u8 set_result_csi = PHYDM_SET_NO_NEED;
|
|
|
|
if (*dm->band_width == CHANNEL_WIDTH_20) {
|
|
if (*dm->channel == 153)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
20, 5760, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 161)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
20, 5800, PHYDM_DONT_CARE);
|
|
else if (*dm->channel >= 5 && *dm->channel <= 8)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
20, 2440, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 13)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
20, 2480, PHYDM_DONT_CARE);
|
|
else
|
|
set_result_csi = PHYDM_SET_NO_NEED;
|
|
} else if (*dm->band_width == CHANNEL_WIDTH_40) {
|
|
if (*dm->channel == 151)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
40, 5760, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 159)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
40, 5800, PHYDM_DONT_CARE);
|
|
else if ((*dm->channel >= 3) && (*dm->channel <= 10))
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
40, 2440, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 11)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
40, 2480, PHYDM_DONT_CARE);
|
|
else
|
|
set_result_csi = PHYDM_SET_NO_NEED;
|
|
} else if (*dm->band_width == CHANNEL_WIDTH_80) {
|
|
if (*dm->channel == 58)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
80, 5280, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 122)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
80, 5600, PHYDM_DONT_CARE);
|
|
else if (*dm->channel == 155)
|
|
set_result_csi =
|
|
phydm_csi_mask_setting(dm, FUNC_ENABLE, *dm->channel,
|
|
80, 5760, PHYDM_DONT_CARE);
|
|
else
|
|
set_result_csi = PHYDM_SET_NO_NEED;
|
|
} else {
|
|
set_result_csi = PHYDM_SET_NO_NEED;
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_dynamic_spur_det_eliminate(struct dm_struct *dm)
|
|
{
|
|
#if (PHYDM_FW_API_FUNC_ENABLE_8822B == 1)
|
|
u32 freq_2g[FREQ_PT_2G_NUM] = {0xFC67, 0xFC27, 0xFFE6, 0xFFA6, 0xFC67,
|
|
0xFCE7, 0xFCA7, 0xFC67, 0xFC27, 0xFFE6,
|
|
0xFFA6, 0xFF66, 0xFF26, 0xFCE7};
|
|
u32 freq_5g[FREQ_PT_5G_NUM] = {0xFFC0, 0xFFC0, 0xFC81, 0xFC81, 0xFC41,
|
|
0xFC40, 0xFF80, 0xFF80, 0xFF40, 0xFD42};
|
|
u32 freq_2g_n1[FREQ_PT_2G_NUM] = {0}, freq_2g_p1[FREQ_PT_2G_NUM] = {0};
|
|
u32 freq_5g_n1[FREQ_PT_5G_NUM] = {0}, freq_5g_p1[FREQ_PT_5G_NUM] = {0};
|
|
u32 f_pt_2g = 0, f_pt_5g = 0, f_pt_2g_b = 0, f_pt_5g_b = 0;
|
|
u32 max_ret_psd_final = 0, max_ret_psd_b_final = 0;
|
|
u32 max_ret_psd_2nd[PSD_SMP_NUM] = {0};
|
|
u32 max_ret_psd_b_2nd[PSD_SMP_NUM] = {0};
|
|
u32 psd_set[PSD_VAL_NUM] = {0}, psd_set_B[PSD_VAL_NUM] = {0};
|
|
u32 rank_psd_index_in[PSD_VAL_NUM] = {0};
|
|
u32 rank_sample_index_in[PSD_SMP_NUM] = {0};
|
|
u32 rank_psd_index_out[PSD_VAL_NUM] = {0};
|
|
u32 rank_sample_index_out[PSD_SMP_NUM] = {0};
|
|
u32 reg_910_15_12 = 0;
|
|
u8 j = 0, k = 0, threshold_nbi = 0x8D, threshold_csi = 0x8D, idx = 0;
|
|
boolean s_dopsd = false, s_donbi_a = false;
|
|
boolean s_docsi = false, s_donbi_b = false;
|
|
|
|
phydm_dsde_init(dm);
|
|
idx = phydm_dsde_ch_idx(dm);
|
|
|
|
if (idx <= 16) {
|
|
s_dopsd = true;
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"Idx Exceed, Not Support Dyn_Elmntr\n");
|
|
return;
|
|
}
|
|
|
|
PHYDM_DBG(dm, ODM_COMP_API, "idx=%d, BW=%d, ch=%d\n", idx,
|
|
*dm->band_width, *dm->channel);
|
|
|
|
for (k = 0; k < FREQ_PT_2G_NUM; k++) {
|
|
freq_2g_n1[k] = freq_2g[k] - 1; freq_2g_p1[k] = freq_2g[k] + 1;
|
|
}
|
|
|
|
for (k = 0; k < FREQ_PT_5G_NUM; k++) {
|
|
freq_5g_n1[k] = freq_5g[k] - 1; freq_5g_p1[k] = freq_5g[k] + 1;
|
|
}
|
|
|
|
if (!s_dopsd || idx > 13) {
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"s_dopsd=flase, Not Support Dyn_Elmntr\n");
|
|
return;
|
|
}
|
|
|
|
for (k = 0; k < PSD_SMP_NUM; k++) {
|
|
if (k == 0) {
|
|
f_pt_2g = freq_2g_n1[idx];
|
|
f_pt_2g_b = freq_2g_n1[idx] | BIT(16);
|
|
if (idx <= 10) {
|
|
f_pt_5g = freq_5g_n1[idx];
|
|
f_pt_5g_b = freq_5g_n1[idx] | BIT(16);
|
|
}
|
|
} else if (k == 1) {
|
|
f_pt_2g = freq_2g[idx];
|
|
f_pt_2g_b = freq_2g[idx] | BIT(16);
|
|
if (idx <= 10) {
|
|
f_pt_5g = freq_5g[idx];
|
|
f_pt_5g_b = freq_5g[idx] | BIT(16);
|
|
}
|
|
} else if (k == 2) {
|
|
f_pt_2g = freq_2g_p1[idx];
|
|
f_pt_2g_b = freq_2g_p1[idx] | BIT(16);
|
|
if (idx <= 10) {
|
|
f_pt_5g = freq_5g_p1[idx];
|
|
f_pt_5g_b = freq_5g_p1[idx] | BIT(16);
|
|
}
|
|
}
|
|
|
|
for (j = 0; j < PSD_VAL_NUM; j++) {
|
|
/* @disable 3-wire, path-A & apth-B */
|
|
odm_set_bb_reg(dm, R_0xc00, MASKBYTE0, 0x4);
|
|
odm_set_bb_reg(dm, R_0xe00, MASKBYTE0, 0x4);
|
|
reg_910_15_12 = odm_get_bb_reg(dm, R_0x910, (BIT(15) |
|
|
BIT(14) | BIT(13) |
|
|
BIT(12)));
|
|
|
|
if (dm->rx_ant_status & BB_PATH_A) {
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0,
|
|
(((BB_PATH_A) << 4) |
|
|
BB_PATH_A)); /*path-A*/
|
|
|
|
if ((*dm->channel >= 1) && (*dm->channel <= 14))
|
|
/* Start PSD at 2G */
|
|
odm_set_bb_reg(dm, R_0x910, MASKDWORD,
|
|
BIT(22) | f_pt_2g);
|
|
else
|
|
/* Start PSD at 5G */
|
|
odm_set_bb_reg(dm, R_0x910, MASKDWORD,
|
|
BIT(22) | f_pt_5g);
|
|
|
|
ODM_delay_us(500);
|
|
|
|
psd_set[j] = odm_get_bb_reg(dm, R_0xf44,
|
|
MASKLWORD);
|
|
/* turn off PSD */
|
|
odm_set_bb_reg(dm, R_0x910, BIT(22), 0x0);
|
|
}
|
|
|
|
if (dm->rx_ant_status & BB_PATH_B) {
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0,
|
|
(((BB_PATH_B) << 4) |
|
|
BB_PATH_B)); /*path-B*/
|
|
|
|
if ((*dm->channel > 0) && (*dm->channel <= 14))
|
|
/* Start PSD at 2G */
|
|
odm_set_bb_reg(dm, R_0x910, MASKDWORD,
|
|
BIT(22) | f_pt_2g_b);
|
|
else
|
|
/* Start PSD at 5G */
|
|
odm_set_bb_reg(dm, R_0x910, MASKDWORD,
|
|
BIT(22) | f_pt_5g_b);
|
|
|
|
ODM_delay_us(500);
|
|
|
|
psd_set_B[j] = odm_get_bb_reg(dm, R_0xf44,
|
|
MASKLWORD);
|
|
|
|
/* turn off PSD */
|
|
odm_set_bb_reg(dm, R_0x910, BIT(22), 0x0);
|
|
}
|
|
|
|
/*@eanble 3-wire*/
|
|
odm_set_bb_reg(dm, R_0xc00, MASKBYTE0, 0x7);
|
|
odm_set_bb_reg(dm, R_0xe00, MASKBYTE0, 0x7);
|
|
odm_set_bb_reg(dm, R_0x910, (BIT(15) | BIT(14) |
|
|
BIT(13) | BIT(12)), reg_910_15_12);
|
|
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0,
|
|
(((dm->rx_ant_status) << 4) |
|
|
dm->rx_ant_status));
|
|
|
|
/* Toggle IGI to let RF enter RX mode */
|
|
/* @because BB doesn't send 3-wire command */
|
|
/* when RX path is enable */
|
|
phydm_igi_toggle_8822b(dm);
|
|
}
|
|
if (dm->rx_ant_status & BB_PATH_A) {
|
|
phydm_seq_sorting(dm, psd_set, rank_psd_index_in,
|
|
rank_psd_index_out, PSD_VAL_NUM);
|
|
max_ret_psd_2nd[k] = psd_set[0];
|
|
}
|
|
if (dm->rx_ant_status & BB_PATH_B) {
|
|
phydm_seq_sorting(dm, psd_set_B, rank_psd_index_in,
|
|
rank_psd_index_out, PSD_VAL_NUM);
|
|
max_ret_psd_b_2nd[k] = psd_set_B[0];
|
|
}
|
|
}
|
|
|
|
if (dm->rx_ant_status & BB_PATH_A) {
|
|
phydm_seq_sorting(dm, max_ret_psd_2nd, rank_sample_index_in,
|
|
rank_sample_index_out, PSD_SMP_NUM);
|
|
max_ret_psd_final = max_ret_psd_2nd[0];
|
|
|
|
if (max_ret_psd_final >= threshold_nbi)
|
|
s_donbi_a = true;
|
|
else
|
|
s_donbi_a = false;
|
|
}
|
|
if (dm->rx_ant_status & BB_PATH_B) {
|
|
phydm_seq_sorting(dm, max_ret_psd_b_2nd, rank_sample_index_in,
|
|
rank_sample_index_out, PSD_SMP_NUM);
|
|
max_ret_psd_b_final = max_ret_psd_b_2nd[0];
|
|
|
|
if (max_ret_psd_b_final >= threshold_nbi)
|
|
s_donbi_b = true;
|
|
else
|
|
s_donbi_b = false;
|
|
}
|
|
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"max_ret_psd_final = %d, max_ret_psd_b_final = %d\n",
|
|
max_ret_psd_final, max_ret_psd_b_final);
|
|
|
|
if (max_ret_psd_final >= threshold_csi ||
|
|
max_ret_psd_b_final >= threshold_csi)
|
|
s_docsi = true;
|
|
else
|
|
s_docsi = false;
|
|
|
|
if (s_donbi_a || s_donbi_b)
|
|
phydm_dsde_nbi(dm);
|
|
|
|
if (s_docsi)
|
|
phydm_dsde_csi(dm);
|
|
|
|
#endif /*PHYDM_SPUR_CANCELL_ENABLE_8822B == 1*/
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_spur_calibration_8822b(struct dm_struct *dm)
|
|
{
|
|
if (*dm->is_scan_in_process)
|
|
return;
|
|
|
|
#ifdef CONFIG_8822B_SPUR_CALIBRATION
|
|
odm_set_bb_reg(dm, R_0x87c, BIT(13), 0x0);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(28), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(28), 0x0);
|
|
phydm_dynamic_spur_det_eliminate(dm);
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"Enable spur eliminator at normal\n");
|
|
#else
|
|
PHYDM_DBG(dm, ODM_COMP_API, "NBI and CSI notch at normal\n");
|
|
#endif
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_switch_band_8822b(struct dm_struct *dm,
|
|
u8 central_ch)
|
|
{
|
|
u32 rf_reg18;
|
|
boolean rf_reg_status = true;
|
|
u32 reg_8;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======>\n", __func__);
|
|
|
|
if (dm->is_disable_phy_api) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "disable PHY API for dbg\n");
|
|
return true;
|
|
}
|
|
|
|
rf_reg18 = config_phydm_read_rf_reg_8822b(dm, RF_PATH_A, 0x18,
|
|
RFREGOFFSETMASK);
|
|
rf_reg_status = rf_reg_status &
|
|
config_phydm_read_rf_check_8822b(rf_reg18);
|
|
|
|
if (central_ch <= 14) {
|
|
/* @2.4G */
|
|
|
|
/* @Enable CCK block */
|
|
odm_set_bb_reg(dm, R_0x808, BIT(28), 0x1);
|
|
|
|
/* @Disable MAC CCK check */
|
|
odm_set_bb_reg(dm, R_0x454, BIT(7), 0x0);
|
|
|
|
/* @Disable BB CCK check */
|
|
odm_set_bb_reg(dm, R_0xa80, BIT(18), 0x0);
|
|
|
|
/*@CCA Mask*/
|
|
odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 15); /*@default value*/
|
|
|
|
/* RF band */
|
|
rf_reg18 = (rf_reg18 & (~(BIT(16) | BIT(9) | BIT(8))));
|
|
|
|
/* RxHP dynamic control */
|
|
/* QFN eFEM RxHP are always low at 2G */
|
|
reg_8 = odm_get_bb_reg(dm, R_0x19a8, BIT(31));
|
|
|
|
/* SoML on */
|
|
if (reg_8 == 0x1) {
|
|
odm_set_bb_reg(dm, R_0xc04, (BIT(18) | BIT(21)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe04, (BIT(18) | BIT(21)), 0x0);
|
|
if (dm->rfe_type == 3 || dm->rfe_type == 5 ||
|
|
dm->rfe_type == 8 || dm->rfe_type == 17) {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108492);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x1);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108000);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x0);
|
|
}
|
|
}
|
|
|
|
/* SoML off */
|
|
if (reg_8 == 0x0) {
|
|
odm_set_bb_reg(dm, R_0xc04, (BIT(18) | BIT(21)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe04, (BIT(18) | BIT(21)), 0x0);
|
|
if (dm->rfe_type == 1 || dm->rfe_type == 6 ||
|
|
dm->rfe_type == 7 || dm->rfe_type == 9) {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108000);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x0);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108492);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x1);
|
|
}
|
|
}
|
|
|
|
if (dm->rfe_type == 12) {
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xb3, RFREGOFFSETMASK,
|
|
0x3C360);
|
|
odm_set_rf_reg(dm, RF_PATH_B, RF_0xb3, RFREGOFFSETMASK,
|
|
0x3C360);
|
|
}
|
|
|
|
} else if (central_ch > 35) {
|
|
/* @5G */
|
|
|
|
/* @Enable BB CCK check */
|
|
odm_set_bb_reg(dm, R_0xa80, BIT(18), 0x1);
|
|
|
|
/* @Enable CCK check */
|
|
odm_set_bb_reg(dm, R_0x454, BIT(7), 0x1);
|
|
|
|
/* @Disable CCK block */
|
|
odm_set_bb_reg(dm, R_0x808, BIT(28), 0x0);
|
|
|
|
/*@CCA Mask*/
|
|
#if (DM_ODM_SUPPORT_TYPE == ODM_AP)
|
|
/*@CCA mask = 13.6us*/
|
|
odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 34);
|
|
#else
|
|
if (!dm->wifi_test)
|
|
/*@CCA mask = 13.6us*/
|
|
odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 34);
|
|
else
|
|
/*@default value*/
|
|
odm_set_bb_reg(dm, R_0x814, 0x0000FC00, 15);
|
|
#endif
|
|
|
|
/* RF band */
|
|
rf_reg18 = (rf_reg18 & (~(BIT(16) | BIT(9) | BIT(8))));
|
|
rf_reg18 = (rf_reg18 | BIT(8) | BIT(16));
|
|
|
|
/* RxHP dynamic control */
|
|
reg_8 = odm_get_bb_reg(dm, R_0x19a8, BIT(31));
|
|
|
|
/* SoML on */
|
|
if (reg_8 == 0x1) {
|
|
odm_set_bb_reg(dm, R_0xc04, (BIT(18) | BIT(21)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe04, (BIT(18) | BIT(21)), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD, 0x08108000);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x0);
|
|
}
|
|
|
|
/* SoML off */
|
|
if (reg_8 == 0x0) {
|
|
odm_set_bb_reg(dm, R_0xc04, (BIT(18) | BIT(21)), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe04, (BIT(18) | BIT(21)), 0x0);
|
|
if (dm->rfe_type == 1 || dm->rfe_type == 6 ||
|
|
dm->rfe_type == 7 || dm->rfe_type == 9) {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108000);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x0);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0x8cc, MASKDWORD,
|
|
0x08108492);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(19), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8d8, BIT(27), 0x1);
|
|
}
|
|
}
|
|
|
|
if (dm->rfe_type == 12) {
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xb3, RFREGOFFSETMASK,
|
|
0xFC760);
|
|
odm_set_rf_reg(dm, RF_PATH_B, RF_0xb3, RFREGOFFSETMASK,
|
|
0xFC760);
|
|
}
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail to switch band (ch: %d)\n",
|
|
central_ch);
|
|
return false;
|
|
}
|
|
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18);
|
|
|
|
if (dm->rf_type > RF_1T1R)
|
|
odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, RFREGOFFSETMASK,
|
|
rf_reg18);
|
|
|
|
if (phydm_rfe_8822b(dm, central_ch) == false)
|
|
return false;
|
|
|
|
if (!rf_reg_status) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Fail to switch band (ch: %d), write RF_reg fail\n",
|
|
central_ch);
|
|
return false;
|
|
}
|
|
|
|
/* @Dynamic spur detection by PSD and NBI/CSI mask */
|
|
if (*dm->mp_mode) {
|
|
odm_set_bb_reg(dm, R_0x87c, BIT(13), 0x0);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(28), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(28), 0x0);
|
|
|
|
phydm_dynamic_spur_det_eliminate(dm);
|
|
} else {
|
|
/* Normal mode */
|
|
phydm_spur_calibration_8822b(dm);
|
|
}
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Success to switch band (ch: %d)\n",
|
|
central_ch);
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
void phydm_rxagc_switch_8822b(struct dm_struct *dm,
|
|
boolean enable_rxagc_switch)
|
|
{
|
|
if (dm->rfe_type == 15 || dm->rfe_type == 16) {
|
|
PHYDM_DBG(dm, ODM_COMP_API, "Microsoft case!\n");
|
|
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_COMP_API, "Not Microsoft case\n");
|
|
return;
|
|
}
|
|
|
|
if (enable_rxagc_switch) {
|
|
if ((*dm->channel >= 36) && (*dm->channel <= 64)) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x1);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x5);
|
|
} else if ((*dm->channel >= 100) && (*dm->channel <= 144)) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x2);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x6);
|
|
} else if (*dm->channel >= 149) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x3);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x7);
|
|
}
|
|
dm->brxagcswitch = true;
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"Microsoft case! AGC table (path-b) is switched!\n");
|
|
|
|
} else {
|
|
if ((*dm->channel >= 36) && (*dm->channel <= 64)) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x1);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x1);
|
|
} else if ((*dm->channel >= 100) && (*dm->channel <= 144)) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x2);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x2);
|
|
} else if (*dm->channel >= 149) {
|
|
odm_set_bb_reg(dm, R_0x958, BIT(4), 0x1);
|
|
odm_set_bb_reg(dm, R_0xc1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x3);
|
|
odm_set_bb_reg(dm, R_0xe1c, (BIT(11) | BIT(10) |
|
|
BIT(9) | BIT(8)), 0x3);
|
|
}
|
|
dm->brxagcswitch = false;
|
|
PHYDM_DBG(dm, ODM_COMP_API,
|
|
"AGC table are the same on path-a and b\n");
|
|
}
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_switch_channel_8822b(struct dm_struct *dm,
|
|
u8 central_ch)
|
|
{
|
|
struct phydm_dig_struct *dig_tab = &dm->dm_dig_table;
|
|
u32 rf_reg18 = 0, rf_reg_be = 0xff;
|
|
boolean rf_reg_status = true;
|
|
u8 low_band[15] = {0x7, 0x6, 0x6, 0x5, 0x0, 0x0, 0x7, 0xff, 0x6, 0x5,
|
|
0x0, 0x0, 0x7, 0x6, 0x6};
|
|
u8 middle_band[23] = {0x6, 0x5, 0x0, 0x0, 0x7, 0x6, 0x6, 0xff, 0x0, 0x0,
|
|
0x7, 0x6, 0x6, 0x5, 0x0, 0xff, 0x7, 0x6, 0x6,
|
|
0x5, 0x0, 0x0, 0x7};
|
|
u8 high_band[15] = {0x5, 0x5, 0x0, 0x7, 0x7, 0x6, 0x5, 0xff, 0x0, 0x7,
|
|
0x7, 0x6, 0x5, 0x5, 0x0};
|
|
u8 band_index = 0;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======> ch=%d\n", __func__,
|
|
central_ch);
|
|
|
|
if (dm->is_disable_phy_api) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "disable PHY API for dbg\n");
|
|
return true;
|
|
}
|
|
#if (DM_ODM_SUPPORT_TYPE & ODM_AP)
|
|
/*@Make protection*/
|
|
if (central_ch == 165 && bw_8822b != CHANNEL_WIDTH_20)
|
|
config_phydm_switch_bandwidth_8822b(dm, 0, CHANNEL_WIDTH_20);
|
|
#endif
|
|
central_ch_8822b = central_ch;
|
|
|
|
/* @Errir handling for wrong HW setting due to wrong channel setting */
|
|
if (central_ch_8822b <= 14)
|
|
band_index = 1;
|
|
else
|
|
band_index = 2;
|
|
|
|
if (dm->rfe_hwsetting_band != band_index)
|
|
phydm_rfe_8822b(dm, central_ch_8822b);
|
|
|
|
if (dm->rfe_type == 15 || dm->rfe_type == 18)
|
|
phydm_rfe_8822b(dm, central_ch_8822b);
|
|
|
|
/* RF register setting */
|
|
rf_reg18 = config_phydm_read_rf_reg_8822b(dm, RF_PATH_A, 0x18,
|
|
RFREGOFFSETMASK);
|
|
rf_reg_status = rf_reg_status &
|
|
config_phydm_read_rf_check_8822b(rf_reg18);
|
|
rf_reg18 = (rf_reg18 & (~(BIT(18) | BIT(17) | MASKBYTE0)));
|
|
|
|
/* Switch band and channel */
|
|
if (central_ch <= 14) {
|
|
/* @2.4G */
|
|
|
|
/* @1. RF band and channel*/
|
|
rf_reg18 = (rf_reg18 | central_ch);
|
|
|
|
/* @2. AGC table selection */
|
|
odm_set_bb_reg(dm, R_0x958, 0x1f, 0x0);
|
|
dig_tab->agc_table_idx = 0x0;
|
|
|
|
/* @3. Set central frequency for clock offset tracking */
|
|
odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x96a);
|
|
|
|
/* @CCK TX filter parameters */
|
|
|
|
if (central_ch == 14) {
|
|
odm_set_bb_reg(dm, R_0xa24, MASKDWORD, 0x00006577);
|
|
odm_set_bb_reg(dm, R_0xa28, MASKLWORD, 0x0000);
|
|
} else {
|
|
odm_set_bb_reg(dm, R_0xa24, MASKDWORD, 0x384f6577);
|
|
odm_set_bb_reg(dm, R_0xa28, MASKLWORD, 0x1525);
|
|
}
|
|
|
|
} else if (central_ch > 35) {
|
|
/* @5G */
|
|
|
|
/* @1. RF band and channel*/
|
|
rf_reg18 = (rf_reg18 | central_ch);
|
|
|
|
/* @2. AGC table selection */
|
|
if (!(dm->rfe_type == 15 || dm->rfe_type == 16)) {
|
|
if (central_ch >= 36 && central_ch <= 64) {
|
|
odm_set_bb_reg(dm, R_0x958, 0x1f, 0x1);
|
|
dig_tab->agc_table_idx = 0x1;
|
|
} else if ((central_ch >= 100) && (central_ch <= 144)) {
|
|
odm_set_bb_reg(dm, R_0x958, 0x1f, 0x2);
|
|
dig_tab->agc_table_idx = 0x2;
|
|
} else if (central_ch >= 149) {
|
|
odm_set_bb_reg(dm, R_0x958, 0x1f, 0x3);
|
|
dig_tab->agc_table_idx = 0x3;
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "(AGC) Fail\n");
|
|
return false;
|
|
}
|
|
} else if ((dm->rfe_type == 15) || (dm->rfe_type == 16)) {
|
|
if (dm->brxagcswitch)
|
|
phydm_rxagc_switch_8822b(dm, true);
|
|
else
|
|
phydm_rxagc_switch_8822b(dm, false);
|
|
}
|
|
|
|
/* @3. Set central frequency for clock offset tracking */
|
|
if (central_ch >= 36 && central_ch <= 48) {
|
|
odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x494);
|
|
} else if ((central_ch >= 52) && (central_ch <= 64)) {
|
|
odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x453);
|
|
} else if ((central_ch >= 100) && (central_ch <= 116)) {
|
|
odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x452);
|
|
} else if ((central_ch >= 118) && (central_ch <= 177)) {
|
|
odm_set_bb_reg(dm, R_0x860, 0x1ffe0000, 0x412);
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "(fc_area)Fail\n");
|
|
return false;
|
|
}
|
|
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail\n");
|
|
return false;
|
|
}
|
|
|
|
/* @Modify IGI for MP driver to aviod PCIE interference */
|
|
if (*dm->mp_mode && (dm->rfe_type == 3 || dm->rfe_type == 5)) {
|
|
if (central_ch == 14)
|
|
odm_write_dig(dm, 0x26);
|
|
else
|
|
odm_write_dig(dm, 0x20);
|
|
}
|
|
|
|
/* @Modify the setting of register 0xBE to reduce phase noise */
|
|
if (central_ch <= 14)
|
|
rf_reg_be = 0x0;
|
|
else if ((central_ch >= 36) && (central_ch <= 64))
|
|
rf_reg_be = low_band[(central_ch - 36) >> 1];
|
|
else if ((central_ch >= 100) && (central_ch <= 144))
|
|
rf_reg_be = middle_band[(central_ch - 100) >> 1];
|
|
else if ((central_ch >= 149) && (central_ch <= 177))
|
|
rf_reg_be = high_band[(central_ch - 149) >> 1];
|
|
|
|
if (rf_reg_be != 0xff) {
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xbe, (BIT(17) | BIT(16) |
|
|
BIT(15)), rf_reg_be);
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "(phase noise)Fail\n");
|
|
return false;
|
|
}
|
|
|
|
/* @Fix channel 144 issue, ask by RFSI Alvin*/
|
|
/* @00 when freq < 5400; 01 when 5400<=freq<=5720; */
|
|
/* @10 when freq > 5720; 2G don't care*/
|
|
/* need to set 0xdf[18]=1 before writing RF18 when channel 144 */
|
|
if (central_ch == 144) {
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, BIT(18), 0x1);
|
|
rf_reg18 = (rf_reg18 | BIT(17));
|
|
} else {
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xdf, BIT(18), 0x0);
|
|
|
|
if (central_ch > 144)
|
|
rf_reg18 = (rf_reg18 | BIT(18));
|
|
else if (central_ch >= 80)
|
|
rf_reg18 = (rf_reg18 | BIT(17));
|
|
}
|
|
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18);
|
|
|
|
if (dm->rf_type > RF_1T1R)
|
|
odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, RFREGOFFSETMASK,
|
|
rf_reg18);
|
|
|
|
if (!rf_reg_status) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail, write RF_reg fail\n");
|
|
return false;
|
|
}
|
|
|
|
/* @Debug for RF resister reading error */
|
|
/* @during synthesizer parameters parsing */
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xb8, BIT(19), 0);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xb8, BIT(19), 1);
|
|
|
|
phydm_igi_toggle_8822b(dm);
|
|
phydm_ccapar_by_rfe_8822b(dm);
|
|
|
|
/* @Dynamic spur detection by PSD and NBI/CSI mask */
|
|
if (*dm->mp_mode) {
|
|
odm_set_bb_reg(dm, R_0x87c, BIT(13), 0x0);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(28), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(28), 0x0);
|
|
|
|
phydm_dynamic_spur_det_eliminate(dm);
|
|
} else {
|
|
/* Normal mode */
|
|
phydm_spur_calibration_8822b(dm);
|
|
}
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Success\n");
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_switch_agc_tab_8822b(struct dm_struct *dm,
|
|
u8 channel, enum agc_tab_sel tab_sel)
|
|
{
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======> channel=%d, table_sel=%d\n",
|
|
__func__, channel, tab_sel);
|
|
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_switch_bandwidth_8822b(struct dm_struct *dm,
|
|
u8 primary_ch_idx,
|
|
enum channel_width bw)
|
|
{
|
|
u32 rf_reg18, val32;
|
|
boolean rf_reg_status = true;
|
|
u8 rfe_type = dm->rfe_type;
|
|
u8 bandwidth = bw;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======> primary_ch=%d, bw=%d\n",
|
|
__func__, primary_ch_idx, bandwidth);
|
|
|
|
if (dm->is_disable_phy_api) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "disable PHY API for dbg\n");
|
|
return true;
|
|
}
|
|
|
|
/* @Error handling */
|
|
if (bandwidth >= CHANNEL_WIDTH_MAX ||
|
|
(bandwidth == CHANNEL_WIDTH_40 && primary_ch_idx > 2) ||
|
|
(bandwidth == CHANNEL_WIDTH_80 && primary_ch_idx > 4)) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail 1\n");
|
|
return false;
|
|
}
|
|
#if (DM_ODM_SUPPORT_TYPE & (ODM_CE | ODM_WIN))
|
|
/*@Make protection*/
|
|
if (central_ch_8822b == 165 && !(*dm->mp_mode))
|
|
bandwidth = CHANNEL_WIDTH_20;
|
|
#endif
|
|
bw_8822b = bandwidth;
|
|
rf_reg18 = config_phydm_read_rf_reg_8822b(dm, RF_PATH_A, 0x18,
|
|
RFREG_MASK);
|
|
rf_reg_status = rf_reg_status &
|
|
config_phydm_read_rf_check_8822b(rf_reg18);
|
|
|
|
/* Switch bandwidth */
|
|
switch (bandwidth) {
|
|
case CHANNEL_WIDTH_20: {
|
|
#if 0
|
|
/* Small BW([7:6]) = 0, primary channel ([5:2]) = 0, */
|
|
/* rf mode([1:0]) = 20M */
|
|
/* odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, CHANNEL_WIDTH_20);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @ADC clock = 160M clock for BW20 */
|
|
/* odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x0);*/
|
|
/* odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x1);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @DAC clock = 160M clock for BW20 */
|
|
/* odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x0);*/
|
|
/* odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x1);*/
|
|
#endif
|
|
|
|
val32 = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD);
|
|
val32 &= 0xFFCFFC00;
|
|
val32 |= (CHANNEL_WIDTH_20);
|
|
odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, val32);
|
|
|
|
/* @ADC buffer clock */
|
|
odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1);
|
|
|
|
/* RF bandwidth */
|
|
rf_reg18 = (rf_reg18 | BIT(11) | BIT(10));
|
|
|
|
break;
|
|
}
|
|
case CHANNEL_WIDTH_40: {
|
|
/* Small BW([7:6]) = 0, primary channel ([5:2]) = sub-channel */
|
|
/* rf mode([1:0]) = 40M */
|
|
/* odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, */
|
|
/* @(((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_40));*/
|
|
|
|
/* @CCK primary channel */
|
|
if (primary_ch_idx == 1)
|
|
odm_set_bb_reg(dm, R_0xa00, BIT(4), primary_ch_idx);
|
|
else
|
|
odm_set_bb_reg(dm, R_0xa00, BIT(4), 0);
|
|
|
|
#if 0
|
|
/* @ADC clock = 160M clock for BW40 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(11) | BIT(10)), 0x0);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(17), 0x1);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @DAC clock = 160M clock for BW20 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(23) | BIT(22)), 0x0);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(29), 0x1);*/
|
|
#endif
|
|
|
|
val32 = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD);
|
|
val32 &= 0xFF3FF300;
|
|
val32 |= (((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_40);
|
|
odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, val32);
|
|
|
|
/* @ADC buffer clock */
|
|
odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1);
|
|
|
|
/* RF bandwidth */
|
|
rf_reg18 = (rf_reg18 & (~(BIT(11) | BIT(10))));
|
|
rf_reg18 = (rf_reg18 | BIT(11));
|
|
|
|
break;
|
|
}
|
|
case CHANNEL_WIDTH_80: {
|
|
#if 0
|
|
/* Small BW([7:6]) = 0, primary channel ([5:2]) = sub-channel */
|
|
/* rf mode([1:0]) = 80M */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, */
|
|
/* @(((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_80));*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @ADC clock = 160M clock for BW80 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(13) | BIT(12)), 0x0);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(18), 0x1);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @DAC clock = 160M clock for BW20 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(25) | BIT(24)), 0x0);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(30), 0x1);*/
|
|
#endif
|
|
|
|
val32 = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD);
|
|
val32 &= 0xFCEFCF00;
|
|
val32 |= (((primary_ch_idx & 0xf) << 2) | CHANNEL_WIDTH_80);
|
|
odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, val32);
|
|
|
|
/* @ADC buffer clock */
|
|
odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x1);
|
|
|
|
/* RF bandwidth */
|
|
rf_reg18 = (rf_reg18 & (~(BIT(11) | BIT(10))));
|
|
rf_reg18 = (rf_reg18 | BIT(10));
|
|
|
|
/* Parameters for SD4 TP requirement */
|
|
if (rfe_type == 2 || rfe_type == 3 || rfe_type == 17) {
|
|
odm_set_bb_reg(dm, R_0x840, 0x0000f000, 0x6);
|
|
odm_set_bb_reg(dm, R_0x8c8, BIT(10), 0x1);
|
|
}
|
|
|
|
break;
|
|
}
|
|
case CHANNEL_WIDTH_5: {
|
|
#if 0
|
|
/* Small BW([7:6]) = 1, primary channel ([5:2]) = 0, */
|
|
/* rf mode([1:0]) = 20M */
|
|
/*@dm_set_bb_reg(dm, 0x8ac, MASKBYTE0, */
|
|
/* @(BIT(6) | CHANNEL_WIDTH_20));*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @ADC clock = 40M clock */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x2);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x0);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @DAC clock = 160M clock for BW20 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x2);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x0);*/
|
|
#endif
|
|
|
|
val32 = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD);
|
|
val32 &= 0xEFEEFE00;
|
|
val32 |= ((BIT(6) | CHANNEL_WIDTH_20));
|
|
odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, val32);
|
|
|
|
/* @ADC buffer clock */
|
|
odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8c8, BIT(31), 0x1);
|
|
|
|
/* RF bandwidth */
|
|
rf_reg18 = (rf_reg18 | BIT(11) | BIT(10));
|
|
|
|
break;
|
|
}
|
|
case CHANNEL_WIDTH_10: {
|
|
#if 0
|
|
/* Small BW([7:6]) = 1, primary channel ([5:2]) = 0, */
|
|
/* rf mode([1:0]) = 20M */
|
|
/* odm_set_bb_reg(dm, R_0x8ac, MASKBYTE0, */
|
|
/* @(BIT(7) | CHANNEL_WIDTH_20));*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @ADC clock = 80M clock */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(9) | BIT(8)), 0x3);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(16), 0x0);*/
|
|
#endif
|
|
|
|
#if 0
|
|
/* @DAC clock = 160M clock for BW20 */
|
|
/*odm_set_bb_reg(dm, R_0x8ac, (BIT(21) | BIT(20)), 0x3);*/
|
|
/*odm_set_bb_reg(dm, R_0x8ac, BIT(28), 0x0);*/
|
|
#endif
|
|
|
|
val32 = odm_get_bb_reg(dm, R_0x8ac, MASKDWORD);
|
|
val32 &= 0xEFFEFF00;
|
|
val32 |= ((BIT(7) | CHANNEL_WIDTH_20));
|
|
odm_set_bb_reg(dm, R_0x8ac, MASKDWORD, val32);
|
|
|
|
/* @ADC buffer clock */
|
|
odm_set_bb_reg(dm, R_0x8c4, BIT(30), 0x0);
|
|
odm_set_bb_reg(dm, R_0x8c8, BIT(31), 0x1);
|
|
|
|
/* RF bandwidth */
|
|
rf_reg18 = (rf_reg18 | BIT(11) | BIT(10));
|
|
|
|
break;
|
|
}
|
|
default:
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail 2\n");
|
|
}
|
|
|
|
/* Write RF register */
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x18, RFREGOFFSETMASK, rf_reg18);
|
|
|
|
if (dm->rf_type > RF_1T1R)
|
|
odm_set_rf_reg(dm, RF_PATH_B, RF_0x18, RFREGOFFSETMASK,
|
|
rf_reg18);
|
|
|
|
if (!rf_reg_status) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Fail, write RF_reg fail\n");
|
|
return false;
|
|
}
|
|
|
|
/* @Modify RX DFIR parameters */
|
|
phydm_rxdfirpar_by_bw_8822b(dm, bandwidth);
|
|
|
|
/* @Modify CCA parameters */
|
|
phydm_ccapar_by_rfe_8822b(dm);
|
|
|
|
/* @Dynamic spur detection by PSD and NBI/CSI mask */
|
|
if (*dm->mp_mode) {
|
|
odm_set_bb_reg(dm, R_0x87c, BIT(13), 0x0);
|
|
odm_set_bb_reg(dm, R_0xc20, BIT(28), 0x0);
|
|
odm_set_bb_reg(dm, R_0xe20, BIT(28), 0x0);
|
|
|
|
phydm_dynamic_spur_det_eliminate(dm);
|
|
} else {
|
|
/* Normal mode */
|
|
phydm_spur_calibration_8822b(dm);
|
|
}
|
|
|
|
/* Toggle RX path to avoid RX dead zone issue */
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0, 0x0);
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0, (dm->rx_ant_status |
|
|
(dm->rx_ant_status << 4)));
|
|
|
|
/* Toggle IGI to let RF enter RX mode */
|
|
phydm_igi_toggle_8822b(dm);
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Success\n");
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_switch_channel_bw_8822b(struct dm_struct *dm,
|
|
u8 central_ch,
|
|
u8 primary_ch_idx,
|
|
enum channel_width bw)
|
|
{
|
|
u8 bandwidth = bw;
|
|
/* Switch band */
|
|
if (!config_phydm_switch_band_8822b(dm, central_ch))
|
|
return false;
|
|
|
|
/* Switch channel */
|
|
if (!config_phydm_switch_channel_8822b(dm, central_ch))
|
|
return false;
|
|
|
|
/* Switch bandwidth */
|
|
if (!config_phydm_switch_bandwidth_8822b(dm, primary_ch_idx, bandwidth))
|
|
return false;
|
|
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_trx_mode_8822b(struct dm_struct *dm,
|
|
enum bb_path tx_path,
|
|
enum bb_path rx_path,
|
|
boolean is_tx2_path)
|
|
{
|
|
u32 rf_reg33 = 0;
|
|
u16 counter = 0;
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s ======> TX:0x%x, RX:0x%x\n", __func__,
|
|
tx_path, rx_path);
|
|
|
|
if (dm->is_disable_phy_api) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "disable PHY API\n");
|
|
return true;
|
|
}
|
|
|
|
if (((tx_path & ~BB_PATH_AB) != 0) || ((rx_path & ~BB_PATH_AB) != 0)) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Wrong set\n");
|
|
return false;
|
|
}
|
|
|
|
/* @[mode table] RF mode of path-A and path-B */
|
|
/* @Cannot shut down path-A, beacause synthesizer will be shut down */
|
|
/* when path-A is in shut down mode */
|
|
/* @3-wire setting */
|
|
/* @0: shutdown, 1: standby, 2: TX, 3: RX */
|
|
|
|
if ((tx_path | rx_path) & BB_PATH_A)
|
|
odm_set_bb_reg(dm, R_0xc08, MASKLWORD, 0x3231);
|
|
else
|
|
odm_set_bb_reg(dm, R_0xc08, MASKLWORD, 0x1111);
|
|
|
|
if ((tx_path | rx_path) & BB_PATH_B)
|
|
odm_set_bb_reg(dm, R_0xe08, MASKLWORD, 0x3231);
|
|
else
|
|
odm_set_bb_reg(dm, R_0xe08, MASKLWORD, 0x1111);
|
|
|
|
/*@[TX Antenna Setting] ==========================================*/
|
|
|
|
/* Set TX antenna by Nsts */
|
|
odm_set_bb_reg(dm, R_0x93c, (BIT(19) | BIT(18)), 0x3);
|
|
odm_set_bb_reg(dm, R_0x80c, (BIT(29) | BIT(28)), 0x1);
|
|
|
|
/* @Control CCK TX path by 0xa07[7] */
|
|
odm_set_bb_reg(dm, R_0x80c, BIT(30), 0x1);
|
|
|
|
/* TX logic map and TX path en for Nsts = 1, and CCK TX path*/
|
|
if (tx_path & BB_PATH_A) {
|
|
odm_set_bb_reg(dm, R_0x93c, 0xfff00000, 0x001);
|
|
odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x8);
|
|
} else if (tx_path & BB_PATH_B) {
|
|
odm_set_bb_reg(dm, R_0x93c, 0xfff00000, 0x002);
|
|
odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0x4);
|
|
}
|
|
|
|
/* TX logic map and TX path en for Nsts = 2*/
|
|
/* @Due to LO is stand-by while 1T at path-b in normal driver, */
|
|
/* so 0x940 is the same setting btw path-A/B*/
|
|
if (tx_path == BB_PATH_A || tx_path == BB_PATH_B)
|
|
odm_set_bb_reg(dm, R_0x940, 0xfff0, 0x01);
|
|
else
|
|
odm_set_bb_reg(dm, R_0x940, 0xfff0, 0x43);
|
|
|
|
/* TX path HW block enable */
|
|
odm_set_bb_reg(dm, R_0x80c, MASKBYTE0, ((tx_path << 4) | tx_path));
|
|
|
|
/* Tx2path for 1ss */
|
|
if (!(tx_path == BB_PATH_A || tx_path == BB_PATH_B)) {
|
|
if (is_tx2_path || *dm->mp_mode) {
|
|
/* @2Tx for OFDM */
|
|
odm_set_bb_reg(dm, R_0x93c, 0xfff00000, 0x043);
|
|
/* @2Tx for CCK */
|
|
odm_set_bb_reg(dm, R_0xa04, 0xf0000000, 0xc);
|
|
}
|
|
}
|
|
|
|
/*@[RX Antenna Setting] ==========================================*/
|
|
|
|
/*@Disable MRC for CCK CCA */
|
|
odm_set_bb_reg(dm, R_0xa2c, BIT(22), 0x0);
|
|
/*@Disable MRC for CCK barker */
|
|
odm_set_bb_reg(dm, R_0xa2c, BIT(18), 0x0);
|
|
|
|
/* @CCK RX 1st and 2nd path setting*/
|
|
if (rx_path & BB_PATH_A)
|
|
odm_set_bb_reg(dm, R_0xa04, 0x0f000000, 0x0); /*@00,00*/
|
|
else if (rx_path & BB_PATH_B)
|
|
odm_set_bb_reg(dm, R_0xa04, 0x0f000000, 0x5); /*@01,01*/
|
|
|
|
/* RX path enable */
|
|
odm_set_bb_reg(dm, R_0x808, MASKBYTE0, ((rx_path << 4) | rx_path));
|
|
|
|
if (rx_path == BB_PATH_A || rx_path == BB_PATH_B) {
|
|
/* @1R */
|
|
|
|
#if 0
|
|
/* @Disable MRC for CCA */
|
|
/* odm_set_bb_reg(dm, R_0xa2c, BIT22, 0x0); */
|
|
#endif
|
|
|
|
#if 0
|
|
/* @Disable MRC for barker */
|
|
/* odm_set_bb_reg(dm, R_0xa2c, BIT18, 0x0); */
|
|
#endif
|
|
|
|
#if 0
|
|
/* @Disable CCK antenna diversity */
|
|
/* odm_set_bb_reg(dm, R_0xa00, BIT15, 0x0); */
|
|
#endif
|
|
|
|
/* @Disable Antenna weighting */
|
|
/*@AntWgt_en*/
|
|
odm_set_bb_reg(dm, R_0x1904, BIT(16), 0x0);
|
|
/*@htstf ant-wgt enable = 0*/
|
|
odm_set_bb_reg(dm, R_0x800, BIT(28), 0x0);
|
|
/*@MRC_mode = 'original ZF eqz'*/
|
|
odm_set_bb_reg(dm, R_0x850, BIT(23), 0x0);
|
|
} else {
|
|
/* @2R */
|
|
|
|
#if 0
|
|
/* @Enable MRC for CCA */
|
|
/* odm_set_bb_reg(dm, R_0xa2c, BIT22, 0x1); */
|
|
#endif
|
|
|
|
#if 0
|
|
/* @Enable MRC for barker */
|
|
/* odm_set_bb_reg(dm, R_0xa2c, BIT18, 0x1); */
|
|
#endif
|
|
|
|
#if 0
|
|
/* @Disable CCK antenna diversity */
|
|
/* odm_set_bb_reg(dm, R_0xa00, BIT15, 0x0); */
|
|
#endif
|
|
|
|
/* @Enable Antenna weighting */
|
|
/*@AntWgt_en*/
|
|
odm_set_bb_reg(dm, R_0x1904, BIT(16), 0x1);
|
|
/*@htstf ant-wgt enable = 1*/
|
|
odm_set_bb_reg(dm, R_0x800, BIT(28), 0x1);
|
|
/*@MRC_mode = 'modified ZF eqz'*/
|
|
odm_set_bb_reg(dm, R_0x850, BIT(23), 0x1);
|
|
}
|
|
|
|
/* Update TXRX antenna status for PHYDM */
|
|
dm->tx_ant_status = (tx_path & 0x3);
|
|
dm->rx_ant_status = (rx_path & 0x3);
|
|
|
|
/* @MP driver need to support path-B TX\RX */
|
|
|
|
while (1) {
|
|
counter++;
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x80000);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREG_MASK, 0x00001);
|
|
|
|
ODM_delay_us(2);
|
|
rf_reg33 = config_phydm_read_rf_reg_8822b(dm, RF_PATH_A, 0x33,
|
|
RFREG_MASK);
|
|
|
|
if (rf_reg33 == 0x00001 &&
|
|
(config_phydm_read_rf_check_8822b(rf_reg33))) {
|
|
break;
|
|
} else if (counter == 100) {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Fail, write RF mode table fail\n");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
if (*dm->mp_mode || (*dm->antenna_test) || dm->normal_rx_path) {
|
|
/* @0xef 0x80000 0x33 0x00001 0x3e 0x00034 0x3f 0x4080e */
|
|
/* @0xef 0x00000 suggested by Lucas*/
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x80000);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREG_MASK, 0x00001);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, RFREG_MASK, 0x00034);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREG_MASK, 0x4080e);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x00000);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"MP/Ant test mode, support path-B TRX\n");
|
|
} else {
|
|
/* @0xef 0x80000 0x33 0x00001 0x3e 0x00034 0x3f 0x4080c */
|
|
/* @0xef 0x00000 */
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x80000);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x33, RFREG_MASK, 0x00001);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x3e, RFREG_MASK, 0x00034);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0x3f, RFREG_MASK, 0x4080c);
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x00000);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Normal mode, not support path-B TRX\n");
|
|
}
|
|
|
|
odm_set_rf_reg(dm, RF_PATH_A, RF_0xef, RFREG_MASK, 0x00000);
|
|
|
|
/* Toggle igi to let RF enter RX mode, */
|
|
/* @because BB doesn't send 3-wire command when RX path is enable */
|
|
phydm_igi_toggle_8822b(dm);
|
|
|
|
/* @Modify CCA parameters */
|
|
phydm_ccapar_by_rfe_8822b(dm);
|
|
|
|
/* @HW Setting depending on RFE type & band */
|
|
phydm_rfe_8822b(dm, central_ch_8822b);
|
|
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "Set Success\n");
|
|
return true;
|
|
}
|
|
|
|
__iram_odm_func__
|
|
boolean
|
|
config_phydm_parameter_init_8822b(struct dm_struct *dm,
|
|
enum odm_parameter_init type)
|
|
{
|
|
if (type == ODM_PRE_SETTING) {
|
|
odm_set_bb_reg(dm, R_0x808, (BIT(28) | BIT(29)), 0x0);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Pre set: disable OFDM/CCK block\n");
|
|
} else if (type == ODM_POST_SETTING) {
|
|
odm_set_bb_reg(dm, R_0x808, (BIT(28) | BIT(29)), 0x3);
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG,
|
|
"Post set: enable OFDM/CCK block\n");
|
|
#if (PHYDM_FW_API_FUNC_ENABLE_8822B == 1)
|
|
} else if (type == ODM_INIT_FW_SETTING) {
|
|
u8 h2c_content[4] = {0};
|
|
|
|
h2c_content[0] = dm->rfe_type;
|
|
h2c_content[1] = dm->rf_type;
|
|
h2c_content[2] = dm->cut_version;
|
|
h2c_content[3] = (dm->tx_ant_status << 4) | dm->rx_ant_status;
|
|
|
|
odm_fill_h2c_cmd(dm, PHYDM_H2C_FW_GENERAL_INIT, 4, h2c_content);
|
|
#endif
|
|
} else {
|
|
PHYDM_DBG(dm, ODM_PHY_CONFIG, "%s: Wrong type!!\n", __func__);
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
/* @======================================================================== */
|
|
#endif /*PHYDM_FW_API_ENABLE_8822B == 1*/
|
|
#endif /* RTL8822B_SUPPORT == 1 */
|