broadcom/b43/phy_ac.c

0001 // SPDX-License-Identifier: GPL-2.0-or-later
0002 /*
0003  * Broadcom B43 wireless driver
0004  * IEEE 802.11ac AC-PHY support
0005  *
0006  * Copyright (c) 2015 Rafał Miłecki <zajec5@gmail.com>
0007  */
0008
0009 #include "b43.h"
0010 #include "phy_ac.h"
0011
0012 /**************************************************
0013  * Basic PHY ops
0014  **************************************************/
0015
0016 static int b43_phy_ac_op_allocate(struct b43_wldev *dev)
0017 {
0018     struct b43_phy_ac *phy_ac;
0019
0020     phy_ac = kzalloc(sizeof(*phy_ac), GFP_KERNEL);
0021     if (!phy_ac)
0022         return -ENOMEM;
0023     dev->phy.ac = phy_ac;
0024
0025     return 0;
0026 }
0027
0028 static void b43_phy_ac_op_free(struct b43_wldev *dev)
0029 {
0030     struct b43_phy *phy = &dev->phy;
0031     struct b43_phy_ac *phy_ac = phy->ac;
0032
0033     kfree(phy_ac);
0034     phy->ac = NULL;
0035 }
0036
0037 static void b43_phy_ac_op_maskset(struct b43_wldev *dev, u16 reg, u16 mask,
0038                   u16 set)
0039 {
0040     b43_write16f(dev, B43_MMIO_PHY_CONTROL, reg);
0041     b43_write16(dev, B43_MMIO_PHY_DATA,
0042             (b43_read16(dev, B43_MMIO_PHY_DATA) & mask) | set);
0043 }
0044
0045 static u16 b43_phy_ac_op_radio_read(struct b43_wldev *dev, u16 reg)
0046 {
0047     b43_write16f(dev, B43_MMIO_RADIO24_CONTROL, reg);
0048     return b43_read16(dev, B43_MMIO_RADIO24_DATA);
0049 }
0050
0051 static void b43_phy_ac_op_radio_write(struct b43_wldev *dev, u16 reg,
0052                       u16 value)
0053 {
0054     b43_write16f(dev, B43_MMIO_RADIO24_CONTROL, reg);
0055     b43_write16(dev, B43_MMIO_RADIO24_DATA, value);
0056 }
0057
0058 static unsigned int b43_phy_ac_op_get_default_chan(struct b43_wldev *dev)
0059 {
0060     if (b43_current_band(dev->wl) == NL80211_BAND_2GHZ)
0061         return 11;
0062     return 36;
0063 }
0064
0065 static enum b43_txpwr_result
0066 b43_phy_ac_op_recalc_txpower(struct b43_wldev *dev, bool ignore_tssi)
0067 {
0068     return B43_TXPWR_RES_DONE;
0069 }
0070
0071 static void b43_phy_ac_op_adjust_txpower(struct b43_wldev *dev)
0072 {
0073 }
0074
0075 /**************************************************
0076  * PHY ops struct
0077  **************************************************/
0078
0079 const struct b43_phy_operations b43_phyops_ac = {
0080     .allocate       = b43_phy_ac_op_allocate,
0081     .free           = b43_phy_ac_op_free,
0082     .phy_maskset        = b43_phy_ac_op_maskset,
0083     .radio_read     = b43_phy_ac_op_radio_read,
0084     .radio_write        = b43_phy_ac_op_radio_write,
0085     .get_default_chan   = b43_phy_ac_op_get_default_chan,
0086     .recalc_txpower     = b43_phy_ac_op_recalc_txpower,
0087     .adjust_txpower     = b43_phy_ac_op_adjust_txpower,
0088 };