1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2021 Intel Corporation
4 */
5 #include "mvm.h"
6 #include <linux/nl80211-vnd-intel.h>
7 #include <net/netlink.h>
8
9 static const struct nla_policy
10 iwl_mvm_vendor_attr_policy[NUM_IWL_MVM_VENDOR_ATTR] = {
11 [IWL_MVM_VENDOR_ATTR_ROAMING_FORBIDDEN] = { .type = NLA_U8 },
12 [IWL_MVM_VENDOR_ATTR_AUTH_MODE] = { .type = NLA_U32 },
13 [IWL_MVM_VENDOR_ATTR_CHANNEL_NUM] = { .type = NLA_U8 },
14 [IWL_MVM_VENDOR_ATTR_SSID] = { .type = NLA_BINARY,
15 .len = IEEE80211_MAX_SSID_LEN },
16 [IWL_MVM_VENDOR_ATTR_BAND] = { .type = NLA_U8 },
17 [IWL_MVM_VENDOR_ATTR_COLLOC_CHANNEL] = { .type = NLA_U8 },
18 [IWL_MVM_VENDOR_ATTR_COLLOC_ADDR] = { .type = NLA_BINARY, .len = ETH_ALEN },
19 };
20
iwl_mvm_vendor_get_csme_conn_info(struct wiphy * wiphy,struct wireless_dev * wdev,const void * data,int data_len)21 static int iwl_mvm_vendor_get_csme_conn_info(struct wiphy *wiphy,
22 struct wireless_dev *wdev,
23 const void *data, int data_len)
24 {
25 struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
26 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
27 struct iwl_mvm_csme_conn_info *csme_conn_info;
28 struct sk_buff *skb;
29 int err = 0;
30
31 mutex_lock(&mvm->mutex);
32 csme_conn_info = iwl_mvm_get_csme_conn_info(mvm);
33
34 if (!csme_conn_info) {
35 err = -EINVAL;
36 goto out_unlock;
37 }
38
39 skb = cfg80211_vendor_cmd_alloc_reply_skb(wiphy, 200);
40 if (!skb) {
41 err = -ENOMEM;
42 goto out_unlock;
43 }
44
45 if (nla_put_u32(skb, IWL_MVM_VENDOR_ATTR_AUTH_MODE,
46 csme_conn_info->conn_info.auth_mode) ||
47 nla_put(skb, IWL_MVM_VENDOR_ATTR_SSID,
48 csme_conn_info->conn_info.ssid_len,
49 csme_conn_info->conn_info.ssid) ||
50 nla_put_u32(skb, IWL_MVM_VENDOR_ATTR_STA_CIPHER,
51 csme_conn_info->conn_info.pairwise_cipher) ||
52 nla_put_u8(skb, IWL_MVM_VENDOR_ATTR_CHANNEL_NUM,
53 csme_conn_info->conn_info.channel) ||
54 nla_put(skb, IWL_MVM_VENDOR_ATTR_ADDR, ETH_ALEN,
55 csme_conn_info->conn_info.bssid)) {
56 kfree_skb(skb);
57 err = -ENOBUFS;
58 }
59
60 out_unlock:
61 mutex_unlock(&mvm->mutex);
62 if (err)
63 return err;
64
65 return cfg80211_vendor_cmd_reply(skb);
66 }
67
iwl_mvm_vendor_host_get_ownership(struct wiphy * wiphy,struct wireless_dev * wdev,const void * data,int data_len)68 static int iwl_mvm_vendor_host_get_ownership(struct wiphy *wiphy,
69 struct wireless_dev *wdev,
70 const void *data, int data_len)
71 {
72 struct ieee80211_hw *hw = wiphy_to_ieee80211_hw(wiphy);
73 struct iwl_mvm *mvm = IWL_MAC80211_GET_MVM(hw);
74 int ret;
75
76 mutex_lock(&mvm->mutex);
77 ret = iwl_mvm_mei_get_ownership(mvm);
78 mutex_unlock(&mvm->mutex);
79
80 return ret;
81 }
82
83 static const struct wiphy_vendor_command iwl_mvm_vendor_commands[] = {
84 {
85 .info = {
86 .vendor_id = INTEL_OUI,
87 .subcmd = IWL_MVM_VENDOR_CMD_GET_CSME_CONN_INFO,
88 },
89 .doit = iwl_mvm_vendor_get_csme_conn_info,
90 .flags = WIPHY_VENDOR_CMD_NEED_WDEV,
91 .policy = iwl_mvm_vendor_attr_policy,
92 .maxattr = MAX_IWL_MVM_VENDOR_ATTR,
93 },
94 {
95 .info = {
96 .vendor_id = INTEL_OUI,
97 .subcmd = IWL_MVM_VENDOR_CMD_HOST_GET_OWNERSHIP,
98 },
99 .doit = iwl_mvm_vendor_host_get_ownership,
100 .flags = WIPHY_VENDOR_CMD_NEED_WDEV,
101 .policy = iwl_mvm_vendor_attr_policy,
102 .maxattr = MAX_IWL_MVM_VENDOR_ATTR,
103 },
104 };
105
106 enum iwl_mvm_vendor_events_idx {
107 /* 0x0 - 0x3 are deprecated */
108 IWL_MVM_VENDOR_EVENT_IDX_ROAMING_FORBIDDEN = 4,
109 NUM_IWL_MVM_VENDOR_EVENT_IDX
110 };
111
112 static const struct nl80211_vendor_cmd_info
113 iwl_mvm_vendor_events[NUM_IWL_MVM_VENDOR_EVENT_IDX] = {
114 [IWL_MVM_VENDOR_EVENT_IDX_ROAMING_FORBIDDEN] = {
115 .vendor_id = INTEL_OUI,
116 .subcmd = IWL_MVM_VENDOR_CMD_ROAMING_FORBIDDEN_EVENT,
117 },
118 };
119
iwl_mvm_vendor_cmds_register(struct iwl_mvm * mvm)120 void iwl_mvm_vendor_cmds_register(struct iwl_mvm *mvm)
121 {
122 mvm->hw->wiphy->vendor_commands = iwl_mvm_vendor_commands;
123 mvm->hw->wiphy->n_vendor_commands = ARRAY_SIZE(iwl_mvm_vendor_commands);
124 mvm->hw->wiphy->vendor_events = iwl_mvm_vendor_events;
125 mvm->hw->wiphy->n_vendor_events = ARRAY_SIZE(iwl_mvm_vendor_events);
126 }
127
iwl_mvm_send_roaming_forbidden_event(struct iwl_mvm * mvm,struct ieee80211_vif * vif,bool forbidden)128 void iwl_mvm_send_roaming_forbidden_event(struct iwl_mvm *mvm,
129 struct ieee80211_vif *vif,
130 bool forbidden)
131 {
132 struct sk_buff *msg =
133 cfg80211_vendor_event_alloc(mvm->hw->wiphy,
134 ieee80211_vif_to_wdev(vif),
135 200, IWL_MVM_VENDOR_EVENT_IDX_ROAMING_FORBIDDEN,
136 GFP_ATOMIC);
137 if (!msg)
138 return;
139
140 if (WARN_ON(!vif))
141 return;
142
143 if (nla_put(msg, IWL_MVM_VENDOR_ATTR_VIF_ADDR,
144 ETH_ALEN, vif->addr) ||
145 nla_put_u8(msg, IWL_MVM_VENDOR_ATTR_ROAMING_FORBIDDEN, forbidden))
146 goto nla_put_failure;
147
148 cfg80211_vendor_event(msg, GFP_ATOMIC);
149 return;
150
151 nla_put_failure:
152 kfree_skb(msg);
153 }
154