> On Wed, 2019-05-01 at 18:07 +0200, Lorenzo Bianconi wrote: > > Remove function pointer in mt7615_mcu_set_bss_info and run function > > directly. Moreover remove __mt7615_mcu_set_bss_info since it is run just > > by mt7615_mcu_set_bss_info and remove duplicated istructions > > > > Signed-off-by: Lorenzo Bianconi <[email protected]> > > --- > > .../net/wireless/mediatek/mt76/mt7615/mcu.c | 220 +++++++++--------- > > 1 file changed, 105 insertions(+), 115 deletions(-) > > > > diff --git a/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c > > b/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c > > index c90ae77db22b..b3fb3d731129 100644 > > --- a/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c > > +++ b/drivers/net/wireless/mediatek/mt76/mt7615/mcu.c > > @@ -676,154 +676,107 @@ int mt7615_mcu_set_dev_info(struct mt7615_dev *dev, > > return mt7615_mcu_msg_send(dev, skb, MCU_EXT_CMD_DEV_INFO_UPDATE); > > } > > > > -static void bss_info_omac_handler (struct mt7615_dev *dev, > > - struct bss_info *bss_info, > > - struct sk_buff *skb) > > +static void > > +mt7615_mcu_bss_info_omac_header(struct mt7615_vif *mvif, u8 *data, > > + u32 conn_type) > > { > > - struct bss_info_omac tlv = {0}; > > - > > - tlv.tag = cpu_to_le16(BSS_INFO_OMAC); > > - tlv.len = cpu_to_le16(sizeof(tlv)); > > - tlv.hw_bss_idx = (bss_info->omac_idx > EXT_BSSID_START) ? > > - HW_BSSID_0 : bss_info->omac_idx; > > - tlv.omac_idx = bss_info->omac_idx; > > - tlv.band_idx = bss_info->band_idx; > > - tlv.conn_type = cpu_to_le32(bss_info->conn_type); > > - > > - memcpy(skb_put(skb, sizeof(tlv)), &tlv, sizeof(tlv)); > > + struct bss_info_omac *hdr = (struct bss_info_omac *)data; > > + u8 idx; > > + > > + idx = mvif->omac_idx > EXT_BSSID_START ? HW_BSSID_0 : mvif->omac_idx; > > + hdr->tag = cpu_to_le16(BSS_INFO_OMAC); > > + hdr->len = cpu_to_le16(sizeof(struct bss_info_omac)); > > + hdr->hw_bss_idx = idx; > > + hdr->omac_idx = mvif->omac_idx; > > + hdr->band_idx = mvif->band_idx; > > + hdr->conn_type = cpu_to_le32(conn_type); > > } > > > > -static void bss_info_basic_handler (struct mt7615_dev *dev, > > - struct bss_info *bss_info, > > - struct sk_buff *skb) > > +static void > > +mt7615_mcu_bss_info_basic_header(struct ieee80211_vif *vif, u8 *data, > > + u32 net_type, u8 tx_wlan_idx, > > + bool enable) > > { > > - struct bss_info_basic tlv = {0}; > > - > > - tlv.tag = cpu_to_le16(BSS_INFO_BASIC); > > - tlv.len = cpu_to_le16(sizeof(tlv)); > > - tlv.network_type = cpu_to_le32(bss_info->network_type); > > - tlv.active = bss_info->enable; > > - tlv.bcn_interval = cpu_to_le16(bss_info->bcn_interval); > > - memcpy(tlv.bssid, bss_info->bssid, ETH_ALEN); > > - tlv.wmm_idx = bss_info->wmm_idx; > > - tlv.dtim_period = bss_info->dtim_period; > > - tlv.bmc_tx_wlan_idx = bss_info->bmc_tx_wlan_idx; > > - > > - memcpy(skb_put(skb, sizeof(tlv)), &tlv, sizeof(tlv)); > > + struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv; > > + struct bss_info_basic *hdr = (struct bss_info_basic *)data; > > + > > + hdr->tag = cpu_to_le16(BSS_INFO_BASIC); > > + hdr->len = cpu_to_le16(sizeof(struct bss_info_basic)); > > + hdr->network_type = cpu_to_le32(net_type); > > If I read this patch correctly, it seems nobody sets the net_type? >
Hi Ryder,
you are right, I swapped the initialization of conn_type and net_type.
I will fix it, thx
Regards,
Lorenzo
> > + hdr->active = enable;
> > + hdr->bcn_interval = cpu_to_le16(vif->bss_conf.beacon_int);
> > + memcpy(hdr->bssid, vif->bss_conf.bssid, ETH_ALEN);
> > + hdr->wmm_idx = mvif->wmm_idx;
> > + hdr->dtim_period = vif->bss_conf.dtim_period;
> > + hdr->bmc_tx_wlan_idx = tx_wlan_idx;
> > }
> >
> > -static void bss_info_ext_bss_handler (struct mt7615_dev *dev,
> > - struct bss_info *bss_info,
> > - struct sk_buff *skb)
> > +static void
> > +mt7615_mcu_bss_info_ext_header(struct mt7615_vif *mvif, u8 *data)
> > {
> > /* SIFS 20us + 512 byte beacon tranmitted by 1Mbps (3906us) */
> > #define BCN_TX_ESTIMATE_TIME (4096 + 20)
> > - struct bss_info_ext_bss tlv = {0};
> > + struct bss_info_ext_bss *hdr = (struct bss_info_ext_bss *)data;
> > int ext_bss_idx;
> >
> > - ext_bss_idx = bss_info->omac_idx - EXT_BSSID_START;
> > -
> > + ext_bss_idx = mvif->omac_idx - EXT_BSSID_START;
> > if (ext_bss_idx < 0)
> > return;
> >
> > - tlv.tag = cpu_to_le16(BSS_INFO_EXT_BSS);
> > - tlv.len = cpu_to_le16(sizeof(tlv));
> > - tlv.mbss_tsf_offset = ext_bss_idx * BCN_TX_ESTIMATE_TIME;
> > -
> > - memcpy(skb_put(skb, sizeof(tlv)), &tlv, sizeof(tlv));
> > + hdr->tag = cpu_to_le16(BSS_INFO_EXT_BSS);
> > + hdr->len = cpu_to_le16(sizeof(struct bss_info_ext_bss));
> > + hdr->mbss_tsf_offset = ext_bss_idx * BCN_TX_ESTIMATE_TIME;
> > }
> >
> > -static struct bss_info_tag_handler bss_info_tag_handler[] = {
> > - {BSS_INFO_OMAC, sizeof(struct bss_info_omac), bss_info_omac_handler},
> > - {BSS_INFO_BASIC, sizeof(struct bss_info_basic), bss_info_basic_handler},
> > - {BSS_INFO_RF_CH, sizeof(struct bss_info_rf_ch), NULL},
> > - {BSS_INFO_PM, 0, NULL},
> > - {BSS_INFO_UAPSD, 0, NULL},
> > - {BSS_INFO_ROAM_DETECTION, 0, NULL},
> > - {BSS_INFO_LQ_RM, 0, NULL},
> > - {BSS_INFO_EXT_BSS, sizeof(struct bss_info_ext_bss),
> > bss_info_ext_bss_handler},
> > - {BSS_INFO_BMC_INFO, 0, NULL},
> > - {BSS_INFO_SYNC_MODE, 0, NULL},
> > - {BSS_INFO_RA, 0, NULL},
> > - {BSS_INFO_MAX_NUM, 0, NULL},
> > -};
> > -
> > -static int __mt7615_mcu_set_bss_info(struct mt7615_dev *dev,
> > - struct bss_info *bss_info)
> > +int mt7615_mcu_set_bss_info(struct mt7615_dev *dev,
> > + struct ieee80211_vif *vif, int en)
> > {
> > + struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
> > struct req_hdr {
> > u8 bss_idx;
> > u8 rsv0;
> > __le16 tlv_num;
> > u8 is_tlv_append;
> > u8 rsv1[3];
> > - } __packed req_hdr = {0};
> > + } __packed;
> > + int len = sizeof(struct req_hdr) + sizeof(struct bss_info_basic);
> > + int ret, i, features = BIT(BSS_INFO_BASIC), ntlv = 1;
> > + u32 conn_type = NETWORK_INFRA, net_type = 0;
> > + u8 *buf, *data, tx_wlan_idx = 0;
> > + struct req_hdr *hdr;
> > struct sk_buff *skb;
> > - u16 tlv_num = 0;
> > - u32 size = 0;
> > - int i;
> >
> > - for (i = 0; i < BSS_INFO_MAX_NUM; i++)
> > - if ((BIT(bss_info_tag_handler[i].tag) & bss_info->feature) &&
> > - bss_info_tag_handler[i].handler) {
> > - tlv_num++;
> > - size += bss_info_tag_handler[i].len;
> > + if (en) {
> > + len += sizeof(struct bss_info_omac);
> > + features |= BIT(BSS_INFO_OMAC);
> > + if (mvif->omac_idx > EXT_BSSID_START) {
> > + len += sizeof(struct bss_info_ext_bss);
> > + features |= BIT(BSS_INFO_EXT_BSS);
> > + ntlv++;
> > }
> > -
> > - skb = mt7615_mcu_msg_alloc(NULL, sizeof(req_hdr) + size);
> > -
> > - req_hdr.bss_idx = bss_info->bss_idx;
> > - req_hdr.tlv_num = cpu_to_le16(tlv_num);
> > - req_hdr.is_tlv_append = tlv_num ? 1 : 0;
> > -
> > - memcpy(skb_put(skb, sizeof(req_hdr)), &req_hdr, sizeof(req_hdr));
> > -
> > - for (i = 0; i < BSS_INFO_MAX_NUM; i++)
> > - if ((BIT(bss_info_tag_handler[i].tag) & bss_info->feature) &&
> > - bss_info_tag_handler[i].handler)
> > - bss_info_tag_handler[i].handler(dev, bss_info, skb);
> > -
> > - return mt7615_mcu_msg_send(dev, skb, MCU_EXT_CMD_BSS_INFO_UPDATE);
> > -}
> > -
> > -int mt7615_mcu_set_bss_info(struct mt7615_dev *dev,
> > - struct ieee80211_vif *vif, int en)
> > -{
> > - struct mt7615_vif *mvif = (struct mt7615_vif *)vif->drv_priv;
> > - struct bss_info bss_info = {
> > - .bss_idx = mvif->idx,
> > - .omac_idx = mvif->omac_idx,
> > - .band_idx = mvif->band_idx,
> > - .bcn_interval = vif->bss_conf.beacon_int,
> > - .dtim_period = vif->bss_conf.dtim_period,
> > - .enable = en,
> > - .feature = BIT(BSS_INFO_BASIC),
> > - .wmm_idx = mvif->wmm_idx,
> > - };
> > + ntlv++;
> > + }
> >
> > switch (vif->type) {
> > case NL80211_IFTYPE_AP:
> > - bss_info.bmc_tx_wlan_idx = mvif->sta.wcid.idx;
> > - bss_info.network_type = NETWORK_INFRA;
> > - bss_info.conn_type = CONNECTION_INFRA_AP;
> > + tx_wlan_idx = mvif->sta.wcid.idx;
> > + conn_type = CONNECTION_INFRA_AP;
> > break;
> > case NL80211_IFTYPE_STATION: {
> > - /* find the unicast entry for sta mode bmc tx */
> > - struct ieee80211_sta *ap_sta;
> > + struct ieee80211_sta *sta;
> > struct mt7615_sta *msta;
> >
> > rcu_read_lock();
> >
> > - ap_sta = ieee80211_find_sta(vif, vif->bss_conf.bssid);
> > - if (!ap_sta) {
> > + sta = ieee80211_find_sta(vif, vif->bss_conf.bssid);
> > + if (!sta) {
> > rcu_read_unlock();
> > return -EINVAL;
> > }
> >
> > - msta = (struct mt7615_sta *)ap_sta->drv_priv;
> > - bss_info.bmc_tx_wlan_idx = msta->wcid.idx;
> > - bss_info.network_type = NETWORK_INFRA;
> > - bss_info.conn_type = CONNECTION_INFRA_STA;
> > + msta = (struct mt7615_sta *)sta->drv_priv;
> > + tx_wlan_idx = msta->wcid.idx;
> > + conn_type = CONNECTION_INFRA_STA;
> >
> > rcu_read_unlock();
> > break;
> > @@ -832,15 +785,52 @@ int mt7615_mcu_set_bss_info(struct mt7615_dev *dev,
> > WARN_ON(1);
> > break;
> > }
> > - memcpy(bss_info.bssid, vif->bss_conf.bssid, ETH_ALEN);
> >
> > - if (en) {
> > - bss_info.feature |= BIT(BSS_INFO_OMAC);
> > - if (mvif->omac_idx > EXT_BSSID_START)
> > - bss_info.feature |= BIT(BSS_INFO_EXT_BSS);
> > + buf = kzalloc(len, GFP_KERNEL);
> > + if (!buf)
> > + return -ENOMEM;
> > +
> > + hdr = (struct req_hdr *)buf;
> > + hdr->bss_idx = mvif->idx;
> > + hdr->tlv_num = cpu_to_le16(ntlv);
> > + hdr->is_tlv_append = 1;
> > +
> > + data = buf + sizeof(*hdr);
> > + for (i = 0; i < BSS_INFO_MAX_NUM; i++) {
> > + int tag = ffs(features & BIT(i)) - 1;
> > +
> > + switch (tag) {
> > + case BSS_INFO_OMAC:
> > + mt7615_mcu_bss_info_omac_header(mvif, data,
> > + conn_type);
> > + data += sizeof(struct bss_info_omac);
> > + break;
> > + case BSS_INFO_BASIC:
> > + mt7615_mcu_bss_info_basic_header(vif, data, net_type,
> > + tx_wlan_idx, en);
> > + data += sizeof(struct bss_info_basic);
> > + break;
> > + case BSS_INFO_EXT_BSS:
> > + mt7615_mcu_bss_info_ext_header(mvif, data);
> > + data += sizeof(struct bss_info_ext_bss);
> > + break;
> > + default:
> > + break;
> > + }
> > + }
> > +
> > + skb = mt7615_mcu_msg_alloc(buf, len);
> > + if (!skb) {
> > + ret = -ENOMEM;
> > + goto out;
> > }
> >
> > - return __mt7615_mcu_set_bss_info(dev, &bss_info);
> > + ret = mt7615_mcu_msg_send(dev, skb, MCU_EXT_CMD_BSS_INFO_UPDATE);
> > +
> > +out:
> > + kfree(buf);
> > +
> > + return ret;
> > }
> >
> > static int
>
>
signature.asc
Description: PGP signature
