nbd-server: do not check request length except for reads and writes
[qemu/ar7.git] / hw / ssi / omap_spi.c
blob27263299bec5ed344c1c4ad8923e5ac46de07b74
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/arm/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 omap_badwidth_write32(opaque, addr, value);
230 return;
233 switch (addr) {
234 case 0x00: /* MCSPI_REVISION */
235 case 0x14: /* MCSPI_SYSSTATUS */
236 case 0x30: /* MCSPI_CHSTAT0 */
237 case 0x3c: /* MCSPI_RX0 */
238 case 0x44: /* MCSPI_CHSTAT1 */
239 case 0x50: /* MCSPI_RX1 */
240 case 0x58: /* MCSPI_CHSTAT2 */
241 case 0x64: /* MCSPI_RX2 */
242 case 0x6c: /* MCSPI_CHSTAT3 */
243 case 0x78: /* MCSPI_RX3 */
244 OMAP_RO_REG(addr);
245 return;
247 case 0x10: /* MCSPI_SYSCONFIG */
248 if (value & (1 << 1)) /* SOFTRESET */
249 omap_mcspi_reset(s);
250 s->sysconfig = value & 0x31d;
251 break;
253 case 0x18: /* MCSPI_IRQSTATUS */
254 if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
255 s->irqst &= ~value;
256 omap_mcspi_interrupt_update(s);
258 break;
260 case 0x1c: /* MCSPI_IRQENABLE */
261 s->irqen = value & 0x1777f;
262 omap_mcspi_interrupt_update(s);
263 break;
265 case 0x20: /* MCSPI_WAKEUPENABLE */
266 s->wken = value & 1;
267 break;
269 case 0x24: /* MCSPI_SYST */
270 if (s->control & (1 << 3)) /* SYSTEM_TEST */
271 if (value & (1 << 11)) { /* SSB */
272 s->irqst |= 0x1777f;
273 omap_mcspi_interrupt_update(s);
275 s->systest = value & 0xfff;
276 break;
278 case 0x28: /* MCSPI_MODULCTRL */
279 if (value & (1 << 3)) /* SYSTEM_TEST */
280 if (s->systest & (1 << 11)) { /* SSB */
281 s->irqst |= 0x1777f;
282 omap_mcspi_interrupt_update(s);
284 s->control = value & 0xf;
285 break;
287 case 0x68: ch ++;
288 /* fall through */
289 case 0x54: ch ++;
290 /* fall through */
291 case 0x40: ch ++;
292 /* fall through */
293 case 0x2c: /* MCSPI_CHCONF */
294 if ((value ^ s->ch[ch].config) & (3 << 14)) /* DMAR | DMAW */
295 omap_mcspi_dmarequest_update(s->ch + ch);
296 if (((value >> 12) & 3) == 3) /* TRM */
297 fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
298 if (((value >> 7) & 0x1f) < 3) /* WL */
299 fprintf(stderr, "%s: invalid WL value (%" PRIx64 ")\n",
300 __FUNCTION__, (value >> 7) & 0x1f);
301 s->ch[ch].config = value & 0x7fffff;
302 break;
304 case 0x70: ch ++;
305 /* fall through */
306 case 0x5c: ch ++;
307 /* fall through */
308 case 0x48: ch ++;
309 /* fall through */
310 case 0x34: /* MCSPI_CHCTRL */
311 if (value & ~s->ch[ch].control & 1) { /* EN */
312 s->ch[ch].control |= 1;
313 omap_mcspi_transfer_run(s, ch);
314 } else
315 s->ch[ch].control = value & 1;
316 break;
318 case 0x74: ch ++;
319 /* fall through */
320 case 0x60: ch ++;
321 /* fall through */
322 case 0x4c: ch ++;
323 /* fall through */
324 case 0x38: /* MCSPI_TX */
325 s->ch[ch].tx = value;
326 s->ch[ch].status &= ~(1 << 1); /* TXS */
327 omap_mcspi_transfer_run(s, ch);
328 break;
330 default:
331 OMAP_BAD_REG(addr);
332 return;
336 static const MemoryRegionOps omap_mcspi_ops = {
337 .read = omap_mcspi_read,
338 .write = omap_mcspi_write,
339 .endianness = DEVICE_NATIVE_ENDIAN,
342 struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
343 qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
345 struct omap_mcspi_s *s = g_new0(struct omap_mcspi_s, 1);
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, NULL, &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;