]> git.proxmox.com Git - qemu.git/blame - hw/scsi/lsi53c895a.c
rng-egd: remove redundant free
[qemu.git] / hw / scsi / lsi53c895a.c
CommitLineData
5fafdf24 1/*
7d8406be
PB
2 * QEMU LSI53C895A SCSI Host Bus Adapter emulation
3 *
4 * Copyright (c) 2006 CodeSourcery.
5 * Written by Paul Brook
6 *
8e31bf38 7 * This code is licensed under the LGPL.
7d8406be
PB
8 */
9
ceae18bd
HP
10/* Note:
11 * LSI53C810 emulation is incorrect, in the sense that it supports
12 * features added in later evolutions. This should not be a problem,
13 * as well-behaved operating systems will not try to use them.
14 */
15
a15fdf86 16#include <assert.h>
777aec7a 17
83c9f4ca
PB
18#include "hw/hw.h"
19#include "hw/pci/pci.h"
0d09e41a 20#include "hw/scsi/scsi.h"
9c17d615 21#include "sysemu/dma.h"
7d8406be
PB
22
23//#define DEBUG_LSI
24//#define DEBUG_LSI_REG
25
26#ifdef DEBUG_LSI
001faf32
BS
27#define DPRINTF(fmt, ...) \
28do { printf("lsi_scsi: " fmt , ## __VA_ARGS__); } while (0)
29#define BADF(fmt, ...) \
30do { fprintf(stderr, "lsi_scsi: error: " fmt , ## __VA_ARGS__); exit(1);} while (0)
7d8406be 31#else
001faf32
BS
32#define DPRINTF(fmt, ...) do {} while(0)
33#define BADF(fmt, ...) \
34do { fprintf(stderr, "lsi_scsi: error: " fmt , ## __VA_ARGS__);} while (0)
7d8406be
PB
35#endif
36
18e08a55
MT
37#define LSI_MAX_DEVS 7
38
7d8406be
PB
39#define LSI_SCNTL0_TRG 0x01
40#define LSI_SCNTL0_AAP 0x02
41#define LSI_SCNTL0_EPC 0x08
42#define LSI_SCNTL0_WATN 0x10
43#define LSI_SCNTL0_START 0x20
44
45#define LSI_SCNTL1_SST 0x01
46#define LSI_SCNTL1_IARB 0x02
47#define LSI_SCNTL1_AESP 0x04
48#define LSI_SCNTL1_RST 0x08
49#define LSI_SCNTL1_CON 0x10
50#define LSI_SCNTL1_DHP 0x20
51#define LSI_SCNTL1_ADB 0x40
52#define LSI_SCNTL1_EXC 0x80
53
54#define LSI_SCNTL2_WSR 0x01
55#define LSI_SCNTL2_VUE0 0x02
56#define LSI_SCNTL2_VUE1 0x04
57#define LSI_SCNTL2_WSS 0x08
58#define LSI_SCNTL2_SLPHBEN 0x10
59#define LSI_SCNTL2_SLPMD 0x20
60#define LSI_SCNTL2_CHM 0x40
61#define LSI_SCNTL2_SDU 0x80
62
63#define LSI_ISTAT0_DIP 0x01
64#define LSI_ISTAT0_SIP 0x02
65#define LSI_ISTAT0_INTF 0x04
66#define LSI_ISTAT0_CON 0x08
67#define LSI_ISTAT0_SEM 0x10
68#define LSI_ISTAT0_SIGP 0x20
69#define LSI_ISTAT0_SRST 0x40
70#define LSI_ISTAT0_ABRT 0x80
71
72#define LSI_ISTAT1_SI 0x01
73#define LSI_ISTAT1_SRUN 0x02
74#define LSI_ISTAT1_FLSH 0x04
75
76#define LSI_SSTAT0_SDP0 0x01
77#define LSI_SSTAT0_RST 0x02
78#define LSI_SSTAT0_WOA 0x04
79#define LSI_SSTAT0_LOA 0x08
80#define LSI_SSTAT0_AIP 0x10
81#define LSI_SSTAT0_OLF 0x20
82#define LSI_SSTAT0_ORF 0x40
83#define LSI_SSTAT0_ILF 0x80
84
85#define LSI_SIST0_PAR 0x01
86#define LSI_SIST0_RST 0x02
87#define LSI_SIST0_UDC 0x04
88#define LSI_SIST0_SGE 0x08
89#define LSI_SIST0_RSL 0x10
90#define LSI_SIST0_SEL 0x20
91#define LSI_SIST0_CMP 0x40
92#define LSI_SIST0_MA 0x80
93
94#define LSI_SIST1_HTH 0x01
95#define LSI_SIST1_GEN 0x02
96#define LSI_SIST1_STO 0x04
97#define LSI_SIST1_SBMC 0x10
98
99#define LSI_SOCL_IO 0x01
100#define LSI_SOCL_CD 0x02
101#define LSI_SOCL_MSG 0x04
102#define LSI_SOCL_ATN 0x08
103#define LSI_SOCL_SEL 0x10
104#define LSI_SOCL_BSY 0x20
105#define LSI_SOCL_ACK 0x40
106#define LSI_SOCL_REQ 0x80
107
108#define LSI_DSTAT_IID 0x01
109#define LSI_DSTAT_SIR 0x04
110#define LSI_DSTAT_SSI 0x08
111#define LSI_DSTAT_ABRT 0x10
112#define LSI_DSTAT_BF 0x20
113#define LSI_DSTAT_MDPE 0x40
114#define LSI_DSTAT_DFE 0x80
115
116#define LSI_DCNTL_COM 0x01
117#define LSI_DCNTL_IRQD 0x02
118#define LSI_DCNTL_STD 0x04
119#define LSI_DCNTL_IRQM 0x08
120#define LSI_DCNTL_SSM 0x10
121#define LSI_DCNTL_PFEN 0x20
122#define LSI_DCNTL_PFF 0x40
123#define LSI_DCNTL_CLSE 0x80
124
125#define LSI_DMODE_MAN 0x01
126#define LSI_DMODE_BOF 0x02
127#define LSI_DMODE_ERMP 0x04
128#define LSI_DMODE_ERL 0x08
129#define LSI_DMODE_DIOM 0x10
130#define LSI_DMODE_SIOM 0x20
131
132#define LSI_CTEST2_DACK 0x01
133#define LSI_CTEST2_DREQ 0x02
134#define LSI_CTEST2_TEOP 0x04
135#define LSI_CTEST2_PCICIE 0x08
136#define LSI_CTEST2_CM 0x10
137#define LSI_CTEST2_CIO 0x20
138#define LSI_CTEST2_SIGP 0x40
139#define LSI_CTEST2_DDIR 0x80
140
141#define LSI_CTEST5_BL2 0x04
142#define LSI_CTEST5_DDIR 0x08
143#define LSI_CTEST5_MASR 0x10
144#define LSI_CTEST5_DFSN 0x20
145#define LSI_CTEST5_BBCK 0x40
146#define LSI_CTEST5_ADCK 0x80
147
148#define LSI_CCNTL0_DILS 0x01
149#define LSI_CCNTL0_DISFC 0x10
150#define LSI_CCNTL0_ENNDJ 0x20
151#define LSI_CCNTL0_PMJCTL 0x40
152#define LSI_CCNTL0_ENPMJ 0x80
153
b25cf589
AL
154#define LSI_CCNTL1_EN64DBMV 0x01
155#define LSI_CCNTL1_EN64TIBMV 0x02
156#define LSI_CCNTL1_64TIMOD 0x04
157#define LSI_CCNTL1_DDAC 0x08
158#define LSI_CCNTL1_ZMOD 0x80
159
e560125e
LA
160/* Enable Response to Reselection */
161#define LSI_SCID_RRE 0x60
162
b25cf589
AL
163#define LSI_CCNTL1_40BIT (LSI_CCNTL1_EN64TIBMV|LSI_CCNTL1_64TIMOD)
164
7d8406be
PB
165#define PHASE_DO 0
166#define PHASE_DI 1
167#define PHASE_CMD 2
168#define PHASE_ST 3
169#define PHASE_MO 6
170#define PHASE_MI 7
171#define PHASE_MASK 7
172
a917d384
PB
173/* Maximum length of MSG IN data. */
174#define LSI_MAX_MSGIN_LEN 8
175
176/* Flag set if this is a tagged command. */
177#define LSI_TAG_VALID (1 << 16)
178
042ec49d 179typedef struct lsi_request {
5c6c0e51 180 SCSIRequest *req;
a917d384 181 uint32_t tag;
b96a0da0
GH
182 uint32_t dma_len;
183 uint8_t *dma_buf;
a917d384
PB
184 uint32_t pending;
185 int out;
042ec49d
GH
186 QTAILQ_ENTRY(lsi_request) next;
187} lsi_request;
4d611c9a 188
7d8406be 189typedef struct {
725eec70
AF
190 /*< private >*/
191 PCIDevice parent_obj;
192 /*< public >*/
193
b0ce84e5
AK
194 MemoryRegion mmio_io;
195 MemoryRegion ram_io;
196 MemoryRegion io_io;
7d8406be
PB
197
198 int carry; /* ??? Should this be an a visible register somewhere? */
2f172849 199 int status;
a917d384 200 /* Action to take at the end of a MSG IN phase.
a15fdf86 201 0 = COMMAND, 1 = disconnect, 2 = DATA OUT, 3 = DATA IN. */
a917d384
PB
202 int msg_action;
203 int msg_len;
204 uint8_t msg[LSI_MAX_MSGIN_LEN];
4d611c9a
PB
205 /* 0 if SCRIPTS are running or stopped.
206 * 1 if a Wait Reselect instruction has been issued.
a917d384
PB
207 * 2 if processing DMA from lsi_execute_script.
208 * 3 if a DMA operation is in progress. */
7d8406be 209 int waiting;
ca9c39fa 210 SCSIBus bus;
7d8406be 211 int current_lun;
a917d384 212 /* The tag is a combination of the device ID and the SCSI tag. */
af12ac98 213 uint32_t select_tag;
8ccc2ace 214 int command_complete;
042ec49d 215 QTAILQ_HEAD(, lsi_request) queue;
af12ac98 216 lsi_request *current;
7d8406be
PB
217
218 uint32_t dsa;
219 uint32_t temp;
220 uint32_t dnad;
221 uint32_t dbc;
222 uint8_t istat0;
223 uint8_t istat1;
224 uint8_t dcmd;
225 uint8_t dstat;
226 uint8_t dien;
227 uint8_t sist0;
228 uint8_t sist1;
229 uint8_t sien0;
230 uint8_t sien1;
231 uint8_t mbox0;
232 uint8_t mbox1;
233 uint8_t dfifo;
9167a69a 234 uint8_t ctest2;
7d8406be
PB
235 uint8_t ctest3;
236 uint8_t ctest4;
237 uint8_t ctest5;
238 uint8_t ccntl0;
239 uint8_t ccntl1;
240 uint32_t dsp;
241 uint32_t dsps;
242 uint8_t dmode;
243 uint8_t dcntl;
244 uint8_t scntl0;
245 uint8_t scntl1;
246 uint8_t scntl2;
247 uint8_t scntl3;
248 uint8_t sstat0;
249 uint8_t sstat1;
250 uint8_t scid;
251 uint8_t sxfer;
252 uint8_t socl;
253 uint8_t sdid;
a917d384 254 uint8_t ssid;
7d8406be
PB
255 uint8_t sfbr;
256 uint8_t stest1;
257 uint8_t stest2;
258 uint8_t stest3;
a917d384 259 uint8_t sidl;
7d8406be
PB
260 uint8_t stime0;
261 uint8_t respid0;
262 uint8_t respid1;
263 uint32_t mmrs;
264 uint32_t mmws;
265 uint32_t sfs;
266 uint32_t drs;
267 uint32_t sbms;
ab57d967 268 uint32_t dbms;
7d8406be
PB
269 uint32_t dnad64;
270 uint32_t pmjad1;
271 uint32_t pmjad2;
272 uint32_t rbc;
273 uint32_t ua;
274 uint32_t ia;
275 uint32_t sbc;
276 uint32_t csbc;
dcfb9014 277 uint32_t scratch[18]; /* SCRATCHA-SCRATCHR */
bd8ee11a 278 uint8_t sbr;
7d8406be
PB
279
280 /* Script ram is stored as 32-bit words in host byteorder. */
281 uint32_t script_ram[2048];
282} LSIState;
283
ceae18bd 284#define TYPE_LSI53C810 "lsi53c810"
71186c86
PC
285#define TYPE_LSI53C895A "lsi53c895a"
286
287#define LSI53C895A(obj) \
288 OBJECT_CHECK(LSIState, (obj), TYPE_LSI53C895A)
289
e560125e
LA
290static inline int lsi_irq_on_rsl(LSIState *s)
291{
292 return (s->sien0 & LSI_SIST0_RSL) && (s->scid & LSI_SCID_RRE);
293}
294
7d8406be
PB
295static void lsi_soft_reset(LSIState *s)
296{
297 DPRINTF("Reset\n");
298 s->carry = 0;
299
d43ba0af
JK
300 s->msg_action = 0;
301 s->msg_len = 0;
7d8406be
PB
302 s->waiting = 0;
303 s->dsa = 0;
304 s->dnad = 0;
305 s->dbc = 0;
306 s->temp = 0;
307 memset(s->scratch, 0, sizeof(s->scratch));
308 s->istat0 = 0;
309 s->istat1 = 0;
12aa6dd6
JK
310 s->dcmd = 0x40;
311 s->dstat = LSI_DSTAT_DFE;
7d8406be
PB
312 s->dien = 0;
313 s->sist0 = 0;
314 s->sist1 = 0;
315 s->sien0 = 0;
316 s->sien1 = 0;
317 s->mbox0 = 0;
318 s->mbox1 = 0;
319 s->dfifo = 0;
12aa6dd6 320 s->ctest2 = LSI_CTEST2_DACK;
7d8406be
PB
321 s->ctest3 = 0;
322 s->ctest4 = 0;
323 s->ctest5 = 0;
324 s->ccntl0 = 0;
325 s->ccntl1 = 0;
326 s->dsp = 0;
327 s->dsps = 0;
328 s->dmode = 0;
329 s->dcntl = 0;
330 s->scntl0 = 0xc0;
331 s->scntl1 = 0;
332 s->scntl2 = 0;
333 s->scntl3 = 0;
334 s->sstat0 = 0;
335 s->sstat1 = 0;
336 s->scid = 7;
337 s->sxfer = 0;
338 s->socl = 0;
12aa6dd6
JK
339 s->sdid = 0;
340 s->ssid = 0;
7d8406be
PB
341 s->stest1 = 0;
342 s->stest2 = 0;
343 s->stest3 = 0;
a917d384 344 s->sidl = 0;
7d8406be
PB
345 s->stime0 = 0;
346 s->respid0 = 0x80;
347 s->respid1 = 0;
348 s->mmrs = 0;
349 s->mmws = 0;
350 s->sfs = 0;
351 s->drs = 0;
352 s->sbms = 0;
ab57d967 353 s->dbms = 0;
7d8406be
PB
354 s->dnad64 = 0;
355 s->pmjad1 = 0;
356 s->pmjad2 = 0;
357 s->rbc = 0;
358 s->ua = 0;
359 s->ia = 0;
360 s->sbc = 0;
361 s->csbc = 0;
bd8ee11a 362 s->sbr = 0;
2f0772c5
PB
363 assert(QTAILQ_EMPTY(&s->queue));
364 assert(!s->current);
7d8406be
PB
365}
366
b25cf589
AL
367static int lsi_dma_40bit(LSIState *s)
368{
369 if ((s->ccntl1 & LSI_CCNTL1_40BIT) == LSI_CCNTL1_40BIT)
370 return 1;
371 return 0;
372}
373
dd8edf01
AL
374static int lsi_dma_ti64bit(LSIState *s)
375{
376 if ((s->ccntl1 & LSI_CCNTL1_EN64TIBMV) == LSI_CCNTL1_EN64TIBMV)
377 return 1;
378 return 0;
379}
380
381static int lsi_dma_64bit(LSIState *s)
382{
383 if ((s->ccntl1 & LSI_CCNTL1_EN64DBMV) == LSI_CCNTL1_EN64DBMV)
384 return 1;
385 return 0;
386}
387
7d8406be
PB
388static uint8_t lsi_reg_readb(LSIState *s, int offset);
389static void lsi_reg_writeb(LSIState *s, int offset, uint8_t val);
4d611c9a 390static void lsi_execute_script(LSIState *s);
aa4d32c4 391static void lsi_reselect(LSIState *s, lsi_request *p);
7d8406be
PB
392
393static inline uint32_t read_dword(LSIState *s, uint32_t addr)
394{
395 uint32_t buf;
396
725eec70 397 pci_dma_read(PCI_DEVICE(s), addr, &buf, 4);
7d8406be
PB
398 return cpu_to_le32(buf);
399}
400
401static void lsi_stop_script(LSIState *s)
402{
403 s->istat1 &= ~LSI_ISTAT1_SRUN;
404}
405
406static void lsi_update_irq(LSIState *s)
407{
725eec70 408 PCIDevice *d = PCI_DEVICE(s);
7d8406be
PB
409 int level;
410 static int last_level;
042ec49d 411 lsi_request *p;
7d8406be
PB
412
413 /* It's unclear whether the DIP/SIP bits should be cleared when the
414 Interrupt Status Registers are cleared or when istat0 is read.
415 We currently do the formwer, which seems to work. */
416 level = 0;
417 if (s->dstat) {
418 if (s->dstat & s->dien)
419 level = 1;
420 s->istat0 |= LSI_ISTAT0_DIP;
421 } else {
422 s->istat0 &= ~LSI_ISTAT0_DIP;
423 }
424
425 if (s->sist0 || s->sist1) {
426 if ((s->sist0 & s->sien0) || (s->sist1 & s->sien1))
427 level = 1;
428 s->istat0 |= LSI_ISTAT0_SIP;
429 } else {
430 s->istat0 &= ~LSI_ISTAT0_SIP;
431 }
432 if (s->istat0 & LSI_ISTAT0_INTF)
433 level = 1;
434
435 if (level != last_level) {
436 DPRINTF("Update IRQ level %d dstat %02x sist %02x%02x\n",
437 level, s->dstat, s->sist1, s->sist0);
438 last_level = level;
439 }
9e64f8a3 440 pci_set_irq(d, level);
e560125e
LA
441
442 if (!level && lsi_irq_on_rsl(s) && !(s->scntl1 & LSI_SCNTL1_CON)) {
443 DPRINTF("Handled IRQs & disconnected, looking for pending "
444 "processes\n");
042ec49d
GH
445 QTAILQ_FOREACH(p, &s->queue, next) {
446 if (p->pending) {
aa4d32c4 447 lsi_reselect(s, p);
e560125e
LA
448 break;
449 }
450 }
451 }
7d8406be
PB
452}
453
454/* Stop SCRIPTS execution and raise a SCSI interrupt. */
455static void lsi_script_scsi_interrupt(LSIState *s, int stat0, int stat1)
456{
457 uint32_t mask0;
458 uint32_t mask1;
459
460 DPRINTF("SCSI Interrupt 0x%02x%02x prev 0x%02x%02x\n",
461 stat1, stat0, s->sist1, s->sist0);
462 s->sist0 |= stat0;
463 s->sist1 |= stat1;
464 /* Stop processor on fatal or unmasked interrupt. As a special hack
465 we don't stop processing when raising STO. Instead continue
466 execution and stop at the next insn that accesses the SCSI bus. */
467 mask0 = s->sien0 | ~(LSI_SIST0_CMP | LSI_SIST0_SEL | LSI_SIST0_RSL);
468 mask1 = s->sien1 | ~(LSI_SIST1_GEN | LSI_SIST1_HTH);
469 mask1 &= ~LSI_SIST1_STO;
470 if (s->sist0 & mask0 || s->sist1 & mask1) {
471 lsi_stop_script(s);
472 }
473 lsi_update_irq(s);
474}
475
476/* Stop SCRIPTS execution and raise a DMA interrupt. */
477static void lsi_script_dma_interrupt(LSIState *s, int stat)
478{
479 DPRINTF("DMA Interrupt 0x%x prev 0x%x\n", stat, s->dstat);
480 s->dstat |= stat;
481 lsi_update_irq(s);
482 lsi_stop_script(s);
483}
484
485static inline void lsi_set_phase(LSIState *s, int phase)
486{
487 s->sstat1 = (s->sstat1 & ~PHASE_MASK) | phase;
488}
489
490static void lsi_bad_phase(LSIState *s, int out, int new_phase)
491{
492 /* Trigger a phase mismatch. */
493 if (s->ccntl0 & LSI_CCNTL0_ENPMJ) {
d1d74664
PB
494 if ((s->ccntl0 & LSI_CCNTL0_PMJCTL)) {
495 s->dsp = out ? s->pmjad1 : s->pmjad2;
7d8406be 496 } else {
d1d74664 497 s->dsp = (s->scntl2 & LSI_SCNTL2_WSR ? s->pmjad2 : s->pmjad1);
7d8406be
PB
498 }
499 DPRINTF("Data phase mismatch jump to %08x\n", s->dsp);
500 } else {
501 DPRINTF("Phase mismatch interrupt\n");
502 lsi_script_scsi_interrupt(s, LSI_SIST0_MA, 0);
503 lsi_stop_script(s);
504 }
505 lsi_set_phase(s, new_phase);
506}
507
a917d384
PB
508
509/* Resume SCRIPTS execution after a DMA operation. */
510static void lsi_resume_script(LSIState *s)
511{
512 if (s->waiting != 2) {
513 s->waiting = 0;
514 lsi_execute_script(s);
515 } else {
516 s->waiting = 0;
517 }
518}
519
64d56409
JK
520static void lsi_disconnect(LSIState *s)
521{
522 s->scntl1 &= ~LSI_SCNTL1_CON;
523 s->sstat1 &= ~PHASE_MASK;
524}
525
526static void lsi_bad_selection(LSIState *s, uint32_t id)
527{
528 DPRINTF("Selected absent target %d\n", id);
529 lsi_script_scsi_interrupt(s, 0, LSI_SIST1_STO);
530 lsi_disconnect(s);
531}
532
4d611c9a 533/* Initiate a SCSI layer data transfer. */
7d8406be
PB
534static void lsi_do_dma(LSIState *s, int out)
535{
725eec70 536 PCIDevice *pci_dev;
f48a7a6e 537 uint32_t count;
9ba4524c 538 dma_addr_t addr;
64d56409 539 SCSIDevice *dev;
7d8406be 540
b96a0da0
GH
541 assert(s->current);
542 if (!s->current->dma_len) {
a917d384
PB
543 /* Wait until data is available. */
544 DPRINTF("DMA no data available\n");
545 return;
7d8406be
PB
546 }
547
725eec70 548 pci_dev = PCI_DEVICE(s);
f48a7a6e
PB
549 dev = s->current->req->dev;
550 assert(dev);
64d56409 551
a917d384 552 count = s->dbc;
b96a0da0
GH
553 if (count > s->current->dma_len)
554 count = s->current->dma_len;
a917d384
PB
555
556 addr = s->dnad;
dd8edf01
AL
557 /* both 40 and Table Indirect 64-bit DMAs store upper bits in dnad64 */
558 if (lsi_dma_40bit(s) || lsi_dma_ti64bit(s))
b25cf589 559 addr |= ((uint64_t)s->dnad64 << 32);
dd8edf01
AL
560 else if (s->dbms)
561 addr |= ((uint64_t)s->dbms << 32);
b25cf589
AL
562 else if (s->sbms)
563 addr |= ((uint64_t)s->sbms << 32);
564
9ba4524c 565 DPRINTF("DMA addr=0x" DMA_ADDR_FMT " len=%d\n", addr, count);
7d8406be 566 s->csbc += count;
a917d384
PB
567 s->dnad += count;
568 s->dbc -= count;
5c6c0e51 569 if (s->current->dma_buf == NULL) {
0c34459b 570 s->current->dma_buf = scsi_req_get_buf(s->current->req);
a917d384 571 }
7d8406be 572 /* ??? Set SFBR to first data byte. */
a917d384 573 if (out) {
725eec70 574 pci_dma_read(pci_dev, addr, s->current->dma_buf, count);
a917d384 575 } else {
725eec70 576 pci_dma_write(pci_dev, addr, s->current->dma_buf, count);
a917d384 577 }
b96a0da0
GH
578 s->current->dma_len -= count;
579 if (s->current->dma_len == 0) {
580 s->current->dma_buf = NULL;
ad3376cc 581 scsi_req_continue(s->current->req);
a917d384 582 } else {
b96a0da0 583 s->current->dma_buf += count;
a917d384
PB
584 lsi_resume_script(s);
585 }
586}
587
588
589/* Add a command to the queue. */
590static void lsi_queue_command(LSIState *s)
591{
af12ac98 592 lsi_request *p = s->current;
a917d384 593
aa2b1e89 594 DPRINTF("Queueing tag=0x%x\n", p->tag);
af12ac98 595 assert(s->current != NULL);
b96a0da0 596 assert(s->current->dma_len == 0);
af12ac98
GH
597 QTAILQ_INSERT_TAIL(&s->queue, s->current, next);
598 s->current = NULL;
599
a917d384
PB
600 p->pending = 0;
601 p->out = (s->sstat1 & PHASE_MASK) == PHASE_DO;
602}
603
604/* Queue a byte for a MSG IN phase. */
605static void lsi_add_msg_byte(LSIState *s, uint8_t data)
606{
607 if (s->msg_len >= LSI_MAX_MSGIN_LEN) {
608 BADF("MSG IN data too long\n");
4d611c9a 609 } else {
a917d384
PB
610 DPRINTF("MSG IN 0x%02x\n", data);
611 s->msg[s->msg_len++] = data;
7d8406be 612 }
a917d384
PB
613}
614
615/* Perform reselection to continue a command. */
aa4d32c4 616static void lsi_reselect(LSIState *s, lsi_request *p)
a917d384 617{
a917d384
PB
618 int id;
619
af12ac98
GH
620 assert(s->current == NULL);
621 QTAILQ_REMOVE(&s->queue, p, next);
622 s->current = p;
623
aa4d32c4 624 id = (p->tag >> 8) & 0xf;
a917d384 625 s->ssid = id | 0x80;
cc9f28bc 626 /* LSI53C700 Family Compatibility, see LSI53C895A 4-73 */
f6dc18df 627 if (!(s->dcntl & LSI_DCNTL_COM)) {
cc9f28bc
LA
628 s->sfbr = 1 << (id & 0x7);
629 }
a917d384 630 DPRINTF("Reselected target %d\n", id);
a917d384
PB
631 s->scntl1 |= LSI_SCNTL1_CON;
632 lsi_set_phase(s, PHASE_MI);
633 s->msg_action = p->out ? 2 : 3;
b96a0da0 634 s->current->dma_len = p->pending;
a917d384 635 lsi_add_msg_byte(s, 0x80);
af12ac98 636 if (s->current->tag & LSI_TAG_VALID) {
a917d384 637 lsi_add_msg_byte(s, 0x20);
aa4d32c4 638 lsi_add_msg_byte(s, p->tag & 0xff);
a917d384
PB
639 }
640
e560125e
LA
641 if (lsi_irq_on_rsl(s)) {
642 lsi_script_scsi_interrupt(s, LSI_SIST0_RSL, 0);
643 }
a917d384
PB
644}
645
11257187 646static lsi_request *lsi_find_by_tag(LSIState *s, uint32_t tag)
a917d384 647{
042ec49d
GH
648 lsi_request *p;
649
650 QTAILQ_FOREACH(p, &s->queue, next) {
a917d384 651 if (p->tag == tag) {
11257187 652 return p;
a917d384
PB
653 }
654 }
11257187
PB
655
656 return NULL;
657}
658
d2a9998f
PB
659static void lsi_request_free(LSIState *s, lsi_request *p)
660{
661 if (p == s->current) {
662 s->current = NULL;
663 } else {
664 QTAILQ_REMOVE(&s->queue, p, next);
665 }
666 g_free(p);
667}
668
94d3f98a
PB
669static void lsi_request_cancelled(SCSIRequest *req)
670{
71186c86 671 LSIState *s = LSI53C895A(req->bus->qbus.parent);
c5bf71a9 672 lsi_request *p = req->hba_private;
94d3f98a 673
d2a9998f
PB
674 req->hba_private = NULL;
675 lsi_request_free(s, p);
676 scsi_req_unref(req);
94d3f98a
PB
677}
678
11257187
PB
679/* Record that data is available for a queued command. Returns zero if
680 the device was reselected, nonzero if the IO is deferred. */
c5bf71a9 681static int lsi_queue_req(LSIState *s, SCSIRequest *req, uint32_t len)
11257187 682{
c5bf71a9 683 lsi_request *p = req->hba_private;
11257187
PB
684
685 if (p->pending) {
c5bf71a9 686 BADF("Multiple IO pending for request %p\n", p);
11257187 687 }
aba1f023 688 p->pending = len;
11257187
PB
689 /* Reselect if waiting for it, or if reselection triggers an IRQ
690 and the bus is free.
691 Since no interrupt stacking is implemented in the emulation, it
692 is also required that there are no pending interrupts waiting
693 for service from the device driver. */
694 if (s->waiting == 1 ||
695 (lsi_irq_on_rsl(s) && !(s->scntl1 & LSI_SCNTL1_CON) &&
696 !(s->istat0 & (LSI_ISTAT0_SIP | LSI_ISTAT0_DIP)))) {
697 /* Reselect device. */
698 lsi_reselect(s, p);
699 return 0;
700 } else {
4789bc39 701 DPRINTF("Queueing IO tag=0x%x\n", p->tag);
aba1f023 702 p->pending = len;
11257187
PB
703 return 1;
704 }
7d8406be 705}
c6df7102
PB
706
707 /* Callback to indicate that the SCSI layer has completed a command. */
01e95455 708static void lsi_command_complete(SCSIRequest *req, uint32_t status, size_t resid)
4d611c9a 709{
71186c86 710 LSIState *s = LSI53C895A(req->bus->qbus.parent);
4d611c9a
PB
711 int out;
712
a917d384 713 out = (s->sstat1 & PHASE_MASK) == PHASE_DO;
aba1f023
PB
714 DPRINTF("Command complete status=%d\n", (int)status);
715 s->status = status;
c6df7102
PB
716 s->command_complete = 2;
717 if (s->waiting && s->dbc != 0) {
718 /* Raise phase mismatch for short transfers. */
719 lsi_bad_phase(s, out, PHASE_ST);
720 } else {
721 lsi_set_phase(s, PHASE_ST);
722 }
af12ac98 723
8f6e699d 724 if (req->hba_private == s->current) {
d2a9998f
PB
725 req->hba_private = NULL;
726 lsi_request_free(s, s->current);
727 scsi_req_unref(req);
4d611c9a 728 }
c6df7102
PB
729 lsi_resume_script(s);
730}
731
732 /* Callback to indicate that the SCSI layer has completed a transfer. */
aba1f023 733static void lsi_transfer_data(SCSIRequest *req, uint32_t len)
c6df7102 734{
71186c86 735 LSIState *s = LSI53C895A(req->bus->qbus.parent);
c6df7102 736 int out;
4d611c9a 737
8f6e699d
PB
738 assert(req->hba_private);
739 if (s->waiting == 1 || req->hba_private != s->current ||
e560125e 740 (lsi_irq_on_rsl(s) && !(s->scntl1 & LSI_SCNTL1_CON))) {
c5bf71a9 741 if (lsi_queue_req(s, req, len)) {
a917d384 742 return;
5c6c0e51 743 }
a917d384 744 }
e560125e 745
c6df7102
PB
746 out = (s->sstat1 & PHASE_MASK) == PHASE_DO;
747
e560125e 748 /* host adapter (re)connected */
aba1f023
PB
749 DPRINTF("Data ready tag=0x%x len=%d\n", req->tag, len);
750 s->current->dma_len = len;
8ccc2ace 751 s->command_complete = 1;
c6df7102
PB
752 if (s->waiting) {
753 if (s->waiting == 1 || s->dbc == 0) {
754 lsi_resume_script(s);
755 } else {
756 lsi_do_dma(s, out);
757 }
4d611c9a
PB
758 }
759}
7d8406be
PB
760
761static void lsi_do_command(LSIState *s)
762{
64d56409 763 SCSIDevice *dev;
7d8406be 764 uint8_t buf[16];
64d56409 765 uint32_t id;
7d8406be
PB
766 int n;
767
768 DPRINTF("Send command len=%d\n", s->dbc);
769 if (s->dbc > 16)
770 s->dbc = 16;
725eec70 771 pci_dma_read(PCI_DEVICE(s), s->dnad, buf, s->dbc);
7d8406be 772 s->sfbr = buf[0];
8ccc2ace 773 s->command_complete = 0;
af12ac98 774
259d5577 775 id = (s->select_tag >> 8) & 0xf;
0d3545e7 776 dev = scsi_device_find(&s->bus, 0, id, s->current_lun);
64d56409
JK
777 if (!dev) {
778 lsi_bad_selection(s, id);
779 return;
780 }
781
af12ac98 782 assert(s->current == NULL);
7267c094 783 s->current = g_malloc0(sizeof(lsi_request));
af12ac98 784 s->current->tag = s->select_tag;
c39ce112 785 s->current->req = scsi_req_new(dev, s->current->tag, s->current_lun, buf,
c5bf71a9 786 s->current);
af12ac98 787
c39ce112 788 n = scsi_req_enqueue(s->current->req);
ad3376cc
PB
789 if (n) {
790 if (n > 0) {
791 lsi_set_phase(s, PHASE_DI);
792 } else if (n < 0) {
793 lsi_set_phase(s, PHASE_DO);
794 }
795 scsi_req_continue(s->current->req);
a917d384 796 }
8ccc2ace
TS
797 if (!s->command_complete) {
798 if (n) {
799 /* Command did not complete immediately so disconnect. */
800 lsi_add_msg_byte(s, 2); /* SAVE DATA POINTER */
801 lsi_add_msg_byte(s, 4); /* DISCONNECT */
802 /* wait data */
803 lsi_set_phase(s, PHASE_MI);
804 s->msg_action = 1;
805 lsi_queue_command(s);
806 } else {
807 /* wait command complete */
808 lsi_set_phase(s, PHASE_DI);
809 }
7d8406be
PB
810 }
811}
812
7d8406be
PB
813static void lsi_do_status(LSIState *s)
814{
2f172849
HR
815 uint8_t status;
816 DPRINTF("Get status len=%d status=%d\n", s->dbc, s->status);
7d8406be
PB
817 if (s->dbc != 1)
818 BADF("Bad Status move\n");
819 s->dbc = 1;
2f172849
HR
820 status = s->status;
821 s->sfbr = status;
725eec70 822 pci_dma_write(PCI_DEVICE(s), s->dnad, &status, 1);
7d8406be 823 lsi_set_phase(s, PHASE_MI);
a917d384
PB
824 s->msg_action = 1;
825 lsi_add_msg_byte(s, 0); /* COMMAND COMPLETE */
7d8406be
PB
826}
827
7d8406be
PB
828static void lsi_do_msgin(LSIState *s)
829{
a917d384
PB
830 int len;
831 DPRINTF("Message in len=%d/%d\n", s->dbc, s->msg_len);
832 s->sfbr = s->msg[0];
833 len = s->msg_len;
834 if (len > s->dbc)
835 len = s->dbc;
725eec70 836 pci_dma_write(PCI_DEVICE(s), s->dnad, s->msg, len);
a917d384
PB
837 /* Linux drivers rely on the last byte being in the SIDL. */
838 s->sidl = s->msg[len - 1];
839 s->msg_len -= len;
840 if (s->msg_len) {
841 memmove(s->msg, s->msg + len, s->msg_len);
7d8406be
PB
842 } else {
843 /* ??? Check if ATN (not yet implemented) is asserted and maybe
844 switch to PHASE_MO. */
a917d384
PB
845 switch (s->msg_action) {
846 case 0:
847 lsi_set_phase(s, PHASE_CMD);
848 break;
849 case 1:
850 lsi_disconnect(s);
851 break;
852 case 2:
853 lsi_set_phase(s, PHASE_DO);
854 break;
855 case 3:
856 lsi_set_phase(s, PHASE_DI);
857 break;
858 default:
859 abort();
860 }
7d8406be
PB
861 }
862}
863
a917d384
PB
864/* Read the next byte during a MSGOUT phase. */
865static uint8_t lsi_get_msgbyte(LSIState *s)
866{
867 uint8_t data;
725eec70 868 pci_dma_read(PCI_DEVICE(s), s->dnad, &data, 1);
a917d384
PB
869 s->dnad++;
870 s->dbc--;
871 return data;
872}
873
444dd39b
SH
874/* Skip the next n bytes during a MSGOUT phase. */
875static void lsi_skip_msgbytes(LSIState *s, unsigned int n)
876{
877 s->dnad += n;
878 s->dbc -= n;
879}
880
7d8406be
PB
881static void lsi_do_msgout(LSIState *s)
882{
883 uint8_t msg;
a917d384 884 int len;
508240c0 885 uint32_t current_tag;
5c6c0e51 886 lsi_request *current_req, *p, *p_next;
508240c0
BK
887
888 if (s->current) {
889 current_tag = s->current->tag;
5c6c0e51 890 current_req = s->current;
508240c0
BK
891 } else {
892 current_tag = s->select_tag;
5c6c0e51 893 current_req = lsi_find_by_tag(s, current_tag);
508240c0 894 }
7d8406be
PB
895
896 DPRINTF("MSG out len=%d\n", s->dbc);
a917d384
PB
897 while (s->dbc) {
898 msg = lsi_get_msgbyte(s);
899 s->sfbr = msg;
900
901 switch (msg) {
77203ea0 902 case 0x04:
a917d384
PB
903 DPRINTF("MSG: Disconnect\n");
904 lsi_disconnect(s);
905 break;
906 case 0x08:
907 DPRINTF("MSG: No Operation\n");
908 lsi_set_phase(s, PHASE_CMD);
909 break;
910 case 0x01:
911 len = lsi_get_msgbyte(s);
912 msg = lsi_get_msgbyte(s);
f3f5b867 913 (void)len; /* avoid a warning about unused variable*/
a917d384
PB
914 DPRINTF("Extended message 0x%x (len %d)\n", msg, len);
915 switch (msg) {
916 case 1:
917 DPRINTF("SDTR (ignored)\n");
444dd39b 918 lsi_skip_msgbytes(s, 2);
a917d384
PB
919 break;
920 case 3:
921 DPRINTF("WDTR (ignored)\n");
444dd39b 922 lsi_skip_msgbytes(s, 1);
a917d384
PB
923 break;
924 default:
925 goto bad;
926 }
927 break;
928 case 0x20: /* SIMPLE queue */
af12ac98 929 s->select_tag |= lsi_get_msgbyte(s) | LSI_TAG_VALID;
aa2b1e89 930 DPRINTF("SIMPLE queue tag=0x%x\n", s->select_tag & 0xff);
a917d384
PB
931 break;
932 case 0x21: /* HEAD of queue */
933 BADF("HEAD queue not implemented\n");
af12ac98 934 s->select_tag |= lsi_get_msgbyte(s) | LSI_TAG_VALID;
a917d384
PB
935 break;
936 case 0x22: /* ORDERED queue */
937 BADF("ORDERED queue not implemented\n");
af12ac98 938 s->select_tag |= lsi_get_msgbyte(s) | LSI_TAG_VALID;
a917d384 939 break;
508240c0
BK
940 case 0x0d:
941 /* The ABORT TAG message clears the current I/O process only. */
942 DPRINTF("MSG: ABORT TAG tag=0x%x\n", current_tag);
5c6c0e51 943 if (current_req) {
94d3f98a 944 scsi_req_cancel(current_req->req);
5c6c0e51 945 }
508240c0
BK
946 lsi_disconnect(s);
947 break;
948 case 0x06:
949 case 0x0e:
950 case 0x0c:
951 /* The ABORT message clears all I/O processes for the selecting
952 initiator on the specified logical unit of the target. */
953 if (msg == 0x06) {
954 DPRINTF("MSG: ABORT tag=0x%x\n", current_tag);
955 }
956 /* The CLEAR QUEUE message clears all I/O processes for all
957 initiators on the specified logical unit of the target. */
958 if (msg == 0x0e) {
959 DPRINTF("MSG: CLEAR QUEUE tag=0x%x\n", current_tag);
960 }
961 /* The BUS DEVICE RESET message clears all I/O processes for all
962 initiators on all logical units of the target. */
963 if (msg == 0x0c) {
964 DPRINTF("MSG: BUS DEVICE RESET tag=0x%x\n", current_tag);
965 }
966
967 /* clear the current I/O process */
5c6c0e51 968 if (s->current) {
94d3f98a 969 scsi_req_cancel(s->current->req);
5c6c0e51 970 }
508240c0
BK
971
972 /* As the current implemented devices scsi_disk and scsi_generic
973 only support one LUN, we don't need to keep track of LUNs.
974 Clearing I/O processes for other initiators could be possible
975 for scsi_generic by sending a SG_SCSI_RESET to the /dev/sgX
976 device, but this is currently not implemented (and seems not
977 to be really necessary). So let's simply clear all queued
978 commands for the current device: */
508240c0 979 QTAILQ_FOREACH_SAFE(p, &s->queue, next, p_next) {
a6c6f44a 980 if ((p->tag & 0x0000ff00) == (current_tag & 0x0000ff00)) {
94d3f98a 981 scsi_req_cancel(p->req);
508240c0
BK
982 }
983 }
984
985 lsi_disconnect(s);
986 break;
a917d384
PB
987 default:
988 if ((msg & 0x80) == 0) {
989 goto bad;
990 }
991 s->current_lun = msg & 7;
992 DPRINTF("Select LUN %d\n", s->current_lun);
993 lsi_set_phase(s, PHASE_CMD);
994 break;
995 }
7d8406be 996 }
a917d384
PB
997 return;
998bad:
999 BADF("Unimplemented message 0x%02x\n", msg);
1000 lsi_set_phase(s, PHASE_MI);
1001 lsi_add_msg_byte(s, 7); /* MESSAGE REJECT */
1002 s->msg_action = 0;
7d8406be
PB
1003}
1004
e20a8dff 1005#define LSI_BUF_SIZE 4096
7d8406be
PB
1006static void lsi_memcpy(LSIState *s, uint32_t dest, uint32_t src, int count)
1007{
725eec70 1008 PCIDevice *d = PCI_DEVICE(s);
7d8406be 1009 int n;
e20a8dff 1010 uint8_t buf[LSI_BUF_SIZE];
7d8406be
PB
1011
1012 DPRINTF("memcpy dest 0x%08x src 0x%08x count %d\n", dest, src, count);
1013 while (count) {
e20a8dff 1014 n = (count > LSI_BUF_SIZE) ? LSI_BUF_SIZE : count;
725eec70
AF
1015 pci_dma_read(d, src, buf, n);
1016 pci_dma_write(d, dest, buf, n);
7d8406be
PB
1017 src += n;
1018 dest += n;
1019 count -= n;
1020 }
1021}
1022
a917d384
PB
1023static void lsi_wait_reselect(LSIState *s)
1024{
042ec49d
GH
1025 lsi_request *p;
1026
a917d384 1027 DPRINTF("Wait Reselect\n");
042ec49d
GH
1028
1029 QTAILQ_FOREACH(p, &s->queue, next) {
1030 if (p->pending) {
aa4d32c4 1031 lsi_reselect(s, p);
a917d384
PB
1032 break;
1033 }
1034 }
b96a0da0 1035 if (s->current == NULL) {
a917d384
PB
1036 s->waiting = 1;
1037 }
1038}
1039
7d8406be
PB
1040static void lsi_execute_script(LSIState *s)
1041{
725eec70 1042 PCIDevice *pci_dev = PCI_DEVICE(s);
7d8406be 1043 uint32_t insn;
b25cf589 1044 uint32_t addr, addr_high;
7d8406be 1045 int opcode;
ee4d919f 1046 int insn_processed = 0;
7d8406be
PB
1047
1048 s->istat1 |= LSI_ISTAT1_SRUN;
1049again:
ee4d919f 1050 insn_processed++;
7d8406be 1051 insn = read_dword(s, s->dsp);
02b373ad
AZ
1052 if (!insn) {
1053 /* If we receive an empty opcode increment the DSP by 4 bytes
1054 instead of 8 and execute the next opcode at that location */
1055 s->dsp += 4;
1056 goto again;
1057 }
7d8406be 1058 addr = read_dword(s, s->dsp + 4);
b25cf589 1059 addr_high = 0;
7d8406be
PB
1060 DPRINTF("SCRIPTS dsp=%08x opcode %08x arg %08x\n", s->dsp, insn, addr);
1061 s->dsps = addr;
1062 s->dcmd = insn >> 24;
1063 s->dsp += 8;
1064 switch (insn >> 30) {
1065 case 0: /* Block move. */
1066 if (s->sist1 & LSI_SIST1_STO) {
1067 DPRINTF("Delayed select timeout\n");
1068 lsi_stop_script(s);
1069 break;
1070 }
1071 s->dbc = insn & 0xffffff;
1072 s->rbc = s->dbc;
dd8edf01
AL
1073 /* ??? Set ESA. */
1074 s->ia = s->dsp - 8;
7d8406be
PB
1075 if (insn & (1 << 29)) {
1076 /* Indirect addressing. */
1077 addr = read_dword(s, addr);
1078 } else if (insn & (1 << 28)) {
1079 uint32_t buf[2];
1080 int32_t offset;
1081 /* Table indirect addressing. */
dd8edf01
AL
1082
1083 /* 32-bit Table indirect */
92794105 1084 offset = sextract32(addr, 0, 24);
725eec70 1085 pci_dma_read(pci_dev, s->dsa + offset, buf, 8);
b25cf589
AL
1086 /* byte count is stored in bits 0:23 only */
1087 s->dbc = cpu_to_le32(buf[0]) & 0xffffff;
7faa239c 1088 s->rbc = s->dbc;
7d8406be 1089 addr = cpu_to_le32(buf[1]);
b25cf589
AL
1090
1091 /* 40-bit DMA, upper addr bits [39:32] stored in first DWORD of
1092 * table, bits [31:24] */
1093 if (lsi_dma_40bit(s))
1094 addr_high = cpu_to_le32(buf[0]) >> 24;
dd8edf01
AL
1095 else if (lsi_dma_ti64bit(s)) {
1096 int selector = (cpu_to_le32(buf[0]) >> 24) & 0x1f;
1097 switch (selector) {
1098 case 0 ... 0x0f:
1099 /* offset index into scratch registers since
1100 * TI64 mode can use registers C to R */
1101 addr_high = s->scratch[2 + selector];
1102 break;
1103 case 0x10:
1104 addr_high = s->mmrs;
1105 break;
1106 case 0x11:
1107 addr_high = s->mmws;
1108 break;
1109 case 0x12:
1110 addr_high = s->sfs;
1111 break;
1112 case 0x13:
1113 addr_high = s->drs;
1114 break;
1115 case 0x14:
1116 addr_high = s->sbms;
1117 break;
1118 case 0x15:
1119 addr_high = s->dbms;
1120 break;
1121 default:
1122 BADF("Illegal selector specified (0x%x > 0x15)"
1123 " for 64-bit DMA block move", selector);
1124 break;
1125 }
1126 }
1127 } else if (lsi_dma_64bit(s)) {
1128 /* fetch a 3rd dword if 64-bit direct move is enabled and
1129 only if we're not doing table indirect or indirect addressing */
1130 s->dbms = read_dword(s, s->dsp);
1131 s->dsp += 4;
1132 s->ia = s->dsp - 12;
7d8406be
PB
1133 }
1134 if ((s->sstat1 & PHASE_MASK) != ((insn >> 24) & 7)) {
1135 DPRINTF("Wrong phase got %d expected %d\n",
1136 s->sstat1 & PHASE_MASK, (insn >> 24) & 7);
1137 lsi_script_scsi_interrupt(s, LSI_SIST0_MA, 0);
1138 break;
1139 }
1140 s->dnad = addr;
b25cf589 1141 s->dnad64 = addr_high;
7d8406be
PB
1142 switch (s->sstat1 & 0x7) {
1143 case PHASE_DO:
a917d384 1144 s->waiting = 2;
7d8406be 1145 lsi_do_dma(s, 1);
a917d384
PB
1146 if (s->waiting)
1147 s->waiting = 3;
7d8406be
PB
1148 break;
1149 case PHASE_DI:
a917d384 1150 s->waiting = 2;
7d8406be 1151 lsi_do_dma(s, 0);
a917d384
PB
1152 if (s->waiting)
1153 s->waiting = 3;
7d8406be
PB
1154 break;
1155 case PHASE_CMD:
1156 lsi_do_command(s);
1157 break;
1158 case PHASE_ST:
1159 lsi_do_status(s);
1160 break;
1161 case PHASE_MO:
1162 lsi_do_msgout(s);
1163 break;
1164 case PHASE_MI:
1165 lsi_do_msgin(s);
1166 break;
1167 default:
1168 BADF("Unimplemented phase %d\n", s->sstat1 & PHASE_MASK);
1169 exit(1);
1170 }
1171 s->dfifo = s->dbc & 0xff;
1172 s->ctest5 = (s->ctest5 & 0xfc) | ((s->dbc >> 8) & 3);
1173 s->sbc = s->dbc;
1174 s->rbc -= s->dbc;
1175 s->ua = addr + s->dbc;
7d8406be
PB
1176 break;
1177
1178 case 1: /* IO or Read/Write instruction. */
1179 opcode = (insn >> 27) & 7;
1180 if (opcode < 5) {
1181 uint32_t id;
1182
1183 if (insn & (1 << 25)) {
92794105 1184 id = read_dword(s, s->dsa + sextract32(insn, 0, 24));
7d8406be 1185 } else {
07a1bea8 1186 id = insn;
7d8406be
PB
1187 }
1188 id = (id >> 16) & 0xf;
1189 if (insn & (1 << 26)) {
92794105 1190 addr = s->dsp + sextract32(addr, 0, 24);
7d8406be
PB
1191 }
1192 s->dnad = addr;
1193 switch (opcode) {
1194 case 0: /* Select */
a917d384 1195 s->sdid = id;
38f5b2b8
LA
1196 if (s->scntl1 & LSI_SCNTL1_CON) {
1197 DPRINTF("Already reselected, jumping to alternative address\n");
1198 s->dsp = s->dnad;
a917d384
PB
1199 break;
1200 }
7d8406be
PB
1201 s->sstat0 |= LSI_SSTAT0_WOA;
1202 s->scntl1 &= ~LSI_SCNTL1_IARB;
0d3545e7 1203 if (!scsi_device_find(&s->bus, 0, id, 0)) {
64d56409 1204 lsi_bad_selection(s, id);
7d8406be
PB
1205 break;
1206 }
1207 DPRINTF("Selected target %d%s\n",
1208 id, insn & (1 << 3) ? " ATN" : "");
1209 /* ??? Linux drivers compain when this is set. Maybe
1210 it only applies in low-level mode (unimplemented).
1211 lsi_script_scsi_interrupt(s, LSI_SIST0_CMP, 0); */
af12ac98 1212 s->select_tag = id << 8;
7d8406be
PB
1213 s->scntl1 |= LSI_SCNTL1_CON;
1214 if (insn & (1 << 3)) {
1215 s->socl |= LSI_SOCL_ATN;
1216 }
1217 lsi_set_phase(s, PHASE_MO);
1218 break;
1219 case 1: /* Disconnect */
a15fdf86 1220 DPRINTF("Wait Disconnect\n");
7d8406be
PB
1221 s->scntl1 &= ~LSI_SCNTL1_CON;
1222 break;
1223 case 2: /* Wait Reselect */
e560125e
LA
1224 if (!lsi_irq_on_rsl(s)) {
1225 lsi_wait_reselect(s);
1226 }
7d8406be
PB
1227 break;
1228 case 3: /* Set */
1229 DPRINTF("Set%s%s%s%s\n",
1230 insn & (1 << 3) ? " ATN" : "",
1231 insn & (1 << 6) ? " ACK" : "",
1232 insn & (1 << 9) ? " TM" : "",
1233 insn & (1 << 10) ? " CC" : "");
1234 if (insn & (1 << 3)) {
1235 s->socl |= LSI_SOCL_ATN;
1236 lsi_set_phase(s, PHASE_MO);
1237 }
1238 if (insn & (1 << 9)) {
1239 BADF("Target mode not implemented\n");
1240 exit(1);
1241 }
1242 if (insn & (1 << 10))
1243 s->carry = 1;
1244 break;
1245 case 4: /* Clear */
1246 DPRINTF("Clear%s%s%s%s\n",
1247 insn & (1 << 3) ? " ATN" : "",
1248 insn & (1 << 6) ? " ACK" : "",
1249 insn & (1 << 9) ? " TM" : "",
1250 insn & (1 << 10) ? " CC" : "");
1251 if (insn & (1 << 3)) {
1252 s->socl &= ~LSI_SOCL_ATN;
1253 }
1254 if (insn & (1 << 10))
1255 s->carry = 0;
1256 break;
1257 }
1258 } else {
1259 uint8_t op0;
1260 uint8_t op1;
1261 uint8_t data8;
1262 int reg;
1263 int operator;
1264#ifdef DEBUG_LSI
1265 static const char *opcode_names[3] =
1266 {"Write", "Read", "Read-Modify-Write"};
1267 static const char *operator_names[8] =
1268 {"MOV", "SHL", "OR", "XOR", "AND", "SHR", "ADD", "ADC"};
1269#endif
1270
1271 reg = ((insn >> 16) & 0x7f) | (insn & 0x80);
1272 data8 = (insn >> 8) & 0xff;
1273 opcode = (insn >> 27) & 7;
1274 operator = (insn >> 24) & 7;
a917d384 1275 DPRINTF("%s reg 0x%x %s data8=0x%02x sfbr=0x%02x%s\n",
7d8406be 1276 opcode_names[opcode - 5], reg,
a917d384 1277 operator_names[operator], data8, s->sfbr,
7d8406be
PB
1278 (insn & (1 << 23)) ? " SFBR" : "");
1279 op0 = op1 = 0;
1280 switch (opcode) {
1281 case 5: /* From SFBR */
1282 op0 = s->sfbr;
1283 op1 = data8;
1284 break;
1285 case 6: /* To SFBR */
1286 if (operator)
1287 op0 = lsi_reg_readb(s, reg);
1288 op1 = data8;
1289 break;
1290 case 7: /* Read-modify-write */
1291 if (operator)
1292 op0 = lsi_reg_readb(s, reg);
1293 if (insn & (1 << 23)) {
1294 op1 = s->sfbr;
1295 } else {
1296 op1 = data8;
1297 }
1298 break;
1299 }
1300
1301 switch (operator) {
1302 case 0: /* move */
1303 op0 = op1;
1304 break;
1305 case 1: /* Shift left */
1306 op1 = op0 >> 7;
1307 op0 = (op0 << 1) | s->carry;
1308 s->carry = op1;
1309 break;
1310 case 2: /* OR */
1311 op0 |= op1;
1312 break;
1313 case 3: /* XOR */
dcfb9014 1314 op0 ^= op1;
7d8406be
PB
1315 break;
1316 case 4: /* AND */
1317 op0 &= op1;
1318 break;
1319 case 5: /* SHR */
1320 op1 = op0 & 1;
1321 op0 = (op0 >> 1) | (s->carry << 7);
687fa640 1322 s->carry = op1;
7d8406be
PB
1323 break;
1324 case 6: /* ADD */
1325 op0 += op1;
1326 s->carry = op0 < op1;
1327 break;
1328 case 7: /* ADC */
1329 op0 += op1 + s->carry;
1330 if (s->carry)
1331 s->carry = op0 <= op1;
1332 else
1333 s->carry = op0 < op1;
1334 break;
1335 }
1336
1337 switch (opcode) {
1338 case 5: /* From SFBR */
1339 case 7: /* Read-modify-write */
1340 lsi_reg_writeb(s, reg, op0);
1341 break;
1342 case 6: /* To SFBR */
1343 s->sfbr = op0;
1344 break;
1345 }
1346 }
1347 break;
1348
1349 case 2: /* Transfer Control. */
1350 {
1351 int cond;
1352 int jmp;
1353
1354 if ((insn & 0x002e0000) == 0) {
1355 DPRINTF("NOP\n");
1356 break;
1357 }
1358 if (s->sist1 & LSI_SIST1_STO) {
1359 DPRINTF("Delayed select timeout\n");
1360 lsi_stop_script(s);
1361 break;
1362 }
1363 cond = jmp = (insn & (1 << 19)) != 0;
1364 if (cond == jmp && (insn & (1 << 21))) {
1365 DPRINTF("Compare carry %d\n", s->carry == jmp);
1366 cond = s->carry != 0;
1367 }
1368 if (cond == jmp && (insn & (1 << 17))) {
1369 DPRINTF("Compare phase %d %c= %d\n",
1370 (s->sstat1 & PHASE_MASK),
1371 jmp ? '=' : '!',
1372 ((insn >> 24) & 7));
1373 cond = (s->sstat1 & PHASE_MASK) == ((insn >> 24) & 7);
1374 }
1375 if (cond == jmp && (insn & (1 << 18))) {
1376 uint8_t mask;
1377
1378 mask = (~insn >> 8) & 0xff;
1379 DPRINTF("Compare data 0x%x & 0x%x %c= 0x%x\n",
1380 s->sfbr, mask, jmp ? '=' : '!', insn & mask);
1381 cond = (s->sfbr & mask) == (insn & mask);
1382 }
1383 if (cond == jmp) {
1384 if (insn & (1 << 23)) {
1385 /* Relative address. */
92794105 1386 addr = s->dsp + sextract32(addr, 0, 24);
7d8406be
PB
1387 }
1388 switch ((insn >> 27) & 7) {
1389 case 0: /* Jump */
1390 DPRINTF("Jump to 0x%08x\n", addr);
1391 s->dsp = addr;
1392 break;
1393 case 1: /* Call */
1394 DPRINTF("Call 0x%08x\n", addr);
1395 s->temp = s->dsp;
1396 s->dsp = addr;
1397 break;
1398 case 2: /* Return */
1399 DPRINTF("Return to 0x%08x\n", s->temp);
1400 s->dsp = s->temp;
1401 break;
1402 case 3: /* Interrupt */
1403 DPRINTF("Interrupt 0x%08x\n", s->dsps);
1404 if ((insn & (1 << 20)) != 0) {
1405 s->istat0 |= LSI_ISTAT0_INTF;
1406 lsi_update_irq(s);
1407 } else {
1408 lsi_script_dma_interrupt(s, LSI_DSTAT_SIR);
1409 }
1410 break;
1411 default:
1412 DPRINTF("Illegal transfer control\n");
1413 lsi_script_dma_interrupt(s, LSI_DSTAT_IID);
1414 break;
1415 }
1416 } else {
1417 DPRINTF("Control condition failed\n");
1418 }
1419 }
1420 break;
1421
1422 case 3:
1423 if ((insn & (1 << 29)) == 0) {
1424 /* Memory move. */
1425 uint32_t dest;
1426 /* ??? The docs imply the destination address is loaded into
1427 the TEMP register. However the Linux drivers rely on
1428 the value being presrved. */
1429 dest = read_dword(s, s->dsp);
1430 s->dsp += 4;
1431 lsi_memcpy(s, dest, addr, insn & 0xffffff);
1432 } else {
1433 uint8_t data[7];
1434 int reg;
1435 int n;
1436 int i;
1437
1438 if (insn & (1 << 28)) {
92794105 1439 addr = s->dsa + sextract32(addr, 0, 24);
7d8406be
PB
1440 }
1441 n = (insn & 7);
1442 reg = (insn >> 16) & 0xff;
1443 if (insn & (1 << 24)) {
725eec70 1444 pci_dma_read(pci_dev, addr, data, n);
a917d384
PB
1445 DPRINTF("Load reg 0x%x size %d addr 0x%08x = %08x\n", reg, n,
1446 addr, *(int *)data);
7d8406be
PB
1447 for (i = 0; i < n; i++) {
1448 lsi_reg_writeb(s, reg + i, data[i]);
1449 }
1450 } else {
1451 DPRINTF("Store reg 0x%x size %d addr 0x%08x\n", reg, n, addr);
1452 for (i = 0; i < n; i++) {
1453 data[i] = lsi_reg_readb(s, reg + i);
1454 }
725eec70 1455 pci_dma_write(pci_dev, addr, data, n);
7d8406be
PB
1456 }
1457 }
1458 }
ee4d919f 1459 if (insn_processed > 10000 && !s->waiting) {
64c68080
PB
1460 /* Some windows drivers make the device spin waiting for a memory
1461 location to change. If we have been executed a lot of code then
1462 assume this is the case and force an unexpected device disconnect.
1463 This is apparently sufficient to beat the drivers into submission.
1464 */
ee4d919f
AL
1465 if (!(s->sien0 & LSI_SIST0_UDC))
1466 fprintf(stderr, "inf. loop with UDC masked\n");
1467 lsi_script_scsi_interrupt(s, LSI_SIST0_UDC, 0);
1468 lsi_disconnect(s);
1469 } else if (s->istat1 & LSI_ISTAT1_SRUN && !s->waiting) {
7d8406be
PB
1470 if (s->dcntl & LSI_DCNTL_SSM) {
1471 lsi_script_dma_interrupt(s, LSI_DSTAT_SSI);
1472 } else {
1473 goto again;
1474 }
1475 }
1476 DPRINTF("SCRIPTS execution stopped\n");
1477}
1478
1479static uint8_t lsi_reg_readb(LSIState *s, int offset)
1480{
1481 uint8_t tmp;
75f76531
AJ
1482#define CASE_GET_REG24(name, addr) \
1483 case addr: return s->name & 0xff; \
1484 case addr + 1: return (s->name >> 8) & 0xff; \
1485 case addr + 2: return (s->name >> 16) & 0xff;
1486
7d8406be
PB
1487#define CASE_GET_REG32(name, addr) \
1488 case addr: return s->name & 0xff; \
1489 case addr + 1: return (s->name >> 8) & 0xff; \
1490 case addr + 2: return (s->name >> 16) & 0xff; \
1491 case addr + 3: return (s->name >> 24) & 0xff;
1492
1493#ifdef DEBUG_LSI_REG
1494 DPRINTF("Read reg %x\n", offset);
1495#endif
1496 switch (offset) {
1497 case 0x00: /* SCNTL0 */
1498 return s->scntl0;
1499 case 0x01: /* SCNTL1 */
1500 return s->scntl1;
1501 case 0x02: /* SCNTL2 */
1502 return s->scntl2;
1503 case 0x03: /* SCNTL3 */
1504 return s->scntl3;
1505 case 0x04: /* SCID */
1506 return s->scid;
1507 case 0x05: /* SXFER */
1508 return s->sxfer;
1509 case 0x06: /* SDID */
1510 return s->sdid;
1511 case 0x07: /* GPREG0 */
1512 return 0x7f;
985a03b0
TS
1513 case 0x08: /* Revision ID */
1514 return 0x00;
a917d384
PB
1515 case 0xa: /* SSID */
1516 return s->ssid;
7d8406be
PB
1517 case 0xb: /* SBCL */
1518 /* ??? This is not correct. However it's (hopefully) only
1519 used for diagnostics, so should be ok. */
1520 return 0;
1521 case 0xc: /* DSTAT */
16b8ed1d 1522 tmp = s->dstat | LSI_DSTAT_DFE;
7d8406be
PB
1523 if ((s->istat0 & LSI_ISTAT0_INTF) == 0)
1524 s->dstat = 0;
1525 lsi_update_irq(s);
1526 return tmp;
1527 case 0x0d: /* SSTAT0 */
1528 return s->sstat0;
1529 case 0x0e: /* SSTAT1 */
1530 return s->sstat1;
1531 case 0x0f: /* SSTAT2 */
1532 return s->scntl1 & LSI_SCNTL1_CON ? 0 : 2;
1533 CASE_GET_REG32(dsa, 0x10)
1534 case 0x14: /* ISTAT0 */
1535 return s->istat0;
ecabe8cc
AL
1536 case 0x15: /* ISTAT1 */
1537 return s->istat1;
7d8406be
PB
1538 case 0x16: /* MBOX0 */
1539 return s->mbox0;
1540 case 0x17: /* MBOX1 */
1541 return s->mbox1;
1542 case 0x18: /* CTEST0 */
1543 return 0xff;
1544 case 0x19: /* CTEST1 */
1545 return 0;
1546 case 0x1a: /* CTEST2 */
9167a69a 1547 tmp = s->ctest2 | LSI_CTEST2_DACK | LSI_CTEST2_CM;
7d8406be
PB
1548 if (s->istat0 & LSI_ISTAT0_SIGP) {
1549 s->istat0 &= ~LSI_ISTAT0_SIGP;
1550 tmp |= LSI_CTEST2_SIGP;
1551 }
1552 return tmp;
1553 case 0x1b: /* CTEST3 */
1554 return s->ctest3;
1555 CASE_GET_REG32(temp, 0x1c)
1556 case 0x20: /* DFIFO */
1557 return 0;
1558 case 0x21: /* CTEST4 */
1559 return s->ctest4;
1560 case 0x22: /* CTEST5 */
1561 return s->ctest5;
985a03b0
TS
1562 case 0x23: /* CTEST6 */
1563 return 0;
75f76531 1564 CASE_GET_REG24(dbc, 0x24)
7d8406be
PB
1565 case 0x27: /* DCMD */
1566 return s->dcmd;
4b9a2d6d 1567 CASE_GET_REG32(dnad, 0x28)
7d8406be
PB
1568 CASE_GET_REG32(dsp, 0x2c)
1569 CASE_GET_REG32(dsps, 0x30)
1570 CASE_GET_REG32(scratch[0], 0x34)
1571 case 0x38: /* DMODE */
1572 return s->dmode;
1573 case 0x39: /* DIEN */
1574 return s->dien;
bd8ee11a
SH
1575 case 0x3a: /* SBR */
1576 return s->sbr;
7d8406be
PB
1577 case 0x3b: /* DCNTL */
1578 return s->dcntl;
1579 case 0x40: /* SIEN0 */
1580 return s->sien0;
1581 case 0x41: /* SIEN1 */
1582 return s->sien1;
1583 case 0x42: /* SIST0 */
1584 tmp = s->sist0;
1585 s->sist0 = 0;
1586 lsi_update_irq(s);
1587 return tmp;
1588 case 0x43: /* SIST1 */
1589 tmp = s->sist1;
1590 s->sist1 = 0;
1591 lsi_update_irq(s);
1592 return tmp;
9167a69a
AZ
1593 case 0x46: /* MACNTL */
1594 return 0x0f;
7d8406be
PB
1595 case 0x47: /* GPCNTL0 */
1596 return 0x0f;
1597 case 0x48: /* STIME0 */
1598 return s->stime0;
1599 case 0x4a: /* RESPID0 */
1600 return s->respid0;
1601 case 0x4b: /* RESPID1 */
1602 return s->respid1;
1603 case 0x4d: /* STEST1 */
1604 return s->stest1;
1605 case 0x4e: /* STEST2 */
1606 return s->stest2;
1607 case 0x4f: /* STEST3 */
1608 return s->stest3;
a917d384
PB
1609 case 0x50: /* SIDL */
1610 /* This is needed by the linux drivers. We currently only update it
1611 during the MSG IN phase. */
1612 return s->sidl;
7d8406be
PB
1613 case 0x52: /* STEST4 */
1614 return 0xe0;
1615 case 0x56: /* CCNTL0 */
1616 return s->ccntl0;
1617 case 0x57: /* CCNTL1 */
1618 return s->ccntl1;
a917d384
PB
1619 case 0x58: /* SBDL */
1620 /* Some drivers peek at the data bus during the MSG IN phase. */
1621 if ((s->sstat1 & PHASE_MASK) == PHASE_MI)
1622 return s->msg[0];
1623 return 0;
1624 case 0x59: /* SBDL high */
7d8406be
PB
1625 return 0;
1626 CASE_GET_REG32(mmrs, 0xa0)
1627 CASE_GET_REG32(mmws, 0xa4)
1628 CASE_GET_REG32(sfs, 0xa8)
1629 CASE_GET_REG32(drs, 0xac)
1630 CASE_GET_REG32(sbms, 0xb0)
ab57d967 1631 CASE_GET_REG32(dbms, 0xb4)
7d8406be
PB
1632 CASE_GET_REG32(dnad64, 0xb8)
1633 CASE_GET_REG32(pmjad1, 0xc0)
1634 CASE_GET_REG32(pmjad2, 0xc4)
1635 CASE_GET_REG32(rbc, 0xc8)
1636 CASE_GET_REG32(ua, 0xcc)
1637 CASE_GET_REG32(ia, 0xd4)
1638 CASE_GET_REG32(sbc, 0xd8)
1639 CASE_GET_REG32(csbc, 0xdc)
1640 }
1641 if (offset >= 0x5c && offset < 0xa0) {
1642 int n;
1643 int shift;
1644 n = (offset - 0x58) >> 2;
1645 shift = (offset & 3) * 8;
1646 return (s->scratch[n] >> shift) & 0xff;
1647 }
1648 BADF("readb 0x%x\n", offset);
1649 exit(1);
75f76531 1650#undef CASE_GET_REG24
7d8406be
PB
1651#undef CASE_GET_REG32
1652}
1653
1654static void lsi_reg_writeb(LSIState *s, int offset, uint8_t val)
1655{
49c47daa
SH
1656#define CASE_SET_REG24(name, addr) \
1657 case addr : s->name &= 0xffffff00; s->name |= val; break; \
1658 case addr + 1: s->name &= 0xffff00ff; s->name |= val << 8; break; \
1659 case addr + 2: s->name &= 0xff00ffff; s->name |= val << 16; break;
1660
7d8406be
PB
1661#define CASE_SET_REG32(name, addr) \
1662 case addr : s->name &= 0xffffff00; s->name |= val; break; \
1663 case addr + 1: s->name &= 0xffff00ff; s->name |= val << 8; break; \
1664 case addr + 2: s->name &= 0xff00ffff; s->name |= val << 16; break; \
1665 case addr + 3: s->name &= 0x00ffffff; s->name |= val << 24; break;
1666
1667#ifdef DEBUG_LSI_REG
1668 DPRINTF("Write reg %x = %02x\n", offset, val);
1669#endif
1670 switch (offset) {
1671 case 0x00: /* SCNTL0 */
1672 s->scntl0 = val;
1673 if (val & LSI_SCNTL0_START) {
1674 BADF("Start sequence not implemented\n");
1675 }
1676 break;
1677 case 0x01: /* SCNTL1 */
1678 s->scntl1 = val & ~LSI_SCNTL1_SST;
1679 if (val & LSI_SCNTL1_IARB) {
1680 BADF("Immediate Arbritration not implemented\n");
1681 }
1682 if (val & LSI_SCNTL1_RST) {
680a34ee 1683 if (!(s->sstat0 & LSI_SSTAT0_RST)) {
032f0101 1684 qbus_reset_all(&s->bus.qbus);
680a34ee
JK
1685 s->sstat0 |= LSI_SSTAT0_RST;
1686 lsi_script_scsi_interrupt(s, LSI_SIST0_RST, 0);
1687 }
7d8406be
PB
1688 } else {
1689 s->sstat0 &= ~LSI_SSTAT0_RST;
1690 }
1691 break;
1692 case 0x02: /* SCNTL2 */
1693 val &= ~(LSI_SCNTL2_WSR | LSI_SCNTL2_WSS);
3d834c78 1694 s->scntl2 = val;
7d8406be
PB
1695 break;
1696 case 0x03: /* SCNTL3 */
1697 s->scntl3 = val;
1698 break;
1699 case 0x04: /* SCID */
1700 s->scid = val;
1701 break;
1702 case 0x05: /* SXFER */
1703 s->sxfer = val;
1704 break;
a917d384 1705 case 0x06: /* SDID */
c7ac9f40 1706 if ((s->ssid & 0x80) && (val & 0xf) != (s->ssid & 0xf)) {
a917d384 1707 BADF("Destination ID does not match SSID\n");
c7ac9f40 1708 }
a917d384
PB
1709 s->sdid = val & 0xf;
1710 break;
7d8406be
PB
1711 case 0x07: /* GPREG0 */
1712 break;
a917d384
PB
1713 case 0x08: /* SFBR */
1714 /* The CPU is not allowed to write to this register. However the
1715 SCRIPTS register move instructions are. */
1716 s->sfbr = val;
1717 break;
a15fdf86 1718 case 0x0a: case 0x0b:
9167a69a 1719 /* Openserver writes to these readonly registers on startup */
a15fdf86 1720 return;
7d8406be
PB
1721 case 0x0c: case 0x0d: case 0x0e: case 0x0f:
1722 /* Linux writes to these readonly registers on startup. */
1723 return;
1724 CASE_SET_REG32(dsa, 0x10)
1725 case 0x14: /* ISTAT0 */
1726 s->istat0 = (s->istat0 & 0x0f) | (val & 0xf0);
1727 if (val & LSI_ISTAT0_ABRT) {
1728 lsi_script_dma_interrupt(s, LSI_DSTAT_ABRT);
1729 }
1730 if (val & LSI_ISTAT0_INTF) {
1731 s->istat0 &= ~LSI_ISTAT0_INTF;
1732 lsi_update_irq(s);
1733 }
4d611c9a 1734 if (s->waiting == 1 && val & LSI_ISTAT0_SIGP) {
7d8406be
PB
1735 DPRINTF("Woken by SIGP\n");
1736 s->waiting = 0;
1737 s->dsp = s->dnad;
1738 lsi_execute_script(s);
1739 }
1740 if (val & LSI_ISTAT0_SRST) {
71186c86 1741 qdev_reset_all(DEVICE(s));
7d8406be 1742 }
92d88ecb 1743 break;
7d8406be
PB
1744 case 0x16: /* MBOX0 */
1745 s->mbox0 = val;
92d88ecb 1746 break;
7d8406be
PB
1747 case 0x17: /* MBOX1 */
1748 s->mbox1 = val;
92d88ecb 1749 break;
0903c35d
HP
1750 case 0x18: /* CTEST0 */
1751 /* nothing to do */
1752 break;
9167a69a
AZ
1753 case 0x1a: /* CTEST2 */
1754 s->ctest2 = val & LSI_CTEST2_PCICIE;
1755 break;
7d8406be
PB
1756 case 0x1b: /* CTEST3 */
1757 s->ctest3 = val & 0x0f;
1758 break;
1759 CASE_SET_REG32(temp, 0x1c)
1760 case 0x21: /* CTEST4 */
1761 if (val & 7) {
1762 BADF("Unimplemented CTEST4-FBL 0x%x\n", val);
1763 }
1764 s->ctest4 = val;
1765 break;
1766 case 0x22: /* CTEST5 */
1767 if (val & (LSI_CTEST5_ADCK | LSI_CTEST5_BBCK)) {
1768 BADF("CTEST5 DMA increment not implemented\n");
1769 }
1770 s->ctest5 = val;
1771 break;
49c47daa 1772 CASE_SET_REG24(dbc, 0x24)
4b9a2d6d 1773 CASE_SET_REG32(dnad, 0x28)
3d834c78 1774 case 0x2c: /* DSP[0:7] */
7d8406be
PB
1775 s->dsp &= 0xffffff00;
1776 s->dsp |= val;
1777 break;
3d834c78 1778 case 0x2d: /* DSP[8:15] */
7d8406be
PB
1779 s->dsp &= 0xffff00ff;
1780 s->dsp |= val << 8;
1781 break;
3d834c78 1782 case 0x2e: /* DSP[16:23] */
7d8406be
PB
1783 s->dsp &= 0xff00ffff;
1784 s->dsp |= val << 16;
1785 break;
3d834c78 1786 case 0x2f: /* DSP[24:31] */
7d8406be
PB
1787 s->dsp &= 0x00ffffff;
1788 s->dsp |= val << 24;
1789 if ((s->dmode & LSI_DMODE_MAN) == 0
1790 && (s->istat1 & LSI_ISTAT1_SRUN) == 0)
1791 lsi_execute_script(s);
1792 break;
1793 CASE_SET_REG32(dsps, 0x30)
1794 CASE_SET_REG32(scratch[0], 0x34)
1795 case 0x38: /* DMODE */
1796 if (val & (LSI_DMODE_SIOM | LSI_DMODE_DIOM)) {
1797 BADF("IO mappings not implemented\n");
1798 }
1799 s->dmode = val;
1800 break;
1801 case 0x39: /* DIEN */
1802 s->dien = val;
1803 lsi_update_irq(s);
1804 break;
bd8ee11a
SH
1805 case 0x3a: /* SBR */
1806 s->sbr = val;
1807 break;
7d8406be
PB
1808 case 0x3b: /* DCNTL */
1809 s->dcntl = val & ~(LSI_DCNTL_PFF | LSI_DCNTL_STD);
1810 if ((val & LSI_DCNTL_STD) && (s->istat1 & LSI_ISTAT1_SRUN) == 0)
1811 lsi_execute_script(s);
1812 break;
1813 case 0x40: /* SIEN0 */
1814 s->sien0 = val;
1815 lsi_update_irq(s);
1816 break;
1817 case 0x41: /* SIEN1 */
1818 s->sien1 = val;
1819 lsi_update_irq(s);
1820 break;
1821 case 0x47: /* GPCNTL0 */
1822 break;
1823 case 0x48: /* STIME0 */
1824 s->stime0 = val;
1825 break;
1826 case 0x49: /* STIME1 */
1827 if (val & 0xf) {
1828 DPRINTF("General purpose timer not implemented\n");
1829 /* ??? Raising the interrupt immediately seems to be sufficient
1830 to keep the FreeBSD driver happy. */
1831 lsi_script_scsi_interrupt(s, 0, LSI_SIST1_GEN);
1832 }
1833 break;
1834 case 0x4a: /* RESPID0 */
1835 s->respid0 = val;
1836 break;
1837 case 0x4b: /* RESPID1 */
1838 s->respid1 = val;
1839 break;
1840 case 0x4d: /* STEST1 */
1841 s->stest1 = val;
1842 break;
1843 case 0x4e: /* STEST2 */
1844 if (val & 1) {
1845 BADF("Low level mode not implemented\n");
1846 }
1847 s->stest2 = val;
1848 break;
1849 case 0x4f: /* STEST3 */
1850 if (val & 0x41) {
1851 BADF("SCSI FIFO test mode not implemented\n");
1852 }
1853 s->stest3 = val;
1854 break;
1855 case 0x56: /* CCNTL0 */
1856 s->ccntl0 = val;
1857 break;
1858 case 0x57: /* CCNTL1 */
1859 s->ccntl1 = val;
1860 break;
1861 CASE_SET_REG32(mmrs, 0xa0)
1862 CASE_SET_REG32(mmws, 0xa4)
1863 CASE_SET_REG32(sfs, 0xa8)
1864 CASE_SET_REG32(drs, 0xac)
1865 CASE_SET_REG32(sbms, 0xb0)
ab57d967 1866 CASE_SET_REG32(dbms, 0xb4)
7d8406be
PB
1867 CASE_SET_REG32(dnad64, 0xb8)
1868 CASE_SET_REG32(pmjad1, 0xc0)
1869 CASE_SET_REG32(pmjad2, 0xc4)
1870 CASE_SET_REG32(rbc, 0xc8)
1871 CASE_SET_REG32(ua, 0xcc)
1872 CASE_SET_REG32(ia, 0xd4)
1873 CASE_SET_REG32(sbc, 0xd8)
1874 CASE_SET_REG32(csbc, 0xdc)
1875 default:
1876 if (offset >= 0x5c && offset < 0xa0) {
1877 int n;
1878 int shift;
1879 n = (offset - 0x58) >> 2;
1880 shift = (offset & 3) * 8;
57ffcc4c 1881 s->scratch[n] = deposit32(s->scratch[n], shift, 8, val);
7d8406be
PB
1882 } else {
1883 BADF("Unhandled writeb 0x%x = 0x%x\n", offset, val);
1884 }
1885 }
49c47daa 1886#undef CASE_SET_REG24
7d8406be
PB
1887#undef CASE_SET_REG32
1888}
1889
a8170e5e 1890static void lsi_mmio_write(void *opaque, hwaddr addr,
b0ce84e5 1891 uint64_t val, unsigned size)
7d8406be 1892{
eb40f984 1893 LSIState *s = opaque;
7d8406be
PB
1894
1895 lsi_reg_writeb(s, addr & 0xff, val);
1896}
1897
a8170e5e 1898static uint64_t lsi_mmio_read(void *opaque, hwaddr addr,
b0ce84e5 1899 unsigned size)
7d8406be 1900{
eb40f984 1901 LSIState *s = opaque;
7d8406be
PB
1902
1903 return lsi_reg_readb(s, addr & 0xff);
1904}
1905
b0ce84e5
AK
1906static const MemoryRegionOps lsi_mmio_ops = {
1907 .read = lsi_mmio_read,
1908 .write = lsi_mmio_write,
1909 .endianness = DEVICE_NATIVE_ENDIAN,
1910 .impl = {
1911 .min_access_size = 1,
1912 .max_access_size = 1,
1913 },
7d8406be
PB
1914};
1915
a8170e5e 1916static void lsi_ram_write(void *opaque, hwaddr addr,
b0ce84e5 1917 uint64_t val, unsigned size)
7d8406be 1918{
eb40f984 1919 LSIState *s = opaque;
7d8406be 1920 uint32_t newval;
b0ce84e5 1921 uint32_t mask;
7d8406be
PB
1922 int shift;
1923
7d8406be
PB
1924 newval = s->script_ram[addr >> 2];
1925 shift = (addr & 3) * 8;
b0ce84e5
AK
1926 mask = ((uint64_t)1 << (size * 8)) - 1;
1927 newval &= ~(mask << shift);
7d8406be
PB
1928 newval |= val << shift;
1929 s->script_ram[addr >> 2] = newval;
1930}
1931
a8170e5e 1932static uint64_t lsi_ram_read(void *opaque, hwaddr addr,
b0ce84e5 1933 unsigned size)
7d8406be 1934{
eb40f984 1935 LSIState *s = opaque;
7d8406be 1936 uint32_t val;
b0ce84e5 1937 uint32_t mask;
7d8406be 1938
7d8406be 1939 val = s->script_ram[addr >> 2];
b0ce84e5 1940 mask = ((uint64_t)1 << (size * 8)) - 1;
7d8406be 1941 val >>= (addr & 3) * 8;
b0ce84e5 1942 return val & mask;
7d8406be
PB
1943}
1944
b0ce84e5
AK
1945static const MemoryRegionOps lsi_ram_ops = {
1946 .read = lsi_ram_read,
1947 .write = lsi_ram_write,
1948 .endianness = DEVICE_NATIVE_ENDIAN,
7d8406be
PB
1949};
1950
a8170e5e 1951static uint64_t lsi_io_read(void *opaque, hwaddr addr,
b0ce84e5 1952 unsigned size)
7d8406be 1953{
eb40f984 1954 LSIState *s = opaque;
7d8406be
PB
1955 return lsi_reg_readb(s, addr & 0xff);
1956}
1957
a8170e5e 1958static void lsi_io_write(void *opaque, hwaddr addr,
b0ce84e5 1959 uint64_t val, unsigned size)
7d8406be 1960{
eb40f984 1961 LSIState *s = opaque;
7d8406be
PB
1962 lsi_reg_writeb(s, addr & 0xff, val);
1963}
1964
b0ce84e5
AK
1965static const MemoryRegionOps lsi_io_ops = {
1966 .read = lsi_io_read,
1967 .write = lsi_io_write,
1968 .endianness = DEVICE_NATIVE_ENDIAN,
1969 .impl = {
1970 .min_access_size = 1,
1971 .max_access_size = 1,
1972 },
1973};
7d8406be 1974
54eefd72
JK
1975static void lsi_scsi_reset(DeviceState *dev)
1976{
71186c86 1977 LSIState *s = LSI53C895A(dev);
54eefd72
JK
1978
1979 lsi_soft_reset(s);
1980}
1981
4a1b0f1c 1982static void lsi_pre_save(void *opaque)
777aec7a
N
1983{
1984 LSIState *s = opaque;
1985
b96a0da0
GH
1986 if (s->current) {
1987 assert(s->current->dma_buf == NULL);
1988 assert(s->current->dma_len == 0);
1989 }
042ec49d 1990 assert(QTAILQ_EMPTY(&s->queue));
777aec7a
N
1991}
1992
4a1b0f1c
JQ
1993static const VMStateDescription vmstate_lsi_scsi = {
1994 .name = "lsiscsi",
1995 .version_id = 0,
1996 .minimum_version_id = 0,
1997 .minimum_version_id_old = 0,
1998 .pre_save = lsi_pre_save,
1999 .fields = (VMStateField []) {
725eec70 2000 VMSTATE_PCI_DEVICE(parent_obj, LSIState),
4a1b0f1c
JQ
2001
2002 VMSTATE_INT32(carry, LSIState),
2f172849 2003 VMSTATE_INT32(status, LSIState),
4a1b0f1c
JQ
2004 VMSTATE_INT32(msg_action, LSIState),
2005 VMSTATE_INT32(msg_len, LSIState),
2006 VMSTATE_BUFFER(msg, LSIState),
2007 VMSTATE_INT32(waiting, LSIState),
2008
2009 VMSTATE_UINT32(dsa, LSIState),
2010 VMSTATE_UINT32(temp, LSIState),
2011 VMSTATE_UINT32(dnad, LSIState),
2012 VMSTATE_UINT32(dbc, LSIState),
2013 VMSTATE_UINT8(istat0, LSIState),
2014 VMSTATE_UINT8(istat1, LSIState),
2015 VMSTATE_UINT8(dcmd, LSIState),
2016 VMSTATE_UINT8(dstat, LSIState),
2017 VMSTATE_UINT8(dien, LSIState),
2018 VMSTATE_UINT8(sist0, LSIState),
2019 VMSTATE_UINT8(sist1, LSIState),
2020 VMSTATE_UINT8(sien0, LSIState),
2021 VMSTATE_UINT8(sien1, LSIState),
2022 VMSTATE_UINT8(mbox0, LSIState),
2023 VMSTATE_UINT8(mbox1, LSIState),
2024 VMSTATE_UINT8(dfifo, LSIState),
2025 VMSTATE_UINT8(ctest2, LSIState),
2026 VMSTATE_UINT8(ctest3, LSIState),
2027 VMSTATE_UINT8(ctest4, LSIState),
2028 VMSTATE_UINT8(ctest5, LSIState),
2029 VMSTATE_UINT8(ccntl0, LSIState),
2030 VMSTATE_UINT8(ccntl1, LSIState),
2031 VMSTATE_UINT32(dsp, LSIState),
2032 VMSTATE_UINT32(dsps, LSIState),
2033 VMSTATE_UINT8(dmode, LSIState),
2034 VMSTATE_UINT8(dcntl, LSIState),
2035 VMSTATE_UINT8(scntl0, LSIState),
2036 VMSTATE_UINT8(scntl1, LSIState),
2037 VMSTATE_UINT8(scntl2, LSIState),
2038 VMSTATE_UINT8(scntl3, LSIState),
2039 VMSTATE_UINT8(sstat0, LSIState),
2040 VMSTATE_UINT8(sstat1, LSIState),
2041 VMSTATE_UINT8(scid, LSIState),
2042 VMSTATE_UINT8(sxfer, LSIState),
2043 VMSTATE_UINT8(socl, LSIState),
2044 VMSTATE_UINT8(sdid, LSIState),
2045 VMSTATE_UINT8(ssid, LSIState),
2046 VMSTATE_UINT8(sfbr, LSIState),
2047 VMSTATE_UINT8(stest1, LSIState),
2048 VMSTATE_UINT8(stest2, LSIState),
2049 VMSTATE_UINT8(stest3, LSIState),
2050 VMSTATE_UINT8(sidl, LSIState),
2051 VMSTATE_UINT8(stime0, LSIState),
2052 VMSTATE_UINT8(respid0, LSIState),
2053 VMSTATE_UINT8(respid1, LSIState),
2054 VMSTATE_UINT32(mmrs, LSIState),
2055 VMSTATE_UINT32(mmws, LSIState),
2056 VMSTATE_UINT32(sfs, LSIState),
2057 VMSTATE_UINT32(drs, LSIState),
2058 VMSTATE_UINT32(sbms, LSIState),
2059 VMSTATE_UINT32(dbms, LSIState),
2060 VMSTATE_UINT32(dnad64, LSIState),
2061 VMSTATE_UINT32(pmjad1, LSIState),
2062 VMSTATE_UINT32(pmjad2, LSIState),
2063 VMSTATE_UINT32(rbc, LSIState),
2064 VMSTATE_UINT32(ua, LSIState),
2065 VMSTATE_UINT32(ia, LSIState),
2066 VMSTATE_UINT32(sbc, LSIState),
2067 VMSTATE_UINT32(csbc, LSIState),
2068 VMSTATE_BUFFER_UNSAFE(scratch, LSIState, 0, 18 * sizeof(uint32_t)),
2069 VMSTATE_UINT8(sbr, LSIState),
2070
2071 VMSTATE_BUFFER_UNSAFE(script_ram, LSIState, 0, 2048 * sizeof(uint32_t)),
2072 VMSTATE_END_OF_LIST()
777aec7a 2073 }
4a1b0f1c 2074};
777aec7a 2075
f90c2bcd 2076static void lsi_scsi_uninit(PCIDevice *d)
4b09be85 2077{
71186c86 2078 LSIState *s = LSI53C895A(d);
4b09be85 2079
b0ce84e5
AK
2080 memory_region_destroy(&s->mmio_io);
2081 memory_region_destroy(&s->ram_io);
2082 memory_region_destroy(&s->io_io);
4b09be85
AL
2083}
2084
afd4030c
PB
2085static const struct SCSIBusInfo lsi_scsi_info = {
2086 .tcq = true,
7e0380b9
PB
2087 .max_target = LSI_MAX_DEVS,
2088 .max_lun = 0, /* LUN support is buggy */
afd4030c 2089
c6df7102 2090 .transfer_data = lsi_transfer_data,
94d3f98a
PB
2091 .complete = lsi_command_complete,
2092 .cancel = lsi_request_cancelled
cfdc1bb0
PB
2093};
2094
81a322d4 2095static int lsi_scsi_init(PCIDevice *dev)
7d8406be 2096{
71186c86
PC
2097 LSIState *s = LSI53C895A(dev);
2098 DeviceState *d = DEVICE(dev);
deb54399 2099 uint8_t *pci_conf;
caad4eb3 2100 Error *err = NULL;
7d8406be 2101
725eec70 2102 pci_conf = dev->config;
deb54399 2103
9167a69a 2104 /* PCI latency timer = 255 */
5845f0e5 2105 pci_conf[PCI_LATENCY_TIMER] = 0xff;
817e0b6f 2106 /* Interrupt pin A */
5845f0e5 2107 pci_conf[PCI_INTERRUPT_PIN] = 0x01;
7d8406be 2108
29776739
PB
2109 memory_region_init_io(&s->mmio_io, OBJECT(s), &lsi_mmio_ops, s,
2110 "lsi-mmio", 0x400);
2111 memory_region_init_io(&s->ram_io, OBJECT(s), &lsi_ram_ops, s,
2112 "lsi-ram", 0x2000);
2113 memory_region_init_io(&s->io_io, OBJECT(s), &lsi_io_ops, s,
2114 "lsi-io", 256);
b0ce84e5 2115
725eec70 2116 pci_register_bar(dev, 0, PCI_BASE_ADDRESS_SPACE_IO, &s->io_io);
16b8ed1d 2117 pci_register_bar(dev, 1, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->mmio_io);
725eec70 2118 pci_register_bar(dev, 2, PCI_BASE_ADDRESS_SPACE_MEMORY, &s->ram_io);
042ec49d 2119 QTAILQ_INIT(&s->queue);
7d8406be 2120
b1187b51 2121 scsi_bus_new(&s->bus, sizeof(s->bus), d, &lsi_scsi_info, NULL);
71186c86 2122 if (!d->hotplugged) {
caad4eb3
AF
2123 scsi_bus_legacy_handle_cmdline(&s->bus, &err);
2124 if (err != NULL) {
2125 error_free(err);
2126 return -1;
2127 }
5b684b5a 2128 }
81a322d4 2129 return 0;
7d8406be 2130}
9be5dafe 2131
40021f08
AL
2132static void lsi_class_init(ObjectClass *klass, void *data)
2133{
39bffca2 2134 DeviceClass *dc = DEVICE_CLASS(klass);
40021f08
AL
2135 PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
2136
2137 k->init = lsi_scsi_init;
2138 k->exit = lsi_scsi_uninit;
2139 k->vendor_id = PCI_VENDOR_ID_LSI_LOGIC;
2140 k->device_id = PCI_DEVICE_ID_LSI_53C895A;
2141 k->class_id = PCI_CLASS_STORAGE_SCSI;
2142 k->subsystem_id = 0x1000;
39bffca2
AL
2143 dc->reset = lsi_scsi_reset;
2144 dc->vmsd = &vmstate_lsi_scsi;
125ee0ed 2145 set_bit(DEVICE_CATEGORY_STORAGE, dc->categories);
40021f08
AL
2146}
2147
8c43a6f0 2148static const TypeInfo lsi_info = {
71186c86 2149 .name = TYPE_LSI53C895A,
39bffca2
AL
2150 .parent = TYPE_PCI_DEVICE,
2151 .instance_size = sizeof(LSIState),
2152 .class_init = lsi_class_init,
0aab0d3a
GH
2153};
2154
ceae18bd
HP
2155static void lsi53c810_class_init(ObjectClass *klass, void *data)
2156{
2157 PCIDeviceClass *k = PCI_DEVICE_CLASS(klass);
2158
2159 k->device_id = PCI_DEVICE_ID_LSI_53C810;
2160}
2161
2162static TypeInfo lsi53c810_info = {
2163 .name = TYPE_LSI53C810,
2164 .parent = TYPE_LSI53C895A,
2165 .class_init = lsi53c810_class_init,
2166};
2167
83f7d43a 2168static void lsi53c895a_register_types(void)
9be5dafe 2169{
39bffca2 2170 type_register_static(&lsi_info);
ceae18bd 2171 type_register_static(&lsi53c810_info);
9be5dafe
PB
2172}
2173
83f7d43a 2174type_init(lsi53c895a_register_types)