Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 28b91884 authored by Sergey Matyukevich's avatar Sergey Matyukevich Committed by Kalle Valo
Browse files

qtnfmac: implement basic WoWLAN support 



This patch implements basic WoWLAN support in qtnfmac driver, including
processing of WoWLAN features reported by firmware and implementation
of cfg80211 suspend/resume/wakeup callbacks. Currently the following
WoWLAN triggers are supported: disconnect, magic packet,
custom pattern packet.

Signed-off-by: default avatarSergey Matyukevich <sergey.matyukevich.os@quantenna.com>
Signed-off-by: default avatarKalle Valo <kvalo@codeaurora.org>
parent a33ce21e

drivers/net/wireless/quantenna/qtnfmac/cfg80211.c

+76 −0
Original line number Diff line number Diff line
@@ -859,6 +859,72 @@ static int qtnf_set_power_mgmt(struct wiphy *wiphy, struct net_device *dev, 
	return ret;

}



#ifdef CONFIG_PM

static int qtnf_suspend(struct wiphy *wiphy, struct cfg80211_wowlan *wowlan)

{

	struct qtnf_wmac *mac = wiphy_priv(wiphy);

	struct qtnf_vif *vif;

	int ret = 0;



	vif = qtnf_mac_get_base_vif(mac);

	if (!vif) {

		pr_err("MAC%u: primary VIF is not configured\n", mac->macid);

		ret = -EFAULT;

		goto exit;

	}



	if (!wowlan) {

		pr_debug("WoWLAN triggers are not enabled\n");

		qtnf_virtual_intf_cleanup(vif->netdev);

		goto exit;

	}



	qtnf_scan_done(vif->mac, true);



	ret = qtnf_cmd_send_wowlan_set(vif, wowlan);

	if (ret) {

		pr_err("MAC%u: failed to set WoWLAN triggers\n",

		       mac->macid);

		goto exit;

	}



exit:

	return ret;

}



static int qtnf_resume(struct wiphy *wiphy)

{

	struct qtnf_wmac *mac = wiphy_priv(wiphy);

	struct qtnf_vif *vif;

	int ret = 0;



	vif = qtnf_mac_get_base_vif(mac);

	if (!vif) {

		pr_err("MAC%u: primary VIF is not configured\n", mac->macid);

		ret = -EFAULT;

		goto exit;

	}



	ret = qtnf_cmd_send_wowlan_set(vif, NULL);

	if (ret) {

		pr_err("MAC%u: failed to reset WoWLAN triggers\n",

		       mac->macid);

		goto exit;

	}



exit:

	return ret;

}



static void qtnf_set_wakeup(struct wiphy *wiphy, bool enabled)

{

	struct qtnf_wmac *mac = wiphy_priv(wiphy);

	struct qtnf_bus *bus = mac->bus;



	device_set_wakeup_enable(bus->dev, enabled);

}

#endif



static struct cfg80211_ops qtn_cfg80211_ops = {

	.add_virtual_intf	= qtnf_add_virtual_intf,

