> 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 <lorenzo@kernel.org>
> > ---
> >  .../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
> 
>