drivers/net/wireless/broadcom/b43/phy_ac.c

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