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)
74 b53_mmap_read16(dev, page, reg, &lo);
75 b53_mmap_read32(dev, page, reg + 2, &hi);
77 *val = ((u64)hi << 16) | lo;
82 b53_mmap_read32(dev, page, reg, &lo);
83 b53_mmap_read16(dev, page, reg + 4, &hi);
85 *val = ((u64)hi << 32) | lo;
91 static int b53_mmap_read64(struct b53_device *dev, u8 page, u8 reg, u64 *val)
98 b53_mmap_read32(dev, page, reg, &lo);
99 b53_mmap_read32(dev, page, reg + 4, &hi);
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 if (WARN_ON(reg % 2))
154 u32 hi = (u32)(value >> 16);
157 b53_mmap_write16(dev, page, reg, lo);
158 b53_mmap_write32(dev, page, reg + 2, hi);
160 u16 hi = (u16)(value >> 32);
163 b53_mmap_write32(dev, page, reg, lo);
164 b53_mmap_write16(dev, page, reg + 4, hi);
170 static int b53_mmap_write64(struct b53_device *dev, u8 page, u8 reg,
175 hi = (u32)(value >> 32);
178 if (WARN_ON(reg % 4))
181 b53_mmap_write32(dev, page, reg, lo);
182 b53_mmap_write32(dev, page, reg + 4, hi);
187 static struct b53_io_ops b53_mmap_ops = {
188 .read8 = b53_mmap_read8,
189 .read16 = b53_mmap_read16,
190 .read32 = b53_mmap_read32,
191 .read48 = b53_mmap_read48,
192 .read64 = b53_mmap_read64,
193 .write8 = b53_mmap_write8,
194 .write16 = b53_mmap_write16,
195 .write32 = b53_mmap_write32,
196 .write48 = b53_mmap_write48,
197 .write64 = b53_mmap_write64,
200 static int b53_mmap_probe(struct platform_device *pdev)
202 struct b53_platform_data *pdata = pdev->dev.platform_data;
203 struct b53_device *dev;
208 dev = b53_switch_alloc(&pdev->dev, &b53_mmap_ops, pdata->regs);
215 platform_set_drvdata(pdev, dev);
217 return b53_switch_register(dev);
220 static int b53_mmap_remove(struct platform_device *pdev)
222 struct b53_device *dev = platform_get_drvdata(pdev);
225 b53_switch_remove(dev);
230 static struct platform_driver b53_mmap_driver = {
231 .probe = b53_mmap_probe,
232 .remove = b53_mmap_remove,
234 .name = "b53-switch",
238 module_platform_driver(b53_mmap_driver);
239 MODULE_AUTHOR("Jonas Gorski <jogo@openwrt.org>");
240 MODULE_DESCRIPTION("B53 MMAP access driver");
241 MODULE_LICENSE("Dual BSD/GPL");