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->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->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->regs + offset, data, len >> 2);
  47 }
  48
  49 void mt76_mmio_init(struct mt76_dev *dev, void __iomem *regs)
  50 {
  51         static const struct mt76_bus_ops mt76_mmio_ops = {
  52                 .rr = mt76_mmio_rr,
  53                 .rmw = mt76_mmio_rmw,
  54                 .wr = mt76_mmio_wr,
  55                 .copy = mt76_mmio_copy,
  56         };
  57
  58         dev->bus = &mt76_mmio_ops;
  59         dev->regs = regs;
  60 }
  61 EXPORT_SYMBOL_GPL(mt76_mmio_init);