	.change_virtual_intf	= qtnf_change_virtual_intf,
@@ -886,6 +952,11 @@ static struct cfg80211_ops qtn_cfg80211_ops = { 
	.start_radar_detection	= qtnf_start_radar_detection,

	.set_mac_acl		= qtnf_set_mac_acl,

	.set_power_mgmt		= qtnf_set_power_mgmt,

#ifdef CONFIG_PM

	.suspend		= qtnf_suspend,

	.resume			= qtnf_resume,

	.set_wakeup		= qtnf_set_wakeup,

#endif

};



static void qtnf_cfg80211_reg_notifier(struct wiphy *wiphy_in,
@@ -1038,6 +1109,11 @@ int qtnf_wiphy_register(struct qtnf_hw_info *hw_info, struct qtnf_wmac *mac) 
	if (hw_info->hw_capab & QLINK_HW_CAPAB_SCAN_RANDOM_MAC_ADDR)

		wiphy->features |= NL80211_FEATURE_SCAN_RANDOM_MAC_ADDR;



#ifdef CONFIG_PM

	if (macinfo->wowlan)

		wiphy->wowlan = macinfo->wowlan;

#endif



	if (hw_info->hw_capab & QLINK_HW_CAPAB_REG_UPDATE) {

		wiphy->regulatory_flags |= REGULATORY_STRICT_REG |

			REGULATORY_CUSTOM_REG;

drivers/net/wireless/quantenna/qtnfmac/commands.c

+112 −0
Original line number Diff line number Diff line
@@ -1138,6 +1138,37 @@ qtnf_cmd_resp_proc_hw_info(struct qtnf_bus *bus, 
	return 0;

}



static void

qtnf_parse_wowlan_info(struct qtnf_wmac *mac,

		       const struct qlink_wowlan_capab_data *wowlan)

{

	struct qtnf_mac_info *mac_info = &mac->macinfo;

	const struct qlink_wowlan_support *data1;

	struct wiphy_wowlan_support *supp;



	supp = kzalloc(sizeof(*supp), GFP_KERNEL);

	if (!supp)

		return;



	switch (le16_to_cpu(wowlan->version)) {

	case 0x1:

		data1 = (struct qlink_wowlan_support *)wowlan->data;



		supp->flags = WIPHY_WOWLAN_MAGIC_PKT | WIPHY_WOWLAN_DISCONNECT;

		supp->n_patterns = le32_to_cpu(data1->n_patterns);

		supp->pattern_max_len = le32_to_cpu(data1->pattern_max_len);

		supp->pattern_min_len = le32_to_cpu(data1->pattern_min_len);



		mac_info->wowlan = supp;

		break;

	default:

		pr_warn("MAC%u: unsupported WoWLAN version 0x%x\n",

			mac->macid, le16_to_cpu(wowlan->version));

		kfree(supp);

		break;

	}

}



static int qtnf_parse_variable_mac_info(struct qtnf_wmac *mac,

					const u8 *tlv_buf, size_t tlv_buf_size)

{
@@ -1147,6 +1178,7 @@ static int qtnf_parse_variable_mac_info(struct qtnf_wmac *mac, 
	const struct qlink_iface_comb_num *comb_num;

	const struct qlink_iface_limit_record *rec;

	const struct qlink_iface_limit *lim;

	const struct qlink_wowlan_capab_data *wowlan;

	u16 rec_len;

	u16 tlv_type;

	u16 tlv_value_len;
@@ -1255,7 +1287,31 @@ static int qtnf_parse_variable_mac_info(struct qtnf_wmac *mac, 
			ext_capa_mask = (u8 *)tlv->val;

			ext_capa_mask_len = tlv_value_len;

			break;

		case QTN_TLV_ID_WOWLAN_CAPAB:

			if (tlv_value_len < sizeof(*wowlan))

				return -EINVAL;



			wowlan = (void *)tlv->val;

			if (!le16_to_cpu(wowlan->len)) {

				pr_warn("MAC%u: skip empty WoWLAN data\n",

					mac->macid);

				break;

			}



			rec_len = sizeof(*wowlan) + le16_to_cpu(wowlan->len);

			if (unlikely(tlv_value_len != rec_len)) {

				pr_warn("MAC%u: WoWLAN data size mismatch\n",

					mac->macid);

				return -EINVAL;

			}



			kfree(mac->macinfo.wowlan);

			mac->macinfo.wowlan = NULL;

			qtnf_parse_wowlan_info(mac, wowlan);

			break;

		default:

			pr_warn("MAC%u: unknown TLV type %u\n",

				mac->macid, tlv_type);

			break;

		}
@@ -2831,3 +2887,59 @@ int qtnf_cmd_send_pm_set(const struct qtnf_vif *vif, u8 pm_mode, int timeout) 
	qtnf_bus_unlock(bus);

	return ret;

}



int qtnf_cmd_send_wowlan_set(const struct qtnf_vif *vif,

			     const struct cfg80211_wowlan *wowl)

{

	struct qtnf_bus *bus = vif->mac->bus;

	struct sk_buff *cmd_skb;

	u16 res_code = QLINK_CMD_RESULT_OK;

	struct qlink_cmd_wowlan_set *cmd;

	u32 triggers = 0;

	int count = 0;

	int ret = 0;



	cmd_skb = qtnf_cmd_alloc_new_cmdskb(vif->mac->macid, vif->vifid,

					    QLINK_CMD_WOWLAN_SET, sizeof(*cmd));

	if (!cmd_skb)

		return -ENOMEM;



	qtnf_bus_lock(bus);



	cmd = (struct qlink_cmd_wowlan_set *)cmd_skb->data;



	if (wowl) {

		if (wowl->disconnect)

			triggers |=  QLINK_WOWLAN_TRIG_DISCONNECT;



		if (wowl->magic_pkt)

			triggers |= QLINK_WOWLAN_TRIG_MAGIC_PKT;



		if (wowl->n_patterns && wowl->patterns) {

			triggers |= QLINK_WOWLAN_TRIG_PATTERN_PKT;

			while (count < wowl->n_patterns) {

				qtnf_cmd_skb_put_tlv_arr(cmd_skb,

					QTN_TLV_ID_WOWLAN_PATTERN,

					wowl->patterns[count].pattern,

					wowl->patterns[count].pattern_len);

				count++;

			}

		}

	}



	cmd->triggers = cpu_to_le32(triggers);



	ret = qtnf_cmd_send(bus, cmd_skb, &res_code);



	if (unlikely(ret))

		goto out;



	if (unlikely(res_code != QLINK_CMD_RESULT_OK)) {

		pr_err("cmd exec failed: 0x%.4X\n", res_code);

		ret = -EFAULT;

	}



out:

	qtnf_bus_unlock(bus);

	return ret;

}

drivers/net/wireless/quantenna/qtnfmac/commands.h

+2 −0
Original line number Diff line number Diff line
@@ -77,5 +77,7 @@ int qtnf_cmd_start_cac(const struct qtnf_vif *vif, 
int qtnf_cmd_set_mac_acl(const struct qtnf_vif *vif,

			 const struct cfg80211_acl_data *params);

int qtnf_cmd_send_pm_set(const struct qtnf_vif *vif, u8 pm_mode, int timeout);

int qtnf_cmd_send_wowlan_set(const struct qtnf_vif *vif,

			     const struct cfg80211_wowlan *wowl);



#endif /* QLINK_COMMANDS_H_ */

drivers/net/wireless/quantenna/qtnfmac/core.c

+1 −0
Original line number Diff line number Diff line
@@ -495,6 +495,7 @@ static void qtnf_core_mac_detach(struct qtnf_bus *bus, unsigned int macid) 
	qtnf_mac_iface_comb_free(mac);

	kfree(mac->macinfo.extended_capabilities);

	kfree(mac->macinfo.extended_capabilities_mask);

	kfree(mac->macinfo.wowlan);

	wiphy_free(wiphy);

	bus->mac[macid] = NULL;

}

drivers/net/wireless/quantenna/qtnfmac/core.h

+1 −0
Original line number Diff line number Diff line
@@ -110,6 +110,7 @@ struct qtnf_mac_info { 
	u8 *extended_capabilities;

	u8 *extended_capabilities_mask;

	u8 extended_capabilities_len;

	struct wiphy_wowlan_support *wowlan;

};



struct qtnf_chan_stats {