siop.c revision 1.19 1 1.19 tsutsui /* $NetBSD: siop.c,v 1.19 2000/06/07 14:40:20 tsutsui Exp $ */
2 1.1 bouyer
3 1.1 bouyer /*
4 1.1 bouyer * Copyright (c) 2000 Manuel Bouyer.
5 1.1 bouyer *
6 1.1 bouyer * Redistribution and use in source and binary forms, with or without
7 1.1 bouyer * modification, are permitted provided that the following conditions
8 1.1 bouyer * are met:
9 1.1 bouyer * 1. Redistributions of source code must retain the above copyright
10 1.1 bouyer * notice, this list of conditions and the following disclaimer.
11 1.1 bouyer * 2. Redistributions in binary form must reproduce the above copyright
12 1.1 bouyer * notice, this list of conditions and the following disclaimer in the
13 1.1 bouyer * documentation and/or other materials provided with the distribution.
14 1.1 bouyer * 3. All advertising materials mentioning features or use of this software
15 1.1 bouyer * must display the following acknowledgement:
16 1.5 bouyer * This product includes software developed by Manuel Bouyer
17 1.5 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.5 bouyer * derived from this software without specific prior written permission.
19 1.1 bouyer *
20 1.14 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.14 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.14 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.14 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.14 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.14 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.14 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.14 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.14 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.14 bouyer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30 1.1 bouyer *
31 1.1 bouyer */
32 1.1 bouyer
33 1.1 bouyer /* SYM53c7/8xx PCI-SCSI I/O Processors driver */
34 1.1 bouyer
35 1.1 bouyer #include <sys/param.h>
36 1.1 bouyer #include <sys/systm.h>
37 1.1 bouyer #include <sys/device.h>
38 1.1 bouyer #include <sys/malloc.h>
39 1.1 bouyer #include <sys/buf.h>
40 1.1 bouyer #include <sys/kernel.h>
41 1.1 bouyer
42 1.1 bouyer #include <machine/endian.h>
43 1.1 bouyer #include <machine/bus.h>
44 1.1 bouyer
45 1.1 bouyer #include <vm/vm.h>
46 1.1 bouyer #include <vm/vm_param.h>
47 1.1 bouyer #include <vm/vm_kern.h>
48 1.1 bouyer
49 1.1 bouyer #include <dev/microcode/siop/siop.out>
50 1.1 bouyer
51 1.1 bouyer #include <dev/scsipi/scsi_all.h>
52 1.1 bouyer #include <dev/scsipi/scsi_message.h>
53 1.1 bouyer #include <dev/scsipi/scsipi_all.h>
54 1.1 bouyer
55 1.1 bouyer #include <dev/scsipi/scsiconf.h>
56 1.1 bouyer
57 1.1 bouyer #include <dev/ic/siopreg.h>
58 1.1 bouyer #include <dev/ic/siopvar.h>
59 1.14 bouyer #include <dev/ic/siopvar_common.h>
60 1.1 bouyer
61 1.15 bouyer #undef DEBUG
62 1.8 bouyer #undef DEBUG_DR
63 1.2 bouyer #undef DEBUG_INTR
64 1.2 bouyer #undef DEBUG_SHED
65 1.2 bouyer #undef DUMP_SCRIPT
66 1.2 bouyer
67 1.2 bouyer #define SIOP_STATS
68 1.2 bouyer
69 1.1 bouyer #ifndef SIOP_DEFAULT_TARGET
70 1.1 bouyer #define SIOP_DEFAULT_TARGET 7
71 1.1 bouyer #endif
72 1.1 bouyer
73 1.16 bouyer /* number of cmd descriptors per block */
74 1.16 bouyer #define SIOP_NCMDPB (NBPG / sizeof(struct siop_xfer))
75 1.1 bouyer
76 1.1 bouyer void siop_reset __P((struct siop_softc *));
77 1.2 bouyer void siop_handle_reset __P((struct siop_softc *));
78 1.2 bouyer void siop_scsicmd_end __P((struct siop_cmd *));
79 1.1 bouyer void siop_start __P((struct siop_softc *));
80 1.1 bouyer void siop_timeout __P((void *));
81 1.1 bouyer int siop_scsicmd __P((struct scsipi_xfer *));
82 1.2 bouyer void siop_dump_script __P((struct siop_softc *));
83 1.16 bouyer int siop_morecbd __P((struct siop_softc *));
84 1.1 bouyer
85 1.1 bouyer struct scsipi_adapter siop_adapter = {
86 1.1 bouyer 0,
87 1.1 bouyer siop_scsicmd,
88 1.1 bouyer siop_minphys,
89 1.2 bouyer siop_ioctl,
90 1.19 tsutsui NULL,
91 1.1 bouyer NULL,
92 1.1 bouyer };
93 1.1 bouyer
94 1.1 bouyer struct scsipi_device siop_dev = {
95 1.1 bouyer NULL,
96 1.1 bouyer NULL,
97 1.1 bouyer NULL,
98 1.1 bouyer NULL,
99 1.1 bouyer };
100 1.1 bouyer
101 1.2 bouyer #ifdef SIOP_STATS
102 1.2 bouyer static int siop_stat_intr = 0;
103 1.2 bouyer static int siop_stat_intr_shortxfer = 0;
104 1.2 bouyer static int siop_stat_intr_sdp = 0;
105 1.2 bouyer static int siop_stat_intr_done = 0;
106 1.2 bouyer static int siop_stat_intr_reselect = 0;
107 1.2 bouyer static int siop_stat_intr_xferdisc = 0;
108 1.2 bouyer void siop_printstats __P((void));
109 1.2 bouyer #define INCSTAT(x) x++
110 1.2 bouyer #else
111 1.2 bouyer #define INCSTAT(x)
112 1.2 bouyer #endif
113 1.2 bouyer
114 1.2 bouyer static __inline__ void siop_table_sync __P((struct siop_cmd *, int));
115 1.2 bouyer static __inline__ void
116 1.2 bouyer siop_table_sync(siop_cmd, ops)
117 1.2 bouyer struct siop_cmd *siop_cmd;
118 1.2 bouyer int ops;
119 1.2 bouyer {
120 1.7 bouyer struct siop_softc *sc = siop_cmd->siop_target->siop_sc;
121 1.2 bouyer bus_addr_t offset;
122 1.2 bouyer
123 1.16 bouyer offset = siop_cmd->dsa -
124 1.16 bouyer siop_cmd->siop_cbdp->xferdma->dm_segs[0].ds_addr;
125 1.16 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->siop_cbdp->xferdma, offset,
126 1.2 bouyer sizeof(struct siop_xfer), ops);
127 1.2 bouyer }
128 1.2 bouyer
129 1.17 bouyer static __inline__ void siop_shed_sync __P((struct siop_softc *, int));
130 1.2 bouyer static __inline__ void
131 1.17 bouyer siop_shed_sync(sc, ops)
132 1.2 bouyer struct siop_softc *sc;
133 1.2 bouyer int ops;
134 1.2 bouyer {
135 1.17 bouyer bus_dmamap_sync(sc->sc_dmat, sc->sc_sheddma, 0, NBPG, ops);
136 1.2 bouyer }
137 1.2 bouyer
138 1.1 bouyer void
139 1.1 bouyer siop_attach(sc)
140 1.1 bouyer struct siop_softc *sc;
141 1.1 bouyer {
142 1.1 bouyer int error, i;
143 1.1 bouyer bus_dma_segment_t seg;
144 1.1 bouyer int rseg;
145 1.1 bouyer
146 1.1 bouyer /*
147 1.17 bouyer * Allocate DMA-safe memory for the script and script sheduler
148 1.17 bouyer * and map it.
149 1.1 bouyer */
150 1.17 bouyer if ((sc->features & SF_CHIP_RAM) == 0) {
151 1.17 bouyer error = bus_dmamem_alloc(sc->sc_dmat, NBPG,
152 1.17 bouyer NBPG, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT);
153 1.17 bouyer if (error) {
154 1.17 bouyer printf("%s: unable to allocate script DMA memory, "
155 1.17 bouyer "error = %d\n", sc->sc_dev.dv_xname, error);
156 1.17 bouyer return;
157 1.17 bouyer }
158 1.17 bouyer error = bus_dmamem_map(sc->sc_dmat, &seg, rseg, NBPG,
159 1.17 bouyer (caddr_t *)&sc->sc_script, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
160 1.17 bouyer if (error) {
161 1.17 bouyer printf("%s: unable to map script DMA memory, "
162 1.17 bouyer "error = %d\n", sc->sc_dev.dv_xname, error);
163 1.17 bouyer return;
164 1.17 bouyer }
165 1.17 bouyer error = bus_dmamap_create(sc->sc_dmat, NBPG, 1,
166 1.17 bouyer NBPG, 0, BUS_DMA_NOWAIT, &sc->sc_scriptdma);
167 1.17 bouyer if (error) {
168 1.17 bouyer printf("%s: unable to create script DMA map, "
169 1.17 bouyer "error = %d\n", sc->sc_dev.dv_xname, error);
170 1.17 bouyer return;
171 1.17 bouyer }
172 1.17 bouyer error = bus_dmamap_load(sc->sc_dmat, sc->sc_scriptdma,
173 1.17 bouyer sc->sc_script,
174 1.17 bouyer NBPG, NULL, BUS_DMA_NOWAIT);
175 1.17 bouyer if (error) {
176 1.17 bouyer printf("%s: unable to load script DMA map, "
177 1.17 bouyer "error = %d\n", sc->sc_dev.dv_xname, error);
178 1.17 bouyer return;
179 1.17 bouyer }
180 1.17 bouyer sc->sc_scriptaddr = sc->sc_scriptdma->dm_segs[0].ds_addr;
181 1.17 bouyer }
182 1.16 bouyer error = bus_dmamem_alloc(sc->sc_dmat, NBPG,
183 1.1 bouyer NBPG, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT);
184 1.1 bouyer if (error) {
185 1.17 bouyer printf("%s: unable to allocate sheduler DMA memory, "
186 1.17 bouyer "error = %d\n", sc->sc_dev.dv_xname, error);
187 1.1 bouyer return;
188 1.1 bouyer }
189 1.16 bouyer error = bus_dmamem_map(sc->sc_dmat, &seg, rseg, NBPG,
190 1.17 bouyer (caddr_t *)&sc->sc_shed, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
191 1.1 bouyer if (error) {
192 1.17 bouyer printf("%s: unable to map sheduler DMA memory, error = %d\n",
193 1.1 bouyer sc->sc_dev.dv_xname, error);
194 1.1 bouyer return;
195 1.1 bouyer }
196 1.16 bouyer error = bus_dmamap_create(sc->sc_dmat, NBPG, 1,
197 1.17 bouyer NBPG, 0, BUS_DMA_NOWAIT, &sc->sc_sheddma);
198 1.1 bouyer if (error) {
199 1.17 bouyer printf("%s: unable to create sheduler DMA map, error = %d\n",
200 1.1 bouyer sc->sc_dev.dv_xname, error);
201 1.1 bouyer return;
202 1.1 bouyer }
203 1.17 bouyer error = bus_dmamap_load(sc->sc_dmat, sc->sc_sheddma, sc->sc_shed,
204 1.16 bouyer NBPG, NULL, BUS_DMA_NOWAIT);
205 1.1 bouyer if (error) {
206 1.17 bouyer printf("%s: unable to load sheduler DMA map, error = %d\n",
207 1.1 bouyer sc->sc_dev.dv_xname, error);
208 1.1 bouyer return;
209 1.1 bouyer }
210 1.1 bouyer TAILQ_INIT(&sc->free_list);
211 1.16 bouyer TAILQ_INIT(&sc->cmds);
212 1.2 bouyer /* compute number of sheduler slots */
213 1.2 bouyer sc->sc_nshedslots = (
214 1.17 bouyer NBPG /* memory size allocated for sheduler */
215 1.2 bouyer - sizeof(endslot_script) /* memory needed at end of sheduler */
216 1.2 bouyer ) / (sizeof(slot_script) - 8);
217 1.7 bouyer sc->sc_currshedslot = 0;
218 1.1 bouyer #ifdef DEBUG
219 1.2 bouyer printf("%s: script size = %d, PHY addr=0x%x, VIRT=%p nslots %d\n",
220 1.2 bouyer sc->sc_dev.dv_xname, (int)sizeof(siop_script),
221 1.18 bouyer sc->sc_scriptaddr, sc->sc_script, sc->sc_nshedslots);
222 1.1 bouyer #endif
223 1.1 bouyer
224 1.1 bouyer sc->sc_link.adapter_softc = sc;
225 1.1 bouyer sc->sc_link.openings = 1;
226 1.1 bouyer sc->sc_link.scsipi_scsi.channel = SCSI_CHANNEL_ONLY_ONE;
227 1.1 bouyer sc->sc_link.scsipi_scsi.max_target =
228 1.1 bouyer (sc->features & SF_BUS_WIDE) ? 15 : 7;
229 1.1 bouyer sc->sc_link.scsipi_scsi.max_lun = 7;
230 1.1 bouyer sc->sc_link.scsipi_scsi.adapter_target = bus_space_read_1(sc->sc_rt,
231 1.1 bouyer sc->sc_rh, SIOP_SCID);
232 1.2 bouyer if (sc->sc_link.scsipi_scsi.adapter_target == 0 ||
233 1.2 bouyer sc->sc_link.scsipi_scsi.adapter_target >
234 1.1 bouyer sc->sc_link.scsipi_scsi.max_target)
235 1.1 bouyer sc->sc_link.scsipi_scsi.adapter_target = SIOP_DEFAULT_TARGET;
236 1.1 bouyer sc->sc_link.type = BUS_SCSI;
237 1.1 bouyer sc->sc_link.adapter = &siop_adapter;
238 1.1 bouyer sc->sc_link.device = &siop_dev;
239 1.1 bouyer sc->sc_link.flags = 0;
240 1.1 bouyer
241 1.7 bouyer for (i = 0; i < 16; i++)
242 1.7 bouyer sc->targets[i] = NULL;
243 1.7 bouyer
244 1.7 bouyer /* find min/max sync period for this chip */
245 1.7 bouyer sc->maxsync = 0;
246 1.7 bouyer sc->minsync = 255;
247 1.7 bouyer for (i = 0; i < sizeof(scf_period) / sizeof(scf_period[0]); i++) {
248 1.7 bouyer if (sc->clock_period != scf_period[i].clock)
249 1.7 bouyer continue;
250 1.7 bouyer if (sc->maxsync < scf_period[i].period)
251 1.7 bouyer sc->maxsync = scf_period[i].period;
252 1.7 bouyer if (sc->minsync > scf_period[i].period)
253 1.7 bouyer sc->minsync = scf_period[i].period;
254 1.7 bouyer }
255 1.7 bouyer if (sc->maxsync == 255 || sc->minsync == 0)
256 1.7 bouyer panic("siop: can't find my sync parameters\n");
257 1.1 bouyer siop_reset(sc);
258 1.2 bouyer #ifdef DUMP_SCRIPT
259 1.2 bouyer siop_dump_script(sc);
260 1.2 bouyer #endif
261 1.1 bouyer
262 1.1 bouyer config_found((struct device*)sc, &sc->sc_link, scsiprint);
263 1.1 bouyer }
264 1.1 bouyer
265 1.1 bouyer void
266 1.1 bouyer siop_reset(sc)
267 1.1 bouyer struct siop_softc *sc;
268 1.1 bouyer {
269 1.4 bouyer int i, j;
270 1.2 bouyer u_int32_t *scr;
271 1.2 bouyer bus_addr_t physaddr;
272 1.4 bouyer
273 1.14 bouyer siop_common_reset(sc);
274 1.1 bouyer
275 1.1 bouyer /* copy and patch the script */
276 1.17 bouyer if (sc->features & SF_CHIP_RAM) {
277 1.17 bouyer bus_space_write_region_4(sc->sc_ramt, sc->sc_ramh, 0,
278 1.17 bouyer siop_script, sizeof(siop_script) / sizeof(siop_script[0]));
279 1.17 bouyer for (j = 0; j <
280 1.17 bouyer (sizeof(E_script_abs_shed_Used) /
281 1.17 bouyer sizeof(E_script_abs_shed_Used[0]));
282 1.17 bouyer j++) {
283 1.17 bouyer bus_space_write_4(sc->sc_ramt, sc->sc_ramh,
284 1.17 bouyer E_script_abs_shed_Used[j] * 4,
285 1.17 bouyer sc->sc_sheddma->dm_segs[0].ds_addr);
286 1.17 bouyer }
287 1.17 bouyer } else {
288 1.17 bouyer for (j = 0;
289 1.17 bouyer j < (sizeof(siop_script) / sizeof(siop_script[0])); j++) {
290 1.17 bouyer sc->sc_script[j] = htole32(siop_script[j]);
291 1.17 bouyer }
292 1.17 bouyer for (j = 0; j <
293 1.17 bouyer (sizeof(E_script_abs_shed_Used) /
294 1.17 bouyer sizeof(E_script_abs_shed_Used[0]));
295 1.17 bouyer j++) {
296 1.17 bouyer sc->sc_script[E_script_abs_shed_Used[j]] =
297 1.17 bouyer htole32(sc->sc_sheddma->dm_segs[0].ds_addr);
298 1.17 bouyer }
299 1.4 bouyer }
300 1.17 bouyer /* copy and init the sheduler slots script */
301 1.2 bouyer for (i = 0; i < sc->sc_nshedslots; i++) {
302 1.17 bouyer scr = &sc->sc_shed[(Ent_nextslot / 4) * i];
303 1.17 bouyer physaddr = sc->sc_sheddma->dm_segs[0].ds_addr +
304 1.17 bouyer Ent_nextslot * i;
305 1.4 bouyer for (j = 0; j < (sizeof(slot_script) / sizeof(slot_script[0]));
306 1.4 bouyer j++) {
307 1.4 bouyer scr[j] = htole32(slot_script[j]);
308 1.4 bouyer }
309 1.2 bouyer /*
310 1.2 bouyer * save current jump offset and patch MOVE MEMORY operands
311 1.2 bouyer * to restore it.
312 1.2 bouyer */
313 1.2 bouyer scr[Ent_slotdata/4 + 1] = scr[Ent_slot/4 + 1];
314 1.2 bouyer scr[E_slot_nextp_Used[0]] = htole32(physaddr + Ent_slot + 4);
315 1.2 bouyer scr[E_slot_shed_addrsrc_Used[0]] = htole32(physaddr +
316 1.2 bouyer Ent_slotdata + 4);
317 1.2 bouyer /* JUMP selected, in main script */
318 1.2 bouyer scr[E_slot_abs_selected_Used[0]] =
319 1.17 bouyer htole32(sc->sc_scriptaddr + Ent_selected);
320 1.2 bouyer /* JUMP addr if SELECT fail */
321 1.2 bouyer scr[E_slot_abs_reselect_Used[0]] =
322 1.17 bouyer htole32(sc->sc_scriptaddr + Ent_reselect);
323 1.2 bouyer }
324 1.2 bouyer /* Now the final JUMP */
325 1.17 bouyer scr = &sc->sc_shed[(Ent_nextslot / 4) * sc->sc_nshedslots];
326 1.4 bouyer for (j = 0; j < (sizeof(endslot_script) / sizeof(endslot_script[0]));
327 1.4 bouyer j++) {
328 1.4 bouyer scr[j] = htole32(endslot_script[j]);
329 1.4 bouyer }
330 1.2 bouyer scr[E_endslot_abs_reselect_Used[0]] =
331 1.17 bouyer htole32(sc->sc_scriptaddr + Ent_reselect);
332 1.1 bouyer
333 1.2 bouyer /* start script */
334 1.17 bouyer bus_dmamap_sync(sc->sc_dmat, sc->sc_scriptdma, 0, NBPG,
335 1.17 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
336 1.17 bouyer siop_shed_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
337 1.2 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP,
338 1.17 bouyer sc->sc_scriptaddr + Ent_reselect);
339 1.1 bouyer }
340 1.1 bouyer
341 1.1 bouyer #if 0
342 1.1 bouyer #define CALL_SCRIPT(ent) do {\
343 1.1 bouyer printf ("start script DSA 0x%lx DSP 0x%lx\n", \
344 1.4 bouyer siop_cmd->dsa, \
345 1.17 bouyer sc->sc_scriptaddr + ent); \
346 1.17 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP, sc->sc_scriptaddr + ent); \
347 1.1 bouyer } while (0)
348 1.1 bouyer #else
349 1.1 bouyer #define CALL_SCRIPT(ent) do {\
350 1.17 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP, sc->sc_scriptaddr + ent); \
351 1.1 bouyer } while (0)
352 1.1 bouyer #endif
353 1.1 bouyer
354 1.1 bouyer int
355 1.1 bouyer siop_intr(v)
356 1.1 bouyer void *v;
357 1.1 bouyer {
358 1.1 bouyer struct siop_softc *sc = v;
359 1.7 bouyer struct siop_target *siop_target;
360 1.1 bouyer struct siop_cmd *siop_cmd;
361 1.1 bouyer struct scsipi_xfer *xs;
362 1.8 bouyer int istat, sist0, sist1, sstat1, dstat, scntl1;
363 1.1 bouyer u_int32_t irqcode;
364 1.1 bouyer int need_reset = 0;
365 1.7 bouyer int offset, target, lun;
366 1.2 bouyer bus_addr_t dsa;
367 1.16 bouyer struct siop_cbd *cbdp;
368 1.1 bouyer
369 1.1 bouyer istat = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_ISTAT);
370 1.2 bouyer if ((istat & (ISTAT_INTF | ISTAT_DIP | ISTAT_SIP)) == 0)
371 1.2 bouyer return 0;
372 1.2 bouyer INCSTAT(siop_stat_intr);
373 1.1 bouyer if (istat & ISTAT_INTF) {
374 1.1 bouyer printf("INTRF\n");
375 1.1 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_ISTAT, ISTAT_INTF);
376 1.1 bouyer }
377 1.2 bouyer /* use DSA to find the current siop_cmd */
378 1.2 bouyer dsa = bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSA);
379 1.16 bouyer for (cbdp = TAILQ_FIRST(&sc->cmds); cbdp != NULL;
380 1.16 bouyer cbdp = TAILQ_NEXT(cbdp, next)) {
381 1.16 bouyer if (dsa >= cbdp->xferdma->dm_segs[0].ds_addr &&
382 1.16 bouyer dsa < cbdp->xferdma->dm_segs[0].ds_addr + NBPG) {
383 1.16 bouyer dsa -= cbdp->xferdma->dm_segs[0].ds_addr;
384 1.16 bouyer siop_cmd = &cbdp->cmds[dsa / sizeof(struct siop_xfer)];
385 1.16 bouyer siop_table_sync(siop_cmd,
386 1.16 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
387 1.16 bouyer break;
388 1.16 bouyer }
389 1.16 bouyer }
390 1.16 bouyer if (cbdp == NULL) {
391 1.2 bouyer printf("%s: current DSA invalid\n",
392 1.2 bouyer sc->sc_dev.dv_xname);
393 1.2 bouyer siop_cmd = NULL;
394 1.2 bouyer }
395 1.1 bouyer if (istat & ISTAT_DIP) {
396 1.1 bouyer u_int32_t *p;
397 1.1 bouyer dstat = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_DSTAT);
398 1.2 bouyer if (dstat & DSTAT_SSI) {
399 1.2 bouyer printf("single step dsp 0x%08x dsa 0x08%x\n",
400 1.7 bouyer (int)(bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSP) -
401 1.17 bouyer sc->sc_scriptaddr),
402 1.2 bouyer bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSA));
403 1.2 bouyer if ((dstat & ~(DSTAT_DFE | DSTAT_SSI)) == 0 &&
404 1.2 bouyer (istat & ISTAT_SIP) == 0) {
405 1.2 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh,
406 1.2 bouyer SIOP_DCNTL, bus_space_read_1(sc->sc_rt,
407 1.2 bouyer sc->sc_rh, SIOP_DCNTL) | DCNTL_STD);
408 1.2 bouyer }
409 1.2 bouyer return 1;
410 1.2 bouyer }
411 1.2 bouyer if (dstat & ~(DSTAT_SIR | DSTAT_DFE | DSTAT_SSI)) {
412 1.1 bouyer printf("DMA IRQ:");
413 1.1 bouyer if (dstat & DSTAT_IID)
414 1.1 bouyer printf(" Illegal instruction");
415 1.1 bouyer if (dstat & DSTAT_ABRT)
416 1.1 bouyer printf(" abort");
417 1.1 bouyer if (dstat & DSTAT_BF)
418 1.1 bouyer printf(" bus fault");
419 1.1 bouyer if (dstat & DSTAT_MDPE)
420 1.1 bouyer printf(" parity");
421 1.1 bouyer if (dstat & DSTAT_DFE)
422 1.1 bouyer printf(" dma fifo empty");
423 1.1 bouyer printf(", DSP=0x%x DSA=0x%x: ",
424 1.7 bouyer (int)(bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSP) -
425 1.17 bouyer sc->sc_scriptaddr),
426 1.1 bouyer bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSA));
427 1.2 bouyer p = sc->sc_script +
428 1.1 bouyer (bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSP) -
429 1.17 bouyer sc->sc_scriptaddr - 8) / 4;
430 1.4 bouyer printf("0x%x 0x%x 0x%x 0x%x\n", le32toh(p[0]), le32toh(p[1]),
431 1.4 bouyer le32toh(p[2]), le32toh(p[3]));
432 1.2 bouyer if (siop_cmd)
433 1.1 bouyer printf("last msg_in=0x%x status=0x%x\n",
434 1.2 bouyer siop_cmd->siop_table->msg_in[0],
435 1.6 bouyer le32toh(siop_cmd->siop_table->status));
436 1.1 bouyer need_reset = 1;
437 1.1 bouyer }
438 1.1 bouyer }
439 1.1 bouyer if (istat & ISTAT_SIP) {
440 1.2 bouyer /*
441 1.2 bouyer * SCSI interrupt. If current command is not active,
442 1.2 bouyer * we don't need siop_cmd
443 1.2 bouyer */
444 1.17 bouyer if (siop_cmd && siop_cmd->status != CMDST_ACTIVE &&
445 1.2 bouyer siop_cmd->status != CMDST_SENSE_ACTIVE) {
446 1.2 bouyer siop_cmd = NULL;
447 1.2 bouyer }
448 1.1 bouyer if (istat & ISTAT_DIP)
449 1.8 bouyer delay(10);
450 1.1 bouyer sist0 = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SIST0);
451 1.8 bouyer delay(10);
452 1.1 bouyer sist1 = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SIST1);
453 1.1 bouyer sstat1 = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SSTAT1);
454 1.8 bouyer #ifdef DEBUG_INTR
455 1.1 bouyer printf("scsi interrupt, sist0=0x%x sist1=0x%x sstat1=0x%x "
456 1.8 bouyer "DSA=0x%x DSP=0x%lx\n", sist0, sist1,
457 1.1 bouyer bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SSTAT1),
458 1.1 bouyer bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSA),
459 1.8 bouyer (u_long)(bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSP) -
460 1.17 bouyer sc->sc_scriptaddr));
461 1.1 bouyer #endif
462 1.7 bouyer if (siop_cmd) {
463 1.1 bouyer xs = siop_cmd->xs;
464 1.7 bouyer siop_target = siop_cmd->siop_target;
465 1.7 bouyer }
466 1.1 bouyer if (sist0 & SIST0_RST) {
467 1.2 bouyer siop_handle_reset(sc);
468 1.1 bouyer siop_start(sc);
469 1.2 bouyer /* no table to flush here */
470 1.1 bouyer return 1;
471 1.1 bouyer }
472 1.1 bouyer if (sist0 & SIST0_SGE) {
473 1.1 bouyer if (siop_cmd)
474 1.1 bouyer scsi_print_addr(xs->sc_link);
475 1.1 bouyer else
476 1.1 bouyer printf("%s:", sc->sc_dev.dv_xname);
477 1.1 bouyer printf("scsi gross error\n");
478 1.1 bouyer goto reset;
479 1.1 bouyer }
480 1.1 bouyer if ((sist0 & SIST0_MA) && need_reset == 0) {
481 1.1 bouyer if (siop_cmd) {
482 1.8 bouyer int scratcha0;
483 1.8 bouyer dstat = bus_space_read_1(sc->sc_rt, sc->sc_rh,
484 1.8 bouyer SIOP_DSTAT);
485 1.3 bouyer /*
486 1.3 bouyer * first restore DSA, in case we were in a S/G
487 1.3 bouyer * operation.
488 1.3 bouyer */
489 1.3 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh,
490 1.4 bouyer SIOP_DSA, siop_cmd->dsa);
491 1.8 bouyer scratcha0 = bus_space_read_1(sc->sc_rt,
492 1.8 bouyer sc->sc_rh, SIOP_SCRATCHA);
493 1.1 bouyer switch (sstat1 & SSTAT1_PHASE_MASK) {
494 1.1 bouyer case SSTAT1_PHASE_STATUS:
495 1.1 bouyer /*
496 1.1 bouyer * previous phase may be aborted for any reason
497 1.1 bouyer * ( for example, the target has less data to
498 1.1 bouyer * transfer than requested). Just go to status
499 1.1 bouyer * and the command should terminate.
500 1.1 bouyer */
501 1.2 bouyer INCSTAT(siop_stat_intr_shortxfer);
502 1.1 bouyer CALL_SCRIPT(Ent_status);
503 1.8 bouyer if ((dstat & DSTAT_DFE) == 0)
504 1.8 bouyer siop_clearfifo(sc);
505 1.2 bouyer /* no table to flush here */
506 1.1 bouyer return 1;
507 1.1 bouyer case SSTAT1_PHASE_MSGIN:
508 1.1 bouyer /*
509 1.1 bouyer * target may be ready to disconnect
510 1.1 bouyer * Save data pointers just in case.
511 1.1 bouyer */
512 1.2 bouyer INCSTAT(siop_stat_intr_xferdisc);
513 1.8 bouyer if (scratcha0 & A_flag_data)
514 1.8 bouyer siop_sdp(siop_cmd);
515 1.8 bouyer else if ((dstat & DSTAT_DFE) == 0)
516 1.8 bouyer siop_clearfifo(sc);
517 1.8 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh,
518 1.8 bouyer SIOP_SCRATCHA,
519 1.8 bouyer scratcha0 & ~A_flag_data);
520 1.2 bouyer siop_table_sync(siop_cmd,
521 1.2 bouyer BUS_DMASYNC_PREREAD |
522 1.2 bouyer BUS_DMASYNC_PREWRITE);
523 1.1 bouyer CALL_SCRIPT(Ent_msgin);
524 1.1 bouyer return 1;
525 1.1 bouyer }
526 1.1 bouyer printf("%s: unexpected phase mismatch %d\n",
527 1.1 bouyer sc->sc_dev.dv_xname,
528 1.1 bouyer sstat1 & SSTAT1_PHASE_MASK);
529 1.1 bouyer } else {
530 1.1 bouyer printf("%s: phase mismatch without command\n",
531 1.1 bouyer sc->sc_dev.dv_xname);
532 1.1 bouyer }
533 1.1 bouyer need_reset = 1;
534 1.1 bouyer }
535 1.1 bouyer if (sist0 & SIST0_PAR) {
536 1.1 bouyer /* parity error, reset */
537 1.1 bouyer if (siop_cmd)
538 1.1 bouyer scsi_print_addr(xs->sc_link);
539 1.1 bouyer else
540 1.1 bouyer printf("%s:", sc->sc_dev.dv_xname);
541 1.1 bouyer printf("parity error\n");
542 1.11 bouyer goto reset;
543 1.1 bouyer }
544 1.1 bouyer if ((sist1 & SIST1_STO) && need_reset == 0) {
545 1.1 bouyer /* selection time out, assume there's no device here */
546 1.1 bouyer if (siop_cmd) {
547 1.1 bouyer siop_cmd->status = CMDST_DONE;
548 1.1 bouyer xs->error = XS_SELTIMEOUT;
549 1.1 bouyer goto end;
550 1.1 bouyer } else {
551 1.1 bouyer printf("%s: selection timeout without "
552 1.1 bouyer "command\n", sc->sc_dev.dv_xname);
553 1.1 bouyer need_reset = 1;
554 1.1 bouyer }
555 1.1 bouyer }
556 1.1 bouyer if (sist0 & SIST0_UDC) {
557 1.1 bouyer /*
558 1.1 bouyer * unexpected disconnect. Usually the target signals
559 1.1 bouyer * a fatal condition this way. Attempt to get sense.
560 1.1 bouyer */
561 1.1 bouyer if (siop_cmd)
562 1.7 bouyer goto check_sense;
563 1.1 bouyer printf("%s: unexpected disconnect without "
564 1.1 bouyer "command\n", sc->sc_dev.dv_xname);
565 1.2 bouyer goto reset;
566 1.1 bouyer }
567 1.1 bouyer /* Else it's an unhandled exeption (for now). */
568 1.1 bouyer printf("%s: unhandled scsi interrupt, sist0=0x%x sist1=0x%x "
569 1.1 bouyer "sstat1=0x%x DSA=0x%x DSP=0x%x\n", sc->sc_dev.dv_xname,
570 1.1 bouyer sist0, sist1,
571 1.1 bouyer bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SSTAT1),
572 1.1 bouyer bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSA),
573 1.7 bouyer (int)(bus_space_read_4(sc->sc_rt, sc->sc_rh, SIOP_DSP) -
574 1.17 bouyer sc->sc_scriptaddr));
575 1.1 bouyer if (siop_cmd) {
576 1.1 bouyer siop_cmd->status = CMDST_DONE;
577 1.1 bouyer xs->error = XS_SELTIMEOUT;
578 1.1 bouyer goto end;
579 1.1 bouyer }
580 1.1 bouyer need_reset = 1;
581 1.1 bouyer }
582 1.1 bouyer if (need_reset) {
583 1.1 bouyer reset:
584 1.1 bouyer /* fatal error, reset the bus */
585 1.1 bouyer scntl1 = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1);
586 1.1 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1,
587 1.1 bouyer scntl1 | SCNTL1_RST);
588 1.1 bouyer /* minimum 25 us, more time won't hurt */
589 1.1 bouyer delay(100);
590 1.1 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1, scntl1);
591 1.2 bouyer /* no table to flush here */
592 1.1 bouyer return 1;
593 1.1 bouyer }
594 1.1 bouyer
595 1.1 bouyer
596 1.1 bouyer if ((istat & ISTAT_DIP) && (dstat & DSTAT_SIR)) { /* script interrupt */
597 1.1 bouyer irqcode = bus_space_read_4(sc->sc_rt, sc->sc_rh,
598 1.1 bouyer SIOP_DSPS);
599 1.2 bouyer #ifdef DEBUG_INTR
600 1.2 bouyer printf("script interrupt 0x%x\n", irqcode);
601 1.2 bouyer #endif
602 1.16 bouyer if (siop_cmd == NULL) {
603 1.16 bouyer printf("%s: script interrupt (0x%x) with invalid "
604 1.16 bouyer "DSA !!!\n", sc->sc_dev.dv_xname, irqcode);
605 1.16 bouyer goto reset;
606 1.16 bouyer }
607 1.2 bouyer /*
608 1.2 bouyer * an inactive command is only valid if it's a reselect
609 1.2 bouyer * interrupt: we'll change siop_cmd to point to the rigth one
610 1.2 bouyer * just here
611 1.2 bouyer */
612 1.14 bouyer if (irqcode != A_int_resel && irqcode != A_int_reseltag &&
613 1.2 bouyer siop_cmd->status != CMDST_ACTIVE &&
614 1.2 bouyer siop_cmd->status != CMDST_SENSE_ACTIVE) {
615 1.2 bouyer printf("%s: Aie, no command (IRQ code 0x%x current "
616 1.2 bouyer "status %d) !\n", sc->sc_dev.dv_xname,
617 1.2 bouyer irqcode, siop_cmd->status);
618 1.2 bouyer xs = NULL;
619 1.7 bouyer } else {
620 1.2 bouyer xs = siop_cmd->xs;
621 1.7 bouyer siop_target = siop_cmd->siop_target;
622 1.7 bouyer }
623 1.1 bouyer switch(irqcode) {
624 1.1 bouyer case A_int_err:
625 1.2 bouyer printf("error, DSP=0x%x\n",
626 1.17 bouyer (int)(bus_space_read_4(sc->sc_rt, sc->sc_rh,
627 1.17 bouyer SIOP_DSP) - sc->sc_scriptaddr));
628 1.2 bouyer if (xs) {
629 1.2 bouyer xs->error = XS_SELTIMEOUT;
630 1.2 bouyer goto end;
631 1.2 bouyer } else {
632 1.2 bouyer goto reset;
633 1.2 bouyer }
634 1.1 bouyer case A_int_msgin:
635 1.2 bouyer if (siop_cmd->siop_table->msg_in[0] ==
636 1.2 bouyer MSG_MESSAGE_REJECT) {
637 1.8 bouyer int msg, extmsg;
638 1.8 bouyer if (siop_cmd->siop_table->msg_out[0] & 0x80) {
639 1.8 bouyer /*
640 1.8 bouyer * message was part of a identify +
641 1.8 bouyer * something else. Identify shoudl't
642 1.8 bouyer * have been rejected.
643 1.8 bouyer */
644 1.8 bouyer msg = siop_cmd->siop_table->msg_out[1];
645 1.8 bouyer extmsg =
646 1.8 bouyer siop_cmd->siop_table->msg_out[3];
647 1.8 bouyer } else {
648 1.8 bouyer msg = siop_cmd->siop_table->msg_out[0];
649 1.8 bouyer extmsg =
650 1.8 bouyer siop_cmd->siop_table->msg_out[2];
651 1.8 bouyer }
652 1.8 bouyer if (msg == MSG_MESSAGE_REJECT) {
653 1.2 bouyer /* MSG_REJECT for a MSG_REJECT !*/
654 1.9 bouyer if (xs)
655 1.9 bouyer scsi_print_addr(xs->sc_link);
656 1.9 bouyer else
657 1.9 bouyer printf("%s: ",
658 1.9 bouyer sc->sc_dev.dv_xname);
659 1.9 bouyer printf("our reject message was "
660 1.9 bouyer "rejected\n");
661 1.2 bouyer goto reset;
662 1.2 bouyer }
663 1.8 bouyer if (msg == MSG_EXTENDED &&
664 1.8 bouyer extmsg == MSG_EXT_WDTR) {
665 1.9 bouyer /* WDTR rejected, initiate sync */
666 1.9 bouyer printf("%s: target %d using 8bit "
667 1.9 bouyer "transfers\n", sc->sc_dev.dv_xname,
668 1.9 bouyer xs->sc_link->scsipi_scsi.target);
669 1.9 bouyer siop_target->status = TARST_SYNC_NEG;
670 1.9 bouyer siop_cmd->siop_table->msg_out[0] =
671 1.9 bouyer MSG_EXTENDED;
672 1.9 bouyer siop_cmd->siop_table->msg_out[1] =
673 1.9 bouyer MSG_EXT_SDTR_LEN;
674 1.9 bouyer siop_cmd->siop_table->msg_out[2] =
675 1.9 bouyer MSG_EXT_SDTR;
676 1.9 bouyer siop_cmd->siop_table->msg_out[3] =
677 1.9 bouyer sc->minsync;
678 1.9 bouyer siop_cmd->siop_table->msg_out[4] =
679 1.9 bouyer sc->maxoff;
680 1.9 bouyer siop_cmd->siop_table->t_msgout.count =
681 1.9 bouyer htole32(MSG_EXT_SDTR_LEN + 2);
682 1.9 bouyer siop_cmd->siop_table->t_msgout.addr =
683 1.9 bouyer htole32(siop_cmd->dsa);
684 1.9 bouyer siop_table_sync(siop_cmd,
685 1.9 bouyer BUS_DMASYNC_PREREAD |
686 1.9 bouyer BUS_DMASYNC_PREWRITE);
687 1.9 bouyer CALL_SCRIPT(Ent_send_msgout);
688 1.9 bouyer return 1;
689 1.8 bouyer } else if (msg == MSG_EXTENDED &&
690 1.8 bouyer extmsg == MSG_EXT_SDTR) {
691 1.7 bouyer /* sync rejected */
692 1.9 bouyer printf("%s: target %d asynchronous\n",
693 1.9 bouyer sc->sc_dev.dv_xname,
694 1.9 bouyer xs->sc_link->scsipi_scsi.target);
695 1.7 bouyer siop_cmd->siop_target->status =
696 1.7 bouyer TARST_OK;
697 1.9 bouyer /* no table to flush here */
698 1.9 bouyer CALL_SCRIPT(Ent_msgin_ack);
699 1.9 bouyer return 1;
700 1.9 bouyer }
701 1.9 bouyer if (xs)
702 1.9 bouyer scsi_print_addr(xs->sc_link);
703 1.9 bouyer else
704 1.9 bouyer printf("%s: ", sc->sc_dev.dv_xname);
705 1.9 bouyer if (msg == MSG_EXTENDED) {
706 1.9 bouyer printf("scsi message reject, extended "
707 1.9 bouyer "message sent was 0x%x\n", extmsg);
708 1.9 bouyer } else {
709 1.9 bouyer printf("scsi message reject, message "
710 1.9 bouyer "sent was 0x%x\n", msg);
711 1.7 bouyer }
712 1.2 bouyer /* no table to flush here */
713 1.2 bouyer CALL_SCRIPT(Ent_msgin_ack);
714 1.2 bouyer return 1;
715 1.2 bouyer }
716 1.9 bouyer if (xs)
717 1.9 bouyer scsi_print_addr(xs->sc_link);
718 1.9 bouyer else
719 1.9 bouyer printf("%s: ", sc->sc_dev.dv_xname);
720 1.8 bouyer printf("unhandled message 0x%x\n",
721 1.8 bouyer siop_cmd->siop_table->msg_in[0]);
722 1.2 bouyer siop_cmd->siop_table->t_msgout.count= htole32(1);
723 1.2 bouyer siop_cmd->siop_table->t_msgout.addr =
724 1.2 bouyer htole32(siop_cmd->dsa);
725 1.2 bouyer siop_cmd->siop_table->msg_out[0] = MSG_MESSAGE_REJECT;
726 1.2 bouyer siop_table_sync(siop_cmd,
727 1.2 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
728 1.2 bouyer CALL_SCRIPT(Ent_send_msgout);
729 1.2 bouyer return 1;
730 1.2 bouyer case A_int_extmsgin:
731 1.2 bouyer #ifdef DEBUG_INTR
732 1.2 bouyer printf("extended message: msg 0x%x len %d\n",
733 1.2 bouyer siop_cmd->siop_table->msg_in[2],
734 1.2 bouyer siop_cmd->siop_table->msg_in[1]);
735 1.2 bouyer #endif
736 1.8 bouyer if (siop_cmd->siop_table->msg_in[1] > 6)
737 1.8 bouyer printf("%s: extended message too big (%d)\n",
738 1.8 bouyer sc->sc_dev.dv_xname,
739 1.8 bouyer siop_cmd->siop_table->msg_in[1]);
740 1.2 bouyer siop_cmd->siop_table->t_extmsgdata.count =
741 1.2 bouyer htole32(siop_cmd->siop_table->msg_in[1] - 1);
742 1.2 bouyer siop_cmd->siop_table->t_extmsgdata.addr =
743 1.2 bouyer htole32(
744 1.4 bouyer le32toh(siop_cmd->siop_table->t_extmsgin.addr)
745 1.2 bouyer + 2);
746 1.2 bouyer siop_table_sync(siop_cmd,
747 1.2 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
748 1.2 bouyer CALL_SCRIPT(Ent_get_extmsgdata);
749 1.2 bouyer return 1;
750 1.2 bouyer case A_int_extmsgdata:
751 1.2 bouyer #ifdef DEBUG_INTR
752 1.2 bouyer {
753 1.2 bouyer int i;
754 1.2 bouyer printf("extended message: 0x%x, data:",
755 1.2 bouyer siop_cmd->siop_table->msg_in[2]);
756 1.2 bouyer for (i = 3; i < 2 + siop_cmd->siop_table->msg_in[1];
757 1.2 bouyer i++)
758 1.2 bouyer printf(" 0x%x",
759 1.2 bouyer siop_cmd->siop_table->msg_in[i]);
760 1.2 bouyer printf("\n");
761 1.2 bouyer }
762 1.2 bouyer #endif
763 1.7 bouyer if (siop_cmd->siop_table->msg_in[2] == MSG_EXT_WDTR) {
764 1.14 bouyer switch (siop_wdtr_neg(siop_cmd)) {
765 1.14 bouyer case SIOP_NEG_NOP:
766 1.14 bouyer break;
767 1.14 bouyer case SIOP_NEG_MSGOUT:
768 1.14 bouyer siop_table_sync(siop_cmd,
769 1.14 bouyer BUS_DMASYNC_PREREAD |
770 1.14 bouyer BUS_DMASYNC_PREWRITE);
771 1.14 bouyer CALL_SCRIPT(Ent_send_msgout);
772 1.14 bouyer break;
773 1.14 bouyer default:
774 1.14 bouyer panic("invalid retval from "
775 1.14 bouyer "siop_wdtr_neg()");
776 1.14 bouyer }
777 1.7 bouyer return(1);
778 1.7 bouyer }
779 1.2 bouyer if (siop_cmd->siop_table->msg_in[2] == MSG_EXT_SDTR) {
780 1.14 bouyer switch (siop_sdtr_neg(siop_cmd)) {
781 1.14 bouyer case SIOP_NEG_NOP:
782 1.14 bouyer break;
783 1.14 bouyer case SIOP_NEG_MSGOUT:
784 1.14 bouyer siop_table_sync(siop_cmd,
785 1.14 bouyer BUS_DMASYNC_PREREAD |
786 1.14 bouyer BUS_DMASYNC_PREWRITE);
787 1.14 bouyer CALL_SCRIPT(Ent_send_msgout);
788 1.14 bouyer break;
789 1.14 bouyer case SIOP_NEG_ACK:
790 1.14 bouyer CALL_SCRIPT(Ent_msgin_ack);
791 1.14 bouyer break;
792 1.14 bouyer default:
793 1.14 bouyer panic("invalid retval from "
794 1.14 bouyer "siop_wdtr_neg()");
795 1.14 bouyer }
796 1.7 bouyer return(1);
797 1.2 bouyer }
798 1.7 bouyer /* send a message reject */
799 1.7 bouyer siop_cmd->siop_table->t_msgout.count =
800 1.7 bouyer htole32(1);
801 1.7 bouyer siop_cmd->siop_table->t_msgout.addr =
802 1.7 bouyer htole32(siop_cmd->dsa);
803 1.7 bouyer siop_cmd->siop_table->msg_out[0] =
804 1.7 bouyer MSG_MESSAGE_REJECT;
805 1.2 bouyer siop_table_sync(siop_cmd,
806 1.2 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
807 1.2 bouyer CALL_SCRIPT(Ent_send_msgout);
808 1.2 bouyer return 1;
809 1.1 bouyer case A_int_resel: /* reselected */
810 1.14 bouyer case A_int_reseltag: /* reselected with tag */
811 1.2 bouyer INCSTAT(siop_stat_intr_reselect);
812 1.2 bouyer if ((siop_cmd->siop_table->msg_in[0] & 0x80) == 0) {
813 1.1 bouyer printf("%s: reselect without identify (%d)\n",
814 1.1 bouyer sc->sc_dev.dv_xname,
815 1.2 bouyer siop_cmd->siop_table->msg_in[0]);
816 1.1 bouyer goto reset;
817 1.1 bouyer }
818 1.2 bouyer target = bus_space_read_1(sc->sc_rt,
819 1.1 bouyer sc->sc_rh, SIOP_SCRATCHA);
820 1.2 bouyer if ((target & 0x80) == 0) {
821 1.2 bouyer printf("reselect without id (%d)\n", target);
822 1.1 bouyer goto reset;
823 1.1 bouyer }
824 1.2 bouyer target &= 0x0f;
825 1.7 bouyer lun = siop_cmd->siop_table->msg_in[0] & 0x07;
826 1.1 bouyer #ifdef DEBUG_DR
827 1.1 bouyer printf("reselected by target %d lun %d\n",
828 1.7 bouyer target, lun);
829 1.1 bouyer #endif
830 1.1 bouyer siop_cmd =
831 1.7 bouyer sc->targets[target]->active_list[lun].tqh_first;
832 1.1 bouyer if (siop_cmd == NULL) {
833 1.1 bouyer printf("%s: reselected without cmd\n",
834 1.1 bouyer sc->sc_dev.dv_xname);
835 1.1 bouyer goto reset;
836 1.1 bouyer }
837 1.4 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSA,
838 1.4 bouyer siop_cmd->dsa);
839 1.11 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL3,
840 1.11 bouyer (sc->targets[target]->id >> 24) & 0xff);
841 1.11 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCXFER,
842 1.11 bouyer (sc->targets[target]->id >> 8) & 0xff);
843 1.2 bouyer /* no table to flush */
844 1.2 bouyer CALL_SCRIPT(Ent_selected);
845 1.1 bouyer return 1;
846 1.1 bouyer case A_int_disc:
847 1.2 bouyer INCSTAT(siop_stat_intr_sdp);
848 1.1 bouyer offset = bus_space_read_1(sc->sc_rt, sc->sc_rh,
849 1.1 bouyer SIOP_SCRATCHA + 1);
850 1.1 bouyer #ifdef DEBUG_DR
851 1.1 bouyer printf("disconnect offset %d\n", offset);
852 1.1 bouyer #endif
853 1.1 bouyer if (offset > SIOP_NSG) {
854 1.1 bouyer printf("%s: bad offset for disconnect (%d)\n",
855 1.1 bouyer sc->sc_dev.dv_xname, offset);
856 1.1 bouyer goto reset;
857 1.1 bouyer }
858 1.1 bouyer /*
859 1.1 bouyer * offset == SIOP_NSG may be a valid condition if
860 1.1 bouyer * we get a sdp when the xfer is done.
861 1.1 bouyer * Don't call memmove in this case.
862 1.1 bouyer */
863 1.1 bouyer if (offset < SIOP_NSG) {
864 1.1 bouyer memmove(&siop_cmd->siop_table->data[0],
865 1.1 bouyer &siop_cmd->siop_table->data[offset],
866 1.1 bouyer (SIOP_NSG - offset) * sizeof(scr_table_t));
867 1.2 bouyer siop_table_sync(siop_cmd,
868 1.2 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
869 1.1 bouyer }
870 1.17 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP,
871 1.17 bouyer sc->sc_sheddma->dm_segs[0].ds_addr);
872 1.1 bouyer return 1;
873 1.1 bouyer case A_int_resfail:
874 1.1 bouyer printf("reselect failed\n");
875 1.17 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP,
876 1.17 bouyer sc->sc_sheddma->dm_segs[0].ds_addr);
877 1.1 bouyer return 1;
878 1.1 bouyer case A_int_done:
879 1.2 bouyer if (xs == NULL) {
880 1.8 bouyer printf("%s: done without command, DSA=0x%lx\n",
881 1.8 bouyer sc->sc_dev.dv_xname, (u_long)siop_cmd->dsa);
882 1.8 bouyer siop_cmd->status = CMDST_FREE;
883 1.17 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh,
884 1.17 bouyer SIOP_DSP,
885 1.17 bouyer sc->sc_sheddma->dm_segs[0].ds_addr);
886 1.2 bouyer siop_start(sc);
887 1.2 bouyer return 1;
888 1.2 bouyer }
889 1.7 bouyer if (siop_target->status == TARST_PROBING)
890 1.7 bouyer siop_target->status = TARST_ASYNC;
891 1.8 bouyer #ifdef DEBUG_INTR
892 1.8 bouyer printf("done, DSA=0x%lx target id 0x%x last msg "
893 1.8 bouyer "in=0x%x status=0x%x\n", (u_long)siop_cmd->dsa,
894 1.4 bouyer le32toh(siop_cmd->siop_table->id),
895 1.2 bouyer siop_cmd->siop_table->msg_in[0],
896 1.4 bouyer le32toh(siop_cmd->siop_table->status));
897 1.1 bouyer #endif
898 1.2 bouyer INCSTAT(siop_stat_intr_done);
899 1.2 bouyer if (siop_cmd->status == CMDST_SENSE_ACTIVE)
900 1.1 bouyer siop_cmd->status = CMDST_SENSE_DONE;
901 1.1 bouyer else
902 1.1 bouyer siop_cmd->status = CMDST_DONE;
903 1.4 bouyer switch(le32toh(siop_cmd->siop_table->status)) {
904 1.1 bouyer case SCSI_OK:
905 1.1 bouyer xs->error = (siop_cmd->status == CMDST_DONE) ?
906 1.1 bouyer XS_NOERROR : XS_SENSE;
907 1.1 bouyer break;
908 1.1 bouyer case SCSI_BUSY:
909 1.1 bouyer xs->error = XS_BUSY;
910 1.1 bouyer break;
911 1.1 bouyer case SCSI_CHECK:
912 1.1 bouyer check_sense:
913 1.1 bouyer if (siop_cmd->status == CMDST_SENSE_DONE) {
914 1.2 bouyer /* request sense on a request sense ? */
915 1.2 bouyer printf("request sense failed\n");
916 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
917 1.1 bouyer } else {
918 1.1 bouyer siop_cmd->status = CMDST_SENSE;
919 1.1 bouyer }
920 1.1 bouyer break;
921 1.1 bouyer case 0xff:
922 1.1 bouyer /*
923 1.1 bouyer * the status byte was not updated, cmd was
924 1.1 bouyer * aborted
925 1.1 bouyer */
926 1.1 bouyer xs->error = XS_SELTIMEOUT;
927 1.2 bouyer break;
928 1.1 bouyer default:
929 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
930 1.1 bouyer }
931 1.1 bouyer goto end;
932 1.1 bouyer default:
933 1.1 bouyer printf("unknown irqcode %x\n", irqcode);
934 1.1 bouyer xs->error = XS_SELTIMEOUT;
935 1.1 bouyer goto end;
936 1.1 bouyer }
937 1.1 bouyer return 1;
938 1.1 bouyer }
939 1.2 bouyer /* We just should't get there */
940 1.2 bouyer panic("siop_intr: I shouldn't be there !");
941 1.2 bouyer return 1;
942 1.1 bouyer end:
943 1.7 bouyer bus_space_write_4(sc->sc_rt, sc->sc_rh, SIOP_DSP,
944 1.17 bouyer sc->sc_sheddma->dm_segs[0].ds_addr);
945 1.7 bouyer lun = siop_cmd->xs->sc_link->scsipi_scsi.lun;
946 1.2 bouyer siop_scsicmd_end(siop_cmd);
947 1.2 bouyer if (siop_cmd->status == CMDST_FREE) {
948 1.7 bouyer TAILQ_REMOVE(&siop_target->active_list[lun],
949 1.2 bouyer siop_cmd, next);
950 1.2 bouyer TAILQ_INSERT_TAIL(&sc->free_list, siop_cmd, next);
951 1.2 bouyer }
952 1.2 bouyer siop_start(sc);
953 1.2 bouyer return 1;
954 1.2 bouyer }
955 1.2 bouyer
956 1.2 bouyer void
957 1.2 bouyer siop_scsicmd_end(siop_cmd)
958 1.2 bouyer struct siop_cmd *siop_cmd;
959 1.2 bouyer {
960 1.2 bouyer struct scsipi_xfer *xs = siop_cmd->xs;
961 1.7 bouyer struct siop_softc *sc = siop_cmd->siop_target->siop_sc;
962 1.2 bouyer
963 1.1 bouyer if (siop_cmd->status != CMDST_SENSE_DONE &&
964 1.1 bouyer xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
965 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_data, 0,
966 1.1 bouyer siop_cmd->dmamap_data->dm_mapsize,
967 1.1 bouyer (xs->xs_control & XS_CTL_DATA_IN) ?
968 1.1 bouyer BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
969 1.1 bouyer bus_dmamap_unload(sc->sc_dmat, siop_cmd->dmamap_data);
970 1.1 bouyer }
971 1.1 bouyer bus_dmamap_unload(sc->sc_dmat, siop_cmd->dmamap_cmd);
972 1.1 bouyer if (siop_cmd->status == CMDST_SENSE) {
973 1.1 bouyer /* issue a request sense for this target */
974 1.1 bouyer int error, i;
975 1.1 bouyer siop_cmd->rs_cmd.opcode = REQUEST_SENSE;
976 1.1 bouyer siop_cmd->rs_cmd.byte2 = xs->sc_link->scsipi_scsi.lun << 5;
977 1.1 bouyer siop_cmd->rs_cmd.unused[0] = siop_cmd->rs_cmd.unused[1] = 0;
978 1.1 bouyer siop_cmd->rs_cmd.length = sizeof(struct scsipi_sense_data);
979 1.1 bouyer siop_cmd->rs_cmd.control = 0;
980 1.2 bouyer siop_cmd->siop_table->status = htole32(0xff); /*invalid status*/
981 1.2 bouyer siop_cmd->siop_table->t_msgout.count= htole32(1);
982 1.2 bouyer siop_cmd->siop_table->t_msgout.addr = htole32(siop_cmd->dsa);
983 1.2 bouyer siop_cmd->siop_table->msg_out[0] =
984 1.2 bouyer MSG_IDENTIFY(xs->sc_link->scsipi_scsi.lun, 1);
985 1.1 bouyer error = bus_dmamap_load(sc->sc_dmat, siop_cmd->dmamap_cmd,
986 1.1 bouyer &siop_cmd->rs_cmd, sizeof(struct scsipi_sense),
987 1.1 bouyer NULL, BUS_DMA_NOWAIT);
988 1.1 bouyer if (error) {
989 1.1 bouyer printf("%s: unable to load cmd DMA map: %d",
990 1.1 bouyer sc->sc_dev.dv_xname, error);
991 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
992 1.1 bouyer goto out;
993 1.1 bouyer }
994 1.1 bouyer siop_cmd->siop_table->cmd.count =
995 1.1 bouyer htole32(siop_cmd->dmamap_cmd->dm_segs[0].ds_len);
996 1.1 bouyer siop_cmd->siop_table->cmd.addr =
997 1.1 bouyer htole32(siop_cmd->dmamap_cmd->dm_segs[0].ds_addr);
998 1.1 bouyer error = bus_dmamap_load(sc->sc_dmat, siop_cmd->dmamap_data,
999 1.1 bouyer &xs->sense.scsi_sense, sizeof(struct scsipi_sense_data),
1000 1.1 bouyer NULL, BUS_DMA_NOWAIT);
1001 1.1 bouyer if (error) {
1002 1.1 bouyer printf("%s: unable to load sense DMA map: %d",
1003 1.1 bouyer sc->sc_dev.dv_xname, error);
1004 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1005 1.1 bouyer bus_dmamap_unload(sc->sc_dmat, siop_cmd->dmamap_cmd);
1006 1.1 bouyer goto out;
1007 1.1 bouyer }
1008 1.1 bouyer for (i = 0; i < siop_cmd->dmamap_data->dm_nsegs; i++) {
1009 1.1 bouyer siop_cmd->siop_table->data[i].count =
1010 1.1 bouyer htole32(siop_cmd->dmamap_data->dm_segs[i].ds_len);
1011 1.1 bouyer siop_cmd->siop_table->data[i].addr =
1012 1.1 bouyer htole32(siop_cmd->dmamap_data->dm_segs[i].ds_addr);
1013 1.1 bouyer }
1014 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_data, 0,
1015 1.1 bouyer siop_cmd->dmamap_data->dm_mapsize, BUS_DMASYNC_PREREAD);
1016 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_cmd, 0,
1017 1.1 bouyer siop_cmd->dmamap_cmd->dm_mapsize, BUS_DMASYNC_PREWRITE);
1018 1.2 bouyer siop_table_sync(siop_cmd, BUS_DMASYNC_PREWRITE);
1019 1.2 bouyer return;
1020 1.1 bouyer } else if (siop_cmd->status == CMDST_SENSE_DONE) {
1021 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_data, 0,
1022 1.1 bouyer siop_cmd->dmamap_data->dm_mapsize, BUS_DMASYNC_POSTREAD);
1023 1.1 bouyer bus_dmamap_unload(sc->sc_dmat, siop_cmd->dmamap_data);
1024 1.1 bouyer }
1025 1.1 bouyer out:
1026 1.1 bouyer callout_stop(&siop_cmd->xs->xs_callout);
1027 1.1 bouyer siop_cmd->status = CMDST_FREE;
1028 1.1 bouyer xs->xs_status |= XS_STS_DONE;
1029 1.1 bouyer xs->resid = 0;
1030 1.14 bouyer if ((xs->xs_control & XS_CTL_POLL) == 0)
1031 1.14 bouyer scsipi_done (xs);
1032 1.7 bouyer }
1033 1.7 bouyer
1034 1.2 bouyer /*
1035 1.2 bouyer * handle a bus reset: reset chip, unqueue all active commands and report
1036 1.2 bouyer * loosage to upper layer.
1037 1.2 bouyer * As the upper layer may requeue immediatly we have to first store
1038 1.2 bouyer * all active commands in a temporary queue.
1039 1.2 bouyer */
1040 1.2 bouyer void
1041 1.2 bouyer siop_handle_reset(sc)
1042 1.2 bouyer struct siop_softc *sc;
1043 1.2 bouyer {
1044 1.2 bouyer struct cmd_list reset_list;
1045 1.2 bouyer struct siop_cmd *siop_cmd, *next_siop_cmd;
1046 1.7 bouyer int target, lun;
1047 1.2 bouyer /*
1048 1.2 bouyer * scsi bus reset. reset the chip and restart
1049 1.2 bouyer * the queue. Need to clean up all active commands
1050 1.2 bouyer */
1051 1.2 bouyer printf("%s: scsi bus reset\n", sc->sc_dev.dv_xname);
1052 1.2 bouyer /* stop, reset and restart the chip */
1053 1.2 bouyer siop_reset(sc);
1054 1.2 bouyer TAILQ_INIT(&reset_list);
1055 1.2 bouyer /* find all active commands */
1056 1.7 bouyer for (target = 0; target < sc->sc_link.scsipi_scsi.max_target;
1057 1.7 bouyer target++) {
1058 1.7 bouyer if (sc->targets[target] == NULL)
1059 1.7 bouyer continue;
1060 1.7 bouyer for (lun = 0; lun < 8; lun++) {
1061 1.7 bouyer for (siop_cmd =
1062 1.7 bouyer TAILQ_FIRST(&sc->targets[target]->active_list[lun]);
1063 1.7 bouyer siop_cmd != NULL; siop_cmd = next_siop_cmd) {
1064 1.7 bouyer next_siop_cmd = TAILQ_NEXT(siop_cmd, next);
1065 1.7 bouyer if (siop_cmd->status < CMDST_ACTIVE)
1066 1.7 bouyer continue;
1067 1.7 bouyer printf("cmd %p (target %d) in reset list\n",
1068 1.7 bouyer siop_cmd, target);
1069 1.7 bouyer TAILQ_REMOVE(
1070 1.7 bouyer &sc->targets[target]->active_list[lun],
1071 1.7 bouyer siop_cmd, next);
1072 1.7 bouyer TAILQ_INSERT_TAIL(&reset_list, siop_cmd, next);
1073 1.7 bouyer }
1074 1.2 bouyer }
1075 1.7 bouyer sc->targets[target]->status = TARST_ASYNC;
1076 1.7 bouyer sc->targets[target]->flags = ~(TARF_SYNC | TARF_WIDE);
1077 1.2 bouyer }
1078 1.2 bouyer for (siop_cmd = TAILQ_FIRST(&reset_list); siop_cmd != NULL;
1079 1.2 bouyer siop_cmd = next_siop_cmd) {
1080 1.2 bouyer next_siop_cmd = TAILQ_NEXT(siop_cmd, next);
1081 1.2 bouyer siop_cmd->xs->error = (siop_cmd->flags & CMDFL_TIMEOUT) ?
1082 1.2 bouyer XS_TIMEOUT : XS_RESET;
1083 1.2 bouyer printf("cmd %p about to be processed\n", siop_cmd);
1084 1.16 bouyer if (siop_cmd->status == CMDST_SENSE ||
1085 1.16 bouyer siop_cmd->status == CMDST_SENSE_ACTIVE)
1086 1.16 bouyer siop_cmd->status = CMDST_SENSE_DONE;
1087 1.16 bouyer else
1088 1.16 bouyer siop_cmd->status = CMDST_DONE;
1089 1.2 bouyer TAILQ_REMOVE(&reset_list, siop_cmd, next);
1090 1.2 bouyer siop_scsicmd_end(siop_cmd);
1091 1.2 bouyer TAILQ_INSERT_TAIL(&sc->free_list, siop_cmd, next);
1092 1.2 bouyer }
1093 1.1 bouyer }
1094 1.1 bouyer
1095 1.2 bouyer int
1096 1.1 bouyer siop_scsicmd(xs)
1097 1.1 bouyer struct scsipi_xfer *xs;
1098 1.1 bouyer {
1099 1.1 bouyer struct siop_softc *sc = (struct siop_softc *)xs->sc_link->adapter_softc;
1100 1.1 bouyer struct siop_cmd *siop_cmd;
1101 1.1 bouyer int s, error, i;
1102 1.7 bouyer int target = xs->sc_link->scsipi_scsi.target;
1103 1.7 bouyer int lun = xs->sc_link->scsipi_scsi.lun;
1104 1.1 bouyer
1105 1.1 bouyer s = splbio();
1106 1.7 bouyer #ifdef DEBUG_SHED
1107 1.7 bouyer printf("starting cmd for %d:%d\n", target, lun);
1108 1.1 bouyer #endif
1109 1.1 bouyer siop_cmd = sc->free_list.tqh_first;
1110 1.1 bouyer if (siop_cmd) {
1111 1.1 bouyer TAILQ_REMOVE(&sc->free_list, siop_cmd, next);
1112 1.16 bouyer } else {
1113 1.16 bouyer if (siop_morecbd(sc) == 0) {
1114 1.16 bouyer siop_cmd = sc->free_list.tqh_first;
1115 1.16 bouyer #ifdef DIAGNOSTIC
1116 1.16 bouyer if (siop_cmd == NULL)
1117 1.16 bouyer panic("siop_morecbd succeed and does nothing");
1118 1.16 bouyer #endif
1119 1.16 bouyer TAILQ_REMOVE(&sc->free_list, siop_cmd, next);
1120 1.16 bouyer }
1121 1.1 bouyer }
1122 1.1 bouyer splx(s);
1123 1.1 bouyer if (siop_cmd == NULL) {
1124 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1125 1.1 bouyer return(TRY_AGAIN_LATER);
1126 1.1 bouyer }
1127 1.1 bouyer #ifdef DIAGNOSTIC
1128 1.1 bouyer if (siop_cmd->status != CMDST_FREE)
1129 1.1 bouyer panic("siop_scsicmd: new cmd not free");
1130 1.1 bouyer #endif
1131 1.7 bouyer if (sc->targets[target] == NULL) {
1132 1.7 bouyer sc->targets[target] =
1133 1.7 bouyer malloc(sizeof(struct siop_target), M_DEVBUF, M_NOWAIT);
1134 1.7 bouyer if (sc->targets[target] == NULL) {
1135 1.7 bouyer printf("%s: can't malloc memory for target %d\n",
1136 1.7 bouyer sc->sc_dev.dv_xname, target);
1137 1.7 bouyer xs->error = XS_DRIVER_STUFFUP;
1138 1.7 bouyer return(TRY_AGAIN_LATER);
1139 1.7 bouyer }
1140 1.7 bouyer sc->targets[target]->siop_sc = sc;
1141 1.7 bouyer sc->targets[target]->status = TARST_PROBING;
1142 1.7 bouyer sc->targets[target]->flags = 0;
1143 1.7 bouyer sc->targets[target]->id = sc->clock_div << 24; /* scntl3 */
1144 1.7 bouyer sc->targets[target]->id |= target << 16; /* id */
1145 1.14 bouyer /* sc->targets[target]->id |= 0x0 << 8; scxfer is 0 */
1146 1.7 bouyer for (i = 0; i < 8; i++)
1147 1.7 bouyer TAILQ_INIT(&sc->targets[target]->active_list[i]);
1148 1.7 bouyer }
1149 1.7 bouyer siop_cmd->siop_target = sc->targets[target];
1150 1.1 bouyer siop_cmd->xs = xs;
1151 1.7 bouyer siop_cmd->siop_table->id = htole32(sc->targets[target]->id);
1152 1.2 bouyer siop_cmd->siop_table->t_msgout.count= htole32(1);
1153 1.2 bouyer siop_cmd->siop_table->t_msgout.addr = htole32(siop_cmd->dsa);
1154 1.8 bouyer memset(siop_cmd->siop_table->msg_out, 0, 8);
1155 1.7 bouyer siop_cmd->siop_table->msg_out[0] = MSG_IDENTIFY(lun, 1);
1156 1.14 bouyer #if 0
1157 1.14 bouyer siop_cmd->siop_table->msg_out[1] = MSG_SIMPLE_Q_TAG;
1158 1.14 bouyer siop_cmd->siop_table->msg_out[2] = 0;
1159 1.14 bouyer #endif
1160 1.7 bouyer if (sc->targets[target]->status == TARST_ASYNC) {
1161 1.7 bouyer if (sc->features & SF_BUS_WIDE) {
1162 1.7 bouyer sc->targets[target]->status = TARST_WIDE_NEG;
1163 1.7 bouyer siop_cmd->siop_table->msg_out[1] = MSG_EXTENDED;
1164 1.7 bouyer siop_cmd->siop_table->msg_out[2] = MSG_EXT_WDTR_LEN;
1165 1.7 bouyer siop_cmd->siop_table->msg_out[3] = MSG_EXT_WDTR;
1166 1.7 bouyer siop_cmd->siop_table->msg_out[4] =
1167 1.7 bouyer MSG_EXT_WDTR_BUS_16_BIT;
1168 1.8 bouyer siop_cmd->siop_table->t_msgout.count=
1169 1.8 bouyer htole32(MSG_EXT_WDTR_LEN + 2 + 1);
1170 1.7 bouyer } else {
1171 1.7 bouyer sc->targets[target]->status = TARST_SYNC_NEG;
1172 1.7 bouyer siop_cmd->siop_table->msg_out[1] = MSG_EXTENDED;
1173 1.7 bouyer siop_cmd->siop_table->msg_out[2] = MSG_EXT_SDTR_LEN;
1174 1.7 bouyer siop_cmd->siop_table->msg_out[3] = MSG_EXT_SDTR;
1175 1.7 bouyer siop_cmd->siop_table->msg_out[4] = sc->minsync;
1176 1.7 bouyer siop_cmd->siop_table->msg_out[5] = sc->maxoff;
1177 1.8 bouyer siop_cmd->siop_table->t_msgout.count=
1178 1.8 bouyer htole32(MSG_EXT_SDTR_LEN + 2 +1);
1179 1.7 bouyer }
1180 1.7 bouyer }
1181 1.2 bouyer siop_cmd->siop_table->status = htole32(0xff); /* set invalid status */
1182 1.1 bouyer
1183 1.1 bouyer /* load the DMA maps */
1184 1.1 bouyer error = bus_dmamap_load(sc->sc_dmat, siop_cmd->dmamap_cmd,
1185 1.1 bouyer xs->cmd, xs->cmdlen, NULL, BUS_DMA_NOWAIT);
1186 1.1 bouyer if (error) {
1187 1.1 bouyer printf("%s: unable to load cmd DMA map: %d",
1188 1.1 bouyer sc->sc_dev.dv_xname, error);
1189 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1190 1.1 bouyer return(TRY_AGAIN_LATER);
1191 1.1 bouyer }
1192 1.1 bouyer siop_cmd->siop_table->cmd.count =
1193 1.1 bouyer htole32(siop_cmd->dmamap_cmd->dm_segs[0].ds_len);
1194 1.1 bouyer siop_cmd->siop_table->cmd.addr =
1195 1.1 bouyer htole32(siop_cmd->dmamap_cmd->dm_segs[0].ds_addr);
1196 1.1 bouyer if (xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
1197 1.1 bouyer error = bus_dmamap_load(sc->sc_dmat, siop_cmd->dmamap_data,
1198 1.1 bouyer xs->data, xs->datalen, NULL, BUS_DMA_NOWAIT);
1199 1.1 bouyer if (error) {
1200 1.1 bouyer printf("%s: unable to load cmd DMA map: %d",
1201 1.1 bouyer sc->sc_dev.dv_xname, error);
1202 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1203 1.1 bouyer return(TRY_AGAIN_LATER);
1204 1.1 bouyer bus_dmamap_unload(sc->sc_dmat, siop_cmd->dmamap_cmd);
1205 1.1 bouyer }
1206 1.1 bouyer for (i = 0; i < siop_cmd->dmamap_data->dm_nsegs; i++) {
1207 1.1 bouyer siop_cmd->siop_table->data[i].count =
1208 1.1 bouyer htole32(siop_cmd->dmamap_data->dm_segs[i].ds_len);
1209 1.1 bouyer siop_cmd->siop_table->data[i].addr =
1210 1.1 bouyer htole32(siop_cmd->dmamap_data->dm_segs[i].ds_addr);
1211 1.1 bouyer }
1212 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_data, 0,
1213 1.1 bouyer siop_cmd->dmamap_data->dm_mapsize,
1214 1.1 bouyer (xs->xs_control & XS_CTL_DATA_IN) ?
1215 1.1 bouyer BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
1216 1.1 bouyer }
1217 1.1 bouyer bus_dmamap_sync(sc->sc_dmat, siop_cmd->dmamap_cmd, 0,
1218 1.1 bouyer siop_cmd->dmamap_cmd->dm_mapsize, BUS_DMASYNC_PREWRITE);
1219 1.2 bouyer siop_table_sync(siop_cmd, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1220 1.1 bouyer
1221 1.1 bouyer siop_cmd->status = CMDST_READY;
1222 1.1 bouyer s = splbio();
1223 1.7 bouyer TAILQ_INSERT_TAIL(&sc->targets[target]->active_list[lun],
1224 1.1 bouyer siop_cmd, next);
1225 1.2 bouyer siop_start(sc);
1226 1.14 bouyer if (xs->xs_control & XS_CTL_POLL) {
1227 1.14 bouyer /* poll for command completion */
1228 1.14 bouyer while ((xs->xs_status & XS_STS_DONE) == 0)
1229 1.14 bouyer siop_intr(sc);
1230 1.14 bouyer splx(s);
1231 1.14 bouyer return (COMPLETE);
1232 1.14 bouyer }
1233 1.1 bouyer splx(s);
1234 1.1 bouyer return (SUCCESSFULLY_QUEUED);
1235 1.1 bouyer }
1236 1.1 bouyer
1237 1.1 bouyer void
1238 1.1 bouyer siop_start(sc)
1239 1.1 bouyer struct siop_softc *sc;
1240 1.1 bouyer {
1241 1.1 bouyer struct siop_cmd *siop_cmd;
1242 1.2 bouyer u_int32_t *scr;
1243 1.2 bouyer u_int32_t dsa;
1244 1.1 bouyer int timeout;
1245 1.10 bouyer int target, lun, slot;
1246 1.2 bouyer int newcmd = 0;
1247 1.2 bouyer
1248 1.2 bouyer /*
1249 1.2 bouyer * first make sure to read valid data
1250 1.2 bouyer */
1251 1.17 bouyer siop_shed_sync(sc, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1252 1.1 bouyer
1253 1.2 bouyer /*
1254 1.10 bouyer * The queue management here is a bit tricky: the script always looks
1255 1.10 bouyer * at the slot from first to last, so if we always use the first
1256 1.10 bouyer * free slot commands can stay at the tail of the queue ~forever.
1257 1.10 bouyer * The algorithm used here is to restart from the head when we know
1258 1.10 bouyer * that the queue is empty, and only add commands after the last one.
1259 1.10 bouyer * When we're at the end of the queue wait for the script to clear it.
1260 1.10 bouyer * The best thing to do here would be to implement a circular queue,
1261 1.10 bouyer * but using only 53c720 features this can be "interesting".
1262 1.10 bouyer * A mid-way solution could be to implement 2 queues and swap orders.
1263 1.2 bouyer */
1264 1.10 bouyer slot = sc->sc_currshedslot;
1265 1.17 bouyer scr = &sc->sc_shed[(Ent_nextslot / 4) * slot];
1266 1.10 bouyer /*
1267 1.10 bouyer * if relative addr of first jump is not 0 the slot is free. As this is
1268 1.10 bouyer * the last used slot, all previous slots are free, we can restart
1269 1.10 bouyer * from 0.
1270 1.10 bouyer */
1271 1.10 bouyer if (scr[Ent_slot / 4 + 1] != 0) {
1272 1.10 bouyer slot = sc->sc_currshedslot = 0;
1273 1.10 bouyer } else {
1274 1.10 bouyer slot++;
1275 1.10 bouyer }
1276 1.10 bouyer
1277 1.7 bouyer for (target = 0; target <= sc->sc_link.scsipi_scsi.max_target;
1278 1.7 bouyer target++) {
1279 1.7 bouyer if (sc->targets[target] == NULL)
1280 1.2 bouyer continue;
1281 1.7 bouyer for (lun = 0; lun < 8; lun++) {
1282 1.7 bouyer siop_cmd =
1283 1.7 bouyer sc->targets[target]->active_list[lun].tqh_first;
1284 1.7 bouyer if (siop_cmd == NULL)
1285 1.7 bouyer continue;
1286 1.7 bouyer if (siop_cmd->status != CMDST_READY &&
1287 1.7 bouyer siop_cmd->status != CMDST_SENSE)
1288 1.2 bouyer continue;
1289 1.7 bouyer /* find a free sheduler slot and load it */
1290 1.10 bouyer for (; slot < sc->sc_nshedslots; slot++) {
1291 1.17 bouyer scr = &sc->sc_shed[(Ent_nextslot / 4) * slot];
1292 1.7 bouyer /*
1293 1.7 bouyer * if relative addr of first jump is 0 the
1294 1.7 bouyer * slot isn't free
1295 1.7 bouyer */
1296 1.7 bouyer if (scr[Ent_slot / 4 + 1] == 0)
1297 1.7 bouyer continue;
1298 1.2 bouyer #ifdef DEBUG_SHED
1299 1.8 bouyer printf("using slot %d for DSA 0x%lx\n", slot,
1300 1.8 bouyer (u_long)siop_cmd->dsa);
1301 1.2 bouyer #endif
1302 1.7 bouyer /* note that we started a new command */
1303 1.7 bouyer newcmd = 1;
1304 1.7 bouyer /* mark command as active */
1305 1.7 bouyer if (siop_cmd->status == CMDST_READY)
1306 1.7 bouyer siop_cmd->status = CMDST_ACTIVE;
1307 1.7 bouyer else if (siop_cmd->status == CMDST_SENSE)
1308 1.7 bouyer siop_cmd->status = CMDST_SENSE_ACTIVE;
1309 1.7 bouyer else
1310 1.7 bouyer panic("siop_start: bad status");
1311 1.7 bouyer /* patch script with DSA addr */
1312 1.7 bouyer dsa = siop_cmd->dsa;
1313 1.7 bouyer /*
1314 1.7 bouyer * 0x78000000 is a 'move data8 to reg'. data8
1315 1.7 bouyer * is the second octet, reg offset is the third.
1316 1.7 bouyer */
1317 1.7 bouyer scr[Ent_idsa0 / 4] =
1318 1.7 bouyer htole32(0x78100000 |
1319 1.7 bouyer ((dsa & 0x000000ff) << 8));
1320 1.7 bouyer scr[Ent_idsa1 / 4] =
1321 1.7 bouyer htole32(0x78110000 |
1322 1.7 bouyer ( dsa & 0x0000ff00 ));
1323 1.7 bouyer scr[Ent_idsa2 / 4] =
1324 1.7 bouyer htole32(0x78120000 |
1325 1.7 bouyer ((dsa & 0x00ff0000) >> 8));
1326 1.7 bouyer scr[Ent_idsa3 / 4] =
1327 1.7 bouyer htole32(0x78130000 |
1328 1.7 bouyer ((dsa & 0xff000000) >> 16));
1329 1.7 bouyer /* handle timeout */
1330 1.7 bouyer if (siop_cmd->status == CMDST_ACTIVE) {
1331 1.7 bouyer if ((siop_cmd->xs->xs_control &
1332 1.7 bouyer XS_CTL_POLL) == 0) {
1333 1.7 bouyer /* start exire timer */
1334 1.7 bouyer timeout =
1335 1.7 bouyer siop_cmd->xs->timeout *
1336 1.7 bouyer hz / 1000;
1337 1.7 bouyer if (timeout == 0)
1338 1.7 bouyer timeout = 1;
1339 1.7 bouyer callout_reset(
1340 1.7 bouyer &siop_cmd->xs->xs_callout,
1341 1.7 bouyer timeout, siop_timeout,
1342 1.7 bouyer siop_cmd);
1343 1.7 bouyer }
1344 1.2 bouyer }
1345 1.7 bouyer /*
1346 1.7 bouyer * Change jump offset so that this slot will be
1347 1.7 bouyer * handled
1348 1.7 bouyer */
1349 1.7 bouyer scr[Ent_slot / 4 + 1] = 0;
1350 1.7 bouyer break;
1351 1.7 bouyer }
1352 1.10 bouyer /* no more free slot, no need to continue */
1353 1.7 bouyer if (slot == sc->sc_nshedslots) {
1354 1.10 bouyer goto end;
1355 1.2 bouyer }
1356 1.7 bouyer sc->sc_currshedslot = slot;
1357 1.1 bouyer }
1358 1.1 bouyer }
1359 1.7 bouyer end:
1360 1.2 bouyer /* if nothing changed no need to flush cache and wakeup script */
1361 1.2 bouyer if (newcmd == 0)
1362 1.1 bouyer return;
1363 1.2 bouyer /* make sure SCRIPT processor will read valid data */
1364 1.17 bouyer siop_shed_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1365 1.2 bouyer /* Signal script it has some work to do */
1366 1.2 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_ISTAT, ISTAT_SIGP);
1367 1.2 bouyer /* and wait for IRQ */
1368 1.2 bouyer return;
1369 1.1 bouyer }
1370 1.1 bouyer
1371 1.1 bouyer void
1372 1.1 bouyer siop_timeout(v)
1373 1.1 bouyer void *v;
1374 1.1 bouyer {
1375 1.1 bouyer struct siop_cmd *siop_cmd = v;
1376 1.7 bouyer struct siop_softc *sc = siop_cmd->siop_target->siop_sc;
1377 1.1 bouyer int s;
1378 1.1 bouyer u_int8_t scntl1;
1379 1.1 bouyer
1380 1.1 bouyer scsi_print_addr(siop_cmd->xs->sc_link);
1381 1.1 bouyer printf("command timeout\n");
1382 1.1 bouyer
1383 1.1 bouyer s = splbio();
1384 1.1 bouyer /* reset the scsi bus */
1385 1.1 bouyer scntl1 = bus_space_read_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1);
1386 1.1 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1,
1387 1.1 bouyer scntl1 | SCNTL1_RST);
1388 1.1 bouyer /* minimum 25 us, more time won't hurt */
1389 1.1 bouyer delay(100);
1390 1.1 bouyer bus_space_write_1(sc->sc_rt, sc->sc_rh, SIOP_SCNTL1, scntl1);
1391 1.1 bouyer
1392 1.12 soren /* deactivate callout */
1393 1.1 bouyer callout_stop(&siop_cmd->xs->xs_callout);
1394 1.1 bouyer /* mark command has being timed out; siop_intr will handle it */
1395 1.1 bouyer /*
1396 1.1 bouyer * mark command has being timed out and just return;
1397 1.1 bouyer * the bus reset will generate an interrupt,
1398 1.1 bouyer * it will be handled in siop_intr()
1399 1.1 bouyer */
1400 1.1 bouyer siop_cmd->flags |= CMDFL_TIMEOUT;
1401 1.1 bouyer splx(s);
1402 1.1 bouyer return;
1403 1.1 bouyer
1404 1.1 bouyer }
1405 1.2 bouyer
1406 1.2 bouyer void
1407 1.2 bouyer siop_dump_script(sc)
1408 1.2 bouyer struct siop_softc *sc;
1409 1.2 bouyer {
1410 1.2 bouyer int i;
1411 1.17 bouyer siop_shed_sync(sc, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1412 1.16 bouyer for (i = 0; i < NBPG / 4; i += 2) {
1413 1.4 bouyer printf("0x%04x: 0x%08x 0x%08x", i * 4,
1414 1.4 bouyer le32toh(sc->sc_script[i]), le32toh(sc->sc_script[i+1]));
1415 1.4 bouyer if ((le32toh(sc->sc_script[i]) & 0xe0000000) == 0xc0000000) {
1416 1.2 bouyer i++;
1417 1.4 bouyer printf(" 0x%08x", le32toh(sc->sc_script[i+1]));
1418 1.2 bouyer }
1419 1.2 bouyer printf("\n");
1420 1.2 bouyer }
1421 1.16 bouyer }
1422 1.16 bouyer
1423 1.16 bouyer int
1424 1.16 bouyer siop_morecbd(sc)
1425 1.16 bouyer struct siop_softc *sc;
1426 1.16 bouyer {
1427 1.16 bouyer int error, i;
1428 1.16 bouyer bus_dma_segment_t seg;
1429 1.16 bouyer int rseg;
1430 1.16 bouyer struct siop_cbd *newcbd;
1431 1.16 bouyer
1432 1.16 bouyer /* allocate a new list head */
1433 1.16 bouyer newcbd = malloc(sizeof(struct siop_cbd), M_DEVBUF, M_NOWAIT);
1434 1.16 bouyer if (newcbd == NULL) {
1435 1.16 bouyer printf("%s: can't allocate memory for command descriptors "
1436 1.16 bouyer "head\n", sc->sc_dev.dv_xname);
1437 1.16 bouyer return ENOMEM;
1438 1.16 bouyer }
1439 1.16 bouyer
1440 1.16 bouyer /* allocate cmd list */
1441 1.16 bouyer newcbd->cmds =
1442 1.16 bouyer malloc(sizeof(struct siop_cmd) * SIOP_NCMDPB, M_DEVBUF, M_NOWAIT);
1443 1.16 bouyer if (newcbd->cmds == NULL) {
1444 1.16 bouyer printf("%s: can't allocate memory for command descriptors\n",
1445 1.16 bouyer sc->sc_dev.dv_xname);
1446 1.16 bouyer error = ENOMEM;
1447 1.16 bouyer goto bad3;
1448 1.16 bouyer }
1449 1.16 bouyer error = bus_dmamem_alloc(sc->sc_dmat, NBPG, NBPG, 0, &seg, 1, &rseg,
1450 1.16 bouyer BUS_DMA_NOWAIT);
1451 1.16 bouyer if (error) {
1452 1.16 bouyer printf("%s: unable to allocate cbd DMA memory, error = %d\n",
1453 1.16 bouyer sc->sc_dev.dv_xname, error);
1454 1.16 bouyer goto bad2;
1455 1.16 bouyer }
1456 1.16 bouyer error = bus_dmamem_map(sc->sc_dmat, &seg, rseg, NBPG,
1457 1.16 bouyer (caddr_t *)&newcbd->xfers, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
1458 1.16 bouyer if (error) {
1459 1.16 bouyer printf("%s: unable to map cbd DMA memory, error = %d\n",
1460 1.16 bouyer sc->sc_dev.dv_xname, error);
1461 1.16 bouyer goto bad2;
1462 1.16 bouyer }
1463 1.16 bouyer error = bus_dmamap_create(sc->sc_dmat, NBPG, 1, NBPG, 0,
1464 1.16 bouyer BUS_DMA_NOWAIT, &newcbd->xferdma);
1465 1.16 bouyer if (error) {
1466 1.16 bouyer printf("%s: unable to create cbd DMA map, error = %d\n",
1467 1.16 bouyer sc->sc_dev.dv_xname, error);
1468 1.16 bouyer goto bad1;
1469 1.16 bouyer }
1470 1.16 bouyer error = bus_dmamap_load(sc->sc_dmat, newcbd->xferdma, newcbd->xfers,
1471 1.16 bouyer NBPG, NULL, BUS_DMA_NOWAIT);
1472 1.16 bouyer if (error) {
1473 1.17 bouyer printf("%s: unable to load cbd DMA map, error = %d\n",
1474 1.16 bouyer sc->sc_dev.dv_xname, error);
1475 1.16 bouyer goto bad0;
1476 1.16 bouyer }
1477 1.16 bouyer
1478 1.16 bouyer for (i = 0; i < SIOP_NCMDPB; i++) {
1479 1.16 bouyer error = bus_dmamap_create(sc->sc_dmat, MAXPHYS, SIOP_NSG,
1480 1.16 bouyer MAXPHYS, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
1481 1.16 bouyer &newcbd->cmds[i].dmamap_data);
1482 1.16 bouyer if (error) {
1483 1.16 bouyer printf("%s: unable to create data DMA map for cbd: "
1484 1.16 bouyer "error %d\n",
1485 1.16 bouyer sc->sc_dev.dv_xname, error);
1486 1.16 bouyer goto bad0;
1487 1.16 bouyer }
1488 1.16 bouyer error = bus_dmamap_create(sc->sc_dmat,
1489 1.16 bouyer sizeof(struct scsipi_generic), 1,
1490 1.16 bouyer sizeof(struct scsipi_generic), 0,
1491 1.16 bouyer BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
1492 1.16 bouyer &newcbd->cmds[i].dmamap_cmd);
1493 1.16 bouyer if (error) {
1494 1.16 bouyer printf("%s: unable to create cmd DMA map for cbd %d\n",
1495 1.16 bouyer sc->sc_dev.dv_xname, error);
1496 1.16 bouyer goto bad0;
1497 1.16 bouyer }
1498 1.16 bouyer newcbd->cmds[i].siop_cbdp = newcbd;
1499 1.16 bouyer newcbd->cmds[i].siop_table = &newcbd->xfers[i];
1500 1.16 bouyer memset(newcbd->cmds[i].siop_table, 0, sizeof(struct siop_xfer));
1501 1.16 bouyer newcbd->cmds[i].dsa = newcbd->xferdma->dm_segs[0].ds_addr +
1502 1.16 bouyer i * sizeof(struct siop_xfer);
1503 1.16 bouyer newcbd->cmds[i].status = CMDST_FREE;
1504 1.16 bouyer newcbd->cmds[i].siop_table->t_msgout.count= htole32(1);
1505 1.16 bouyer newcbd->cmds[i].siop_table->t_msgout.addr =
1506 1.16 bouyer htole32(newcbd->cmds[i].dsa);
1507 1.16 bouyer newcbd->cmds[i].siop_table->t_msgin.count= htole32(1);
1508 1.16 bouyer newcbd->cmds[i].siop_table->t_msgin.addr =
1509 1.16 bouyer htole32(newcbd->cmds[i].dsa + 8);
1510 1.16 bouyer newcbd->cmds[i].siop_table->t_extmsgin.count= htole32(2);
1511 1.16 bouyer newcbd->cmds[i].siop_table->t_extmsgin.addr = htole32(
1512 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_msgin.addr) + 1);
1513 1.16 bouyer newcbd->cmds[i].siop_table->t_msgtag.count= htole32(2);
1514 1.16 bouyer newcbd->cmds[i].siop_table->t_msgtag.addr = htole32(
1515 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_msgin.addr) + 1);
1516 1.16 bouyer newcbd->cmds[i].siop_table->t_status.count= htole32(1);
1517 1.16 bouyer newcbd->cmds[i].siop_table->t_status.addr = htole32(
1518 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_msgin.addr) + 8);
1519 1.16 bouyer TAILQ_INSERT_TAIL(&sc->free_list, &newcbd->cmds[i], next);
1520 1.16 bouyer #ifdef DEBUG
1521 1.16 bouyer printf("tables[%d]: out=0x%x in=0x%x status=0x%x\n", i,
1522 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_msgin.addr),
1523 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_msgout.addr),
1524 1.16 bouyer le32toh(newcbd->cmds[i].siop_table->t_status.addr));
1525 1.16 bouyer #endif
1526 1.16 bouyer }
1527 1.16 bouyer TAILQ_INSERT_TAIL(&sc->cmds, newcbd, next);
1528 1.16 bouyer return 0;
1529 1.16 bouyer bad0:
1530 1.16 bouyer bus_dmamap_destroy(sc->sc_dmat, newcbd->xferdma);
1531 1.16 bouyer bad1:
1532 1.16 bouyer bus_dmamem_free(sc->sc_dmat, &seg, rseg);
1533 1.16 bouyer bad2:
1534 1.16 bouyer free(newcbd->cmds, M_DEVBUF);
1535 1.16 bouyer bad3:
1536 1.16 bouyer free(newcbd, M_DEVBUF);
1537 1.16 bouyer return error;
1538 1.2 bouyer }
1539 1.2 bouyer
1540 1.2 bouyer #ifdef SIOP_STATS
1541 1.2 bouyer void
1542 1.2 bouyer siop_printstats()
1543 1.2 bouyer {
1544 1.2 bouyer printf("siop_stat_intr %d\n", siop_stat_intr);
1545 1.2 bouyer printf("siop_stat_intr_shortxfer %d\n", siop_stat_intr_shortxfer);
1546 1.2 bouyer printf("siop_stat_intr_xferdisc %d\n", siop_stat_intr_xferdisc);
1547 1.2 bouyer printf("siop_stat_intr_sdp %d\n", siop_stat_intr_sdp);
1548 1.2 bouyer printf("siop_stat_intr_reselect %d\n", siop_stat_intr_reselect);
1549 1.2 bouyer printf("siop_stat_intr_done %d\n", siop_stat_intr_done);
1550 1.2 bouyer }
1551 1.2 bouyer #endif
1552