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

   1 // SPDX-License-Identifier: ISC
   2 /*
   3  * Copyright (C) 2016 Felix Fietkau <nbd@nbd.name>
   4  */
   5
   6 #include "mt76.h"
   7 #include "dma.h"
   8 #include "trace.h"
   9
  10 static u32 mt76_mmio_rr(struct mt76_dev *dev, u32 offset)
  11 {
  12         u32 val;
  13
  14         val = readl(dev->mmio.regs + offset);
  15         trace_reg_rr(dev, offset, val);
  16
  17         return val;
  18 }
  19
  20 static void mt76_mmio_wr(struct mt76_dev *dev, u32 offset, u32 val)
  21 {
  22         trace_reg_wr(dev, offset, val);
  23         writel(val, dev->mmio.regs + offset);
  24 }
  25
  26 static u32 mt76_mmio_rmw(struct mt76_dev *dev, u32 offset, u32 mask, u32 val)
  27 {
  28         val |= mt76_mmio_rr(dev, offset) & ~mask;
  29         mt76_mmio_wr(dev, offset, val);
  30         return val;
  31 }
  32
  33 static void mt76_mmio_write_copy(struct mt76_dev *dev, u32 offset,
  34                                  const void *data, int len)
  35 {
  36         __iowrite32_copy(dev->mmio.regs + offset, data, DIV_ROUND_UP(len, 4));
  37 }
  38
  39 static void mt76_mmio_read_copy(struct mt76_dev *dev, u32 offset,
  40                                 void *data, int len)
  41 {
  42         __ioread32_copy(data, dev->mmio.regs + offset, DIV_ROUND_UP(len, 4));
  43 }
  44
  45 static int mt76_mmio_wr_rp(struct mt76_dev *dev, u32 base,
  46                            const struct mt76_reg_pair *data, int len)
  47 {
  48         while (len > 0) {
  49                 mt76_mmio_wr(dev, data->reg, data->value);
  50                 data++;
  51                 len--;
  52         }
  53
  54         return 0;
  55 }
  56
  57 static int mt76_mmio_rd_rp(struct mt76_dev *dev, u32 base,
  58                            struct mt76_reg_pair *data, int len)
  59 {
  60         while (len > 0) {
  61                 data->value = mt76_mmio_rr(dev, data->reg);
  62                 data++;
  63                 len--;
  64         }
  65
  66         return 0;
  67 }
  68
  69 void mt76_set_irq_mask(struct mt76_dev *dev, u32 addr,
  70                        u32 clear, u32 set)
  71 {
  72         unsigned long flags;
  73
  74         spin_lock_irqsave(&dev->mmio.irq_lock, flags);
  75         dev->mmio.irqmask &= ~clear;
  76         dev->mmio.irqmask |= set;
  77         if (addr) {
  78                 if (mtk_wed_device_active(&dev->mmio.wed))
  79                         mtk_wed_device_irq_set_mask(&dev->mmio.wed,
  80                                                     dev->mmio.irqmask);
  81                 else
  82                         mt76_mmio_wr(dev, addr, dev->mmio.irqmask);
  83         }
  84         spin_unlock_irqrestore(&dev->mmio.irq_lock, flags);
  85 }
  86 EXPORT_SYMBOL_GPL(mt76_set_irq_mask);
  87
  88 void mt76_mmio_init(struct mt76_dev *dev, void __iomem *regs)
  89 {
  90         static const struct mt76_bus_ops mt76_mmio_ops = {
  91                 .rr = mt76_mmio_rr,
  92                 .rmw = mt76_mmio_rmw,
  93                 .wr = mt76_mmio_wr,
  94                 .write_copy = mt76_mmio_write_copy,
  95                 .read_copy = mt76_mmio_read_copy,
  96                 .wr_rp = mt76_mmio_wr_rp,
  97                 .rd_rp = mt76_mmio_rd_rp,
  98                 .type = MT76_BUS_MMIO,
  99         };
 100
 101         dev->bus = &mt76_mmio_ops;
 102         dev->mmio.regs = regs;
 103
 104         spin_lock_init(&dev->mmio.irq_lock);
 105 }
 106 EXPORT_SYMBOL_GPL(mt76_mmio_init);