1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * Broadcom B43 wireless driver
4  * IEEE 802.11ac AC-PHY support
5  *
6  * Copyright (c) 2015 Rafał Miłecki <zajec5@gmail.com>
7  */
8 
9 #include "b43.h"
10 #include "phy_ac.h"
11 
12 /**************************************************
13  * Basic PHY ops
14  **************************************************/
15 
b43_phy_ac_op_allocate(struct b43_wldev * dev)16 static int b43_phy_ac_op_allocate(struct b43_wldev *dev)
17 {
18 	struct b43_phy_ac *phy_ac;
19 
20 	phy_ac = kzalloc(sizeof(*phy_ac), GFP_KERNEL);
21 	if (!phy_ac)
22 		return -ENOMEM;
23 	dev->phy.ac = phy_ac;
24 
25 	return 0;
26 }
27 
b43_phy_ac_op_free(struct b43_wldev * dev)28 static void b43_phy_ac_op_free(struct b43_wldev *dev)
29 {
30 	struct b43_phy *phy = &dev->phy;
31 	struct b43_phy_ac *phy_ac = phy->ac;
32 
33 	kfree(phy_ac);
34 	phy->ac = NULL;
35 }
36 
b43_phy_ac_op_maskset(struct b43_wldev * dev,u16 reg,u16 mask,u16 set)37 static void b43_phy_ac_op_maskset(struct b43_wldev *dev, u16 reg, u16 mask,
38 				  u16 set)
39 {
40 	b43_write16f(dev, B43_MMIO_PHY_CONTROL, reg);
41 	b43_write16(dev, B43_MMIO_PHY_DATA,
42 		    (b43_read16(dev, B43_MMIO_PHY_DATA) & mask) | set);
43 }
44 
b43_phy_ac_op_radio_read(struct b43_wldev * dev,u16 reg)45 static u16 b43_phy_ac_op_radio_read(struct b43_wldev *dev, u16 reg)
46 {
47 	b43_write16f(dev, B43_MMIO_RADIO24_CONTROL, reg);
48 	return b43_read16(dev, B43_MMIO_RADIO24_DATA);
49 }
50 
b43_phy_ac_op_radio_write(struct b43_wldev * dev,u16 reg,u16 value)51 static void b43_phy_ac_op_radio_write(struct b43_wldev *dev, u16 reg,
52 				      u16 value)
53 {
54 	b43_write16f(dev, B43_MMIO_RADIO24_CONTROL, reg);
55 	b43_write16(dev, B43_MMIO_RADIO24_DATA, value);
56 }
57 
b43_phy_ac_op_get_default_chan(struct b43_wldev * dev)58 static unsigned int b43_phy_ac_op_get_default_chan(struct b43_wldev *dev)
59 {
60 	if (b43_current_band(dev->wl) == NL80211_BAND_2GHZ)
61 		return 11;
62 	return 36;
63 }
64 
65 static enum b43_txpwr_result
b43_phy_ac_op_recalc_txpower(struct b43_wldev * dev,bool ignore_tssi)66 b43_phy_ac_op_recalc_txpower(struct b43_wldev *dev, bool ignore_tssi)
67 {
68 	return B43_TXPWR_RES_DONE;
69 }
70 
b43_phy_ac_op_adjust_txpower(struct b43_wldev * dev)71 static void b43_phy_ac_op_adjust_txpower(struct b43_wldev *dev)
72 {
73 }
74 
75 /**************************************************
76  * PHY ops struct
77  **************************************************/
78 
79 const struct b43_phy_operations b43_phyops_ac = {
80 	.allocate		= b43_phy_ac_op_allocate,
81 	.free			= b43_phy_ac_op_free,
82 	.phy_maskset		= b43_phy_ac_op_maskset,
83 	.radio_read		= b43_phy_ac_op_radio_read,
84 	.radio_write		= b43_phy_ac_op_radio_write,
85 	.get_default_chan	= b43_phy_ac_op_get_default_chan,
86 	.recalc_txpower		= b43_phy_ac_op_recalc_txpower,
87 	.adjust_txpower		= b43_phy_ac_op_adjust_txpower,
88 };
89