2 * B53 register access through memory mapped registers
4 * Copyright (C) 2012-2013 Jonas Gorski <jogo@openwrt.org>
6 * Permission to use, copy, modify, and/or distribute this software for any
7 * purpose with or without fee is hereby granted, provided that the above
8 * copyright notice and this permission notice appear in all copies.
10 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
11 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
12 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
13 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
14 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
15 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
16 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
19 #include <linux/kernel.h>
20 #include <linux/module.h>
21 #include <linux/platform_device.h>
22 #include <linux/platform_data/b53.h>
26 static int b53_mmap_read8(struct b53_device *dev, u8 page, u8 reg, u8 *val)
28 u8 __iomem *regs = dev->priv;
30 *val = readb(regs + (page << 8) + reg);
35 static int b53_mmap_read16(struct b53_device *dev, u8 page, u8 reg, u16 *val)
37 u8 __iomem *regs = dev->priv;
42 if (dev->pdata && dev->pdata->big_endian)
43 *val = readw_be(regs + (page << 8) + reg);
45 *val = readw(regs + (page << 8) + reg);
50 static int b53_mmap_read32(struct b53_device *dev, u8 page, u8 reg, u32 *val)
52 u8 __iomem *regs = dev->priv;
57 if (dev->pdata && dev->pdata->big_endian)
58 *val = readl_be(regs + (page << 8) + reg);
60 *val = readl(regs + (page << 8) + reg);
65 static int b53_mmap_read48(struct b53_device *dev, u8 page, u8 reg, u64 *val)
67 u8 __iomem *regs = dev->priv;
72 if (dev->pdata && dev->pdata->big_endian) {
73 *val = readl_be(regs + (page << 8) + reg);
75 *val |= readw_be(regs + (page << 8) + reg + 4);
77 *val |= readw(regs + (page << 8) + reg + 4);
79 *val = readl(regs + (page << 8) + reg);
85 static int b53_mmap_read64(struct b53_device *dev, u8 page, u8 reg, u64 *val)
87 u8 __iomem *regs = dev->priv;
93 if (dev->pdata && dev->pdata->big_endian) {
94 lo = readl_be(regs + (page << 8) + reg);
95 hi = readl_be(regs + (page << 8) + reg + 4);
97 lo = readl(regs + (page << 8) + reg);
98 hi = readl(regs + (page << 8) + reg + 4);
101 *val = ((u64)hi << 32) | lo;
106 static int b53_mmap_write8(struct b53_device *dev, u8 page, u8 reg, u8 value)
108 u8 __iomem *regs = dev->priv;
110 writeb(value, regs + (page << 8) + reg);
115 static int b53_mmap_write16(struct b53_device *dev, u8 page, u8 reg,
118 u8 __iomem *regs = dev->priv;
120 if (WARN_ON(reg % 2))
123 if (dev->pdata && dev->pdata->big_endian)
124 writew_be(value, regs + (page << 8) + reg);
126 writew(value, regs + (page << 8) + reg);
131 static int b53_mmap_write32(struct b53_device *dev, u8 page, u8 reg,
134 u8 __iomem *regs = dev->priv;
136 if (WARN_ON(reg % 4))
139 if (dev->pdata && dev->pdata->big_endian)
140 writel_be(value, regs + (page << 8) + reg);
142 writel(value, regs + (page << 8) + reg);
147 static int b53_mmap_write48(struct b53_device *dev, u8 page, u8 reg,
150 u8 __iomem *regs = dev->priv;
152 if (WARN_ON(reg % 4))
155 if (dev->pdata && dev->pdata->big_endian) {
156 writel_be((u32)(value >> 16), regs + (page << 8) + reg);
157 writew_be((u16)value, regs + (page << 8) + reg + 4);
159 writel((u32)value, regs + (page << 8) + reg);
160 writew((u16)(value >> 32), regs + (page << 8) + reg + 4);
166 static int b53_mmap_write64(struct b53_device *dev, u8 page, u8 reg,
169 u8 __iomem *regs = dev->priv;
171 if (WARN_ON(reg % 4))
174 if (dev->pdata && dev->pdata->big_endian) {
175 writel_be((u32)(value >> 32), regs + (page << 8) + reg);
176 writel_be((u32)value, regs + (page << 8) + reg + 4);
178 writel((u32)value, regs + (page << 8) + reg);
179 writel((u32)(value >> 32), regs + (page << 8) + reg + 4);
185 static struct b53_io_ops b53_mmap_ops = {
186 .read8 = b53_mmap_read8,
187 .read16 = b53_mmap_read16,
188 .read32 = b53_mmap_read32,
189 .read48 = b53_mmap_read48,
190 .read64 = b53_mmap_read64,
191 .write8 = b53_mmap_write8,
192 .write16 = b53_mmap_write16,
193 .write32 = b53_mmap_write32,
194 .write48 = b53_mmap_write48,
195 .write64 = b53_mmap_write64,
198 static int b53_mmap_probe(struct platform_device *pdev)
200 struct b53_platform_data *pdata = pdev->dev.platform_data;
201 struct b53_device *dev;
206 dev = b53_switch_alloc(&pdev->dev, &b53_mmap_ops, pdata->regs);
213 platform_set_drvdata(pdev, dev);
215 return b53_switch_register(dev);
218 static int b53_mmap_remove(struct platform_device *pdev)
220 struct b53_device *dev = platform_get_drvdata(pdev);
223 b53_switch_remove(dev);
229 static struct platform_driver b53_mmap_driver = {
230 .probe = b53_mmap_probe,
231 .remove = b53_mmap_remove,
233 .name = "b53-switch",
237 module_platform_driver(b53_mmap_driver);
238 MODULE_AUTHOR("Jonas Gorski <jogo@openwrt.org>");
239 MODULE_DESCRIPTION("B53 MMAP access driver");
240 MODULE_LICENSE("Dual BSD/GPL");