+++ /dev/null
-/*
- * Misc utility routines used by kernel or app-level.
- * Contents are wifi-specific, used by any kernel or app-level
- * software that might want wifi things as it grows.
- *
- * Copyright (C) 1999-2019, Broadcom.
- *
- * Unless you and Broadcom execute a separate written software license
- * agreement governing use of this software, this software is licensed to you
- * under the terms of the GNU General Public License version 2 (the "GPL"),
- * available at http://www.broadcom.com/licenses/GPLv2.php, with the
- * following added to such license:
- *
- * As a special exception, the copyright holders of this software give you
- * permission to link this software with independent modules, and to copy and
- * distribute the resulting executable under terms of your choice, provided that
- * you also meet, for each linked independent module, the terms and conditions of
- * the license of that module. An independent module is a module which is not
- * derived from this software. The special exception does not apply to any
- * modifications of the software.
- *
- * Notwithstanding the above, under no circumstances may you combine this
- * software in any way with any other Broadcom software provided under a license
- * other than the GPL, without Broadcom's express prior written consent.
- *
- *
- * <<Broadcom-WL-IPTag/Open:>>
- *
- * $Id: bcmwifi_channels.c 806092 2019-02-21 08:19:13Z $
- */
-
-#include <bcm_cfg.h>
-#include <typedefs.h>
-#include <bcmutils.h>
-
-#ifdef BCMDRIVER
-#include <osl.h>
-#define strtoul(nptr, endptr, base) bcm_strtoul((nptr), (endptr), (base))
-#define tolower(c) (bcm_isupper((c)) ? ((c) + 'a' - 'A') : (c))
-#else
-#include <stdio.h>
-#include <stdlib.h>
-#include <ctype.h>
-#ifndef ASSERT
-#define ASSERT(exp)
-#endif // endif
-#endif /* BCMDRIVER */
-
-#include <bcmwifi_channels.h>
-
-#if defined(WIN32) && (defined(BCMDLL) || defined(WLMDLL))
-#include <bcmstdlib.h> /* For wl/exe/GNUmakefile.brcm_wlu and GNUmakefile.wlm_dll */
-#endif // endif
-
-#include <802.11.h>
-
-/* Definitions for D11AC capable (80MHz+) Chanspec type */
-
-/* Chanspec ASCII representation:
- * [<band> 'g'] <channel> ['/'<bandwidth> [<primary-sideband>]['/'<1st80channel>'-'<2nd80channel>]]
- *
- * <band>:
- * (optional) 2, 3, 4, 5 for 2.4GHz, 3GHz, 4GHz, and 5GHz respectively.
- * Default value is 2g if channel <= 14, otherwise 5g.
- * <channel>:
- * channel number of the 5MHz, 10MHz, 20MHz channel,
- * or primary channel of 40MHz, 80MHz, 160MHz, or 80+80MHz channel.
- * <bandwidth>:
- * (optional) 5, 10, 20, 40, 80, 160, or 80+80. Default value is 20.
- * <primary-sideband>:
- * (only for 2.4GHz band 40MHz) U for upper sideband primary, L for lower.
- *
- * For 2.4GHz band 40MHz channels, the same primary channel may be the
- * upper sideband for one 40MHz channel, and the lower sideband for an
- * overlapping 40MHz channel. The U/L disambiguates which 40MHz channel
- * is being specified.
- *
- * For 40MHz in the 5GHz band and all channel bandwidths greater than
- * 40MHz, the U/L specificaion is not allowed since the channels are
- * non-overlapping and the primary sub-band is derived from its
- * position in the wide bandwidth channel.
- *
- * <1st80Channel>:
- * <2nd80Channel>:
- * Required for 80+80, otherwise not allowed.
- * Specifies the center channel of the primary and secondary 80MHz band.
- *
- * In its simplest form, it is a 20MHz channel number, with the implied band
- * of 2.4GHz if channel number <= 14, and 5GHz otherwise.
- *
- * To allow for backward compatibility with scripts, the old form for
- * 40MHz channels is also allowed: <channel><primary-sideband>
- *
- * <channel>:
- * primary channel of 40MHz, channel <= 14 is 2GHz, otherwise 5GHz
- * <primary-sideband>:
- * "U" for upper, "L" for lower (or lower case "u" "l")
- *
- * 5 GHz Examples:
- * Chanspec BW Center Ch Channel Range Primary Ch
- * 5g8 20MHz 8 - -
- * 52 20MHz 52 - -
- * 52/40 40MHz 54 52-56 52
- * 56/40 40MHz 54 52-56 56
- * 52/80 80MHz 58 52-64 52
- * 56/80 80MHz 58 52-64 56
- * 60/80 80MHz 58 52-64 60
- * 64/80 80MHz 58 52-64 64
- * 52/160 160MHz 50 36-64 52
- * 36/160 160MGz 50 36-64 36
- * 36/80+80/42-106 80+80MHz 42,106 36-48,100-112 36
- *
- * 2 GHz Examples:
- * Chanspec BW Center Ch Channel Range Primary Ch
- * 2g8 20MHz 8 - -
- * 8 20MHz 8 - -
- * 6 20MHz 6 - -
- * 6/40l 40MHz 8 6-10 6
- * 6l 40MHz 8 6-10 6
- * 6/40u 40MHz 4 2-6 6
- * 6u 40MHz 4 2-6 6
- */
-
-/* bandwidth ASCII string */
-static const char *wf_chspec_bw_str[] =
-{
- "5",
- "10",
- "20",
- "40",
- "80",
- "160",
- "80+80",
- "na"
-};
-
-static const uint8 wf_chspec_bw_mhz[] =
-{5, 10, 20, 40, 80, 160, 160};
-
-#define WF_NUM_BW \
- (sizeof(wf_chspec_bw_mhz)/sizeof(uint8))
-
-/* 40MHz channels in 5GHz band */
-static const uint8 wf_5g_40m_chans[] =
-{38, 46, 54, 62, 102, 110, 118, 126, 134, 142, 151, 159, 167, 175};
-#define WF_NUM_5G_40M_CHANS \
- (sizeof(wf_5g_40m_chans)/sizeof(uint8))
-
-/* 80MHz channels in 5GHz band */
-static const uint8 wf_5g_80m_chans[] =
-{42, 58, 106, 122, 138, 155, 171};
-#define WF_NUM_5G_80M_CHANS \
- (sizeof(wf_5g_80m_chans)/sizeof(uint8))
-
-/* 160MHz channels in 5GHz band */
-static const uint8 wf_5g_160m_chans[] =
-{50, 114};
-#define WF_NUM_5G_160M_CHANS \
- (sizeof(wf_5g_160m_chans)/sizeof(uint8))
-
-/* opclass and channel information for US. Table E-1 */
-static const uint16 opclass_data[] = {
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_5)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_5)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_10)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_10)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_2G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_3G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_3G |((WL_CHANSPEC_BW_10)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_3G |((WL_CHANSPEC_BW_5)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_5)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_10)&WL_CHANSPEC_BW_MASK)),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_20)&WL_CHANSPEC_BW_MASK)),
- 0,
- 0,
- 0,
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
- (WL_CHANSPEC_BAND_5G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
- (WL_CHANSPEC_BAND_2G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_LOWER),
- (WL_CHANSPEC_BAND_2G |((WL_CHANSPEC_BW_40)&WL_CHANSPEC_BW_MASK)|WL_CHANSPEC_CTL_SB_UPPER),
-};
-
-/**
- * Return the chanspec bandwidth in MHz
- * Bandwidth of 160 MHz will be returned for 80+80MHz chanspecs.
- *
- * @param chspec chanspec_t
- *
- * @return bandwidth of chspec in MHz units
- */
-uint
-wf_bw_chspec_to_mhz(chanspec_t chspec)
-{
- uint bw;
-
- bw = (chspec & WL_CHANSPEC_BW_MASK) >> WL_CHANSPEC_BW_SHIFT;
- return (bw >= WF_NUM_BW ? 0 : wf_chspec_bw_mhz[bw]);
-}
-
-/* bw in MHz, return the channel count from the center channel to the
- * the channel at the edge of the band
- */
-static uint8
-center_chan_to_edge(uint bw)
-{
- /* edge channels separated by BW - 10MHz on each side
- * delta from cf to edge is half of that,
- * MHz to channel num conversion is 5MHz/channel
- */
- return (uint8)(((bw - 20) / 2) / 5);
-}
-
-/* return channel number of the low edge of the band
- * given the center channel and BW
- */
-static uint8
-channel_low_edge(uint center_ch, uint bw)
-{
- return (uint8)(center_ch - center_chan_to_edge(bw));
-}
-
-/* return side band number given center channel and primary20 channel
- * return -1 on error
- */
-static int
-channel_to_sb(uint center_ch, uint primary_ch, uint bw)
-{
- uint lowest = channel_low_edge(center_ch, bw);
- uint sb;
-
- if ((primary_ch - lowest) % 4) {
- /* bad primary channel, not mult 4 */
- return -1;
- }
-
- sb = ((primary_ch - lowest) / 4);
-
- /* sb must be a index to a 20MHz channel in range */
- if (sb >= (bw / 20)) {
- /* primary_ch must have been too high for the center_ch */
- return -1;
- }
-
- return (int)sb;
-}
-
-/* return primary20 channel given center channel and side band */
-static uint8
-channel_to_primary20_chan(uint center_ch, uint bw, uint sb)
-{
- return (uint8)(channel_low_edge(center_ch, bw) + sb * 4);
-}
-
-/* return index of 80MHz channel from channel number
- * return -1 on error
- */
-static int
-channel_80mhz_to_id(uint ch)
-{
- uint i;
- for (i = 0; i < WF_NUM_5G_80M_CHANS; i ++) {
- if (ch == wf_5g_80m_chans[i])
- return (int)i;
- }
-
- return -1;
-}
-
-/* wrapper function for wf_chspec_ntoa. In case of an error it puts
- * the original chanspec in the output buffer, prepended with "invalid".
- * Can be directly used in print routines as it takes care of null
- */
-char *
-wf_chspec_ntoa_ex(chanspec_t chspec, char *buf)
-{
- if (wf_chspec_ntoa(chspec, buf) == NULL)
- snprintf(buf, CHANSPEC_STR_LEN, "invalid 0x%04x", chspec);
- return buf;
-}
-
-/* given a chanspec and a string buffer, format the chanspec as a
- * string, and return the original pointer a.
- * Min buffer length must be CHANSPEC_STR_LEN.
- * On error return NULL
- */
-char *
-wf_chspec_ntoa(chanspec_t chspec, char *buf)
-{
- const char *band;
- uint pri_chan;
-
- if (wf_chspec_malformed(chspec))
- return NULL;
-
- band = "";
-
- /* check for non-default band spec */
- if ((CHSPEC_IS2G(chspec) && CHSPEC_CHANNEL(chspec) > CH_MAX_2G_CHANNEL) ||
- (CHSPEC_IS5G(chspec) && CHSPEC_CHANNEL(chspec) <= CH_MAX_2G_CHANNEL))
- band = (CHSPEC_IS2G(chspec)) ? "2g" : "5g";
-
- /* primary20 channel */
- pri_chan = wf_chspec_primary20_chan(chspec);
-
- /* bandwidth and primary20 sideband */
- if (CHSPEC_IS20(chspec)) {
- snprintf(buf, CHANSPEC_STR_LEN, "%s%d", band, pri_chan);
- } else if (!CHSPEC_IS8080(chspec)) {
- const char *bw;
- const char *sb = "";
-
- bw = wf_chspec_to_bw_str(chspec);
-
-#ifdef CHANSPEC_NEW_40MHZ_FORMAT
- /* primary20 sideband string if needed for 2g 40MHz */
- if (CHSPEC_IS40(chspec) && CHSPEC_IS2G(chspec)) {
- sb = CHSPEC_SB_UPPER(chspec) ? "u" : "l";
- }
-
- snprintf(buf, CHANSPEC_STR_LEN, "%s%d/%s%s", band, pri_chan, bw, sb);
-#else
- /* primary20 sideband string instead of BW for 40MHz */
- if (CHSPEC_IS40(chspec)) {
- sb = CHSPEC_SB_UPPER(chspec) ? "u" : "l";
- snprintf(buf, CHANSPEC_STR_LEN, "%s%d%s", band, pri_chan, sb);
- } else {
- snprintf(buf, CHANSPEC_STR_LEN, "%s%d/%s", band, pri_chan, bw);
- }
-#endif /* CHANSPEC_NEW_40MHZ_FORMAT */
-
- } else {
- /* 80+80 */
- uint chan1 = (chspec & WL_CHANSPEC_CHAN1_MASK) >> WL_CHANSPEC_CHAN1_SHIFT;
- uint chan2 = (chspec & WL_CHANSPEC_CHAN2_MASK) >> WL_CHANSPEC_CHAN2_SHIFT;
-
- /* convert to channel number */
- chan1 = (chan1 < WF_NUM_5G_80M_CHANS) ? wf_5g_80m_chans[chan1] : 0;
- chan2 = (chan2 < WF_NUM_5G_80M_CHANS) ? wf_5g_80m_chans[chan2] : 0;
-
- /* Outputs a max of CHANSPEC_STR_LEN chars including '\0' */
- snprintf(buf, CHANSPEC_STR_LEN, "%d/80+80/%d-%d", pri_chan, chan1, chan2);
- }
-
- return (buf);
-}
-
-static int
-read_uint(const char **p, unsigned int *num)
-{
- unsigned long val;
- char *endp = NULL;
-
- val = strtoul(*p, &endp, 10);
- /* if endp is the initial pointer value, then a number was not read */
- if (endp == *p)
- return 0;
-
- /* advance the buffer pointer to the end of the integer string */
- *p = endp;
- /* return the parsed integer */
- *num = (unsigned int)val;
-
- return 1;
-}
-
-/* given a chanspec string, convert to a chanspec.
- * On error return 0
- */
-chanspec_t
-wf_chspec_aton(const char *a)
-{
- chanspec_t chspec;
- uint chspec_ch, chspec_band, bw, chspec_bw, chspec_sb;
- uint num, pri_ch;
- uint ch1, ch2;
- char c, sb_ul = '\0';
- int i;
-
- bw = 20;
- chspec_sb = 0;
- chspec_ch = ch1 = ch2 = 0;
-
- /* parse channel num or band */
- if (!read_uint(&a, &num))
- return 0;
- /* if we are looking at a 'g', then the first number was a band */
- c = tolower(a[0]);
- if (c == 'g') {
- a++; /* consume the char */
-
- /* band must be "2" or "5" */
- if (num == 2)
- chspec_band = WL_CHANSPEC_BAND_2G;
- else if (num == 5)
- chspec_band = WL_CHANSPEC_BAND_5G;
- else
- return 0;
-
- /* read the channel number */
- if (!read_uint(&a, &pri_ch))
- return 0;
-
- c = tolower(a[0]);
- }
- else {
- /* first number is channel, use default for band */
- pri_ch = num;
- chspec_band = ((pri_ch <= CH_MAX_2G_CHANNEL) ?
- WL_CHANSPEC_BAND_2G : WL_CHANSPEC_BAND_5G);
- }
-
- if (c == '\0') {
- /* default BW of 20MHz */
- chspec_bw = WL_CHANSPEC_BW_20;
- goto done_read;
- }
-
- a ++; /* consume the 'u','l', or '/' */
-
- /* check 'u'/'l' */
- if (c == 'u' || c == 'l') {
- sb_ul = c;
- chspec_bw = WL_CHANSPEC_BW_40;
- goto done_read;
- }
-
- /* next letter must be '/' */
- if (c != '/')
- return 0;
-
- /* read bandwidth */
- if (!read_uint(&a, &bw))
- return 0;
-
- /* convert to chspec value */
- if (bw == 5) {
- chspec_bw = WL_CHANSPEC_BW_5;
- } else if (bw == 10) {
- chspec_bw = WL_CHANSPEC_BW_10;
- } else if (bw == 20) {
- chspec_bw = WL_CHANSPEC_BW_20;
- } else if (bw == 40) {
- chspec_bw = WL_CHANSPEC_BW_40;
- } else if (bw == 80) {
- chspec_bw = WL_CHANSPEC_BW_80;
- } else if (bw == 160) {
- chspec_bw = WL_CHANSPEC_BW_160;
- } else {
- return 0;
- }
-
- /* So far we have <band>g<chan>/<bw>
- * Can now be followed by u/l if bw = 40,
- * or '+80' if bw = 80, to make '80+80' bw.
- */
-
- c = (char)tolower((int)a[0]);
-
- /* if we have a 2g/40 channel, we should have a l/u spec now */
- if (chspec_band == WL_CHANSPEC_BAND_2G && bw == 40) {
- if (c == 'u' || c == 'l') {
- a ++; /* consume the u/l char */
- sb_ul = c;
- goto done_read;
- }
- }
-
- /* check for 80+80 */
- if (c == '+') {
- /* 80+80 */
- const char plus80[] = "80/";
-
- /* must be looking at '+80/'
- * check and consume this string.
- */
- chspec_bw = WL_CHANSPEC_BW_8080;
-
- a ++; /* consume the char '+' */
-
- /* consume the '80/' string */
- for (i = 0; i < 3; i++) {
- if (*a++ != plus80[i]) {
- return 0;
- }
- }
-
- /* read primary 80MHz channel */
- if (!read_uint(&a, &ch1))
- return 0;
-
- /* must followed by '-' */
- if (a[0] != '-')
- return 0;
- a ++; /* consume the char */
-
- /* read secondary 80MHz channel */
- if (!read_uint(&a, &ch2))
- return 0;
- }
-
-done_read:
- /* skip trailing white space */
- while (a[0] == ' ') {
- a ++;
- }
-
- /* must be end of string */
- if (a[0] != '\0')
- return 0;
-
- /* Now have all the chanspec string parts read;
- * chspec_band, pri_ch, chspec_bw, sb_ul, ch1, ch2.
- * chspec_band and chspec_bw are chanspec values.
- * Need to convert pri_ch, sb_ul, and ch1,ch2 into
- * a center channel (or two) and sideband.
- */
-
- /* if a sb u/l string was given, just use that,
- * guaranteed to be bw = 40 by sting parse.
- */
- if (sb_ul != '\0') {
- if (sb_ul == 'l') {
- chspec_ch = UPPER_20_SB(pri_ch);
- chspec_sb = WL_CHANSPEC_CTL_SB_LLL;
- } else if (sb_ul == 'u') {
- chspec_ch = LOWER_20_SB(pri_ch);
- chspec_sb = WL_CHANSPEC_CTL_SB_LLU;
- }
- }
- /* if the bw is 20, center and sideband are trivial */
- else if (chspec_bw == WL_CHANSPEC_BW_20) {
- chspec_ch = pri_ch;
- chspec_sb = WL_CHANSPEC_CTL_SB_NONE;
- }
- /* if the bw is 40/80/160, not 80+80, a single method
- * can be used to to find the center and sideband
- */
- else if (chspec_bw != WL_CHANSPEC_BW_8080) {
- /* figure out primary20 sideband based on primary20 channel and bandwidth */
- const uint8 *center_ch = NULL;
- int num_ch = 0;
- int sb = -1;
-
- if (chspec_bw == WL_CHANSPEC_BW_40) {
- center_ch = wf_5g_40m_chans;
- num_ch = WF_NUM_5G_40M_CHANS;
- } else if (chspec_bw == WL_CHANSPEC_BW_80) {
- center_ch = wf_5g_80m_chans;
- num_ch = WF_NUM_5G_80M_CHANS;
- } else if (chspec_bw == WL_CHANSPEC_BW_160) {
- center_ch = wf_5g_160m_chans;
- num_ch = WF_NUM_5G_160M_CHANS;
- } else {
- return 0;
- }
-
- for (i = 0; i < num_ch; i ++) {
- sb = channel_to_sb(center_ch[i], pri_ch, bw);
- if (sb >= 0) {
- chspec_ch = center_ch[i];
- chspec_sb = (uint)(sb << WL_CHANSPEC_CTL_SB_SHIFT);
- break;
- }
- }
-
- /* check for no matching sb/center */
- if (sb < 0) {
- return 0;
- }
- }
- /* Otherwise, bw is 80+80. Figure out channel pair and sb */
- else {
- int ch1_id = 0, ch2_id = 0;
- int sb;
-
- /* look up the channel ID for the specified channel numbers */
- ch1_id = channel_80mhz_to_id(ch1);
- ch2_id = channel_80mhz_to_id(ch2);
-
- /* validate channels */
- if (ch1_id < 0 || ch2_id < 0)
- return 0;
-
- /* combine 2 channel IDs in channel field of chspec */
- chspec_ch = (((uint)ch1_id << WL_CHANSPEC_CHAN1_SHIFT) |
- ((uint)ch2_id << WL_CHANSPEC_CHAN2_SHIFT));
-
- /* figure out primary 20 MHz sideband */
-
- /* is the primary channel contained in the 1st 80MHz channel? */
- sb = channel_to_sb(ch1, pri_ch, bw);
- if (sb < 0) {
- /* no match for primary channel 'pri_ch' in segment0 80MHz channel */
- return 0;
- }
-
- chspec_sb = (uint)(sb << WL_CHANSPEC_CTL_SB_SHIFT);
- }
-
- chspec = (chanspec_t)(chspec_ch | chspec_band | chspec_bw | chspec_sb);
-
- if (wf_chspec_malformed(chspec))
- return 0;
-
- return chspec;
-}
-
-/*
- * Verify the chanspec is using a legal set of parameters, i.e. that the
- * chanspec specified a band, bw, pri_sb and channel and that the
- * combination could be legal given any set of circumstances.
- * RETURNS: TRUE is the chanspec is malformed, false if it looks good.
- */
-bool
-wf_chspec_malformed(chanspec_t chanspec)
-{
- uint chspec_bw = CHSPEC_BW(chanspec);
- uint chspec_ch = CHSPEC_CHANNEL(chanspec);
-
- /* must be 2G or 5G band */
- if (CHSPEC_IS2G(chanspec)) {
- /* must be valid bandwidth */
- if (!BW_LE40(chspec_bw)) {
- return TRUE;
- }
- } else if (CHSPEC_IS5G(chanspec)) {
- if (chspec_bw == WL_CHANSPEC_BW_8080) {
- uint ch1_id, ch2_id;
-
- /* channel IDs in 80+80 must be in range */
- ch1_id = CHSPEC_CHAN1(chanspec);
- ch2_id = CHSPEC_CHAN2(chanspec);
- if (ch1_id >= WF_NUM_5G_80M_CHANS || ch2_id >= WF_NUM_5G_80M_CHANS)
- return TRUE;
-
- } else if (chspec_bw == WL_CHANSPEC_BW_20 || chspec_bw == WL_CHANSPEC_BW_40 ||
- chspec_bw == WL_CHANSPEC_BW_80 || chspec_bw == WL_CHANSPEC_BW_160) {
-
- if (chspec_ch > MAXCHANNEL) {
- return TRUE;
- }
- } else {
- /* invalid bandwidth */
- return TRUE;
- }
- } else {
- /* must be 2G or 5G band */
- return TRUE;
- }
-
- /* side band needs to be consistent with bandwidth */
- if (chspec_bw == WL_CHANSPEC_BW_20) {
- if (CHSPEC_CTL_SB(chanspec) != WL_CHANSPEC_CTL_SB_LLL)
- return TRUE;
- } else if (chspec_bw == WL_CHANSPEC_BW_40) {
- if (CHSPEC_CTL_SB(chanspec) > WL_CHANSPEC_CTL_SB_LLU)
- return TRUE;
- } else if (chspec_bw == WL_CHANSPEC_BW_80 ||
- chspec_bw == WL_CHANSPEC_BW_8080) {
- /* both 80MHz and 80+80MHz use 80MHz side bands.
- * 80+80 SB info is relative to the primary 80MHz sub-band.
- */
- if (CHSPEC_CTL_SB(chanspec) > WL_CHANSPEC_CTL_SB_LUU)
- return TRUE;
- }
- else if (chspec_bw == WL_CHANSPEC_BW_160) {
- ASSERT(CHSPEC_CTL_SB(chanspec) <= WL_CHANSPEC_CTL_SB_UUU);
- }
- return FALSE;
-}
-
-/*
- * Verify the chanspec specifies a valid channel according to 802.11.
- * RETURNS: TRUE if the chanspec is a valid 802.11 channel
- */
-bool
-wf_chspec_valid(chanspec_t chanspec)
-{
- uint chspec_bw = CHSPEC_BW(chanspec);
- uint chspec_ch = CHSPEC_CHANNEL(chanspec);
-
- if (wf_chspec_malformed(chanspec))
- return FALSE;
-
- if (CHSPEC_IS2G(chanspec)) {
- /* must be valid bandwidth and channel range */
- if (chspec_bw == WL_CHANSPEC_BW_20) {
- if (chspec_ch >= 1 && chspec_ch <= 14)
- return TRUE;
- } else if (chspec_bw == WL_CHANSPEC_BW_40) {
- if (chspec_ch >= 3 && chspec_ch <= 11)
- return TRUE;
- }
- } else if (CHSPEC_IS5G(chanspec)) {
- if (chspec_bw == WL_CHANSPEC_BW_8080) {
- uint16 ch1, ch2;
-
- ch1 = wf_5g_80m_chans[CHSPEC_CHAN1(chanspec)];
- ch2 = wf_5g_80m_chans[CHSPEC_CHAN2(chanspec)];
-
- /* the two channels must be separated by more than 80MHz by VHT req */
- if ((ch2 > ch1 + CH_80MHZ_APART) ||
- (ch1 > ch2 + CH_80MHZ_APART))
- return TRUE;
- } else {
- const uint8 *center_ch;
- uint num_ch, i;
-
- if (chspec_bw == WL_CHANSPEC_BW_20 || chspec_bw == WL_CHANSPEC_BW_40) {
- center_ch = wf_5g_40m_chans;
- num_ch = WF_NUM_5G_40M_CHANS;
- } else if (chspec_bw == WL_CHANSPEC_BW_80) {
- center_ch = wf_5g_80m_chans;
- num_ch = WF_NUM_5G_80M_CHANS;
- } else if (chspec_bw == WL_CHANSPEC_BW_160) {
- center_ch = wf_5g_160m_chans;
- num_ch = WF_NUM_5G_160M_CHANS;
- } else {
- /* invalid bandwidth */
- return FALSE;
- }
-
- /* check for a valid center channel */
- if (chspec_bw == WL_CHANSPEC_BW_20) {
- /* We don't have an array of legal 20MHz 5G channels, but they are
- * each side of the legal 40MHz channels. Check the chanspec
- * channel against either side of the 40MHz channels.
- */
- for (i = 0; i < num_ch; i ++) {
- if (chspec_ch == (uint)LOWER_20_SB(center_ch[i]) ||
- chspec_ch == (uint)UPPER_20_SB(center_ch[i]))
- break; /* match found */
- }
-
- if (i == num_ch) {
- /* check for channel 165 which is not the side band
- * of 40MHz 5G channel
- */
- if (chspec_ch == 165)
- i = 0;
-
- /* check for legacy JP channels on failure */
- if (chspec_ch == 34 || chspec_ch == 38 ||
- chspec_ch == 42 || chspec_ch == 46)
- i = 0;
- }
- } else {
- /* check the chanspec channel to each legal channel */
- for (i = 0; i < num_ch; i ++) {
- if (chspec_ch == center_ch[i])
- break; /* match found */
- }
- }
-
- if (i < num_ch) {
- /* match found */
- return TRUE;
- }
- }
- }
-
- return FALSE;
-}
-
-/*
- * This function returns TRUE if both the chanspec can co-exist in PHY.
- * Addition to primary20 channel, the function checks for side band for 2g 40 channels
- */
-bool
-wf_chspec_coexist(chanspec_t chspec1, chanspec_t chspec2)
-{
- bool same_primary;
-
- same_primary = (wf_chspec_primary20_chan(chspec1) == wf_chspec_primary20_chan(chspec2));
-
- if (same_primary && CHSPEC_IS2G(chspec1)) {
- if (CHSPEC_IS40(chspec1) && CHSPEC_IS40(chspec2)) {
- return (CHSPEC_CTL_SB(chspec1) == CHSPEC_CTL_SB(chspec2));
- }
- }
- return same_primary;
-}
-
-/**
- * Create a 20MHz chanspec for the given band.
- *
- * This function returns a 20MHz chanspec in the given band.
- *
- * @param channel 20MHz channel number
- * @param band a chanspec band (e.g. WL_CHANSPEC_BAND_2G)
- *
- * @return Returns a 20MHz chanspec, or IVNCHANSPEC in case of error.
- */
-chanspec_t
-wf_create_20MHz_chspec(uint channel, chanspec_band_t band)
-{
- chanspec_t chspec;
-
- if (channel <= WL_CHANSPEC_CHAN_MASK &&
- (band == WL_CHANSPEC_BAND_2G ||
- band == WL_CHANSPEC_BAND_5G)) {
- chspec = band | WL_CHANSPEC_BW_20 | WL_CHANSPEC_CTL_SB_NONE | channel;
- if (!wf_chspec_valid(chspec)) {
- chspec = INVCHANSPEC;
- }
- } else {
- chspec = INVCHANSPEC;
- }
-
- return chspec;
-}
-
-/**
- * Return the primary 20MHz channel.
- *
- * This function returns the channel number of the primary 20MHz channel. For
- * 20MHz channels this is just the channel number. For 40MHz or wider channels
- * it is the primary 20MHz channel specified by the chanspec.
- *
- * @param chspec input chanspec
- *
- * @return Returns the channel number of the primary 20MHz channel
- */
-uint8
-wf_chspec_primary20_chan(chanspec_t chspec)
-{
- uint center_chan;
- uint bw_mhz;
- uint sb;
-
- ASSERT(!wf_chspec_malformed(chspec));
-
- /* Is there a sideband ? */
- if (CHSPEC_IS20(chspec)) {
- return CHSPEC_CHANNEL(chspec);
- } else {
- sb = CHSPEC_CTL_SB(chspec) >> WL_CHANSPEC_CTL_SB_SHIFT;
-
- if (CHSPEC_IS8080(chspec)) {
- /* For an 80+80 MHz channel, the sideband 'sb' field is an 80 MHz sideband
- * (LL, LU, UL, LU) for the 80 MHz frequency segment 0.
- */
- uint chan_id = CHSPEC_CHAN1(chspec);
-
- bw_mhz = 80;
-
- /* convert from channel index to channel number */
- center_chan = wf_5g_80m_chans[chan_id];
- }
- else {
- bw_mhz = wf_bw_chspec_to_mhz(chspec);
- center_chan = CHSPEC_CHANNEL(chspec) >> WL_CHANSPEC_CHAN_SHIFT;
- }
-
- return (channel_to_primary20_chan(center_chan, bw_mhz, sb));
- }
-}
-
-/* given a chanspec, return the bandwidth string */
-const char *
-BCMRAMFN(wf_chspec_to_bw_str)(chanspec_t chspec)
-{
- return wf_chspec_bw_str[(CHSPEC_BW(chspec) >> WL_CHANSPEC_BW_SHIFT)];
-}
-
-/*
- * Return the primary 20MHz chanspec of the given chanspec
- */
-chanspec_t
-wf_chspec_primary20_chspec(chanspec_t chspec)
-{
- chanspec_t pri_chspec = chspec;
- uint8 pri_chan;
-
- ASSERT(!wf_chspec_malformed(chspec));
-
- /* Is there a sideband ? */
- if (!CHSPEC_IS20(chspec)) {
- pri_chan = wf_chspec_primary20_chan(chspec);
- pri_chspec = pri_chan | WL_CHANSPEC_BW_20;
- pri_chspec |= CHSPEC_BAND(chspec);
- }
- return pri_chspec;
-}
-
-/* return chanspec given primary 20MHz channel and bandwidth
- * return 0 on error
- */
-uint16
-wf_channel2chspec(uint pri_ch, uint bw)
-{
- uint16 chspec;
- const uint8 *center_ch = NULL;
- int num_ch = 0;
- int sb = -1;
- int i = 0;
-
- chspec = ((pri_ch <= CH_MAX_2G_CHANNEL) ? WL_CHANSPEC_BAND_2G : WL_CHANSPEC_BAND_5G);
-
- chspec |= bw;
-
- if (bw == WL_CHANSPEC_BW_40) {
- center_ch = wf_5g_40m_chans;
- num_ch = WF_NUM_5G_40M_CHANS;
- bw = 40;
- } else if (bw == WL_CHANSPEC_BW_80) {
- center_ch = wf_5g_80m_chans;
- num_ch = WF_NUM_5G_80M_CHANS;
- bw = 80;
- } else if (bw == WL_CHANSPEC_BW_160) {
- center_ch = wf_5g_160m_chans;
- num_ch = WF_NUM_5G_160M_CHANS;
- bw = 160;
- } else if (bw == WL_CHANSPEC_BW_20) {
- chspec |= pri_ch;
- return chspec;
- } else {
- return 0;
- }
-
- for (i = 0; i < num_ch; i ++) {
- sb = channel_to_sb(center_ch[i], pri_ch, bw);
- if (sb >= 0) {
- chspec |= center_ch[i];
- chspec |= (sb << WL_CHANSPEC_CTL_SB_SHIFT);
- break;
- }
- }
-
- /* check for no matching sb/center */
- if (sb < 0) {
- return 0;
- }
-
- return chspec;
-}
-
-/*
- * This function returns the chanspec for the primary 40MHz of an 80MHz or wider channel.
- * The primary 20MHz channel of the returned 40MHz chanspec is the same as the primary 20MHz
- * channel of the input chanspec.
- */
-extern chanspec_t wf_chspec_primary40_chspec(chanspec_t chspec)
-{
- chanspec_t chspec40 = chspec;
- uint center_chan;
- uint sb;
-
- ASSERT(!wf_chspec_malformed(chspec));
-
- /* if the chanspec is > 80MHz, use the helper routine to find the primary 80 MHz channel */
- if (CHSPEC_IS8080(chspec) || CHSPEC_IS160(chspec)) {
- chspec = wf_chspec_primary80_chspec(chspec);
- }
-
- /* determine primary 40 MHz sub-channel of an 80 MHz chanspec */
- if (CHSPEC_IS80(chspec)) {
- center_chan = CHSPEC_CHANNEL(chspec);
- sb = CHSPEC_CTL_SB(chspec);
-
- if (sb < WL_CHANSPEC_CTL_SB_UL) {
- /* Primary 40MHz is on lower side */
- center_chan -= CH_20MHZ_APART;
- /* sideband bits are the same for LL/LU and L/U */
- } else {
- /* Primary 40MHz is on upper side */
- center_chan += CH_20MHZ_APART;
- /* sideband bits need to be adjusted by UL offset */
- sb -= WL_CHANSPEC_CTL_SB_UL;
- }
-
- /* Create primary 40MHz chanspec */
- chspec40 = (chanspec_t)(WL_CHANSPEC_BAND_5G | WL_CHANSPEC_BW_40 |
- sb | center_chan);
- }
-
- return chspec40;
-}
-
-/*
- * Return the channel number for a given frequency and base frequency.
- * The returned channel number is relative to the given base frequency.
- * If the given base frequency is zero, a base frequency of 5 GHz is assumed for
- * frequencies from 5 - 6 GHz, and 2.407 GHz is assumed for 2.4 - 2.5 GHz.
- *
- * Frequency is specified in MHz.
- * The base frequency is specified as (start_factor * 500 kHz).
- * Constants WF_CHAN_FACTOR_2_4_G, WF_CHAN_FACTOR_5_G are defined for
- * 2.4 GHz and 5 GHz bands.
- *
- * The returned channel will be in the range [1, 14] in the 2.4 GHz band
- * and [0, 200] otherwise.
- * -1 is returned if the start_factor is WF_CHAN_FACTOR_2_4_G and the
- * frequency is not a 2.4 GHz channel, or if the frequency is not and even
- * multiple of 5 MHz from the base frequency to the base plus 1 GHz.
- *
- * Reference 802.11-2016, section 17.3.8.3 and section 16.3.6.3
- */
-int
-wf_mhz2channel(uint freq, uint start_factor)
-{
- int ch = -1;
- uint base;
- int offset;
-
- /* take the default channel start frequency */
- if (start_factor == 0) {
- if (freq >= 2400 && freq <= 2500)
- start_factor = WF_CHAN_FACTOR_2_4_G;
- else if (freq >= 5000 && freq <= 6000)
- start_factor = WF_CHAN_FACTOR_5_G;
- }
-
- if (freq == 2484 && start_factor == WF_CHAN_FACTOR_2_4_G)
- return 14;
-
- base = start_factor / 2;
-
- /* check that the frequency is in 1GHz range of the base */
- if ((freq < base) || (freq > base + 1000))
- return -1;
-
- offset = (int)(freq - base);
- ch = offset / 5;
-
- /* check that frequency is a 5MHz multiple from the base */
- if (offset != (ch * 5))
- return -1;
-
- /* restricted channel range check for 2.4G */
- if (start_factor == WF_CHAN_FACTOR_2_4_G && (ch < 1 || ch > 13))
- return -1;
-
- return ch;
-}
-
-/*
- * Return the center frequency in MHz of the given channel and base frequency.
- * The channel number is interpreted relative to the given base frequency.
- *
- * The valid channel range is [1, 14] in the 2.4 GHz band and [0, 200] otherwise.
- * The base frequency is specified as (start_factor * 500 kHz).
- * Constants WF_CHAN_FACTOR_2_4_G, WF_CHAN_FACTOR_4_G, and WF_CHAN_FACTOR_5_G
- * are defined for 2.4 GHz, 4 GHz, and 5 GHz bands.
- * The channel range of [1, 14] is only checked for a start_factor of
- * WF_CHAN_FACTOR_2_4_G (4814 = 2407 * 2).
- * Odd start_factors produce channels on .5 MHz boundaries, in which case
- * the answer is rounded down to an integral MHz.
- * -1 is returned for an out of range channel.
- *
- * Reference 802.11-2016, section 17.3.8.3 and section 16.3.6.3
- */
-int
-wf_channel2mhz(uint ch, uint start_factor)
-{
- int freq;
-
- if ((start_factor == WF_CHAN_FACTOR_2_4_G && (ch < 1 || ch > 14)) ||
- (ch > 200))
- freq = -1;
- else if ((start_factor == WF_CHAN_FACTOR_2_4_G) && (ch == 14))
- freq = 2484;
- else
- freq = (int)(ch * 5 + start_factor / 2);
-
- return freq;
-}
-
-static const uint16 sidebands[] = {
- WL_CHANSPEC_CTL_SB_LLL, WL_CHANSPEC_CTL_SB_LLU,
- WL_CHANSPEC_CTL_SB_LUL, WL_CHANSPEC_CTL_SB_LUU,
- WL_CHANSPEC_CTL_SB_ULL, WL_CHANSPEC_CTL_SB_ULU,
- WL_CHANSPEC_CTL_SB_UUL, WL_CHANSPEC_CTL_SB_UUU
-};
-
-/*
- * Returns the chanspec 80Mhz channel corresponding to the following input
- * parameters
- *
- * primary_channel - primary 20Mhz channel
- * center_channel - center frequecny of the 80Mhz channel
- *
- * The center_channel can be one of {42, 58, 106, 122, 138, 155}
- *
- * returns INVCHANSPEC in case of error
- */
-chanspec_t
-wf_chspec_80(uint8 center_channel, uint8 primary_channel)
-{
-
- chanspec_t chanspec = INVCHANSPEC;
- chanspec_t chanspec_cur;
- uint i;
-
- for (i = 0; i < WF_NUM_SIDEBANDS_80MHZ; i++) {
- chanspec_cur = CH80MHZ_CHSPEC(center_channel, sidebands[i]);
- if (primary_channel == wf_chspec_primary20_chan(chanspec_cur)) {
- chanspec = chanspec_cur;
- break;
- }
- }
- /* If the loop ended early, we are good, otherwise we did not
- * find a 80MHz chanspec with the given center_channel that had a primary channel
- *matching the given primary_channel.
- */
- return chanspec;
-}
-
-/*
- * Returns the 80+80 chanspec corresponding to the following input parameters
- *
- * primary_20mhz - Primary 20 MHz channel
- * chan0 - center channel number of one frequency segment
- * chan1 - center channel number of the other frequency segment
- *
- * Parameters chan0 and chan1 are channel numbers in {42, 58, 106, 122, 138, 155}.
- * The primary channel must be contained in one of the 80MHz channels. This routine
- * will determine which frequency segment is the primary 80 MHz segment.
- *
- * Returns INVCHANSPEC in case of error.
- *
- * Refer to 802.11-2016 section 22.3.14 "Channelization".
- */
-chanspec_t
-wf_chspec_get8080_chspec(uint8 primary_20mhz, uint8 chan0, uint8 chan1)
-{
- int sb = 0;
- uint16 chanspec = 0;
- int chan0_id = 0, chan1_id = 0;
- int seg0, seg1;
-
- chan0_id = channel_80mhz_to_id(chan0);
- chan1_id = channel_80mhz_to_id(chan1);
-
- /* make sure the channel numbers were valid */
- if (chan0_id == -1 || chan1_id == -1)
- return INVCHANSPEC;
-
- /* does the primary channel fit with the 1st 80MHz channel ? */
- sb = channel_to_sb(chan0, primary_20mhz, 80);
- if (sb >= 0) {
- /* yes, so chan0 is frequency segment 0, and chan1 is seg 1 */
- seg0 = chan0_id;
- seg1 = chan1_id;
- } else {
- /* no, so does the primary channel fit with the 2nd 80MHz channel ? */
- sb = channel_to_sb(chan1, primary_20mhz, 80);
- if (sb < 0) {
- /* no match for pri_ch to either 80MHz center channel */
- return INVCHANSPEC;
- }
- /* swapped, so chan1 is frequency segment 0, and chan0 is seg 1 */
- seg0 = chan1_id;
- seg1 = chan0_id;
- }
-
- chanspec = (uint16)((seg0 << WL_CHANSPEC_CHAN1_SHIFT) |
- (seg1 << WL_CHANSPEC_CHAN2_SHIFT) |
- (sb << WL_CHANSPEC_CTL_SB_SHIFT) |
- WL_CHANSPEC_BW_8080 |
- WL_CHANSPEC_BAND_5G);
-
- return chanspec;
-}
-
-/*
- * This function returns the 80Mhz channel for the given id.
- */
-static uint8
-wf_chspec_get80Mhz_ch(uint8 chan_80Mhz_id)
-{
- if (chan_80Mhz_id < WF_NUM_5G_80M_CHANS)
- return wf_5g_80m_chans[chan_80Mhz_id];
-
- return 0;
-}
-
-/*
- * Returns the center channel of the primary 80 MHz sub-band of the provided chanspec
- */
-uint8
-wf_chspec_primary80_channel(chanspec_t chanspec)
-{
- chanspec_t primary80_chspec;
- uint8 primary80_chan;
-
- primary80_chspec = wf_chspec_primary80_chspec(chanspec);
-
- if (primary80_chspec == INVCHANSPEC) {
- primary80_chan = INVCHANNEL;
- } else {
- primary80_chan = CHSPEC_CHANNEL(primary80_chspec);
- }
-
- return primary80_chan;
-}
-
-/*
- * Returns the center channel of the secondary 80 MHz sub-band of the provided chanspec
- */
-uint8
-wf_chspec_secondary80_channel(chanspec_t chanspec)
-{
- chanspec_t secondary80_chspec;
- uint8 secondary80_chan;
-
- secondary80_chspec = wf_chspec_secondary80_chspec(chanspec);
-
- if (secondary80_chspec == INVCHANSPEC) {
- secondary80_chan = INVCHANNEL;
- } else {
- secondary80_chan = CHSPEC_CHANNEL(secondary80_chspec);
- }
-
- return secondary80_chan;
-}
-
-/*
- * Returns the chanspec for the primary 80MHz sub-band of an 160MHz or 80+80 channel
- */
-chanspec_t
-wf_chspec_primary80_chspec(chanspec_t chspec)
-{
- chanspec_t chspec80;
- uint center_chan;
- uint sb;
-
- ASSERT(!wf_chspec_malformed(chspec));
-
- if (CHSPEC_IS80(chspec)) {
- chspec80 = chspec;
- }
- else if (CHSPEC_IS8080(chspec)) {
- sb = CHSPEC_CTL_SB(chspec);
-
- /* primary sub-band is stored in seg0 */
- center_chan = wf_chspec_get80Mhz_ch(CHSPEC_CHAN1(chspec));
-
- /* Create primary 80MHz chanspec */
- chspec80 = (chanspec_t)(WL_CHANSPEC_BAND_5G | WL_CHANSPEC_BW_80 | sb | center_chan);
- }
- else if (CHSPEC_IS160(chspec)) {
- center_chan = CHSPEC_CHANNEL(chspec);
- sb = CHSPEC_CTL_SB(chspec);
-
- if (sb < WL_CHANSPEC_CTL_SB_ULL) {
- /* Primary 80MHz is on lower side */
- center_chan -= CH_40MHZ_APART;
- }
- else {
- /* Primary 80MHz is on upper side */
- center_chan += CH_40MHZ_APART;
- sb -= WL_CHANSPEC_CTL_SB_ULL;
- }
-
- /* Create primary 80MHz chanspec */
- chspec80 = (chanspec_t)(WL_CHANSPEC_BAND_5G | WL_CHANSPEC_BW_80 | sb | center_chan);
- }
- else {
- chspec80 = INVCHANSPEC;
- }
-
- return chspec80;
-}
-
-/*
- * Returns the chanspec for the secondary 80MHz sub-band of an 160MHz or 80+80 channel
- */
-chanspec_t
-wf_chspec_secondary80_chspec(chanspec_t chspec)
-{
- chanspec_t chspec80;
- uint center_chan;
-
- ASSERT(!wf_chspec_malformed(chspec));
-
- if (CHSPEC_IS8080(chspec)) {
- /* secondary sub-band is stored in seg1 */
- center_chan = wf_chspec_get80Mhz_ch(CHSPEC_CHAN2(chspec));
-
- /* Create secondary 80MHz chanspec */
- chspec80 = (chanspec_t)(WL_CHANSPEC_BAND_5G |
- WL_CHANSPEC_BW_80 |
- WL_CHANSPEC_CTL_SB_LL |
- center_chan);
- }
- else if (CHSPEC_IS160(chspec)) {
- center_chan = CHSPEC_CHANNEL(chspec);
-
- if (CHSPEC_CTL_SB(chspec) < WL_CHANSPEC_CTL_SB_ULL) {
- /* Primary 80MHz is on lower side */
- center_chan -= CH_40MHZ_APART;
- }
- else {
- /* Primary 80MHz is on upper side */
- center_chan += CH_40MHZ_APART;
- }
-
- /* Create secondary 80MHz chanspec */
- chspec80 = (chanspec_t)(WL_CHANSPEC_BAND_5G |
- WL_CHANSPEC_BW_80 |
- WL_CHANSPEC_CTL_SB_LL |
- center_chan);
- }
- else {
- chspec80 = INVCHANSPEC;
- }
-
- return chspec80;
-}
-
-/*
- * For 160MHz or 80P80 chanspec, set ch[0]/ch[1] to be the low/high 80 Mhz channels
- *
- * For 20/40/80MHz chanspec, set ch[0] to be the center freq, and chan[1]=-1
- */
-void
-wf_chspec_get_80p80_channels(chanspec_t chspec, uint8 *ch)
-{
-
- if (CHSPEC_IS8080(chspec)) {
- ch[0] = wf_chspec_get80Mhz_ch(CHSPEC_CHAN1(chspec));
- ch[1] = wf_chspec_get80Mhz_ch(CHSPEC_CHAN2(chspec));
- }
- else if (CHSPEC_IS160(chspec)) {
- uint8 center_chan = CHSPEC_CHANNEL(chspec);
- ch[0] = center_chan - CH_40MHZ_APART;
- ch[1] = center_chan + CH_40MHZ_APART;
- }
- else {
- /* for 20, 40, and 80 Mhz */
- ch[0] = CHSPEC_CHANNEL(chspec);
- ch[1] = 0xFFu;
- }
- return;
-
-}
-
-#ifdef WL11AC_80P80
-uint8
-wf_chspec_channel(chanspec_t chspec)
-{
- if (CHSPEC_IS8080(chspec)) {
- return wf_chspec_primary80_channel(chspec);
- }
- else {
- return ((uint8)((chspec) & WL_CHANSPEC_CHAN_MASK));
- }
-}
-#endif /* WL11AC_80P80 */
-
-/* This routine returns the chanspec for a given operating class and
- * channel number
- */
-chanspec_t
-wf_channel_create_chspec_frm_opclass(uint8 opclass, uint8 channel)
-{
- chanspec_t chanspec = 0;
- uint16 opclass_info = 0;
- uint16 lookupindex = 0;
- switch (opclass) {
- case 115:
- lookupindex = 1;
- break;
- case 124:
- lookupindex = 3;
- break;
- case 125:
- lookupindex = 5;
- break;
- case 81:
- lookupindex = 12;
- break;
- case 116:
- lookupindex = 22;
- break;
- case 119:
- lookupindex = 23;
- break;
- case 126:
- lookupindex = 25;
- break;
- case 83:
- lookupindex = 32;
- break;
- case 84:
- lookupindex = 33;
- break;
- default:
- lookupindex = 12;
- }
-
- if (lookupindex < 33) {
- opclass_info = opclass_data[lookupindex-1];
- }
- else {
- opclass_info = opclass_data[11];
- }
- chanspec = opclass_info | (uint16)channel;
- return chanspec;
-}
-
-/* This routine returns the opclass for a given chanspec */
-int
-wf_channel_create_opclass_frm_chspec(chanspec_t chspec)
-{
- BCM_REFERENCE(chspec);
- /* TODO: Implement this function ! */
- return 12; /* opclass 12 for basic 2G channels */
-}
-
-/* Populates array with all 20MHz side bands of a given chanspec_t in the following order:
- * primary20, secondary20, two secondary40s, four secondary80s.
- * 'chspec' is the chanspec of interest
- * 'pext' must point to an uint8 array of long enough to hold all side bands of the given chspec
- *
- * Works with 20, 40, 80, 80p80 and 160MHz chspec
- */
-void
-wf_get_all_ext(chanspec_t chspec, uint8 *pext)
-{
-#ifdef WL11N_20MHZONLY
- GET_ALL_SB(chspec, pext);
-#else /* !WL11N_20MHZONLY */
- chanspec_t t = (CHSPEC_IS160(chspec) || CHSPEC_IS8080(chspec)) ? /* if bw > 80MHz */
- wf_chspec_primary80_chspec(chspec) : (chspec); /* extract primary 80 */
- /* primary20 channel as first element */
- uint8 pri_ch = (pext)[0] = wf_chspec_primary20_chan(t);
- if (CHSPEC_IS20(chspec)) return; /* nothing more to do since 20MHz chspec */
- /* 20MHz EXT */
- (pext)[1] = pri_ch + (uint8)(IS_CTL_IN_L20(t) ? CH_20MHZ_APART : -CH_20MHZ_APART);
- if (CHSPEC_IS40(chspec)) return; /* nothing more to do since 40MHz chspec */
- /* center 40MHz EXT */
- t = wf_channel2chspec((uint)(pri_ch + (IS_CTL_IN_L40(chspec) ?
- CH_40MHZ_APART : -CH_40MHZ_APART)), WL_CHANSPEC_BW_40);
- GET_ALL_SB(t, &((pext)[2])); /* get the 20MHz side bands in 40MHz EXT */
- if (CHSPEC_IS80(chspec)) return; /* nothing more to do since 80MHz chspec */
- t = CH80MHZ_CHSPEC(wf_chspec_secondary80_channel(chspec), WL_CHANSPEC_CTL_SB_LLL);
- /* get the 20MHz side bands in 80MHz EXT (secondary) */
- GET_ALL_SB(t, &((pext)[4]));
-#endif /* !WL11N_20MHZONLY */
-}
-
-/*
- * Given two chanspecs, returns true if they overlap.
- * (Overlap: At least one 20MHz subband is common between the two chanspecs provided)
- */
-bool wf_chspec_overlap(chanspec_t chspec0, chanspec_t chspec1)
-{
- uint8 ch0, ch1;
-
- FOREACH_20_SB(chspec0, ch0) {
- FOREACH_20_SB(chspec1, ch1) {
- if (ABS(ch0 - ch1) < CH_20MHZ_APART) {
- return TRUE;
- }
- }
- }
-
- return FALSE;
-}
-
-uint8
-channel_bw_to_width(chanspec_t chspec)
-{
- uint8 channel_width;
-
- if (CHSPEC_IS80(chspec))
- channel_width = VHT_OP_CHAN_WIDTH_80;
- else if (CHSPEC_IS160(chspec))
- channel_width = VHT_OP_CHAN_WIDTH_160;
- else if (CHSPEC_IS8080(chspec))
- channel_width = VHT_OP_CHAN_WIDTH_80_80;
- else
- channel_width = VHT_OP_CHAN_WIDTH_20_40;
-
- return channel_width;
-}
projects / GitHub / LineageOS / G12 / android_hardware_amlogic_kernel-modules_dhd-driver.git / blobdiff