blob: 1edd7e06462135f4ecc2192b67f12852e2a5a77d [file] [log] [blame]
Hauke Mehrtensecd177c2011-07-23 01:20:08 +02001/*
2 * Broadcom specific AMBA
3 * System on Chip (SoC) Host
4 *
5 * Licensed under the GNU/GPL. See COPYING for details.
6 */
7
8#include "bcma_private.h"
9#include "scan.h"
10#include <linux/bcma/bcma.h>
11#include <linux/bcma/bcma_soc.h>
12
13static u8 bcma_host_soc_read8(struct bcma_device *core, u16 offset)
14{
15 return readb(core->io_addr + offset);
16}
17
18static u16 bcma_host_soc_read16(struct bcma_device *core, u16 offset)
19{
20 return readw(core->io_addr + offset);
21}
22
23static u32 bcma_host_soc_read32(struct bcma_device *core, u16 offset)
24{
25 return readl(core->io_addr + offset);
26}
27
28static void bcma_host_soc_write8(struct bcma_device *core, u16 offset,
29 u8 value)
30{
31 writeb(value, core->io_addr + offset);
32}
33
34static void bcma_host_soc_write16(struct bcma_device *core, u16 offset,
35 u16 value)
36{
37 writew(value, core->io_addr + offset);
38}
39
40static void bcma_host_soc_write32(struct bcma_device *core, u16 offset,
41 u32 value)
42{
43 writel(value, core->io_addr + offset);
44}
45
46#ifdef CONFIG_BCMA_BLOCKIO
47static void bcma_host_soc_block_read(struct bcma_device *core, void *buffer,
48 size_t count, u16 offset, u8 reg_width)
49{
50 void __iomem *addr = core->io_addr + offset;
51
52 switch (reg_width) {
53 case sizeof(u8): {
54 u8 *buf = buffer;
55
56 while (count) {
57 *buf = __raw_readb(addr);
58 buf++;
59 count--;
60 }
61 break;
62 }
63 case sizeof(u16): {
64 __le16 *buf = buffer;
65
66 WARN_ON(count & 1);
67 while (count) {
68 *buf = (__force __le16)__raw_readw(addr);
69 buf++;
70 count -= 2;
71 }
72 break;
73 }
74 case sizeof(u32): {
75 __le32 *buf = buffer;
76
77 WARN_ON(count & 3);
78 while (count) {
79 *buf = (__force __le32)__raw_readl(addr);
80 buf++;
81 count -= 4;
82 }
83 break;
84 }
85 default:
86 WARN_ON(1);
87 }
88}
89
90static void bcma_host_soc_block_write(struct bcma_device *core,
91 const void *buffer,
92 size_t count, u16 offset, u8 reg_width)
93{
94 void __iomem *addr = core->io_addr + offset;
95
96 switch (reg_width) {
97 case sizeof(u8): {
98 const u8 *buf = buffer;
99
100 while (count) {
101 __raw_writeb(*buf, addr);
102 buf++;
103 count--;
104 }
105 break;
106 }
107 case sizeof(u16): {
108 const __le16 *buf = buffer;
109
110 WARN_ON(count & 1);
111 while (count) {
112 __raw_writew((__force u16)(*buf), addr);
113 buf++;
114 count -= 2;
115 }
116 break;
117 }
118 case sizeof(u32): {
119 const __le32 *buf = buffer;
120
121 WARN_ON(count & 3);
122 while (count) {
123 __raw_writel((__force u32)(*buf), addr);
124 buf++;
125 count -= 4;
126 }
127 break;
128 }
129 default:
130 WARN_ON(1);
131 }
132}
133#endif /* CONFIG_BCMA_BLOCKIO */
134
135static u32 bcma_host_soc_aread32(struct bcma_device *core, u16 offset)
136{
Hauke Mehrtensecf47e92014-08-22 08:44:52 +0200137 if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
138 return ~0;
Hauke Mehrtensecd177c2011-07-23 01:20:08 +0200139 return readl(core->io_wrap + offset);
140}
141
142static void bcma_host_soc_awrite32(struct bcma_device *core, u16 offset,
143 u32 value)
144{
Hauke Mehrtensecf47e92014-08-22 08:44:52 +0200145 if (WARN_ONCE(!core->io_wrap, "Accessed core has no wrapper/agent\n"))
146 return;
Hauke Mehrtensecd177c2011-07-23 01:20:08 +0200147 writel(value, core->io_wrap + offset);
148}
149
Hauke Mehrtens94f34572012-08-05 16:54:41 +0200150static const struct bcma_host_ops bcma_host_soc_ops = {
Hauke Mehrtensecd177c2011-07-23 01:20:08 +0200151 .read8 = bcma_host_soc_read8,
152 .read16 = bcma_host_soc_read16,
153 .read32 = bcma_host_soc_read32,
154 .write8 = bcma_host_soc_write8,
155 .write16 = bcma_host_soc_write16,
156 .write32 = bcma_host_soc_write32,
157#ifdef CONFIG_BCMA_BLOCKIO
158 .block_read = bcma_host_soc_block_read,
159 .block_write = bcma_host_soc_block_write,
160#endif
161 .aread32 = bcma_host_soc_aread32,
162 .awrite32 = bcma_host_soc_awrite32,
163};
164
165int __init bcma_host_soc_register(struct bcma_soc *soc)
166{
167 struct bcma_bus *bus = &soc->bus;
168 int err;
169
170 /* iomap only first core. We have to read some register on this core
171 * to scan the bus.
172 */
173 bus->mmio = ioremap_nocache(BCMA_ADDR_BASE, BCMA_CORE_SIZE * 1);
174 if (!bus->mmio)
175 return -ENOMEM;
176
177 /* Host specific */
178 bus->hosttype = BCMA_HOSTTYPE_SOC;
179 bus->ops = &bcma_host_soc_ops;
180
181 /* Register */
182 err = bcma_bus_early_register(bus, &soc->core_cc, &soc->core_mips);
183 if (err)
184 iounmap(bus->mmio);
185
186 return err;
187}