drivers/net/wireless/mediatek/mt76/mmio.c

   1 /*
   2  * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
   3  *
   4  * Permission to use, copy, modify, and/or distribute this software for any
   5  * purpose with or without fee is hereby granted, provided that the above
   6  * copyright notice and this permission notice appear in all copies.
   7  *
   8  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
   9  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
  10  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
  11  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
  12  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
  13  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
  14  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
  15  */
  16
  17 #include "mt76.h"
  18 #include "trace.h"
  19
  20 static u32 mt76_mmio_rr(struct mt76_dev *dev, u32 offset)
  21 {
  22         u32 val;
  23
  24         val = ioread32(dev->mmio.regs + offset);
  25         trace_reg_rr(dev, offset, val);
  26
  27         return val;
  28 }
  29
  30 static void mt76_mmio_wr(struct mt76_dev *dev, u32 offset, u32 val)
  31 {
  32         trace_reg_wr(dev, offset, val);
  33         iowrite32(val, dev->mmio.regs + offset);
  34 }
  35
  36 static u32 mt76_mmio_rmw(struct mt76_dev *dev, u32 offset, u32 mask, u32 val)
  37 {
  38         val |= mt76_mmio_rr(dev, offset) & ~mask;
  39         mt76_mmio_wr(dev, offset, val);
  40         return val;
  41 }
  42
  43 static void mt76_mmio_copy(struct mt76_dev *dev, u32 offset, const void *data,
  44                            int len)
  45 {
  46         __iowrite32_copy(dev->mmio.regs + offset, data, len >> 2);
  47 }
  48
  49 static int mt76_mmio_wr_rp(struct mt76_dev *dev, u32 base,
  50                            const struct mt76_reg_pair *data, int len)
  51 {
  52         while (len > 0) {
  53                 mt76_mmio_wr(dev, data->reg, data->value);
  54                 data++;
  55                 len--;
  56         }
  57
  58         return 0;
  59 }
  60
  61 static int mt76_mmio_rd_rp(struct mt76_dev *dev, u32 base,
  62                            struct mt76_reg_pair *data, int len)
  63 {
  64         while (len > 0) {
  65                 data->value = mt76_mmio_rr(dev, data->reg);
  66                 data++;
  67                 len--;
  68         }
  69
  70         return 0;
  71 }
  72
  73 void mt76_mmio_init(struct mt76_dev *dev, void __iomem *regs)
  74 {
  75         static const struct mt76_bus_ops mt76_mmio_ops = {
  76                 .rr = mt76_mmio_rr,
  77                 .rmw = mt76_mmio_rmw,
  78                 .wr = mt76_mmio_wr,
  79                 .copy = mt76_mmio_copy,
  80                 .wr_rp = mt76_mmio_wr_rp,
  81                 .rd_rp = mt76_mmio_rd_rp,
  82                 .type = MT76_BUS_MMIO,
  83         };
  84
  85         dev->bus = &mt76_mmio_ops;
  86         dev->mmio.regs = regs;
  87
  88         skb_queue_head_init(&dev->mmio.mcu.res_q);
  89         init_waitqueue_head(&dev->mmio.mcu.wait);
  90         spin_lock_init(&dev->mmio.irq_lock);
  91         mutex_init(&dev->mmio.mcu.mutex);
  92 }
  93 EXPORT_SYMBOL_GPL(mt76_mmio_init);