]>
Commit | Line | Data |
---|---|---|
94befa45 PC |
1 | /* |
2 | * QEMU model of the Xilinx Zynq SPI controller | |
3 | * | |
4 | * Copyright (c) 2012 Peter A. G. Crosthwaite | |
5 | * | |
6 | * Permission is hereby granted, free of charge, to any person obtaining a copy | |
7 | * of this software and associated documentation files (the "Software"), to deal | |
8 | * in the Software without restriction, including without limitation the rights | |
9 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
10 | * copies of the Software, and to permit persons to whom the Software is | |
11 | * furnished to do so, subject to the following conditions: | |
12 | * | |
13 | * The above copyright notice and this permission notice shall be included in | |
14 | * all copies or substantial portions of the Software. | |
15 | * | |
16 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
17 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
18 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
19 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
20 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
21 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
22 | * THE SOFTWARE. | |
23 | */ | |
24 | ||
83c9f4ca | 25 | #include "hw/sysbus.h" |
9c17d615 | 26 | #include "sysemu/sysemu.h" |
83c9f4ca | 27 | #include "hw/ptimer.h" |
1de7afc9 | 28 | #include "qemu/log.h" |
fd7f0d66 | 29 | #include "qemu/fifo8.h" |
83c9f4ca | 30 | #include "hw/ssi.h" |
1de7afc9 | 31 | #include "qemu/bitops.h" |
94befa45 PC |
32 | |
33 | #ifdef XILINX_SPIPS_ERR_DEBUG | |
34 | #define DB_PRINT(...) do { \ | |
35 | fprintf(stderr, ": %s: ", __func__); \ | |
36 | fprintf(stderr, ## __VA_ARGS__); \ | |
37 | } while (0); | |
38 | #else | |
39 | #define DB_PRINT(...) | |
40 | #endif | |
41 | ||
42 | /* config register */ | |
43 | #define R_CONFIG (0x00 / 4) | |
f1241144 PC |
44 | #define IFMODE (1 << 31) |
45 | #define ENDIAN (1 << 26) | |
94befa45 PC |
46 | #define MODEFAIL_GEN_EN (1 << 17) |
47 | #define MAN_START_COM (1 << 16) | |
48 | #define MAN_START_EN (1 << 15) | |
49 | #define MANUAL_CS (1 << 14) | |
50 | #define CS (0xF << 10) | |
51 | #define CS_SHIFT (10) | |
52 | #define PERI_SEL (1 << 9) | |
53 | #define REF_CLK (1 << 8) | |
54 | #define FIFO_WIDTH (3 << 6) | |
55 | #define BAUD_RATE_DIV (7 << 3) | |
56 | #define CLK_PH (1 << 2) | |
57 | #define CLK_POL (1 << 1) | |
58 | #define MODE_SEL (1 << 0) | |
59 | ||
60 | /* interrupt mechanism */ | |
61 | #define R_INTR_STATUS (0x04 / 4) | |
62 | #define R_INTR_EN (0x08 / 4) | |
63 | #define R_INTR_DIS (0x0C / 4) | |
64 | #define R_INTR_MASK (0x10 / 4) | |
65 | #define IXR_TX_FIFO_UNDERFLOW (1 << 6) | |
66 | #define IXR_RX_FIFO_FULL (1 << 5) | |
67 | #define IXR_RX_FIFO_NOT_EMPTY (1 << 4) | |
68 | #define IXR_TX_FIFO_FULL (1 << 3) | |
69 | #define IXR_TX_FIFO_NOT_FULL (1 << 2) | |
70 | #define IXR_TX_FIFO_MODE_FAIL (1 << 1) | |
71 | #define IXR_RX_FIFO_OVERFLOW (1 << 0) | |
72 | #define IXR_ALL ((IXR_TX_FIFO_UNDERFLOW<<1)-1) | |
73 | ||
74 | #define R_EN (0x14 / 4) | |
75 | #define R_DELAY (0x18 / 4) | |
76 | #define R_TX_DATA (0x1C / 4) | |
77 | #define R_RX_DATA (0x20 / 4) | |
78 | #define R_SLAVE_IDLE_COUNT (0x24 / 4) | |
79 | #define R_TX_THRES (0x28 / 4) | |
80 | #define R_RX_THRES (0x2C / 4) | |
f1241144 PC |
81 | #define R_TXD1 (0x80 / 4) |
82 | #define R_TXD2 (0x84 / 4) | |
83 | #define R_TXD3 (0x88 / 4) | |
84 | ||
85 | #define R_LQSPI_CFG (0xa0 / 4) | |
86 | #define R_LQSPI_CFG_RESET 0x03A002EB | |
87 | #define LQSPI_CFG_LQ_MODE (1 << 31) | |
88 | #define LQSPI_CFG_TWO_MEM (1 << 30) | |
89 | #define LQSPI_CFG_SEP_BUS (1 << 30) | |
90 | #define LQSPI_CFG_U_PAGE (1 << 28) | |
91 | #define LQSPI_CFG_MODE_EN (1 << 25) | |
92 | #define LQSPI_CFG_MODE_WIDTH 8 | |
93 | #define LQSPI_CFG_MODE_SHIFT 16 | |
94 | #define LQSPI_CFG_DUMMY_WIDTH 3 | |
95 | #define LQSPI_CFG_DUMMY_SHIFT 8 | |
96 | #define LQSPI_CFG_INST_CODE 0xFF | |
97 | ||
98 | #define R_LQSPI_STS (0xA4 / 4) | |
99 | #define LQSPI_STS_WR_RECVD (1 << 1) | |
100 | ||
94befa45 PC |
101 | #define R_MOD_ID (0xFC / 4) |
102 | ||
103 | #define R_MAX (R_MOD_ID+1) | |
104 | ||
105 | /* size of TXRX FIFOs */ | |
94befa45 PC |
106 | #define RXFF_A 32 |
107 | #define TXFF_A 32 | |
108 | ||
f1241144 PC |
109 | /* 16MB per linear region */ |
110 | #define LQSPI_ADDRESS_BITS 24 | |
111 | /* Bite off 4k chunks at a time */ | |
112 | #define LQSPI_CACHE_SIZE 1024 | |
113 | ||
114 | #define SNOOP_CHECKING 0xFF | |
115 | #define SNOOP_NONE 0xFE | |
116 | #define SNOOP_STRIPING 0 | |
117 | ||
08a9635b NR |
118 | typedef enum { |
119 | READ = 0x3, | |
120 | FAST_READ = 0xb, | |
121 | DOR = 0x3b, | |
122 | QOR = 0x6b, | |
123 | DIOR = 0xbb, | |
124 | QIOR = 0xeb, | |
125 | ||
126 | PP = 0x2, | |
127 | DPP = 0xa2, | |
128 | QPP = 0x32, | |
129 | } FlashCMD; | |
130 | ||
94befa45 | 131 | typedef struct { |
6b91f015 PC |
132 | SysBusDevice parent_obj; |
133 | ||
94befa45 | 134 | MemoryRegion iomem; |
f1241144 PC |
135 | MemoryRegion mmlqspi; |
136 | ||
94befa45 PC |
137 | qemu_irq irq; |
138 | int irqline; | |
139 | ||
f1241144 PC |
140 | uint8_t num_cs; |
141 | uint8_t num_busses; | |
142 | ||
143 | uint8_t snoop_state; | |
144 | qemu_irq *cs_lines; | |
145 | SSIBus **spi; | |
94befa45 PC |
146 | |
147 | Fifo8 rx_fifo; | |
148 | Fifo8 tx_fifo; | |
149 | ||
f1241144 PC |
150 | uint8_t num_txrx_bytes; |
151 | ||
94befa45 | 152 | uint32_t regs[R_MAX]; |
6b91f015 PC |
153 | } XilinxSPIPS; |
154 | ||
155 | typedef struct { | |
156 | XilinxSPIPS parent_obj; | |
f1241144 PC |
157 | |
158 | uint32_t lqspi_buf[LQSPI_CACHE_SIZE]; | |
159 | hwaddr lqspi_cached_addr; | |
6b91f015 PC |
160 | } XilinxQSPIPS; |
161 | ||
94befa45 | 162 | |
6b91f015 PC |
163 | #define TYPE_XILINX_SPIPS "xlnx.ps7-spi" |
164 | #define TYPE_XILINX_QSPIPS "xlnx.ps7-qspi" | |
f8b9fe24 PC |
165 | |
166 | #define XILINX_SPIPS(obj) \ | |
167 | OBJECT_CHECK(XilinxSPIPS, (obj), TYPE_XILINX_SPIPS) | |
6b91f015 PC |
168 | #define XILINX_QSPIPS(obj) \ |
169 | OBJECT_CHECK(XilinxQSPIPS, (obj), TYPE_XILINX_QSPIPS) | |
f8b9fe24 | 170 | |
f1241144 PC |
171 | static inline int num_effective_busses(XilinxSPIPS *s) |
172 | { | |
e0891bd8 NR |
173 | return (s->regs[R_LQSPI_CFG] & LQSPI_CFG_SEP_BUS && |
174 | s->regs[R_LQSPI_CFG] & LQSPI_CFG_TWO_MEM) ? s->num_busses : 1; | |
f1241144 PC |
175 | } |
176 | ||
94befa45 PC |
177 | static void xilinx_spips_update_cs_lines(XilinxSPIPS *s) |
178 | { | |
f1241144 | 179 | int i, j; |
94befa45 PC |
180 | bool found = false; |
181 | int field = s->regs[R_CONFIG] >> CS_SHIFT; | |
182 | ||
f1241144 PC |
183 | for (i = 0; i < s->num_cs; i++) { |
184 | for (j = 0; j < num_effective_busses(s); j++) { | |
185 | int upage = !!(s->regs[R_LQSPI_STS] & LQSPI_CFG_U_PAGE); | |
186 | int cs_to_set = (j * s->num_cs + i + upage) % | |
187 | (s->num_cs * s->num_busses); | |
188 | ||
189 | if (~field & (1 << i) && !found) { | |
190 | DB_PRINT("selecting slave %d\n", i); | |
191 | qemu_set_irq(s->cs_lines[cs_to_set], 0); | |
192 | } else { | |
193 | qemu_set_irq(s->cs_lines[cs_to_set], 1); | |
194 | } | |
195 | } | |
196 | if (~field & (1 << i)) { | |
94befa45 | 197 | found = true; |
94befa45 | 198 | } |
f1241144 PC |
199 | } |
200 | if (!found) { | |
201 | s->snoop_state = SNOOP_CHECKING; | |
202 | } | |
94befa45 PC |
203 | } |
204 | ||
205 | static void xilinx_spips_update_ixr(XilinxSPIPS *s) | |
206 | { | |
207 | /* These are set/cleared as they occur */ | |
208 | s->regs[R_INTR_STATUS] &= (IXR_TX_FIFO_UNDERFLOW | IXR_RX_FIFO_OVERFLOW | | |
209 | IXR_TX_FIFO_MODE_FAIL); | |
210 | /* these are pure functions of fifo state, set them here */ | |
211 | s->regs[R_INTR_STATUS] |= | |
212 | (fifo8_is_full(&s->rx_fifo) ? IXR_RX_FIFO_FULL : 0) | | |
213 | (s->rx_fifo.num >= s->regs[R_RX_THRES] ? IXR_RX_FIFO_NOT_EMPTY : 0) | | |
214 | (fifo8_is_full(&s->tx_fifo) ? IXR_TX_FIFO_FULL : 0) | | |
215 | (s->tx_fifo.num < s->regs[R_TX_THRES] ? IXR_TX_FIFO_NOT_FULL : 0); | |
216 | /* drive external interrupt pin */ | |
217 | int new_irqline = !!(s->regs[R_INTR_MASK] & s->regs[R_INTR_STATUS] & | |
218 | IXR_ALL); | |
219 | if (new_irqline != s->irqline) { | |
220 | s->irqline = new_irqline; | |
221 | qemu_set_irq(s->irq, s->irqline); | |
222 | } | |
223 | } | |
224 | ||
225 | static void xilinx_spips_reset(DeviceState *d) | |
226 | { | |
f8b9fe24 | 227 | XilinxSPIPS *s = XILINX_SPIPS(d); |
94befa45 PC |
228 | |
229 | int i; | |
230 | for (i = 0; i < R_MAX; i++) { | |
231 | s->regs[i] = 0; | |
232 | } | |
233 | ||
234 | fifo8_reset(&s->rx_fifo); | |
235 | fifo8_reset(&s->rx_fifo); | |
236 | /* non zero resets */ | |
237 | s->regs[R_CONFIG] |= MODEFAIL_GEN_EN; | |
238 | s->regs[R_SLAVE_IDLE_COUNT] = 0xFF; | |
239 | s->regs[R_TX_THRES] = 1; | |
240 | s->regs[R_RX_THRES] = 1; | |
241 | /* FIXME: move magic number definition somewhere sensible */ | |
242 | s->regs[R_MOD_ID] = 0x01090106; | |
f1241144 PC |
243 | s->regs[R_LQSPI_CFG] = R_LQSPI_CFG_RESET; |
244 | s->snoop_state = SNOOP_CHECKING; | |
94befa45 PC |
245 | xilinx_spips_update_ixr(s); |
246 | xilinx_spips_update_cs_lines(s); | |
247 | } | |
248 | ||
249 | static void xilinx_spips_flush_txfifo(XilinxSPIPS *s) | |
250 | { | |
251 | for (;;) { | |
f1241144 PC |
252 | int i; |
253 | uint8_t rx; | |
254 | uint8_t tx = 0; | |
255 | ||
256 | for (i = 0; i < num_effective_busses(s); ++i) { | |
257 | if (!i || s->snoop_state == SNOOP_STRIPING) { | |
258 | if (fifo8_is_empty(&s->tx_fifo)) { | |
259 | s->regs[R_INTR_STATUS] |= IXR_TX_FIFO_UNDERFLOW; | |
260 | xilinx_spips_update_ixr(s); | |
261 | return; | |
262 | } else { | |
263 | tx = fifo8_pop(&s->tx_fifo); | |
264 | } | |
265 | } | |
266 | rx = ssi_transfer(s->spi[i], (uint32_t)tx); | |
267 | DB_PRINT("tx = %02x rx = %02x\n", tx, rx); | |
268 | if (!i || s->snoop_state == SNOOP_STRIPING) { | |
269 | if (fifo8_is_full(&s->rx_fifo)) { | |
270 | s->regs[R_INTR_STATUS] |= IXR_RX_FIFO_OVERFLOW; | |
271 | DB_PRINT("rx FIFO overflow"); | |
272 | } else { | |
273 | fifo8_push(&s->rx_fifo, (uint8_t)rx); | |
274 | } | |
275 | } | |
276 | } | |
94befa45 | 277 | |
f1241144 PC |
278 | switch (s->snoop_state) { |
279 | case (SNOOP_CHECKING): | |
280 | switch (tx) { /* new instruction code */ | |
08a9635b NR |
281 | case READ: /* 3 address bytes, no dummy bytes/cycles */ |
282 | case PP: | |
283 | case DPP: | |
284 | case QPP: | |
285 | s->snoop_state = 3; | |
f1241144 | 286 | break; |
08a9635b NR |
287 | case FAST_READ: /* 3 address bytes, 1 dummy byte */ |
288 | case DOR: | |
289 | case QOR: | |
290 | case DIOR: /* FIXME: these vary between vendor - set to spansion */ | |
f1241144 PC |
291 | s->snoop_state = 4; |
292 | break; | |
08a9635b | 293 | case QIOR: /* 3 address bytes, 2 dummy bytes */ |
f1241144 PC |
294 | s->snoop_state = 6; |
295 | break; | |
296 | default: | |
297 | s->snoop_state = SNOOP_NONE; | |
298 | } | |
94befa45 | 299 | break; |
f1241144 PC |
300 | case (SNOOP_STRIPING): |
301 | case (SNOOP_NONE): | |
302 | break; | |
303 | default: | |
304 | s->snoop_state--; | |
94befa45 | 305 | } |
f1241144 PC |
306 | } |
307 | } | |
94befa45 | 308 | |
f1241144 PC |
309 | static inline void rx_data_bytes(XilinxSPIPS *s, uint32_t *value, int max) |
310 | { | |
311 | int i; | |
312 | ||
313 | *value = 0; | |
314 | for (i = 0; i < max && !fifo8_is_empty(&s->rx_fifo); ++i) { | |
315 | uint32_t next = fifo8_pop(&s->rx_fifo) & 0xFF; | |
316 | *value |= next << 8 * (s->regs[R_CONFIG] & ENDIAN ? 3-i : i); | |
94befa45 | 317 | } |
94befa45 PC |
318 | } |
319 | ||
a8170e5e | 320 | static uint64_t xilinx_spips_read(void *opaque, hwaddr addr, |
94befa45 PC |
321 | unsigned size) |
322 | { | |
323 | XilinxSPIPS *s = opaque; | |
324 | uint32_t mask = ~0; | |
325 | uint32_t ret; | |
326 | ||
327 | addr >>= 2; | |
328 | switch (addr) { | |
329 | case R_CONFIG: | |
330 | mask = 0x0002FFFF; | |
331 | break; | |
332 | case R_INTR_STATUS: | |
87920b44 PC |
333 | ret = s->regs[addr] & IXR_ALL; |
334 | s->regs[addr] = 0; | |
335 | DB_PRINT("addr=" TARGET_FMT_plx " = %x\n", addr * 4, ret); | |
336 | return ret; | |
94befa45 PC |
337 | case R_INTR_MASK: |
338 | mask = IXR_ALL; | |
339 | break; | |
340 | case R_EN: | |
341 | mask = 0x1; | |
342 | break; | |
343 | case R_SLAVE_IDLE_COUNT: | |
344 | mask = 0xFF; | |
345 | break; | |
346 | case R_MOD_ID: | |
347 | mask = 0x01FFFFFF; | |
348 | break; | |
349 | case R_INTR_EN: | |
350 | case R_INTR_DIS: | |
351 | case R_TX_DATA: | |
352 | mask = 0; | |
353 | break; | |
354 | case R_RX_DATA: | |
f1241144 | 355 | rx_data_bytes(s, &ret, s->num_txrx_bytes); |
94befa45 PC |
356 | DB_PRINT("addr=" TARGET_FMT_plx " = %x\n", addr * 4, ret); |
357 | xilinx_spips_update_ixr(s); | |
358 | return ret; | |
359 | } | |
360 | DB_PRINT("addr=" TARGET_FMT_plx " = %x\n", addr * 4, s->regs[addr] & mask); | |
361 | return s->regs[addr] & mask; | |
362 | ||
363 | } | |
364 | ||
f1241144 PC |
365 | static inline void tx_data_bytes(XilinxSPIPS *s, uint32_t value, int num) |
366 | { | |
367 | int i; | |
368 | for (i = 0; i < num && !fifo8_is_full(&s->tx_fifo); ++i) { | |
369 | if (s->regs[R_CONFIG] & ENDIAN) { | |
370 | fifo8_push(&s->tx_fifo, (uint8_t)(value >> 24)); | |
371 | value <<= 8; | |
372 | } else { | |
373 | fifo8_push(&s->tx_fifo, (uint8_t)value); | |
374 | value >>= 8; | |
375 | } | |
376 | } | |
377 | } | |
378 | ||
a8170e5e | 379 | static void xilinx_spips_write(void *opaque, hwaddr addr, |
94befa45 PC |
380 | uint64_t value, unsigned size) |
381 | { | |
382 | int mask = ~0; | |
383 | int man_start_com = 0; | |
384 | XilinxSPIPS *s = opaque; | |
385 | ||
386 | DB_PRINT("addr=" TARGET_FMT_plx " = %x\n", addr, (unsigned)value); | |
387 | addr >>= 2; | |
388 | switch (addr) { | |
389 | case R_CONFIG: | |
390 | mask = 0x0002FFFF; | |
391 | if (value & MAN_START_COM) { | |
392 | man_start_com = 1; | |
393 | } | |
394 | break; | |
395 | case R_INTR_STATUS: | |
396 | mask = IXR_ALL; | |
397 | s->regs[R_INTR_STATUS] &= ~(mask & value); | |
398 | goto no_reg_update; | |
399 | case R_INTR_DIS: | |
400 | mask = IXR_ALL; | |
401 | s->regs[R_INTR_MASK] &= ~(mask & value); | |
402 | goto no_reg_update; | |
403 | case R_INTR_EN: | |
404 | mask = IXR_ALL; | |
405 | s->regs[R_INTR_MASK] |= mask & value; | |
406 | goto no_reg_update; | |
407 | case R_EN: | |
408 | mask = 0x1; | |
409 | break; | |
410 | case R_SLAVE_IDLE_COUNT: | |
411 | mask = 0xFF; | |
412 | break; | |
413 | case R_RX_DATA: | |
414 | case R_INTR_MASK: | |
415 | case R_MOD_ID: | |
416 | mask = 0; | |
417 | break; | |
418 | case R_TX_DATA: | |
f1241144 PC |
419 | tx_data_bytes(s, (uint32_t)value, s->num_txrx_bytes); |
420 | goto no_reg_update; | |
421 | case R_TXD1: | |
422 | tx_data_bytes(s, (uint32_t)value, 1); | |
423 | goto no_reg_update; | |
424 | case R_TXD2: | |
425 | tx_data_bytes(s, (uint32_t)value, 2); | |
426 | goto no_reg_update; | |
427 | case R_TXD3: | |
428 | tx_data_bytes(s, (uint32_t)value, 3); | |
94befa45 PC |
429 | goto no_reg_update; |
430 | } | |
431 | s->regs[addr] = (s->regs[addr] & ~mask) | (value & mask); | |
432 | no_reg_update: | |
433 | if (man_start_com) { | |
434 | xilinx_spips_flush_txfifo(s); | |
435 | } | |
436 | xilinx_spips_update_ixr(s); | |
437 | xilinx_spips_update_cs_lines(s); | |
438 | } | |
439 | ||
440 | static const MemoryRegionOps spips_ops = { | |
441 | .read = xilinx_spips_read, | |
442 | .write = xilinx_spips_write, | |
443 | .endianness = DEVICE_LITTLE_ENDIAN, | |
444 | }; | |
445 | ||
f1241144 PC |
446 | #define LQSPI_CACHE_SIZE 1024 |
447 | ||
448 | static uint64_t | |
449 | lqspi_read(void *opaque, hwaddr addr, unsigned int size) | |
450 | { | |
451 | int i; | |
6b91f015 | 452 | XilinxQSPIPS *q = opaque; |
f1241144 PC |
453 | XilinxSPIPS *s = opaque; |
454 | ||
6b91f015 PC |
455 | if (addr >= q->lqspi_cached_addr && |
456 | addr <= q->lqspi_cached_addr + LQSPI_CACHE_SIZE - 4) { | |
457 | return q->lqspi_buf[(addr - q->lqspi_cached_addr) >> 2]; | |
f1241144 PC |
458 | } else { |
459 | int flash_addr = (addr / num_effective_busses(s)); | |
460 | int slave = flash_addr >> LQSPI_ADDRESS_BITS; | |
461 | int cache_entry = 0; | |
462 | ||
463 | DB_PRINT("config reg status: %08x\n", s->regs[R_LQSPI_CFG]); | |
464 | ||
465 | fifo8_reset(&s->tx_fifo); | |
466 | fifo8_reset(&s->rx_fifo); | |
467 | ||
468 | s->regs[R_CONFIG] &= ~CS; | |
469 | s->regs[R_CONFIG] |= (~(1 << slave) << CS_SHIFT) & CS; | |
470 | xilinx_spips_update_cs_lines(s); | |
471 | ||
472 | /* instruction */ | |
473 | DB_PRINT("pushing read instruction: %02x\n", | |
474 | (uint8_t)(s->regs[R_LQSPI_CFG] & LQSPI_CFG_INST_CODE)); | |
475 | fifo8_push(&s->tx_fifo, s->regs[R_LQSPI_CFG] & LQSPI_CFG_INST_CODE); | |
476 | /* read address */ | |
477 | DB_PRINT("pushing read address %06x\n", flash_addr); | |
478 | fifo8_push(&s->tx_fifo, (uint8_t)(flash_addr >> 16)); | |
479 | fifo8_push(&s->tx_fifo, (uint8_t)(flash_addr >> 8)); | |
480 | fifo8_push(&s->tx_fifo, (uint8_t)flash_addr); | |
481 | /* mode bits */ | |
482 | if (s->regs[R_LQSPI_CFG] & LQSPI_CFG_MODE_EN) { | |
483 | fifo8_push(&s->tx_fifo, extract32(s->regs[R_LQSPI_CFG], | |
484 | LQSPI_CFG_MODE_SHIFT, | |
485 | LQSPI_CFG_MODE_WIDTH)); | |
486 | } | |
487 | /* dummy bytes */ | |
488 | for (i = 0; i < (extract32(s->regs[R_LQSPI_CFG], LQSPI_CFG_DUMMY_SHIFT, | |
489 | LQSPI_CFG_DUMMY_WIDTH)); ++i) { | |
490 | DB_PRINT("pushing dummy byte\n"); | |
491 | fifo8_push(&s->tx_fifo, 0); | |
492 | } | |
493 | xilinx_spips_flush_txfifo(s); | |
494 | fifo8_reset(&s->rx_fifo); | |
495 | ||
496 | DB_PRINT("starting QSPI data read\n"); | |
497 | ||
498 | for (i = 0; i < LQSPI_CACHE_SIZE / 4; ++i) { | |
499 | tx_data_bytes(s, 0, 4); | |
500 | xilinx_spips_flush_txfifo(s); | |
6b91f015 | 501 | rx_data_bytes(s, &q->lqspi_buf[cache_entry], 4); |
f1241144 PC |
502 | cache_entry++; |
503 | } | |
504 | ||
505 | s->regs[R_CONFIG] |= CS; | |
506 | xilinx_spips_update_cs_lines(s); | |
507 | ||
6b91f015 | 508 | q->lqspi_cached_addr = addr; |
f1241144 PC |
509 | return lqspi_read(opaque, addr, size); |
510 | } | |
511 | } | |
512 | ||
513 | static const MemoryRegionOps lqspi_ops = { | |
514 | .read = lqspi_read, | |
515 | .endianness = DEVICE_NATIVE_ENDIAN, | |
516 | .valid = { | |
517 | .min_access_size = 4, | |
518 | .max_access_size = 4 | |
519 | } | |
520 | }; | |
521 | ||
f8b9fe24 | 522 | static void xilinx_spips_realize(DeviceState *dev, Error **errp) |
94befa45 | 523 | { |
f8b9fe24 PC |
524 | XilinxSPIPS *s = XILINX_SPIPS(dev); |
525 | SysBusDevice *sbd = SYS_BUS_DEVICE(dev); | |
94befa45 PC |
526 | int i; |
527 | ||
6b91f015 | 528 | DB_PRINT("realized spips\n"); |
94befa45 | 529 | |
f1241144 PC |
530 | s->spi = g_new(SSIBus *, s->num_busses); |
531 | for (i = 0; i < s->num_busses; ++i) { | |
532 | char bus_name[16]; | |
533 | snprintf(bus_name, 16, "spi%d", i); | |
f8b9fe24 | 534 | s->spi[i] = ssi_create_bus(dev, bus_name); |
f1241144 | 535 | } |
b4ae3cfa | 536 | |
2790cd91 | 537 | s->cs_lines = g_new0(qemu_irq, s->num_cs * s->num_busses); |
f1241144 PC |
538 | ssi_auto_connect_slaves(DEVICE(s), s->cs_lines, s->spi[0]); |
539 | ssi_auto_connect_slaves(DEVICE(s), s->cs_lines, s->spi[1]); | |
f8b9fe24 | 540 | sysbus_init_irq(sbd, &s->irq); |
f1241144 | 541 | for (i = 0; i < s->num_cs * s->num_busses; ++i) { |
f8b9fe24 | 542 | sysbus_init_irq(sbd, &s->cs_lines[i]); |
94befa45 PC |
543 | } |
544 | ||
545 | memory_region_init_io(&s->iomem, &spips_ops, s, "spi", R_MAX*4); | |
f8b9fe24 | 546 | sysbus_init_mmio(sbd, &s->iomem); |
94befa45 PC |
547 | |
548 | s->irqline = -1; | |
94befa45 PC |
549 | |
550 | fifo8_create(&s->rx_fifo, RXFF_A); | |
551 | fifo8_create(&s->tx_fifo, TXFF_A); | |
94befa45 PC |
552 | } |
553 | ||
6b91f015 PC |
554 | static void xilinx_qspips_realize(DeviceState *dev, Error **errp) |
555 | { | |
556 | XilinxSPIPS *s = XILINX_SPIPS(dev); | |
557 | XilinxQSPIPS *q = XILINX_QSPIPS(dev); | |
558 | SysBusDevice *sbd = SYS_BUS_DEVICE(dev); | |
559 | ||
560 | DB_PRINT("realized qspips\n"); | |
561 | ||
562 | s->num_busses = 2; | |
563 | s->num_cs = 2; | |
564 | s->num_txrx_bytes = 4; | |
565 | ||
566 | xilinx_spips_realize(dev, errp); | |
567 | memory_region_init_io(&s->mmlqspi, &lqspi_ops, s, "lqspi", | |
568 | (1 << LQSPI_ADDRESS_BITS) * 2); | |
569 | sysbus_init_mmio(sbd, &s->mmlqspi); | |
570 | ||
571 | q->lqspi_cached_addr = ~0ULL; | |
572 | } | |
573 | ||
94befa45 PC |
574 | static int xilinx_spips_post_load(void *opaque, int version_id) |
575 | { | |
576 | xilinx_spips_update_ixr((XilinxSPIPS *)opaque); | |
577 | xilinx_spips_update_cs_lines((XilinxSPIPS *)opaque); | |
578 | return 0; | |
579 | } | |
580 | ||
581 | static const VMStateDescription vmstate_xilinx_spips = { | |
582 | .name = "xilinx_spips", | |
f1241144 PC |
583 | .version_id = 2, |
584 | .minimum_version_id = 2, | |
585 | .minimum_version_id_old = 2, | |
94befa45 PC |
586 | .post_load = xilinx_spips_post_load, |
587 | .fields = (VMStateField[]) { | |
588 | VMSTATE_FIFO8(tx_fifo, XilinxSPIPS), | |
589 | VMSTATE_FIFO8(rx_fifo, XilinxSPIPS), | |
590 | VMSTATE_UINT32_ARRAY(regs, XilinxSPIPS, R_MAX), | |
f1241144 | 591 | VMSTATE_UINT8(snoop_state, XilinxSPIPS), |
94befa45 PC |
592 | VMSTATE_END_OF_LIST() |
593 | } | |
594 | }; | |
595 | ||
f1241144 PC |
596 | static Property xilinx_spips_properties[] = { |
597 | DEFINE_PROP_UINT8("num-busses", XilinxSPIPS, num_busses, 1), | |
598 | DEFINE_PROP_UINT8("num-ss-bits", XilinxSPIPS, num_cs, 4), | |
599 | DEFINE_PROP_UINT8("num-txrx-bytes", XilinxSPIPS, num_txrx_bytes, 1), | |
600 | DEFINE_PROP_END_OF_LIST(), | |
601 | }; | |
6b91f015 PC |
602 | |
603 | static void xilinx_qspips_class_init(ObjectClass *klass, void * data) | |
604 | { | |
605 | DeviceClass *dc = DEVICE_CLASS(klass); | |
606 | ||
607 | dc->realize = xilinx_qspips_realize; | |
608 | } | |
609 | ||
94befa45 PC |
610 | static void xilinx_spips_class_init(ObjectClass *klass, void *data) |
611 | { | |
612 | DeviceClass *dc = DEVICE_CLASS(klass); | |
94befa45 | 613 | |
f8b9fe24 | 614 | dc->realize = xilinx_spips_realize; |
94befa45 | 615 | dc->reset = xilinx_spips_reset; |
f1241144 | 616 | dc->props = xilinx_spips_properties; |
94befa45 PC |
617 | dc->vmsd = &vmstate_xilinx_spips; |
618 | } | |
619 | ||
620 | static const TypeInfo xilinx_spips_info = { | |
f8b9fe24 | 621 | .name = TYPE_XILINX_SPIPS, |
94befa45 PC |
622 | .parent = TYPE_SYS_BUS_DEVICE, |
623 | .instance_size = sizeof(XilinxSPIPS), | |
624 | .class_init = xilinx_spips_class_init, | |
625 | }; | |
626 | ||
6b91f015 PC |
627 | static const TypeInfo xilinx_qspips_info = { |
628 | .name = TYPE_XILINX_QSPIPS, | |
629 | .parent = TYPE_XILINX_SPIPS, | |
630 | .instance_size = sizeof(XilinxQSPIPS), | |
631 | .class_init = xilinx_qspips_class_init, | |
632 | }; | |
633 | ||
94befa45 PC |
634 | static void xilinx_spips_register_types(void) |
635 | { | |
636 | type_register_static(&xilinx_spips_info); | |
6b91f015 | 637 | type_register_static(&xilinx_qspips_info); |
94befa45 PC |
638 | } |
639 | ||
640 | type_init(xilinx_spips_register_types) |