Re: [RFC 12/17] mt7615: mcu: do not use function pointer whenever possible

[Ryder Lee <ryder.lee@mediatek.com>]

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?

> +	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