linux-imx

/*

 * VHT handling

 *

 * Portions of this file

 * Copyright(c) 2015 - 2016 Intel Deutschland GmbH

 * Copyright (C) 2018 Intel Corporation

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 */

​

#include <linux/ieee80211.h>

#include <linux/export.h>

#include <net/mac80211.h>

#include "ieee80211_i.h"

#include "rate.h"

​

​

static void __check_vhtcap_disable(struct ieee80211_sub_if_data *sdata,

                   struct ieee80211_sta_vht_cap *vht_cap,

                   u32 flag)

{

    __le32 le_flag = cpu_to_le32(flag);

​

    if (sdata->u.mgd.vht_capa_mask.vht_cap_info & le_flag &&

        !(sdata->u.mgd.vht_capa.vht_cap_info & le_flag))

        vht_cap->cap &= ~flag;

}

​

void ieee80211_apply_vhtcap_overrides(struct ieee80211_sub_if_data *sdata,

                      struct ieee80211_sta_vht_cap *vht_cap)

{

    int i;

    u16 rxmcs_mask, rxmcs_cap, rxmcs_n, txmcs_mask, txmcs_cap, txmcs_n;

​

    if (!vht_cap->vht_supported)

        return;

​

    if (sdata->vif.type != NL80211_IFTYPE_STATION)

        return;

​

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_RXLDPC);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_SHORT_GI_80);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_SHORT_GI_160);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_TXSTBC);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_SU_BEAMFORMER_CAPABLE);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_SU_BEAMFORMEE_CAPABLE);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_RX_ANTENNA_PATTERN);

    __check_vhtcap_disable(sdata, vht_cap,

                   IEEE80211_VHT_CAP_TX_ANTENNA_PATTERN);

​

    /* Allow user to decrease AMPDU length exponent */

    if (sdata->u.mgd.vht_capa_mask.vht_cap_info &

        cpu_to_le32(IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK)) {

        u32 cap, n;

​

        n = le32_to_cpu(sdata->u.mgd.vht_capa.vht_cap_info) &

            IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;

        n >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;

        cap = vht_cap->cap & IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;

        cap >>= IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;

​

        if (n < cap) {

            vht_cap->cap &=

                ~IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_MASK;

            vht_cap->cap |=

                n << IEEE80211_VHT_CAP_MAX_A_MPDU_LENGTH_EXPONENT_SHIFT;

        }

    }

​

    /* Allow the user to decrease MCSes */

    rxmcs_mask =

        le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.rx_mcs_map);

    rxmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.rx_mcs_map);

    rxmcs_n &= rxmcs_mask;

    rxmcs_cap = le16_to_cpu(vht_cap->vht_mcs.rx_mcs_map);

​

    txmcs_mask =

        le16_to_cpu(sdata->u.mgd.vht_capa_mask.supp_mcs.tx_mcs_map);

    txmcs_n = le16_to_cpu(sdata->u.mgd.vht_capa.supp_mcs.tx_mcs_map);

    txmcs_n &= txmcs_mask;

    txmcs_cap = le16_to_cpu(vht_cap->vht_mcs.tx_mcs_map);

    for (i = 0; i < 8; i++) {

        u8 m, n, c;