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");