mmu-hash*: Don't keep looking for PTEs after we find a match
[qemu/agraf.git] / hw / omap_spi.c
blob1cbd98d338f6e4af033af60b0e5cfa41a701ed41
1 /*
2 * TI OMAP processor's Multichannel SPI emulation.
4 * Copyright (C) 2007-2009 Nokia Corporation
6 * Original code for OMAP2 by Andrzej Zaborowski <andrew@openedhand.com>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 or
11 * (at your option) any later version of the License.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License along
19 * with this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
22 #include "hw/hw.h"
23 #include "hw/omap.h"
25 /* Multichannel SPI */
26 struct omap_mcspi_s {
27 MemoryRegion iomem;
28 qemu_irq irq;
29 int chnum;
31 uint32_t sysconfig;
32 uint32_t systest;
33 uint32_t irqst;
34 uint32_t irqen;
35 uint32_t wken;
36 uint32_t control;
38 struct omap_mcspi_ch_s {
39 qemu_irq txdrq;
40 qemu_irq rxdrq;
41 uint32_t (*txrx)(void *opaque, uint32_t, int);
42 void *opaque;
44 uint32_t tx;
45 uint32_t rx;
47 uint32_t config;
48 uint32_t status;
49 uint32_t control;
50 } ch[4];
53 static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
55 qemu_set_irq(s->irq, s->irqst & s->irqen);
58 static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
60 qemu_set_irq(ch->txdrq,
61 (ch->control & 1) && /* EN */
62 (ch->config & (1 << 14)) && /* DMAW */
63 (ch->status & (1 << 1)) && /* TXS */
64 ((ch->config >> 12) & 3) != 1); /* TRM */
65 qemu_set_irq(ch->rxdrq,
66 (ch->control & 1) && /* EN */
67 (ch->config & (1 << 15)) && /* DMAW */
68 (ch->status & (1 << 0)) && /* RXS */
69 ((ch->config >> 12) & 3) != 2); /* TRM */
72 static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
74 struct omap_mcspi_ch_s *ch = s->ch + chnum;
76 if (!(ch->control & 1)) /* EN */
77 return;
78 if ((ch->status & (1 << 0)) && /* RXS */
79 ((ch->config >> 12) & 3) != 2 && /* TRM */
80 !(ch->config & (1 << 19))) /* TURBO */
81 goto intr_update;
82 if ((ch->status & (1 << 1)) && /* TXS */
83 ((ch->config >> 12) & 3) != 1) /* TRM */
84 goto intr_update;
86 if (!(s->control & 1) || /* SINGLE */
87 (ch->config & (1 << 20))) { /* FORCE */
88 if (ch->txrx)
89 ch->rx = ch->txrx(ch->opaque, ch->tx, /* WL */
90 1 + (0x1f & (ch->config >> 7)));
93 ch->tx = 0;
94 ch->status |= 1 << 2; /* EOT */
95 ch->status |= 1 << 1; /* TXS */
96 if (((ch->config >> 12) & 3) != 2) /* TRM */
97 ch->status |= 1 << 0; /* RXS */
99 intr_update:
100 if ((ch->status & (1 << 0)) && /* RXS */
101 ((ch->config >> 12) & 3) != 2 && /* TRM */
102 !(ch->config & (1 << 19))) /* TURBO */
103 s->irqst |= 1 << (2 + 4 * chnum); /* RX_FULL */
104 if ((ch->status & (1 << 1)) && /* TXS */
105 ((ch->config >> 12) & 3) != 1) /* TRM */
106 s->irqst |= 1 << (0 + 4 * chnum); /* TX_EMPTY */
107 omap_mcspi_interrupt_update(s);
108 omap_mcspi_dmarequest_update(ch);
111 void omap_mcspi_reset(struct omap_mcspi_s *s)
113 int ch;
115 s->sysconfig = 0;
116 s->systest = 0;
117 s->irqst = 0;
118 s->irqen = 0;
119 s->wken = 0;
120 s->control = 4;
122 for (ch = 0; ch < 4; ch ++) {
123 s->ch[ch].config = 0x060000;
124 s->ch[ch].status = 2; /* TXS */
125 s->ch[ch].control = 0;
127 omap_mcspi_dmarequest_update(s->ch + ch);
130 omap_mcspi_interrupt_update(s);
133 static uint64_t omap_mcspi_read(void *opaque, hwaddr addr,
134 unsigned size)
136 struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
137 int ch = 0;
138 uint32_t ret;
140 if (size != 4) {
141 return omap_badwidth_read32(opaque, addr);
144 switch (addr) {
145 case 0x00: /* MCSPI_REVISION */
146 return 0x91;
148 case 0x10: /* MCSPI_SYSCONFIG */
149 return s->sysconfig;
151 case 0x14: /* MCSPI_SYSSTATUS */
152 return 1; /* RESETDONE */
154 case 0x18: /* MCSPI_IRQSTATUS */
155 return s->irqst;
157 case 0x1c: /* MCSPI_IRQENABLE */
158 return s->irqen;
160 case 0x20: /* MCSPI_WAKEUPENABLE */
161 return s->wken;
163 case 0x24: /* MCSPI_SYST */
164 return s->systest;
166 case 0x28: /* MCSPI_MODULCTRL */
167 return s->control;
169 case 0x68: ch ++;
170 /* fall through */
171 case 0x54: ch ++;
172 /* fall through */
173 case 0x40: ch ++;
174 /* fall through */
175 case 0x2c: /* MCSPI_CHCONF */
176 return s->ch[ch].config;
178 case 0x6c: ch ++;
179 /* fall through */
180 case 0x58: ch ++;
181 /* fall through */
182 case 0x44: ch ++;
183 /* fall through */
184 case 0x30: /* MCSPI_CHSTAT */
185 return s->ch[ch].status;
187 case 0x70: ch ++;
188 /* fall through */
189 case 0x5c: ch ++;
190 /* fall through */
191 case 0x48: ch ++;
192 /* fall through */
193 case 0x34: /* MCSPI_CHCTRL */
194 return s->ch[ch].control;
196 case 0x74: ch ++;
197 /* fall through */
198 case 0x60: ch ++;
199 /* fall through */
200 case 0x4c: ch ++;
201 /* fall through */
202 case 0x38: /* MCSPI_TX */
203 return s->ch[ch].tx;
205 case 0x78: ch ++;
206 /* fall through */
207 case 0x64: ch ++;
208 /* fall through */
209 case 0x50: ch ++;
210 /* fall through */
211 case 0x3c: /* MCSPI_RX */
212 s->ch[ch].status &= ~(1 << 0); /* RXS */
213 ret = s->ch[ch].rx;
214 omap_mcspi_transfer_run(s, ch);
215 return ret;
218 OMAP_BAD_REG(addr);
219 return 0;
222 static void omap_mcspi_write(void *opaque, hwaddr addr,
223 uint64_t value, unsigned size)
225 struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
226 int ch = 0;
228 if (size != 4) {
229 return omap_badwidth_write32(opaque, addr, value);
232 switch (addr) {
233 case 0x00: /* MCSPI_REVISION */
234 case 0x14: /* MCSPI_SYSSTATUS */
235 case 0x30: /* MCSPI_CHSTAT0 */
236 case 0x3c: /* MCSPI_RX0 */
237 case 0x44: /* MCSPI_CHSTAT1 */
238 case 0x50: /* MCSPI_RX1 */
239 case 0x58: /* MCSPI_CHSTAT2 */
240 case 0x64: /* MCSPI_RX2 */
241 case 0x6c: /* MCSPI_CHSTAT3 */
242 case 0x78: /* MCSPI_RX3 */
243 OMAP_RO_REG(addr);
244 return;
246 case 0x10: /* MCSPI_SYSCONFIG */
247 if (value & (1 << 1)) /* SOFTRESET */
248 omap_mcspi_reset(s);
249 s->sysconfig = value & 0x31d;
250 break;
252 case 0x18: /* MCSPI_IRQSTATUS */
253 if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
254 s->irqst &= ~value;
255 omap_mcspi_interrupt_update(s);
257 break;
259 case 0x1c: /* MCSPI_IRQENABLE */
260 s->irqen = value & 0x1777f;
261 omap_mcspi_interrupt_update(s);
262 break;
264 case 0x20: /* MCSPI_WAKEUPENABLE */
265 s->wken = value & 1;
266 break;
268 case 0x24: /* MCSPI_SYST */
269 if (s->control & (1 << 3)) /* SYSTEM_TEST */
270 if (value & (1 << 11)) { /* SSB */
271 s->irqst |= 0x1777f;
272 omap_mcspi_interrupt_update(s);
274 s->systest = value & 0xfff;
275 break;
277 case 0x28: /* MCSPI_MODULCTRL */
278 if (value & (1 << 3)) /* SYSTEM_TEST */
279 if (s->systest & (1 << 11)) { /* SSB */
280 s->irqst |= 0x1777f;
281 omap_mcspi_interrupt_update(s);
283 s->control = value & 0xf;
284 break;
286 case 0x68: ch ++;
287 /* fall through */
288 case 0x54: ch ++;
289 /* fall through */
290 case 0x40: ch ++;
291 /* fall through */
292 case 0x2c: /* MCSPI_CHCONF */
293 if ((value ^ s->ch[ch].config) & (3 << 14)) /* DMAR | DMAW */
294 omap_mcspi_dmarequest_update(s->ch + ch);
295 if (((value >> 12) & 3) == 3) /* TRM */
296 fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
297 if (((value >> 7) & 0x1f) < 3) /* WL */
298 fprintf(stderr, "%s: invalid WL value (%" PRIx64 ")\n",
299 __FUNCTION__, (value >> 7) & 0x1f);
300 s->ch[ch].config = value & 0x7fffff;
301 break;
303 case 0x70: ch ++;
304 /* fall through */
305 case 0x5c: ch ++;
306 /* fall through */
307 case 0x48: ch ++;
308 /* fall through */
309 case 0x34: /* MCSPI_CHCTRL */
310 if (value & ~s->ch[ch].control & 1) { /* EN */
311 s->ch[ch].control |= 1;
312 omap_mcspi_transfer_run(s, ch);
313 } else
314 s->ch[ch].control = value & 1;
315 break;
317 case 0x74: ch ++;
318 /* fall through */
319 case 0x60: ch ++;
320 /* fall through */
321 case 0x4c: ch ++;
322 /* fall through */
323 case 0x38: /* MCSPI_TX */
324 s->ch[ch].tx = value;
325 s->ch[ch].status &= ~(1 << 1); /* TXS */
326 omap_mcspi_transfer_run(s, ch);
327 break;
329 default:
330 OMAP_BAD_REG(addr);
331 return;
335 static const MemoryRegionOps omap_mcspi_ops = {
336 .read = omap_mcspi_read,
337 .write = omap_mcspi_write,
338 .endianness = DEVICE_NATIVE_ENDIAN,
341 struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
342 qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
344 struct omap_mcspi_s *s = (struct omap_mcspi_s *)
345 g_malloc0(sizeof(struct omap_mcspi_s));
346 struct omap_mcspi_ch_s *ch = s->ch;
348 s->irq = irq;
349 s->chnum = chnum;
350 while (chnum --) {
351 ch->txdrq = *drq ++;
352 ch->rxdrq = *drq ++;
353 ch ++;
355 omap_mcspi_reset(s);
357 memory_region_init_io(&s->iomem, &omap_mcspi_ops, s, "omap.mcspi",
358 omap_l4_region_size(ta, 0));
359 omap_l4_attach(ta, 0, &s->iomem);
361 return s;
364 void omap_mcspi_attach(struct omap_mcspi_s *s,
365 uint32_t (*txrx)(void *opaque, uint32_t, int), void *opaque,
366 int chipselect)
368 if (chipselect < 0 || chipselect >= s->chnum)
369 hw_error("%s: Bad chipselect %i\n", __FUNCTION__, chipselect);
371 s->ch[chipselect].txrx = txrx;
372 s->ch[chipselect].opaque = opaque;