1  // SPDX-License-Identifier: ISC
2  /*
3   * Copyright (c) 2014 Broadcom Corporation
4   */
5  
6  #include <linux/netdevice.h>
7  #include <linux/module.h>
8  
9  #include <brcm_hw_ids.h>
10  #include <brcmu_wifi.h>
11  #include "core.h"
12  #include "bus.h"
13  #include "debug.h"
14  #include "fwil.h"
15  #include "fwil_types.h"
16  #include "fwvid.h"
17  #include "feature.h"
18  #include "common.h"
19  
20  #define BRCMF_FW_UNSUPPORTED	23
21  
22  /*
23   * expand feature list to array of feature strings.
24   */
25  #define BRCMF_FEAT_DEF(_f) \
26  	#_f,
27  static const char *brcmf_feat_names[] = {
28  	BRCMF_FEAT_LIST
29  };
30  #undef BRCMF_FEAT_DEF
31  
32  struct brcmf_feat_fwcap {
33  	enum brcmf_feat_id feature;
34  	const char * const fwcap_id;
35  };
36  
37  static const struct brcmf_feat_fwcap brcmf_fwcap_map[] = {
38  	{ BRCMF_FEAT_MBSS, "mbss" },
39  	{ BRCMF_FEAT_MCHAN, "mchan" },
40  	{ BRCMF_FEAT_P2P, "p2p" },
41  	{ BRCMF_FEAT_MONITOR, "monitor" },
42  	{ BRCMF_FEAT_MONITOR_FLAG, "rtap" },
43  	{ BRCMF_FEAT_MONITOR_FMT_RADIOTAP, "rtap" },
44  	{ BRCMF_FEAT_DOT11H, "802.11h" },
45  	{ BRCMF_FEAT_SAE, "sae" },
46  	{ BRCMF_FEAT_FWAUTH, "idauth" },
47  };
48  
49  #ifdef DEBUG
50  /*
51   * expand quirk list to array of quirk strings.
52   */
53  #define BRCMF_QUIRK_DEF(_q) \
54  	#_q,
55  static const char * const brcmf_quirk_names[] = {
56  	BRCMF_QUIRK_LIST
57  };
58  #undef BRCMF_QUIRK_DEF
59  
60  /**
61   * brcmf_feat_debugfs_read() - expose feature info to debugfs.
62   *
63   * @seq: sequence for debugfs entry.
64   * @data: raw data pointer.
65   */
brcmf_feat_debugfs_read(struct seq_file * seq,void * data)66  static int brcmf_feat_debugfs_read(struct seq_file *seq, void *data)
67  {
68  	struct brcmf_bus *bus_if = dev_get_drvdata(seq->private);
69  	u32 feats = bus_if->drvr->feat_flags;
70  	u32 quirks = bus_if->drvr->chip_quirks;
71  	int id;
72  
73  	seq_printf(seq, "Features: %08x\n", feats);
74  	for (id = 0; id < BRCMF_FEAT_LAST; id++)
75  		if (feats & BIT(id))
76  			seq_printf(seq, "\t%s\n", brcmf_feat_names[id]);
77  	seq_printf(seq, "\nQuirks:   %08x\n", quirks);
78  	for (id = 0; id < BRCMF_FEAT_QUIRK_LAST; id++)
79  		if (quirks & BIT(id))
80  			seq_printf(seq, "\t%s\n", brcmf_quirk_names[id]);
81  	return 0;
82  }
83  #else
brcmf_feat_debugfs_read(struct seq_file * seq,void * data)84  static int brcmf_feat_debugfs_read(struct seq_file *seq, void *data)
85  {
86  	return 0;
87  }
88  #endif /* DEBUG */
89  
90  struct brcmf_feat_fwfeat {
91  	const char * const fwid;
92  	u32 feat_flags;
93  };
94  
95  static const struct brcmf_feat_fwfeat brcmf_feat_fwfeat_map[] = {
96  	/* brcmfmac43602-pcie.ap.bin from linux-firmware.git commit ea1178515b88 */
97  	{ "01-6cb8e269", BIT(BRCMF_FEAT_MONITOR) },
98  	/* brcmfmac4366b-pcie.bin from linux-firmware.git commit 52442afee990 */
99  	{ "01-c47a91a4", BIT(BRCMF_FEAT_MONITOR) },
100  	/* brcmfmac4366b-pcie.bin from linux-firmware.git commit 211de1679a68 */
101  	{ "01-801fb449", BIT(BRCMF_FEAT_MONITOR_FMT_HW_RX_HDR) },
102  	/* brcmfmac4366c-pcie.bin from linux-firmware.git commit 211de1679a68 */
103  	{ "01-d2cbb8fd", BIT(BRCMF_FEAT_MONITOR_FMT_HW_RX_HDR) },
104  };
105  
brcmf_feat_firmware_overrides(struct brcmf_pub * drv)106  static void brcmf_feat_firmware_overrides(struct brcmf_pub *drv)
107  {
108  	const struct brcmf_feat_fwfeat *e;
109  	u32 feat_flags = 0;
110  	int i;
111  
112  	for (i = 0; i < ARRAY_SIZE(brcmf_feat_fwfeat_map); i++) {
113  		e = &brcmf_feat_fwfeat_map[i];
114  		if (!strcmp(e->fwid, drv->fwver)) {
115  			feat_flags = e->feat_flags;
116  			break;
117  		}
118  	}
119  
120  	if (!feat_flags)
121  		return;
122  
123  	for (i = 0; i < BRCMF_FEAT_LAST; i++)
124  		if (feat_flags & BIT(i))
125  			brcmf_dbg(INFO, "enabling firmware feature: %s\n",
126  				  brcmf_feat_names[i]);
127  	drv->feat_flags |= feat_flags;
128  }
129  
130  struct brcmf_feat_wlcfeat {
131  	u16 min_ver_major;
132  	u16 min_ver_minor;
133  	u32 feat_flags;
134  };
135  
136  static const struct brcmf_feat_wlcfeat brcmf_feat_wlcfeat_map[] = {
137  	{ 12, 0, BIT(BRCMF_FEAT_PMKID_V2) },
138  	{ 13, 0, BIT(BRCMF_FEAT_PMKID_V3) },
139  };
140  
brcmf_feat_wlc_version_overrides(struct brcmf_pub * drv)141  static void brcmf_feat_wlc_version_overrides(struct brcmf_pub *drv)
142  {
143  	struct brcmf_if *ifp = brcmf_get_ifp(drv, 0);
144  	const struct brcmf_feat_wlcfeat *e;
145  	struct brcmf_wlc_version_le ver;
146  	u32 feat_flags = 0;
147  	int i, err, major, minor;
148  
149  	err = brcmf_fil_iovar_data_get(ifp, "wlc_ver", &ver, sizeof(ver));
150  	if (err)
151  		return;
152  
153  	major = le16_to_cpu(ver.wlc_ver_major);
154  	minor = le16_to_cpu(ver.wlc_ver_minor);
155  
156  	brcmf_dbg(INFO, "WLC version: %d.%d\n", major, minor);
157  
158  	for (i = 0; i < ARRAY_SIZE(brcmf_feat_wlcfeat_map); i++) {
159  		e = &brcmf_feat_wlcfeat_map[i];
160  		if (major > e->min_ver_major ||
161  		    (major == e->min_ver_major &&
162  		     minor >= e->min_ver_minor)) {
163  			feat_flags |= e->feat_flags;
164  		}
165  	}
166  
167  	if (!feat_flags)
168  		return;
169  
170  	for (i = 0; i < BRCMF_FEAT_LAST; i++)
171  		if (feat_flags & BIT(i))
172  			brcmf_dbg(INFO, "enabling firmware feature: %s\n",
173  				  brcmf_feat_names[i]);
174  	drv->feat_flags |= feat_flags;
175  }
176  
177  /**
178   * brcmf_feat_iovar_int_get() - determine feature through iovar query.
179   *
180   * @ifp: interface to query.
181   * @id: feature id.
182   * @name: iovar name.
183   */
brcmf_feat_iovar_int_get(struct brcmf_if * ifp,enum brcmf_feat_id id,char * name)184  static void brcmf_feat_iovar_int_get(struct brcmf_if *ifp,
185  				     enum brcmf_feat_id id, char *name)
186  {
187  	u32 data;
188  	int err;
189  
190  	/* we need to know firmware error */
191  	ifp->fwil_fwerr = true;
192  
193  	err = brcmf_fil_iovar_int_get(ifp, name, &data);
194  	if (err != -BRCMF_FW_UNSUPPORTED) {
195  		brcmf_dbg(INFO, "enabling feature: %s\n", brcmf_feat_names[id]);
196  		ifp->drvr->feat_flags |= BIT(id);
197  	} else {
198  		brcmf_dbg(TRACE, "%s feature check failed: %d\n",
199  			  brcmf_feat_names[id], err);
200  	}
201  
202  	ifp->fwil_fwerr = false;
203  }
204  
brcmf_feat_iovar_data_set(struct brcmf_if * ifp,enum brcmf_feat_id id,char * name,const void * data,size_t len)205  static void brcmf_feat_iovar_data_set(struct brcmf_if *ifp,
206  				      enum brcmf_feat_id id, char *name,
207  				      const void *data, size_t len)
208  {
209  	int err;
210  
211  	/* we need to know firmware error */
212  	ifp->fwil_fwerr = true;
213  
214  	err = brcmf_fil_iovar_data_set(ifp, name, data, len);
215  	if (err != -BRCMF_FW_UNSUPPORTED) {
216  		brcmf_dbg(INFO, "enabling feature: %s\n", brcmf_feat_names[id]);
217  		ifp->drvr->feat_flags |= BIT(id);
218  	} else {
219  		brcmf_dbg(TRACE, "%s feature check failed: %d\n",
220  			  brcmf_feat_names[id], err);
221  	}
222  
223  	ifp->fwil_fwerr = false;
224  }
225  
226  #define MAX_CAPS_BUFFER_SIZE	768
brcmf_feat_firmware_capabilities(struct brcmf_if * ifp)227  static void brcmf_feat_firmware_capabilities(struct brcmf_if *ifp)
228  {
229  	struct brcmf_pub *drvr = ifp->drvr;
230  	char caps[MAX_CAPS_BUFFER_SIZE];
231  	enum brcmf_feat_id id;
232  	int i, err;
233  
234  	err = brcmf_fil_iovar_data_get(ifp, "cap", caps, sizeof(caps));
235  	if (err) {
236  		bphy_err(drvr, "could not get firmware cap (%d)\n", err);
237  		return;
238  	}
239  
240  	brcmf_dbg(INFO, "[ %s]\n", caps);
241  
242  	for (i = 0; i < ARRAY_SIZE(brcmf_fwcap_map); i++) {
243  		if (strnstr(caps, brcmf_fwcap_map[i].fwcap_id, sizeof(caps))) {
244  			id = brcmf_fwcap_map[i].feature;
245  			brcmf_dbg(INFO, "enabling feature: %s\n",
246  				  brcmf_feat_names[id]);
247  			ifp->drvr->feat_flags |= BIT(id);
248  		}
249  	}
250  }
251  
252  /**
253   * brcmf_feat_fwcap_debugfs_read() - expose firmware capabilities to debugfs.
254   *
255   * @seq: sequence for debugfs entry.
256   * @data: raw data pointer.
257   */
brcmf_feat_fwcap_debugfs_read(struct seq_file * seq,void * data)258  static int brcmf_feat_fwcap_debugfs_read(struct seq_file *seq, void *data)
259  {
260  	struct brcmf_bus *bus_if = dev_get_drvdata(seq->private);
261  	struct brcmf_pub *drvr = bus_if->drvr;
262  	struct brcmf_if *ifp = brcmf_get_ifp(drvr, 0);
263  	char caps[MAX_CAPS_BUFFER_SIZE + 1] = { };
264  	char *tmp;
265  	int err;
266  
267  	err = brcmf_fil_iovar_data_get(ifp, "cap", caps, sizeof(caps));
268  	if (err) {
269  		bphy_err(drvr, "could not get firmware cap (%d)\n", err);
270  		return err;
271  	}
272  
273  	/* Put every capability in a new line */
274  	for (tmp = caps; *tmp; tmp++) {
275  		if (*tmp == ' ')
276  			*tmp = '\n';
277  	}
278  
279  	/* Usually there is a space at the end of capabilities string */
280  	seq_printf(seq, "%s", caps);
281  	/* So make sure we don't print two line breaks */
282  	if (tmp > caps && *(tmp - 1) != '\n')
283  		seq_printf(seq, "\n");
284  
285  	return 0;
286  }
287  
brcmf_feat_attach(struct brcmf_pub * drvr)288  void brcmf_feat_attach(struct brcmf_pub *drvr)
289  {
290  	struct brcmf_if *ifp = brcmf_get_ifp(drvr, 0);
291  	struct brcmf_pno_macaddr_le pfn_mac;
292  	struct brcmf_gscan_config gscan_cfg;
293  	u32 wowl_cap;
294  	s32 err;
295  
296  	brcmf_feat_firmware_capabilities(ifp);
297  	memset(&gscan_cfg, 0, sizeof(gscan_cfg));
298  	if (drvr->bus_if->chip != BRCM_CC_43430_CHIP_ID &&
299  	    drvr->bus_if->chip != BRCM_CC_4345_CHIP_ID &&
300  	    drvr->bus_if->chip != BRCM_CC_43454_CHIP_ID &&
301  	    drvr->bus_if->chip != CY_CC_43439_CHIP_ID)
302  		brcmf_feat_iovar_data_set(ifp, BRCMF_FEAT_GSCAN,
303  					  "pfn_gscan_cfg",
304  					  &gscan_cfg, sizeof(gscan_cfg));
305  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_PNO, "pfn");
306  	if (drvr->bus_if->wowl_supported)
307  		brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_WOWL, "wowl");
308  	if (brcmf_feat_is_enabled(ifp, BRCMF_FEAT_WOWL)) {
309  		err = brcmf_fil_iovar_int_get(ifp, "wowl_cap", &wowl_cap);
310  		if (!err) {
311  			ifp->drvr->feat_flags |= BIT(BRCMF_FEAT_WOWL_ARP_ND);
312  			if (wowl_cap & BRCMF_WOWL_PFN_FOUND)
313  				ifp->drvr->feat_flags |=
314  					BIT(BRCMF_FEAT_WOWL_ND);
315  			if (wowl_cap & BRCMF_WOWL_GTK_FAILURE)
316  				ifp->drvr->feat_flags |=
317  					BIT(BRCMF_FEAT_WOWL_GTK);
318  		}
319  	}
320  	/* MBSS does not work for all chips */
321  	switch (drvr->bus_if->chip) {
322  	case BRCM_CC_4330_CHIP_ID:
323  	case BRCM_CC_43362_CHIP_ID:
324  		ifp->drvr->feat_flags &= ~BIT(BRCMF_FEAT_MBSS);
325  		break;
326  	default:
327  		break;
328  	}
329  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_RSDB, "rsdb_mode");
330  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_TDLS, "tdls_enable");
331  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_MFP, "mfp");
332  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_DUMP_OBSS, "dump_obss");
333  
334  	pfn_mac.version = BRCMF_PFN_MACADDR_CFG_VER;
335  	err = brcmf_fil_iovar_data_get(ifp, "pfn_macaddr", &pfn_mac,
336  				       sizeof(pfn_mac));
337  	if (!err)
338  		ifp->drvr->feat_flags |= BIT(BRCMF_FEAT_SCAN_RANDOM_MAC);
339  
340  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_FWSUP, "sup_wpa");
341  	brcmf_feat_iovar_int_get(ifp, BRCMF_FEAT_SCAN_V2, "scan_ver");
342  
343  	brcmf_feat_wlc_version_overrides(drvr);
344  	brcmf_feat_firmware_overrides(drvr);
345  
346  	brcmf_fwvid_feat_attach(ifp);
347  
348  	if (drvr->settings->feature_disable) {
349  		brcmf_dbg(INFO, "Features: 0x%02x, disable: 0x%02x\n",
350  			  ifp->drvr->feat_flags,
351  			  drvr->settings->feature_disable);
352  		ifp->drvr->feat_flags &= ~drvr->settings->feature_disable;
353  	}
354  
355  	/* set chip related quirks */
356  	switch (drvr->bus_if->chip) {
357  	case BRCM_CC_43236_CHIP_ID:
358  		drvr->chip_quirks |= BIT(BRCMF_FEAT_QUIRK_AUTO_AUTH);
359  		break;
360  	case BRCM_CC_4329_CHIP_ID:
361  		drvr->chip_quirks |= BIT(BRCMF_FEAT_QUIRK_NEED_MPC);
362  		break;
363  	default:
364  		/* no quirks */
365  		break;
366  	}
367  }
368  
brcmf_feat_debugfs_create(struct brcmf_pub * drvr)369  void brcmf_feat_debugfs_create(struct brcmf_pub *drvr)
370  {
371  	brcmf_debugfs_add_entry(drvr, "features", brcmf_feat_debugfs_read);
372  	brcmf_debugfs_add_entry(drvr, "fwcap", brcmf_feat_fwcap_debugfs_read);
373  }
374  
brcmf_feat_is_enabled(struct brcmf_if * ifp,enum brcmf_feat_id id)375  bool brcmf_feat_is_enabled(struct brcmf_if *ifp, enum brcmf_feat_id id)
376  {
377  	return (ifp->drvr->feat_flags & BIT(id));
378  }
379  
brcmf_feat_is_quirk_enabled(struct brcmf_if * ifp,enum brcmf_feat_quirk quirk)380  bool brcmf_feat_is_quirk_enabled(struct brcmf_if *ifp,
381  				 enum brcmf_feat_quirk quirk)
382  {
383  	return (ifp->drvr->chip_quirks & BIT(quirk));
384  }
385