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