/******************************************************************************
|
*
|
* Copyright(c) 2007 - 2019 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.
|
*
|
*****************************************************************************/
|
#define _RTW_RF_C_
|
|
#include <drv_types.h>
|
|
u8 center_ch_2g[CENTER_CH_2G_NUM] = {
|
/* G00 */1, 2,
|
/* G01 */3, 4, 5,
|
/* G02 */6, 7, 8,
|
/* G03 */9, 10, 11,
|
/* G04 */12, 13,
|
/* G05 */14
|
};
|
|
#define ch_to_cch_2g_idx(ch) ((ch) - 1)
|
|
u8 center_ch_2g_40m[CENTER_CH_2G_40M_NUM] = {
|
3,
|
4,
|
5,
|
6,
|
7,
|
8,
|
9,
|
10,
|
11,
|
};
|
|
u8 op_chs_of_cch_2g_40m[CENTER_CH_2G_40M_NUM][2] = {
|
{1, 5}, /* 3 */
|
{2, 6}, /* 4 */
|
{3, 7}, /* 5 */
|
{4, 8}, /* 6 */
|
{5, 9}, /* 7 */
|
{6, 10}, /* 8 */
|
{7, 11}, /* 9 */
|
{8, 12}, /* 10 */
|
{9, 13}, /* 11 */
|
};
|
|
u8 center_ch_5g_all[CENTER_CH_5G_ALL_NUM] = {
|
/* G00 */36, 38, 40,
|
42,
|
/* G01 */44, 46, 48,
|
/* 50, */
|
/* G02 */52, 54, 56,
|
58,
|
/* G03 */60, 62, 64,
|
/* G04 */100, 102, 104,
|
106,
|
/* G05 */108, 110, 112,
|
/* 114, */
|
/* G06 */116, 118, 120,
|
122,
|
/* G07 */124, 126, 128,
|
/* G08 */132, 134, 136,
|
138,
|
/* G09 */140, 142, 144,
|
/* G10 */149, 151, 153,
|
155,
|
/* G11 */157, 159, 161,
|
/* 163, */
|
/* G12 */165, 167, 169,
|
171,
|
/* G13 */173, 175, 177
|
};
|
|
u8 center_ch_5g_20m[CENTER_CH_5G_20M_NUM] = {
|
/* G00 */36, 40,
|
/* G01 */44, 48,
|
/* G02 */52, 56,
|
/* G03 */60, 64,
|
/* G04 */100, 104,
|
/* G05 */108, 112,
|
/* G06 */116, 120,
|
/* G07 */124, 128,
|
/* G08 */132, 136,
|
/* G09 */140, 144,
|
/* G10 */149, 153,
|
/* G11 */157, 161,
|
/* G12 */165, 169,
|
/* G13 */173, 177
|
};
|
|
#define ch_to_cch_5g_20m_idx(ch) \
|
( \
|
((ch) >= 36 && (ch) <= 64) ? (((ch) - 36) >> 2) : \
|
((ch) >= 100 && (ch) <= 144) ? 8 + (((ch) - 100) >> 2) : \
|
((ch) >= 149 && (ch) <= 177) ? 20 + (((ch) - 149) >> 2) : 255 \
|
)
|
|
u8 center_ch_5g_40m[CENTER_CH_5G_40M_NUM] = {
|
/* G00 */38,
|
/* G01 */46,
|
/* G02 */54,
|
/* G03 */62,
|
/* G04 */102,
|
/* G05 */110,
|
/* G06 */118,
|
/* G07 */126,
|
/* G08 */134,
|
/* G09 */142,
|
/* G10 */151,
|
/* G11 */159,
|
/* G12 */167,
|
/* G13 */175
|
};
|
|
u8 center_ch_5g_20m_40m[CENTER_CH_5G_20M_NUM + CENTER_CH_5G_40M_NUM] = {
|
/* G00 */36, 38, 40,
|
/* G01 */44, 46, 48,
|
/* G02 */52, 54, 56,
|
/* G03 */60, 62, 64,
|
/* G04 */100, 102, 104,
|
/* G05 */108, 110, 112,
|
/* G06 */116, 118, 120,
|
/* G07 */124, 126, 128,
|
/* G08 */132, 134, 136,
|
/* G09 */140, 142, 144,
|
/* G10 */149, 151, 153,
|
/* G11 */157, 159, 161,
|
/* G12 */165, 167, 169,
|
/* G13 */173, 175, 177
|
};
|
|
u8 op_chs_of_cch_5g_40m[CENTER_CH_5G_40M_NUM][2] = {
|
{36, 40}, /* 38 */
|
{44, 48}, /* 46 */
|
{52, 56}, /* 54 */
|
{60, 64}, /* 62 */
|
{100, 104}, /* 102 */
|
{108, 112}, /* 110 */
|
{116, 120}, /* 118 */
|
{124, 128}, /* 126 */
|
{132, 136}, /* 134 */
|
{140, 144}, /* 142 */
|
{149, 153}, /* 151 */
|
{157, 161}, /* 159 */
|
{165, 169}, /* 167 */
|
{173, 177}, /* 175 */
|
};
|
|
u8 center_ch_5g_80m[CENTER_CH_5G_80M_NUM] = {
|
/* G00 ~ G01*/42,
|
/* G02 ~ G03*/58,
|
/* G04 ~ G05*/106,
|
/* G06 ~ G07*/122,
|
/* G08 ~ G09*/138,
|
/* G10 ~ G11*/155,
|
/* G12 ~ G13*/171
|
};
|
|
u8 op_chs_of_cch_5g_80m[CENTER_CH_5G_80M_NUM][4] = {
|
{36, 40, 44, 48}, /* 42 */
|
{52, 56, 60, 64}, /* 58 */
|
{100, 104, 108, 112}, /* 106 */
|
{116, 120, 124, 128}, /* 122 */
|
{132, 136, 140, 144}, /* 138 */
|
{149, 153, 157, 161}, /* 155 */
|
{165, 169, 173, 177}, /* 171 */
|
};
|
|
u8 center_ch_5g_160m[CENTER_CH_5G_160M_NUM] = {
|
/* G00 ~ G03*/50,
|
/* G04 ~ G07*/114,
|
/* G10 ~ G13*/163
|
};
|
|
u8 op_chs_of_cch_5g_160m[CENTER_CH_5G_160M_NUM][8] = {
|
{36, 40, 44, 48, 52, 56, 60, 64}, /* 50 */
|
{100, 104, 108, 112, 116, 120, 124, 128}, /* 114 */
|
{149, 153, 157, 161, 165, 169, 173, 177}, /* 163 */
|
};
|
|
struct center_chs_ent_t {
|
u8 ch_num;
|
u8 *chs;
|
};
|
|
struct center_chs_ent_t center_chs_2g_by_bw[] = {
|
{CENTER_CH_2G_NUM, center_ch_2g},
|
{CENTER_CH_2G_40M_NUM, center_ch_2g_40m},
|
};
|
|
struct center_chs_ent_t center_chs_5g_by_bw[] = {
|
{CENTER_CH_5G_20M_NUM, center_ch_5g_20m},
|
{CENTER_CH_5G_40M_NUM, center_ch_5g_40m},
|
{CENTER_CH_5G_80M_NUM, center_ch_5g_80m},
|
{CENTER_CH_5G_160M_NUM, center_ch_5g_160m},
|
};
|
|
/*
|
* Get center channel of smaller bandwidth by @param cch, @param bw, @param offset
|
* @cch: the given center channel
|
* @bw: the given bandwidth
|
* @offset: the given primary SC offset of the given bandwidth
|
*
|
* return center channel of smaller bandiwdth if valid, or 0
|
*/
|
u8 rtw_get_scch_by_cch_offset(u8 cch, u8 bw, u8 offset)
|
{
|
u8 t_cch = 0;
|
|
if (bw == CHANNEL_WIDTH_20) {
|
t_cch = cch;
|
goto exit;
|
}
|
|
if (offset == CHAN_OFFSET_NO_EXT) {
|
rtw_warn_on(1);
|
goto exit;
|
}
|
|
/* 2.4G, 40MHz */
|
if (cch >= 3 && cch <= 11 && bw == CHANNEL_WIDTH_40) {
|
t_cch = (offset == CHAN_OFFSET_LOWER) ? cch + 2 : cch - 2;
|
goto exit;
|
}
|
|
/* 5G, 160MHz */
|
if (cch >= 50 && cch <= 163 && bw == CHANNEL_WIDTH_160) {
|
t_cch = (offset == CHAN_OFFSET_LOWER) ? cch + 8 : cch - 8;
|
goto exit;
|
|
/* 5G, 80MHz */
|
} else if (cch >= 42 && cch <= 171 && bw == CHANNEL_WIDTH_80) {
|
t_cch = (offset == CHAN_OFFSET_LOWER) ? cch + 4 : cch - 4;
|
goto exit;
|
|
/* 5G, 40MHz */
|
} else if (cch >= 38 && cch <= 175 && bw == CHANNEL_WIDTH_40) {
|
t_cch = (offset == CHAN_OFFSET_LOWER) ? cch + 2 : cch - 2;
|
goto exit;
|
|
} else {
|
rtw_warn_on(1);
|
goto exit;
|
}
|
|
exit:
|
return t_cch;
|
}
|
|
struct op_chs_ent_t {
|
u8 ch_num;
|
u8 *chs;
|
};
|
|
struct op_chs_ent_t op_chs_of_cch_2g_by_bw[] = {
|
{1, center_ch_2g},
|
{2, (u8 *)op_chs_of_cch_2g_40m},
|
};
|
|
struct op_chs_ent_t op_chs_of_cch_5g_by_bw[] = {
|
{1, center_ch_5g_20m},
|
{2, (u8 *)op_chs_of_cch_5g_40m},
|
{4, (u8 *)op_chs_of_cch_5g_80m},
|
{8, (u8 *)op_chs_of_cch_5g_160m},
|
};
|
|
inline u8 center_chs_2g_num(u8 bw)
|
{
|
if (bw > CHANNEL_WIDTH_40)
|
return 0;
|
|
return center_chs_2g_by_bw[bw].ch_num;
|
}
|
|
inline u8 center_chs_2g(u8 bw, u8 id)
|
{
|
if (bw > CHANNEL_WIDTH_40)
|
return 0;
|
|
if (id >= center_chs_2g_num(bw))
|
return 0;
|
|
return center_chs_2g_by_bw[bw].chs[id];
|
}
|
|
inline u8 center_chs_5g_num(u8 bw)
|
{
|
if (bw > CHANNEL_WIDTH_160)
|
return 0;
|
|
return center_chs_5g_by_bw[bw].ch_num;
|
}
|
|
inline u8 center_chs_5g(u8 bw, u8 id)
|
{
|
if (bw > CHANNEL_WIDTH_160)
|
return 0;
|
|
if (id >= center_chs_5g_num(bw))
|
return 0;
|
|
return center_chs_5g_by_bw[bw].chs[id];
|
}
|
|
/*
|
* Get available op channels by @param cch, @param bw
|
* @cch: the given center channel
|
* @bw: the given bandwidth
|
* @op_chs: the pointer to return pointer of op channel array
|
* @op_ch_num: the pointer to return pointer of op channel number
|
*
|
* return valid (1) or not (0)
|
*/
|
u8 rtw_get_op_chs_by_cch_bw(u8 cch, u8 bw, u8 **op_chs, u8 *op_ch_num)
|
{
|
int i;
|
struct center_chs_ent_t *c_chs_ent = NULL;
|
struct op_chs_ent_t *op_chs_ent = NULL;
|
u8 valid = 1;
|
|
if (cch <= 14
|
&& bw <= CHANNEL_WIDTH_40
|
) {
|
c_chs_ent = ¢er_chs_2g_by_bw[bw];
|
op_chs_ent = &op_chs_of_cch_2g_by_bw[bw];
|
} else if (cch >= 36 && cch <= 177
|
&& bw <= CHANNEL_WIDTH_160
|
) {
|
c_chs_ent = ¢er_chs_5g_by_bw[bw];
|
op_chs_ent = &op_chs_of_cch_5g_by_bw[bw];
|
} else {
|
valid = 0;
|
goto exit;
|
}
|
|
for (i = 0; i < c_chs_ent->ch_num; i++)
|
if (cch == *(c_chs_ent->chs + i))
|
break;
|
|
if (i == c_chs_ent->ch_num) {
|
valid = 0;
|
goto exit;
|
}
|
|
*op_chs = op_chs_ent->chs + op_chs_ent->ch_num * i;
|
*op_ch_num = op_chs_ent->ch_num;
|
|
exit:
|
return valid;
|
}
|
|
u8 rtw_get_offset_by_chbw(u8 ch, u8 bw, u8 *r_offset)
|
{
|
u8 valid = 1;
|
u8 offset = CHAN_OFFSET_NO_EXT;
|
|
if (bw == CHANNEL_WIDTH_20)
|
goto exit;
|
|
if (bw >= CHANNEL_WIDTH_80 && ch <= 14) {
|
valid = 0;
|
goto exit;
|
}
|
|
if (ch >= 1 && ch <= 4)
|
offset = CHAN_OFFSET_UPPER;
|
else if (ch >= 5 && ch <= 9) {
|
if (*r_offset == CHAN_OFFSET_UPPER || *r_offset == CHAN_OFFSET_LOWER)
|
offset = *r_offset; /* both lower and upper is valid, obey input value */
|
else
|
offset = CHAN_OFFSET_LOWER; /* default use upper */
|
} else if (ch >= 10 && ch <= 13)
|
offset = CHAN_OFFSET_LOWER;
|
else if (ch == 14) {
|
valid = 0; /* ch14 doesn't support 40MHz bandwidth */
|
goto exit;
|
} else if (ch >= 36 && ch <= 177) {
|
switch (ch) {
|
case 36:
|
case 44:
|
case 52:
|
case 60:
|
case 100:
|
case 108:
|
case 116:
|
case 124:
|
case 132:
|
case 140:
|
case 149:
|
case 157:
|
case 165:
|
case 173:
|
offset = CHAN_OFFSET_UPPER;
|
break;
|
case 40:
|
case 48:
|
case 56:
|
case 64:
|
case 104:
|
case 112:
|
case 120:
|
case 128:
|
case 136:
|
case 144:
|
case 153:
|
case 161:
|
case 169:
|
case 177:
|
offset = CHAN_OFFSET_LOWER;
|
break;
|
default:
|
valid = 0;
|
break;
|
}
|
} else
|
valid = 0;
|
|
exit:
|
if (valid && r_offset)
|
*r_offset = offset;
|
return valid;
|
}
|
|
u8 rtw_get_center_ch(u8 ch, u8 bw, u8 offset)
|
{
|
return rtw_phl_get_center_ch(ch, bw, offset);
|
}
|
|
u8 rtw_get_ch_group(u8 ch, u8 *group, u8 *cck_group)
|
{
|
enum band_type band = BAND_MAX;
|
s8 gp = -1, cck_gp = -1;
|
|
if (ch <= 14) {
|
band = BAND_ON_24G;
|
|
if (1 <= ch && ch <= 2)
|
gp = 0;
|
else if (3 <= ch && ch <= 5)
|
gp = 1;
|
else if (6 <= ch && ch <= 8)
|
gp = 2;
|
else if (9 <= ch && ch <= 11)
|
gp = 3;
|
else if (12 <= ch && ch <= 14)
|
gp = 4;
|
else
|
band = BAND_MAX;
|
|
if (ch == 14)
|
cck_gp = 5;
|
else
|
cck_gp = gp;
|
} else {
|
band = BAND_ON_5G;
|
|
if (36 <= ch && ch <= 42)
|
gp = 0;
|
else if (44 <= ch && ch <= 48)
|
gp = 1;
|
else if (50 <= ch && ch <= 58)
|
gp = 2;
|
else if (60 <= ch && ch <= 64)
|
gp = 3;
|
else if (100 <= ch && ch <= 106)
|
gp = 4;
|
else if (108 <= ch && ch <= 114)
|
gp = 5;
|
else if (116 <= ch && ch <= 122)
|
gp = 6;
|
else if (124 <= ch && ch <= 130)
|
gp = 7;
|
else if (132 <= ch && ch <= 138)
|
gp = 8;
|
else if (140 <= ch && ch <= 144)
|
gp = 9;
|
else if (149 <= ch && ch <= 155)
|
gp = 10;
|
else if (157 <= ch && ch <= 161)
|
gp = 11;
|
else if (165 <= ch && ch <= 171)
|
gp = 12;
|
else if (173 <= ch && ch <= 177)
|
gp = 13;
|
else
|
band = BAND_MAX;
|
}
|
|
if (band == BAND_MAX
|
|| (band == BAND_ON_24G && cck_gp == -1)
|
|| gp == -1
|
) {
|
RTW_WARN("%s invalid channel:%u", __func__, ch);
|
rtw_warn_on(1);
|
goto exit;
|
}
|
|
if (group)
|
*group = gp;
|
if (cck_group && band == BAND_ON_24G)
|
*cck_group = cck_gp;
|
|
exit:
|
return band;
|
}
|
|
#if CONFIG_IEEE80211_BAND_6GHZ
|
int rtw_6gch2freq(int chan)
|
{
|
if (chan >= 1 && chan <= 253)
|
return 5950 + chan * 5;
|
|
return 0; /* not supported */
|
}
|
#endif
|
|
int rtw_ch2freq(int chan)
|
{
|
/* see 802.11 17.3.8.3.2 and Annex J
|
* there are overlapping channel numbers in 5GHz and 2GHz bands */
|
|
/*
|
* RTK: don't consider the overlapping channel numbers: 5G channel <= 14,
|
* because we don't support it. simply judge from channel number
|
*/
|
|
if (chan >= 1 && chan <= 14) {
|
if (chan == 14)
|
return 2484;
|
else if (chan < 14)
|
return 2407 + chan * 5;
|
} else if (chan >= 36 && chan <= 177)
|
return 5000 + chan * 5;
|
|
return 0; /* not supported */
|
}
|
|
int rtw_ch2freq_by_band(enum band_type band, int ch)
|
{
|
#if CONFIG_IEEE80211_BAND_6GHZ
|
if (band == BAND_ON_6G)
|
return rtw_6gch2freq(ch);
|
else
|
#endif
|
return rtw_ch2freq(ch);
|
}
|
|
int rtw_freq2ch(int freq)
|
{
|
/* see 802.11 17.3.8.3.2 and Annex J */
|
if (freq == 2484)
|
return 14;
|
else if (freq < 2484)
|
return (freq - 2407) / 5;
|
else if (freq >= 4910 && freq <= 4980)
|
return (freq - 4000) / 5;
|
else if (freq >= 5000 && freq < 5950)
|
return (freq - 5000) / 5;
|
else if (freq >= 5950 && freq <= 7215)
|
return (freq - 5950) / 5;
|
else if (freq >= 58320 && freq <= 64800)
|
return (freq - 56160) / 2160;
|
else
|
return 0;
|
}
|
|
enum band_type rtw_freq2band(int freq)
|
{
|
if (freq <= 2484)
|
return BAND_ON_24G;
|
else if (freq >= 5000 && freq < 5950)
|
return BAND_ON_5G;
|
#if CONFIG_IEEE80211_BAND_6GHZ
|
else if (freq >= 5950 && freq <= 7215)
|
return BAND_ON_6G;
|
#endif
|
else
|
return BAND_MAX;
|
}
|
|
bool rtw_freq_consecutive(int a, int b)
|
{
|
enum band_type band_a, band_b;
|
|
band_a = rtw_freq2band(a);
|
if (band_a == BAND_MAX)
|
return 0;
|
band_b = rtw_freq2band(b);
|
if (band_b == BAND_MAX || band_a != band_b)
|
return 0;
|
|
switch (band_a) {
|
case BAND_ON_24G:
|
return rtw_abs(a - b) == 5;
|
case BAND_ON_5G:
|
#if CONFIG_IEEE80211_BAND_6GHZ
|
case BAND_ON_6G:
|
#endif
|
return rtw_abs(a - b) == 20;
|
default:
|
return 0;
|
}
|
}
|
|
bool rtw_chbw_to_freq_range(u8 ch, u8 bw, u8 offset, u32 *hi, u32 *lo)
|
{
|
u8 c_ch;
|
u32 freq;
|
u32 hi_ret = 0, lo_ret = 0;
|
bool valid = _FALSE;
|
|
if (hi)
|
*hi = 0;
|
if (lo)
|
*lo = 0;
|
|
c_ch = rtw_phl_get_center_ch(ch, bw, offset);
|
freq = rtw_ch2freq(c_ch);
|
|
if (!freq) {
|
rtw_warn_on(1);
|
goto exit;
|
}
|
|
if (bw == CHANNEL_WIDTH_160) {
|
hi_ret = freq + 80;
|
lo_ret = freq - 80;
|
} else if (bw == CHANNEL_WIDTH_80) {
|
hi_ret = freq + 40;
|
lo_ret = freq - 40;
|
} else if (bw == CHANNEL_WIDTH_40) {
|
hi_ret = freq + 20;
|
lo_ret = freq - 20;
|
} else if (bw == CHANNEL_WIDTH_20) {
|
hi_ret = freq + 10;
|
lo_ret = freq - 10;
|
} else
|
rtw_warn_on(1);
|
|
if (hi)
|
*hi = hi_ret;
|
if (lo)
|
*lo = lo_ret;
|
|
valid = _TRUE;
|
|
exit:
|
return valid;
|
}
|
|
const char *const _ch_width_str[CHANNEL_WIDTH_MAX] = {
|
"20MHz",
|
"40MHz",
|
"80MHz",
|
"160MHz",
|
"80_80MHz",
|
"5MHz",
|
"10MHz",
|
};
|
|
const u8 _ch_width_to_bw_cap[CHANNEL_WIDTH_MAX] = {
|
BW_CAP_20M,
|
BW_CAP_40M,
|
BW_CAP_80M,
|
BW_CAP_160M,
|
BW_CAP_80_80M,
|
BW_CAP_5M,
|
BW_CAP_10M,
|
};
|
|
const char *const _rtw_band_str[] = {
|
[BAND_ON_24G] = "2.4G",
|
[BAND_ON_5G] = "5G",
|
[BAND_ON_6G] = "6G",
|
[BAND_MAX] = "BAND_MAX",
|
};
|
|
const u8 _band_to_band_cap[] = {
|
[BAND_ON_24G] = BAND_CAP_2G,
|
[BAND_ON_5G] = BAND_CAP_5G,
|
[BAND_ON_6G] = BAND_CAP_6G,
|
[BAND_MAX] = 0,
|
};
|
|
const char *const _opc_bw_str[OPC_BW_NUM] = {
|
"20M ", /* OPC_BW20 */
|
"40M+", /* OPC_BW40PLUS */
|
"40M-", /* OPC_BW40MINUS */
|
"80M ", /* OPC_BW80 */
|
"160M ", /* OPC_BW160 */
|
"80+80M ", /* OPC_BW80P80 */
|
};
|
|
const u8 _opc_bw_to_ch_width[OPC_BW_NUM] = {
|
CHANNEL_WIDTH_20, /* OPC_BW20 */
|
CHANNEL_WIDTH_40, /* OPC_BW40PLUS */
|
CHANNEL_WIDTH_40, /* OPC_BW40MINUS */
|
CHANNEL_WIDTH_80, /* OPC_BW80 */
|
CHANNEL_WIDTH_160, /* OPC_BW160 */
|
CHANNEL_WIDTH_80_80, /* OPC_BW80P80 */
|
};
|
|
/* global operating class database */
|
|
struct op_class_t {
|
u8 class_id;
|
enum band_type band;
|
enum opc_bw bw;
|
u8 *len_ch_attr;
|
};
|
|
#define OPC_CH_LIST_LEN(_opc) (_opc.len_ch_attr[0])
|
#define OPC_CH_LIST_CH(_opc, _i) (_opc.len_ch_attr[_i + 1])
|
|
#define OP_CLASS_ENT(_class, _band, _bw, _len, arg...) \
|
{.class_id = _class, .band = _band, .bw = _bw, .len_ch_attr = (uint8_t[_len + 1]) {_len, ##arg},}
|
|
/* 802.11-2020, 802.11ax-2021 Table E-4, partial */
|
static const struct op_class_t global_op_class[] = {
|
/* 2G ch1~13, 20M */
|
OP_CLASS_ENT(81, BAND_ON_24G, OPC_BW20, 13, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13),
|
/* 2G ch14, 20M */
|
OP_CLASS_ENT(82, BAND_ON_24G, OPC_BW20, 1, 14),
|
/* 2G, 40M */
|
OP_CLASS_ENT(83, BAND_ON_24G, OPC_BW40PLUS, 9, 1, 2, 3, 4, 5, 6, 7, 8, 9),
|
OP_CLASS_ENT(84, BAND_ON_24G, OPC_BW40MINUS, 9, 5, 6, 7, 8, 9, 10, 11, 12, 13),
|
/* 5G band 1, 20M & 40M */
|
OP_CLASS_ENT(115, BAND_ON_5G, OPC_BW20, 4, 36, 40, 44, 48),
|
OP_CLASS_ENT(116, BAND_ON_5G, OPC_BW40PLUS, 2, 36, 44),
|
OP_CLASS_ENT(117, BAND_ON_5G, OPC_BW40MINUS, 2, 40, 48),
|
/* 5G band 2, 20M & 40M */
|
OP_CLASS_ENT(118, BAND_ON_5G, OPC_BW20, 4, 52, 56, 60, 64),
|
OP_CLASS_ENT(119, BAND_ON_5G, OPC_BW40PLUS, 2, 52, 60),
|
OP_CLASS_ENT(120, BAND_ON_5G, OPC_BW40MINUS, 2, 56, 64),
|
/* 5G band 3, 20M & 40M */
|
OP_CLASS_ENT(121, BAND_ON_5G, OPC_BW20, 12, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144),
|
OP_CLASS_ENT(122, BAND_ON_5G, OPC_BW40PLUS, 6, 100, 108, 116, 124, 132, 140),
|
OP_CLASS_ENT(123, BAND_ON_5G, OPC_BW40MINUS, 6, 104, 112, 120, 128, 136, 144),
|
/* 5G band 4, 20M & 40M */
|
OP_CLASS_ENT(124, BAND_ON_5G, OPC_BW20, 4, 149, 153, 157, 161),
|
OP_CLASS_ENT(125, BAND_ON_5G, OPC_BW20, 8, 149, 153, 157, 161, 165, 169, 173, 177),
|
OP_CLASS_ENT(126, BAND_ON_5G, OPC_BW40PLUS, 4, 149, 157, 165, 173),
|
OP_CLASS_ENT(127, BAND_ON_5G, OPC_BW40MINUS, 4, 153, 161, 169, 177),
|
/* 5G, 80M & 160M */
|
OP_CLASS_ENT(128, BAND_ON_5G, OPC_BW80, 28, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165, 169, 173, 177),
|
OP_CLASS_ENT(129, BAND_ON_5G, OPC_BW160, 24, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 149, 153, 157, 161, 165, 169, 173, 177),
|
#if 0 /* TODO */
|
/* 5G, 80+80M */
|
OP_CLASS_ENT(130, BAND_ON_5G, OPC_BW80P80, 28, 36, 40, 44, 48, 52, 56, 60, 64, 100, 104, 108, 112, 116, 120, 124, 128, 132, 136, 140, 144, 149, 153, 157, 161, 165, 169, 173, 177),
|
#endif
|
};
|
|
static const int global_op_class_num = sizeof(global_op_class) / sizeof(struct op_class_t);
|
|
static const struct op_class_t *get_global_op_class_by_id(u8 gid)
|
{
|
int i;
|
|
for (i = 0; i < global_op_class_num; i++)
|
if (global_op_class[i].class_id == gid)
|
break;
|
|
return i < global_op_class_num ? &global_op_class[i] : NULL;
|
}
|
|
bool is_valid_global_op_class_id(u8 gid)
|
{
|
return get_global_op_class_by_id(gid) ? 1 : 0;
|
}
|
|
static bool is_valid_global_op_class_ch(const struct op_class_t *opc, u8 ch)
|
{
|
int array_idx;
|
int i;
|
|
if (opc < global_op_class
|
|| (((u8 *)opc) - ((u8 *)global_op_class)) % sizeof(struct op_class_t)
|
) {
|
RTW_ERR("Invalid opc pointer:%p (global_op_class:%p, sizeof(struct op_class_t):%zu, %zu)\n"
|
, opc, global_op_class, sizeof(struct op_class_t), (((u8 *)opc) - ((u8 *)global_op_class)) % sizeof(struct op_class_t));
|
return 0;
|
}
|
|
array_idx = (((u8 *)opc) - ((u8 *)global_op_class)) / sizeof(struct op_class_t);
|
|
for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[array_idx]); i++)
|
if (OPC_CH_LIST_CH(global_op_class[array_idx], i) == ch)
|
break;
|
|
return i < OPC_CH_LIST_LEN(global_op_class[array_idx]);
|
}
|
|
static enum opc_bw get_global_opc_bw_by_id(u8 gid)
|
{
|
int i;
|
|
for (i = 0; i < global_op_class_num; i++)
|
if (global_op_class[i].class_id == gid)
|
break;
|
|
return i < global_op_class_num ? global_op_class[i].bw : OPC_BW_NUM;
|
}
|
|
/* -2: logic error, -1: error, 0: is already BW20 */
|
s16 get_sub_op_class(u8 gid, u8 ch)
|
{
|
const struct op_class_t *opc = get_global_op_class_by_id(gid);
|
int i;
|
enum channel_width bw;
|
|
if (!opc)
|
return -1;
|
|
if (!is_valid_global_op_class_ch(opc, ch)) {
|
return -1;
|
}
|
|
if (opc->bw == OPC_BW20)
|
return 0;
|
|
bw = opc_bw_to_ch_width(opc->bw);
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (bw != opc_bw_to_ch_width(global_op_class[i].bw) + 1)
|
continue;
|
if (is_valid_global_op_class_ch(&global_op_class[i], ch))
|
break;
|
}
|
|
return i < global_op_class_num ? global_op_class[i].class_id : -2;
|
}
|
|
static void dump_op_class_ch_title(void *sel)
|
{
|
RTW_PRINT_SEL(sel, "%-5s %-4s %-7s ch_list\n"
|
, "class", "band", "bw");
|
}
|
|
static void dump_global_op_class_ch_single(void *sel, u8 gid)
|
{
|
u8 i;
|
|
RTW_PRINT_SEL(sel, "%5u %4s %7s"
|
, global_op_class[gid].class_id
|
, band_str(global_op_class[gid].band)
|
, opc_bw_str(global_op_class[gid].bw));
|
|
for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[gid]); i++)
|
_RTW_PRINT_SEL(sel, " %u", OPC_CH_LIST_CH(global_op_class[gid], i));
|
|
_RTW_PRINT_SEL(sel, "\n");
|
}
|
|
#ifdef CONFIG_RTW_DEBUG
|
static bool dbg_global_op_class_validate(u8 gid)
|
{
|
u8 i;
|
u8 ch, bw, offset, cch;
|
bool ret = 1;
|
|
switch (global_op_class[gid].bw) {
|
case OPC_BW20:
|
bw = CHANNEL_WIDTH_20;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW40PLUS:
|
bw = CHANNEL_WIDTH_40;
|
offset = CHAN_OFFSET_UPPER;
|
break;
|
case OPC_BW40MINUS:
|
bw = CHANNEL_WIDTH_40;
|
offset = CHAN_OFFSET_LOWER;
|
break;
|
case OPC_BW80:
|
bw = CHANNEL_WIDTH_80;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW160:
|
bw = CHANNEL_WIDTH_160;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW80P80: /* TODO */
|
default:
|
RTW_ERR("%s class:%u unsupported opc_bw:%u\n"
|
, __func__, global_op_class[gid].class_id, global_op_class[gid].bw);
|
ret = 0;
|
goto exit;
|
}
|
|
for (i = 0; i < OPC_CH_LIST_LEN(global_op_class[gid]); i++) {
|
u8 *op_chs;
|
u8 op_ch_num;
|
u8 k;
|
|
ch = OPC_CH_LIST_CH(global_op_class[gid], i);
|
cch = rtw_get_center_ch(ch ,bw, offset);
|
if (!cch) {
|
RTW_ERR("%s can't get cch from class:%u ch:%u\n"
|
, __func__, global_op_class[gid].class_id, ch);
|
ret = 0;
|
continue;
|
}
|
|
if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num)) {
|
RTW_ERR("%s can't get op chs from class:%u cch:%u\n"
|
, __func__, global_op_class[gid].class_id, cch);
|
ret = 0;
|
continue;
|
}
|
|
for (k = 0; k < op_ch_num; k++) {
|
if (*(op_chs + k) == ch)
|
break;
|
}
|
if (k >= op_ch_num) {
|
RTW_ERR("%s can't get ch:%u from op_chs class:%u cch:%u\n"
|
, __func__, ch, global_op_class[i].class_id, cch);
|
ret = 0;
|
}
|
}
|
|
exit:
|
return ret;
|
}
|
#endif /* CONFIG_RTW_DEBUG */
|
|
void dump_global_op_class(void *sel)
|
{
|
u8 i;
|
|
dump_op_class_ch_title(sel);
|
|
for (i = 0; i < global_op_class_num; i++)
|
dump_global_op_class_ch_single(sel, i);
|
}
|
|
u8 rtw_get_op_class_by_chbw(u8 ch, u8 bw, u8 offset)
|
{
|
enum band_type band = BAND_MAX;
|
int i;
|
u8 gid = 0; /* invalid */
|
|
if (rtw_is_2g_ch(ch))
|
band = BAND_ON_24G;
|
else if (rtw_is_5g_ch(ch))
|
band = BAND_ON_5G;
|
else
|
goto exit;
|
|
switch (bw) {
|
case CHANNEL_WIDTH_20:
|
case CHANNEL_WIDTH_40:
|
case CHANNEL_WIDTH_80:
|
case CHANNEL_WIDTH_160:
|
#if 0 /* TODO */
|
case CHANNEL_WIDTH_80_80:
|
#endif
|
break;
|
default:
|
goto exit;
|
}
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (band != global_op_class[i].band)
|
continue;
|
|
if (opc_bw_to_ch_width(global_op_class[i].bw) != bw)
|
continue;
|
|
if ((global_op_class[i].bw == OPC_BW40PLUS
|
&& offset != CHAN_OFFSET_UPPER)
|
|| (global_op_class[i].bw == OPC_BW40MINUS
|
&& offset != CHAN_OFFSET_LOWER)
|
)
|
continue;
|
|
if (is_valid_global_op_class_ch(&global_op_class[i], ch))
|
goto get;
|
}
|
|
get:
|
if (i < global_op_class_num) {
|
#if 0 /* TODO */
|
if (bw == CHANNEL_WIDTH_80_80) {
|
/* search another ch */
|
if (!is_valid_global_op_class_ch(&global_op_class[i], ch2))
|
goto exit;
|
}
|
#endif
|
|
gid = global_op_class[i].class_id;
|
}
|
|
exit:
|
return gid;
|
}
|
|
u8 rtw_get_bw_offset_by_op_class_ch(u8 gid, u8 ch, u8 *bw, u8 *offset)
|
{
|
enum opc_bw opc_bw;
|
u8 valid = 0;
|
int i;
|
|
opc_bw = get_global_opc_bw_by_id(gid);
|
if (opc_bw == OPC_BW_NUM)
|
goto exit;
|
|
*bw = opc_bw_to_ch_width(opc_bw);
|
|
if (opc_bw == OPC_BW40PLUS)
|
*offset = CHAN_OFFSET_UPPER;
|
else if (opc_bw == OPC_BW40MINUS)
|
*offset = CHAN_OFFSET_LOWER;
|
|
if (rtw_get_offset_by_chbw(ch, *bw, offset))
|
valid = 1;
|
|
exit:
|
return valid;
|
}
|
|
static struct op_class_pref_t *opc_pref_alloc(u8 class_id)
|
{
|
int i, j;
|
struct op_class_pref_t *opc_pref = NULL;
|
u8 ch_num;
|
|
for (i = 0; i < global_op_class_num; i++)
|
if (global_op_class[i].class_id == class_id)
|
break;
|
|
if (i >= global_op_class_num)
|
goto exit;
|
|
ch_num = OPC_CH_LIST_LEN(global_op_class[i]);
|
opc_pref = rtw_zmalloc(sizeof(*opc_pref) + (sizeof(struct op_ch_t) * ch_num));
|
if (!opc_pref)
|
goto exit;
|
|
opc_pref->class_id = global_op_class[i].class_id;
|
opc_pref->band = global_op_class[i].band;
|
opc_pref->bw = global_op_class[i].bw;
|
|
for (j = 0; j < OPC_CH_LIST_LEN(global_op_class[i]); j++) {
|
opc_pref->chs[j].ch = OPC_CH_LIST_CH(global_op_class[i], j);
|
opc_pref->chs[j].static_non_op = 1;
|
opc_pref->chs[j].no_ir = 1;
|
opc_pref->chs[j].max_txpwr = UNSPECIFIED_MBM;
|
}
|
opc_pref->ch_num = ch_num;
|
|
exit:
|
return opc_pref;
|
}
|
|
static void opc_pref_free(struct op_class_pref_t *opc_pref)
|
{
|
rtw_mfree(opc_pref, sizeof(*opc_pref) + (sizeof(struct op_ch_t) * opc_pref->ch_num));
|
}
|
|
int op_class_pref_init(_adapter *adapter)
|
{
|
struct dvobj_priv *dvobj = adapter_to_dvobj(adapter);
|
struct rf_ctl_t *rfctl = dvobj_to_rfctl(dvobj);
|
struct registry_priv *regsty = dvobj_to_regsty(dvobj);
|
u8 bw;
|
struct op_class_pref_t *opc_pref;
|
int i;
|
u8 op_class_num = 0;
|
u8 band_bmp = 0;
|
u8 bw_bmp[BAND_MAX] = {0};
|
int ret = _FAIL;
|
|
rfctl->spt_op_class_ch = rtw_zmalloc(sizeof(struct op_class_pref_t *) * global_op_class_num);
|
if (!rfctl->spt_op_class_ch) {
|
RTW_ERR("%s alloc rfctl->spt_op_class_ch fail\n", __func__);
|
goto exit;
|
}
|
|
if (is_supported_24g(regsty->band_type) && rtw_hw_chk_band_cap(dvobj, BAND_CAP_2G))
|
band_bmp |= BAND_CAP_2G;
|
if (is_supported_5g(regsty->band_type) && rtw_hw_chk_band_cap(dvobj, BAND_CAP_5G))
|
band_bmp |= BAND_CAP_5G;
|
|
bw_bmp[BAND_ON_24G] = (ch_width_to_bw_cap(REGSTY_BW_2G(regsty) + 1) - 1) & (GET_HAL_SPEC(dvobj)->bw_cap);
|
bw_bmp[BAND_ON_5G] = (ch_width_to_bw_cap(REGSTY_BW_5G(regsty) + 1) - 1) & (GET_HAL_SPEC(dvobj)->bw_cap);
|
if (!REGSTY_IS_11AC_ENABLE(regsty)
|
|| !is_supported_vht(regsty->wireless_mode)
|
)
|
bw_bmp[BAND_ON_5G] &= ~(BW_CAP_80M | BW_CAP_160M);
|
|
if (0) {
|
RTW_INFO("REGSTY_BW_2G(regsty):%u\n", REGSTY_BW_2G(regsty));
|
RTW_INFO("REGSTY_BW_5G(regsty):%u\n", REGSTY_BW_5G(regsty));
|
RTW_INFO("GET_HAL_SPEC(adapter)->bw_cap:0x%x\n", GET_HAL_SPEC(dvobj)->bw_cap);
|
RTW_INFO("band_bmp:0x%x\n", band_bmp);
|
RTW_INFO("bw_bmp[2G]:0x%x\n", bw_bmp[BAND_ON_24G]);
|
RTW_INFO("bw_bmp[5G]:0x%x\n", bw_bmp[BAND_ON_5G]);
|
}
|
|
for (i = 0; i < global_op_class_num; i++) {
|
#ifdef CONFIG_RTW_DEBUG
|
rtw_warn_on(!dbg_global_op_class_validate(i));
|
#endif
|
|
if (!(band_bmp & band_to_band_cap(global_op_class[i].band)))
|
continue;
|
|
bw = opc_bw_to_ch_width(global_op_class[i].bw);
|
if (bw == CHANNEL_WIDTH_MAX
|
|| bw == CHANNEL_WIDTH_80_80 /* TODO */
|
)
|
continue;
|
|
if (!(bw_bmp[global_op_class[i].band] & ch_width_to_bw_cap(bw)))
|
continue;
|
|
opc_pref = opc_pref_alloc(global_op_class[i].class_id);
|
if (!opc_pref) {
|
RTW_ERR("%s opc_pref_alloc(%u) fail\n", __func__, global_op_class[i].class_id);
|
goto exit;
|
}
|
|
if (opc_pref->ch_num) {
|
rfctl->spt_op_class_ch[i] = opc_pref;
|
op_class_num++;
|
} else
|
opc_pref_free(opc_pref);
|
}
|
|
rfctl->cap_spt_op_class_num = op_class_num;
|
ret = _SUCCESS;
|
|
exit:
|
return ret;
|
}
|
|
void op_class_pref_deinit(_adapter *adapter)
|
{
|
struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);
|
int i;
|
|
if (!rfctl->spt_op_class_ch)
|
return;
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (rfctl->spt_op_class_ch[i]) {
|
opc_pref_free(rfctl->spt_op_class_ch[i]);
|
rfctl->spt_op_class_ch[i] = NULL;
|
}
|
}
|
|
rtw_mfree(rfctl->spt_op_class_ch, sizeof(struct op_class_pref_t *) * global_op_class_num);
|
rfctl->spt_op_class_ch = NULL;
|
}
|
|
void op_class_pref_apply_regulatory(_adapter *adapter, u8 reason)
|
{
|
struct rf_ctl_t *rfctl = adapter_to_rfctl(adapter);
|
RT_CHANNEL_INFO *chset = rfctl->channel_set;
|
struct registry_priv *regsty = adapter_to_regsty(adapter);
|
u8 ch, bw, offset, cch;
|
struct op_class_pref_t *opc_pref;
|
int i, j;
|
u8 reg_op_class_num = 0;
|
u8 op_class_num = 0;
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (!rfctl->spt_op_class_ch[i])
|
continue;
|
opc_pref = rfctl->spt_op_class_ch[i];
|
|
/* reset all channel */
|
for (j = 0; j < opc_pref->ch_num; j++) {
|
if (reason >= REG_CHANGE)
|
opc_pref->chs[j].static_non_op = 1;
|
if (reason != REG_TXPWR_CHANGE)
|
opc_pref->chs[j].no_ir = 1;
|
if (reason >= REG_TXPWR_CHANGE)
|
opc_pref->chs[j].max_txpwr = UNSPECIFIED_MBM;
|
}
|
if (reason >= REG_CHANGE)
|
opc_pref->op_ch_num = 0;
|
if (reason != REG_TXPWR_CHANGE)
|
opc_pref->ir_ch_num = 0;
|
|
switch (opc_pref->bw) {
|
case OPC_BW20:
|
bw = CHANNEL_WIDTH_20;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW40PLUS:
|
bw = CHANNEL_WIDTH_40;
|
offset = CHAN_OFFSET_UPPER;
|
break;
|
case OPC_BW40MINUS:
|
bw = CHANNEL_WIDTH_40;
|
offset = CHAN_OFFSET_LOWER;
|
break;
|
case OPC_BW80:
|
bw = CHANNEL_WIDTH_80;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW160:
|
bw = CHANNEL_WIDTH_160;
|
offset = CHAN_OFFSET_NO_EXT;
|
break;
|
case OPC_BW80P80: /* TODO */
|
default:
|
continue;
|
}
|
|
if (!RFCTL_REG_EN_11AC(rfctl)
|
&& (bw == CHANNEL_WIDTH_80 || bw == CHANNEL_WIDTH_160))
|
continue;
|
|
for (j = 0; j < opc_pref->ch_num; j++) {
|
u8 *op_chs;
|
u8 op_ch_num;
|
u8 k, l;
|
int chset_idx;
|
|
ch = opc_pref->chs[j].ch;
|
|
if (reason >= REG_TXPWR_CHANGE)
|
opc_pref->chs[j].max_txpwr = rtw_rfctl_get_reg_max_txpwr_mbm(rfctl, ch, bw, offset, 1);
|
|
if (reason == REG_TXPWR_CHANGE)
|
continue;
|
|
cch = rtw_get_center_ch(ch ,bw, offset);
|
if (!cch)
|
continue;
|
|
if (!rtw_get_op_chs_by_cch_bw(cch, bw, &op_chs, &op_ch_num))
|
continue;
|
|
for (k = 0, l = 0; k < op_ch_num; k++) {
|
chset_idx = rtw_chset_search_ch(chset, *(op_chs + k));
|
if (chset_idx == -1)
|
break;
|
if (bw >= CHANNEL_WIDTH_40) {
|
if ((chset[chset_idx].flags & RTW_CHF_NO_HT40U) && k % 2 == 0)
|
break;
|
if ((chset[chset_idx].flags & RTW_CHF_NO_HT40L) && k % 2 == 1)
|
break;
|
}
|
if (bw >= CHANNEL_WIDTH_80 && (chset[chset_idx].flags & RTW_CHF_NO_80MHZ))
|
break;
|
if (bw >= CHANNEL_WIDTH_160 && (chset[chset_idx].flags & RTW_CHF_NO_160MHZ))
|
break;
|
if ((chset[chset_idx].flags & RTW_CHF_DFS) && rtw_rfctl_dfs_domain_unknown(rfctl))
|
continue;
|
if (chset[chset_idx].flags & RTW_CHF_NO_IR)
|
continue;
|
l++;
|
}
|
if (k < op_ch_num)
|
continue;
|
|
if (reason >= REG_CHANGE) {
|
opc_pref->chs[j].static_non_op = 0;
|
opc_pref->op_ch_num++;
|
}
|
|
if (l >= op_ch_num) {
|
opc_pref->chs[j].no_ir = 0;
|
opc_pref->ir_ch_num++;
|
}
|
}
|
|
if (opc_pref->op_ch_num)
|
reg_op_class_num++;
|
if (opc_pref->ir_ch_num)
|
op_class_num++;
|
}
|
|
rfctl->reg_spt_op_class_num = reg_op_class_num;
|
rfctl->cur_spt_op_class_num = op_class_num;
|
}
|
|
static void dump_opc_pref_single(void *sel, struct op_class_pref_t *opc_pref, bool show_snon_ocp, bool show_no_ir, bool detail)
|
{
|
u8 i;
|
u8 ch_num = 0;
|
|
if (!show_snon_ocp && !opc_pref->op_ch_num)
|
return;
|
if (!show_no_ir && !opc_pref->ir_ch_num)
|
return;
|
|
RTW_PRINT_SEL(sel, "%5u %4s %7s"
|
, opc_pref->class_id
|
, band_str(opc_pref->band)
|
, opc_bw_str(opc_pref->bw));
|
for (i = 0; i < opc_pref->ch_num; i++) {
|
if ((show_snon_ocp || !opc_pref->chs[i].static_non_op)
|
&& (show_no_ir || !opc_pref->chs[i].no_ir)
|
) {
|
if (detail)
|
_RTW_PRINT_SEL(sel, " %4u", opc_pref->chs[i].ch);
|
else
|
_RTW_PRINT_SEL(sel, " %u", opc_pref->chs[i].ch);
|
}
|
}
|
_RTW_PRINT_SEL(sel, "\n");
|
|
if (!detail)
|
return;
|
|
RTW_PRINT_SEL(sel, " ");
|
for (i = 0; i < opc_pref->ch_num; i++) {
|
if ((show_snon_ocp || !opc_pref->chs[i].static_non_op)
|
&& (show_no_ir || !opc_pref->chs[i].no_ir)
|
) {
|
_RTW_PRINT_SEL(sel, " %c%c"
|
, opc_pref->chs[i].no_ir ? ' ' : 'I'
|
, opc_pref->chs[i].static_non_op ? ' ' : 'E'
|
);
|
}
|
}
|
_RTW_PRINT_SEL(sel, "\n");
|
|
RTW_PRINT_SEL(sel, " ");
|
for (i = 0; i < opc_pref->ch_num; i++) {
|
if ((show_snon_ocp || !opc_pref->chs[i].static_non_op)
|
&& (show_no_ir || !opc_pref->chs[i].no_ir)
|
) {
|
if (opc_pref->chs[i].max_txpwr == UNSPECIFIED_MBM)
|
_RTW_PRINT_SEL(sel, " ");
|
else
|
_RTW_PRINT_SEL(sel, " %4d", opc_pref->chs[i].max_txpwr);
|
}
|
}
|
_RTW_PRINT_SEL(sel, "\n");
|
}
|
|
void dump_cap_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail)
|
{
|
u8 i;
|
|
dump_op_class_ch_title(sel);
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (!rfctl->spt_op_class_ch[i])
|
continue;
|
dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 1, 1, detail);
|
}
|
|
RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->cap_spt_op_class_num);
|
}
|
|
void dump_reg_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail)
|
{
|
u8 i;
|
|
dump_op_class_ch_title(sel);
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (!rfctl->spt_op_class_ch[i])
|
continue;
|
dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 0, 1, detail);
|
}
|
|
RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->reg_spt_op_class_num);
|
}
|
|
void dump_cur_spt_op_class_ch(void *sel, struct rf_ctl_t *rfctl, bool detail)
|
{
|
u8 i;
|
|
dump_op_class_ch_title(sel);
|
|
for (i = 0; i < global_op_class_num; i++) {
|
if (!rfctl->spt_op_class_ch[i])
|
continue;
|
dump_opc_pref_single(sel, rfctl->spt_op_class_ch[i], 0, 0, detail);
|
}
|
|
RTW_PRINT_SEL(sel, "op_class number:%d\n", rfctl->cur_spt_op_class_num);
|
}
|
|
const u8 _rf_type_to_rf_tx_cnt[] = {
|
1, /*RF_1T1R*/
|
1, /*RF_1T2R*/
|
2, /*RF_2T2R*/
|
2, /*RF_2T3R*/
|
2, /*RF_2T4R*/
|
3, /*RF_3T3R*/
|
3, /*RF_3T4R*/
|
4, /*RF_4T4R*/
|
1, /*RF_TYPE_MAX*/
|
};
|
|
const u8 _rf_type_to_rf_rx_cnt[] = {
|
1, /*RF_1T1R*/
|
2, /*RF_1T2R*/
|
2, /*RF_2T2R*/
|
3, /*RF_2T3R*/
|
4, /*RF_2T4R*/
|
3, /*RF_3T3R*/
|
4, /*RF_3T4R*/
|
4, /*RF_4T4R*/
|
1, /*RF_TYPE_MAX*/
|
};
|
|
const char *const _rf_type_to_rfpath_str[] = {
|
"RF_1T1R",
|
"RF_1T2R",
|
"RF_2T2R",
|
"RF_2T3R",
|
"RF_2T4R",
|
"RF_3T3R",
|
"RF_3T4R",
|
"RF_4T4R",
|
"RF_TYPE_MAX"
|
};
|
|
static const u8 _trx_num_to_rf_type[RF_PATH_MAX][RF_PATH_MAX] = {
|
{RF_1T1R, RF_1T2R, RF_TYPE_MAX, RF_TYPE_MAX},
|
{RF_TYPE_MAX, RF_2T2R, RF_2T3R, RF_2T4R},
|
{RF_TYPE_MAX, RF_TYPE_MAX, RF_3T3R, RF_3T4R},
|
{RF_TYPE_MAX, RF_TYPE_MAX, RF_TYPE_MAX, RF_4T4R},
|
};
|
|
enum rf_type trx_num_to_rf_type(u8 tx_num, u8 rx_num)
|
{
|
if (tx_num > 0 && tx_num <= RF_PATH_MAX && rx_num > 0 && rx_num <= RF_PATH_MAX)
|
return _trx_num_to_rf_type[tx_num - 1][rx_num - 1];
|
return RF_TYPE_MAX;
|
}
|
|
enum rf_type trx_bmp_to_rf_type(u8 tx_bmp, u8 rx_bmp)
|
{
|
u8 tx_num = 0;
|
u8 rx_num = 0;
|
int i;
|
|
for (i = 0; i < RF_PATH_MAX; i++) {
|
if (tx_bmp >> i & BIT0)
|
tx_num++;
|
if (rx_bmp >> i & BIT0)
|
rx_num++;
|
}
|
|
return trx_num_to_rf_type(tx_num, rx_num);
|
}
|
|
bool rf_type_is_a_in_b(enum rf_type a, enum rf_type b)
|
{
|
return rf_type_to_rf_tx_cnt(a) <= rf_type_to_rf_tx_cnt(b)
|
&& rf_type_to_rf_rx_cnt(a) <= rf_type_to_rf_rx_cnt(b);
|
}
|
|
static void rtw_path_bmp_limit_from_higher(u8 *bmp, u8 *bmp_bit_cnt, u8 bit_cnt_lmt)
|
{
|
int i;
|
|
for (i = RF_PATH_MAX - 1; *bmp_bit_cnt > bit_cnt_lmt && i >= 0; i--) {
|
if (*bmp & BIT(i)) {
|
*bmp &= ~BIT(i);
|
(*bmp_bit_cnt)--;
|
}
|
}
|
}
|
|
u8 rtw_restrict_trx_path_bmp_by_rftype(u8 trx_path_bmp, enum rf_type type, u8 *tx_num, u8 *rx_num)
|
{
|
u8 bmp_tx = (trx_path_bmp & 0xF0) >> 4;
|
u8 bmp_rx = trx_path_bmp & 0x0F;
|
u8 bmp_tx_num = 0, bmp_rx_num = 0;
|
u8 tx_num_lmt, rx_num_lmt;
|
enum rf_type ret_type = RF_TYPE_MAX;
|
int i, j;
|
|
for (i = 0; i < RF_PATH_MAX; i++) {
|
if (bmp_tx & BIT(i))
|
bmp_tx_num++;
|
if (bmp_rx & BIT(i))
|
bmp_rx_num++;
|
}
|
|
/* limit higher bit first according to input type */
|
tx_num_lmt = rf_type_to_rf_tx_cnt(type);
|
rx_num_lmt = rf_type_to_rf_rx_cnt(type);
|
rtw_path_bmp_limit_from_higher(&bmp_tx, &bmp_tx_num, tx_num_lmt);
|
rtw_path_bmp_limit_from_higher(&bmp_rx, &bmp_rx_num, rx_num_lmt);
|
|
/* search for valid rf_type (larger RX prefer) */
|
for (j = bmp_rx_num; j > 0; j--) {
|
for (i = bmp_tx_num; i > 0; i--) {
|
ret_type = trx_num_to_rf_type(i, j);
|
if (RF_TYPE_VALID(ret_type)) {
|
rtw_path_bmp_limit_from_higher(&bmp_tx, &bmp_tx_num, i);
|
rtw_path_bmp_limit_from_higher(&bmp_rx, &bmp_rx_num, j);
|
if (tx_num)
|
*tx_num = bmp_tx_num;
|
if (rx_num)
|
*rx_num = bmp_rx_num;
|
goto exit;
|
}
|
}
|
}
|
|
exit:
|
return RF_TYPE_VALID(ret_type) ? ((bmp_tx << 4) | bmp_rx) : 0x00;
|
}
|
|
/*
|
* input with txpwr value in unit of txpwr index
|
* return string in length 6 at least (for -xx.xx)
|
*/
|
void txpwr_idx_get_dbm_str(s8 idx, u8 txgi_max, u8 txgi_pdbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len)
|
{
|
char fmt[16];
|
|
if (idx == txgi_max) {
|
snprintf(fmt, 16, "%%%zus", cwidth >= 6 ? cwidth + 1 : 6);
|
snprintf(dbm_str, dbm_str_len, fmt, "NA");
|
} else if (idx > -txgi_pdbm && idx < 0) { /* -0.xx */
|
snprintf(fmt, 16, "%%%zus-0.%%02d", cwidth >= 6 ? cwidth - 4 : 1);
|
snprintf(dbm_str, dbm_str_len, fmt, "", (rtw_abs(idx) % txgi_pdbm) * 100 / txgi_pdbm);
|
} else if (idx % txgi_pdbm) { /* d.xx */
|
snprintf(fmt, 16, "%%%zud.%%02d", cwidth >= 6 ? cwidth - 2 : 3);
|
snprintf(dbm_str, dbm_str_len, fmt, idx / txgi_pdbm, (rtw_abs(idx) % txgi_pdbm) * 100 / txgi_pdbm);
|
} else { /* d */
|
snprintf(fmt, 16, "%%%zud", cwidth >= 6 ? cwidth + 1 : 6);
|
snprintf(dbm_str, dbm_str_len, fmt, idx / txgi_pdbm);
|
}
|
}
|
|
/*
|
* input with txpwr value in unit of mbm
|
* return string in length 6 at least (for -xx.xx)
|
*/
|
void txpwr_mbm_get_dbm_str(s16 mbm, SIZE_T cwidth, char dbm_str[], u8 dbm_str_len)
|
{
|
char fmt[16];
|
|
if (mbm == UNSPECIFIED_MBM) {
|
snprintf(fmt, 16, "%%%zus", cwidth >= 6 ? cwidth + 1 : 6);
|
snprintf(dbm_str, dbm_str_len, fmt, "NA");
|
} else if (mbm > -MBM_PDBM && mbm < 0) { /* -0.xx */
|
snprintf(fmt, 16, "%%%zus-0.%%02d", cwidth >= 6 ? cwidth - 4 : 1);
|
snprintf(dbm_str, dbm_str_len, fmt, "", (rtw_abs(mbm) % MBM_PDBM) * 100 / MBM_PDBM);
|
} else if (mbm % MBM_PDBM) { /* d.xx */
|
snprintf(fmt, 16, "%%%zud.%%02d", cwidth >= 6 ? cwidth - 2 : 3);
|
snprintf(dbm_str, dbm_str_len, fmt, mbm / MBM_PDBM, (rtw_abs(mbm) % MBM_PDBM) * 100 / MBM_PDBM);
|
} else { /* d */
|
snprintf(fmt, 16, "%%%zud", cwidth >= 6 ? cwidth + 1 : 6);
|
snprintf(dbm_str, dbm_str_len, fmt, mbm / MBM_PDBM);
|
}
|
}
|
|
static const s16 _mb_of_ntx[] = {
|
0, /* 1TX */
|
301, /* 2TX */
|
477, /* 3TX */
|
602, /* 4TX */
|
699, /* 5TX */
|
778, /* 6TX */
|
845, /* 7TX */
|
903, /* 8TX */
|
};
|
|
/* get mB(100 *dB) for specifc TX count relative to 1TX */
|
s16 mb_of_ntx(u8 ntx)
|
{
|
if (ntx == 0 || ntx > 8) {
|
RTW_ERR("ntx=%u, out of range\n", ntx);
|
rtw_warn_on(1);
|
}
|
|
return _mb_of_ntx[ntx - 1];
|
}
|
|
#if CONFIG_TXPWR_LIMIT
|
void dump_regd_exc_list(void *sel, struct rf_ctl_t *rfctl)
|
{
|
/* TODO: get from phl */
|
}
|
|
void dump_txpwr_lmt(void *sel, _adapter *adapter)
|
{
|
/* TODO: get from phl */
|
}
|
#endif /* CONFIG_TXPWR_LIMIT */
|
|
bool rtw_is_long_cac_range(u32 hi, u32 lo, u8 dfs_region)
|
{
|
return (dfs_region == RTW_DFS_REGD_ETSI && rtw_is_range_overlap(hi, lo, 5650, 5600)) ? _TRUE : _FALSE;
|
}
|
|
bool rtw_is_long_cac_ch(u8 ch, u8 bw, u8 offset, u8 dfs_region)
|
{
|
u32 hi, lo;
|
|
if (rtw_chbw_to_freq_range(ch, bw, offset, &hi, &lo) == _FALSE)
|
return _FALSE;
|
|
return rtw_is_long_cac_range(hi, lo, dfs_region) ? _TRUE : _FALSE;
|
}
|
