esiop.c revision 1.9 1 1.9 bouyer /* $NetBSD: esiop.c,v 1.9 2002/04/25 19:34:02 bouyer Exp $ */
2 1.1 bouyer
3 1.1 bouyer /*
4 1.1 bouyer * Copyright (c) 2002 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.7 bouyer * This product includes software developed by Manuel Bouyer.
17 1.1 bouyer * 4. The name of the author may not be used to endorse or promote products
18 1.1 bouyer * derived from this software without specific prior written permission.
19 1.1 bouyer *
20 1.1 bouyer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
21 1.1 bouyer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
22 1.1 bouyer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
23 1.1 bouyer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
24 1.1 bouyer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25 1.1 bouyer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
26 1.1 bouyer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
27 1.1 bouyer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
28 1.1 bouyer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29 1.1 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/cdefs.h>
36 1.9 bouyer __KERNEL_RCSID(0, "$NetBSD: esiop.c,v 1.9 2002/04/25 19:34:02 bouyer Exp $");
37 1.1 bouyer
38 1.1 bouyer #include <sys/param.h>
39 1.1 bouyer #include <sys/systm.h>
40 1.1 bouyer #include <sys/device.h>
41 1.1 bouyer #include <sys/malloc.h>
42 1.1 bouyer #include <sys/buf.h>
43 1.1 bouyer #include <sys/kernel.h>
44 1.1 bouyer
45 1.1 bouyer #include <uvm/uvm_extern.h>
46 1.1 bouyer
47 1.1 bouyer #include <machine/endian.h>
48 1.1 bouyer #include <machine/bus.h>
49 1.1 bouyer
50 1.1 bouyer #include <dev/microcode/siop/esiop.out>
51 1.1 bouyer
52 1.1 bouyer #include <dev/scsipi/scsi_all.h>
53 1.1 bouyer #include <dev/scsipi/scsi_message.h>
54 1.1 bouyer #include <dev/scsipi/scsipi_all.h>
55 1.1 bouyer
56 1.1 bouyer #include <dev/scsipi/scsiconf.h>
57 1.1 bouyer
58 1.1 bouyer #include <dev/ic/siopreg.h>
59 1.1 bouyer #include <dev/ic/siopvar_common.h>
60 1.1 bouyer #include <dev/ic/esiopvar.h>
61 1.1 bouyer
62 1.1 bouyer #include "opt_siop.h"
63 1.1 bouyer
64 1.1 bouyer #ifndef DEBUG
65 1.6 bouyer #undef DEBUG
66 1.1 bouyer #endif
67 1.1 bouyer #undef SIOP_DEBUG
68 1.1 bouyer #undef SIOP_DEBUG_DR
69 1.1 bouyer #undef SIOP_DEBUG_INTR
70 1.1 bouyer #undef SIOP_DEBUG_SCHED
71 1.1 bouyer #undef DUMP_SCRIPT
72 1.1 bouyer
73 1.1 bouyer #define SIOP_STATS
74 1.1 bouyer
75 1.1 bouyer #ifndef SIOP_DEFAULT_TARGET
76 1.1 bouyer #define SIOP_DEFAULT_TARGET 7
77 1.1 bouyer #endif
78 1.1 bouyer
79 1.1 bouyer /* number of cmd descriptors per block */
80 1.1 bouyer #define SIOP_NCMDPB (PAGE_SIZE / sizeof(struct esiop_xfer))
81 1.1 bouyer
82 1.1 bouyer void esiop_reset __P((struct esiop_softc *));
83 1.1 bouyer void esiop_checkdone __P((struct esiop_softc *));
84 1.1 bouyer void esiop_handle_reset __P((struct esiop_softc *));
85 1.1 bouyer void esiop_scsicmd_end __P((struct esiop_cmd *));
86 1.1 bouyer void esiop_unqueue __P((struct esiop_softc *, int, int));
87 1.2 bouyer int esiop_handle_qtag_reject __P((struct esiop_cmd *));
88 1.1 bouyer static void esiop_start __P((struct esiop_softc *, struct esiop_cmd *));
89 1.1 bouyer void esiop_timeout __P((void *));
90 1.1 bouyer int esiop_scsicmd __P((struct scsipi_xfer *));
91 1.1 bouyer void esiop_scsipi_request __P((struct scsipi_channel *,
92 1.1 bouyer scsipi_adapter_req_t, void *));
93 1.1 bouyer void esiop_dump_script __P((struct esiop_softc *));
94 1.1 bouyer void esiop_morecbd __P((struct esiop_softc *));
95 1.2 bouyer void esiop_moretagtbl __P((struct esiop_softc *));
96 1.1 bouyer void siop_add_reselsw __P((struct esiop_softc *, int));
97 1.1 bouyer void esiop_target_register __P((struct esiop_softc *, u_int32_t));
98 1.1 bouyer
99 1.9 bouyer void esiop_update_scntl3 __P((struct esiop_softc *,
100 1.9 bouyer struct siop_common_target *));
101 1.1 bouyer
102 1.1 bouyer #ifdef SIOP_STATS
103 1.1 bouyer static int esiop_stat_intr = 0;
104 1.1 bouyer static int esiop_stat_intr_shortxfer = 0;
105 1.1 bouyer static int esiop_stat_intr_sdp = 0;
106 1.1 bouyer static int esiop_stat_intr_done = 0;
107 1.1 bouyer static int esiop_stat_intr_xferdisc = 0;
108 1.1 bouyer static int esiop_stat_intr_lunresel = 0;
109 1.1 bouyer static int esiop_stat_intr_qfull = 0;
110 1.1 bouyer void esiop_printstats __P((void));
111 1.1 bouyer #define INCSTAT(x) x++
112 1.1 bouyer #else
113 1.1 bouyer #define INCSTAT(x)
114 1.1 bouyer #endif
115 1.1 bouyer
116 1.1 bouyer static __inline__ void esiop_script_sync __P((struct esiop_softc *, int));
117 1.1 bouyer static __inline__ void
118 1.1 bouyer esiop_script_sync(sc, ops)
119 1.1 bouyer struct esiop_softc *sc;
120 1.1 bouyer int ops;
121 1.1 bouyer {
122 1.1 bouyer if ((sc->sc_c.features & SF_CHIP_RAM) == 0)
123 1.1 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat, sc->sc_c.sc_scriptdma, 0,
124 1.1 bouyer PAGE_SIZE, ops);
125 1.1 bouyer }
126 1.1 bouyer
127 1.1 bouyer static __inline__ u_int32_t esiop_script_read __P((struct esiop_softc *, u_int));
128 1.1 bouyer static __inline__ u_int32_t
129 1.1 bouyer esiop_script_read(sc, offset)
130 1.1 bouyer struct esiop_softc *sc;
131 1.1 bouyer u_int offset;
132 1.1 bouyer {
133 1.1 bouyer if (sc->sc_c.features & SF_CHIP_RAM) {
134 1.1 bouyer return bus_space_read_4(sc->sc_c.sc_ramt, sc->sc_c.sc_ramh,
135 1.1 bouyer offset * 4);
136 1.1 bouyer } else {
137 1.1 bouyer return le32toh(sc->sc_c.sc_script[offset]);
138 1.1 bouyer }
139 1.1 bouyer }
140 1.1 bouyer
141 1.1 bouyer static __inline__ void esiop_script_write __P((struct esiop_softc *, u_int,
142 1.1 bouyer u_int32_t));
143 1.1 bouyer static __inline__ void
144 1.1 bouyer esiop_script_write(sc, offset, val)
145 1.1 bouyer struct esiop_softc *sc;
146 1.1 bouyer u_int offset;
147 1.1 bouyer u_int32_t val;
148 1.1 bouyer {
149 1.1 bouyer if (sc->sc_c.features & SF_CHIP_RAM) {
150 1.1 bouyer bus_space_write_4(sc->sc_c.sc_ramt, sc->sc_c.sc_ramh,
151 1.1 bouyer offset * 4, val);
152 1.1 bouyer } else {
153 1.1 bouyer sc->sc_c.sc_script[offset] = htole32(val);
154 1.1 bouyer }
155 1.1 bouyer }
156 1.1 bouyer
157 1.1 bouyer void
158 1.1 bouyer esiop_attach(sc)
159 1.1 bouyer struct esiop_softc *sc;
160 1.1 bouyer {
161 1.6 bouyer if (siop_common_attach(&sc->sc_c) != 0 )
162 1.6 bouyer return;
163 1.1 bouyer
164 1.1 bouyer TAILQ_INIT(&sc->free_list);
165 1.1 bouyer TAILQ_INIT(&sc->cmds);
166 1.2 bouyer TAILQ_INIT(&sc->free_tagtbl);
167 1.2 bouyer TAILQ_INIT(&sc->tag_tblblk);
168 1.1 bouyer sc->sc_currschedslot = 0;
169 1.1 bouyer #ifdef SIOP_DEBUG
170 1.1 bouyer printf("%s: script size = %d, PHY addr=0x%x, VIRT=%p\n",
171 1.1 bouyer sc->sc_c.sc_dev.dv_xname, (int)sizeof(esiop_script),
172 1.1 bouyer (u_int32_t)sc->sc_c.sc_scriptaddr, sc->sc_c.sc_script);
173 1.1 bouyer #endif
174 1.1 bouyer
175 1.6 bouyer sc->sc_c.sc_adapt.adapt_max_periph = ESIOP_NTAG;
176 1.1 bouyer sc->sc_c.sc_adapt.adapt_request = esiop_scsipi_request;
177 1.1 bouyer
178 1.1 bouyer /* Do a bus reset, so that devices fall back to narrow/async */
179 1.1 bouyer siop_resetbus(&sc->sc_c);
180 1.1 bouyer /*
181 1.1 bouyer * siop_reset() will reset the chip, thus clearing pending interrupts
182 1.1 bouyer */
183 1.1 bouyer esiop_reset(sc);
184 1.1 bouyer #ifdef DUMP_SCRIPT
185 1.1 bouyer esiop_dump_script(sc);
186 1.1 bouyer #endif
187 1.1 bouyer
188 1.1 bouyer config_found((struct device*)sc, &sc->sc_c.sc_chan, scsiprint);
189 1.1 bouyer }
190 1.1 bouyer
191 1.1 bouyer void
192 1.1 bouyer esiop_reset(sc)
193 1.1 bouyer struct esiop_softc *sc;
194 1.1 bouyer {
195 1.1 bouyer int i, j;
196 1.1 bouyer u_int32_t addr;
197 1.1 bouyer u_int32_t msgin_addr;
198 1.1 bouyer
199 1.1 bouyer siop_common_reset(&sc->sc_c);
200 1.1 bouyer
201 1.1 bouyer /*
202 1.1 bouyer * we copy the script at the beggining of RAM. Then there is 8 bytes
203 1.1 bouyer * for messages in.
204 1.1 bouyer */
205 1.1 bouyer sc->sc_free_offset = sizeof(esiop_script) / sizeof(esiop_script[0]);
206 1.1 bouyer msgin_addr =
207 1.1 bouyer sc->sc_free_offset * sizeof(u_int32_t) + sc->sc_c.sc_scriptaddr;
208 1.1 bouyer sc->sc_free_offset += 2;
209 1.1 bouyer /* then we have the scheduler ring */
210 1.1 bouyer sc->sc_shedoffset = sc->sc_free_offset;
211 1.8 bouyer sc->sc_free_offset += A_ncmd_slots * CMD_SLOTSIZE;
212 1.1 bouyer /* then the targets DSA table */
213 1.1 bouyer sc->sc_target_table_offset = sc->sc_free_offset;
214 1.1 bouyer sc->sc_free_offset += sc->sc_c.sc_chan.chan_ntargets;
215 1.1 bouyer /* copy and patch the script */
216 1.1 bouyer if (sc->sc_c.features & SF_CHIP_RAM) {
217 1.1 bouyer bus_space_write_region_4(sc->sc_c.sc_ramt, sc->sc_c.sc_ramh, 0,
218 1.1 bouyer esiop_script,
219 1.1 bouyer sizeof(esiop_script) / sizeof(esiop_script[0]));
220 1.1 bouyer for (j = 0; j <
221 1.1 bouyer (sizeof(E_tlq_offset_Used) / sizeof(E_tlq_offset_Used[0]));
222 1.1 bouyer j++) {
223 1.1 bouyer bus_space_write_4(sc->sc_c.sc_ramt, sc->sc_c.sc_ramh,
224 1.1 bouyer E_tlq_offset_Used[j] * 4,
225 1.1 bouyer sizeof(struct siop_common_xfer));
226 1.1 bouyer }
227 1.1 bouyer for (j = 0; j <
228 1.1 bouyer (sizeof(E_abs_msgin2_Used) / sizeof(E_abs_msgin2_Used[0]));
229 1.1 bouyer j++) {
230 1.1 bouyer bus_space_write_4(sc->sc_c.sc_ramt, sc->sc_c.sc_ramh,
231 1.1 bouyer E_abs_msgin2_Used[j] * 4, msgin_addr);
232 1.1 bouyer }
233 1.1 bouyer
234 1.4 bouyer if (sc->sc_c.features & SF_CHIP_LED0) {
235 1.4 bouyer bus_space_write_region_4(sc->sc_c.sc_ramt,
236 1.4 bouyer sc->sc_c.sc_ramh,
237 1.4 bouyer Ent_led_on1, esiop_led_on,
238 1.4 bouyer sizeof(esiop_led_on) / sizeof(esiop_led_on[0]));
239 1.4 bouyer bus_space_write_region_4(sc->sc_c.sc_ramt,
240 1.4 bouyer sc->sc_c.sc_ramh,
241 1.4 bouyer Ent_led_on2, esiop_led_on,
242 1.4 bouyer sizeof(esiop_led_on) / sizeof(esiop_led_on[0]));
243 1.4 bouyer bus_space_write_region_4(sc->sc_c.sc_ramt,
244 1.4 bouyer sc->sc_c.sc_ramh,
245 1.4 bouyer Ent_led_off, esiop_led_off,
246 1.4 bouyer sizeof(esiop_led_off) / sizeof(esiop_led_off[0]));
247 1.4 bouyer }
248 1.1 bouyer } else {
249 1.1 bouyer for (j = 0;
250 1.1 bouyer j < (sizeof(esiop_script) / sizeof(esiop_script[0])); j++) {
251 1.1 bouyer sc->sc_c.sc_script[j] = htole32(esiop_script[j]);
252 1.1 bouyer }
253 1.1 bouyer for (j = 0; j <
254 1.1 bouyer (sizeof(E_tlq_offset_Used) / sizeof(E_tlq_offset_Used[0]));
255 1.1 bouyer j++) {
256 1.1 bouyer sc->sc_c.sc_script[E_tlq_offset_Used[j]] =
257 1.1 bouyer htole32(sizeof(struct siop_common_xfer));
258 1.1 bouyer }
259 1.1 bouyer for (j = 0; j <
260 1.1 bouyer (sizeof(E_abs_msgin2_Used) / sizeof(E_abs_msgin2_Used[0]));
261 1.1 bouyer j++) {
262 1.1 bouyer sc->sc_c.sc_script[E_abs_msgin2_Used[j]] =
263 1.1 bouyer htole32(msgin_addr);
264 1.1 bouyer }
265 1.1 bouyer
266 1.4 bouyer if (sc->sc_c.features & SF_CHIP_LED0) {
267 1.4 bouyer for (j = 0; j < (sizeof(esiop_led_on) /
268 1.4 bouyer sizeof(esiop_led_on[0])); j++)
269 1.4 bouyer sc->sc_c.sc_script[
270 1.4 bouyer Ent_led_on1 / sizeof(esiop_led_on[0]) + j
271 1.4 bouyer ] = htole32(esiop_led_on[j]);
272 1.4 bouyer for (j = 0; j < (sizeof(esiop_led_on) /
273 1.4 bouyer sizeof(esiop_led_on[0])); j++)
274 1.4 bouyer sc->sc_c.sc_script[
275 1.4 bouyer Ent_led_on2 / sizeof(esiop_led_on[0]) + j
276 1.4 bouyer ] = htole32(esiop_led_on[j]);
277 1.4 bouyer for (j = 0; j < (sizeof(esiop_led_off) /
278 1.4 bouyer sizeof(esiop_led_off[0])); j++)
279 1.4 bouyer sc->sc_c.sc_script[
280 1.4 bouyer Ent_led_off / sizeof(esiop_led_off[0]) + j
281 1.4 bouyer ] = htole32(esiop_led_off[j]);
282 1.4 bouyer }
283 1.1 bouyer }
284 1.1 bouyer /* get base of scheduler ring */
285 1.1 bouyer addr = sc->sc_c.sc_scriptaddr + sc->sc_shedoffset * sizeof(u_int32_t);
286 1.1 bouyer /* init scheduler */
287 1.1 bouyer for (i = 0; i < A_ncmd_slots; i++) {
288 1.8 bouyer esiop_script_write(sc,
289 1.8 bouyer sc->sc_shedoffset + i * CMD_SLOTSIZE, A_f_cmd_free);
290 1.1 bouyer }
291 1.1 bouyer sc->sc_currschedslot = 0;
292 1.1 bouyer bus_space_write_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_SCRATCHE, 0);
293 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_SCRATCHD, addr);
294 1.1 bouyer /*
295 1.1 bouyer * 0x78000000 is a 'move data8 to reg'. data8 is the second
296 1.1 bouyer * octet, reg offset is the third.
297 1.1 bouyer */
298 1.1 bouyer esiop_script_write(sc, Ent_cmdr0 / 4,
299 1.1 bouyer 0x78640000 | ((addr & 0x000000ff) << 8));
300 1.1 bouyer esiop_script_write(sc, Ent_cmdr1 / 4,
301 1.1 bouyer 0x78650000 | ((addr & 0x0000ff00) ));
302 1.1 bouyer esiop_script_write(sc, Ent_cmdr2 / 4,
303 1.1 bouyer 0x78660000 | ((addr & 0x00ff0000) >> 8));
304 1.1 bouyer esiop_script_write(sc, Ent_cmdr3 / 4,
305 1.1 bouyer 0x78670000 | ((addr & 0xff000000) >> 16));
306 1.1 bouyer /* set flags */
307 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_SCRATCHC, 0);
308 1.1 bouyer /* write pointer of base of target DSA table */
309 1.1 bouyer addr = (sc->sc_target_table_offset * sizeof(u_int32_t)) +
310 1.1 bouyer sc->sc_c.sc_scriptaddr;
311 1.1 bouyer esiop_script_write(sc, (Ent_load_targtable / 4) + 0,
312 1.1 bouyer esiop_script_read(sc,(Ent_load_targtable / 4) + 0) |
313 1.1 bouyer ((addr & 0x000000ff) << 8));
314 1.1 bouyer esiop_script_write(sc, (Ent_load_targtable / 4) + 2,
315 1.1 bouyer esiop_script_read(sc,(Ent_load_targtable / 4) + 2) |
316 1.1 bouyer ((addr & 0x0000ff00) ));
317 1.1 bouyer esiop_script_write(sc, (Ent_load_targtable / 4) + 4,
318 1.1 bouyer esiop_script_read(sc,(Ent_load_targtable / 4) + 4) |
319 1.1 bouyer ((addr & 0x00ff0000) >> 8));
320 1.1 bouyer esiop_script_write(sc, (Ent_load_targtable / 4) + 6,
321 1.1 bouyer esiop_script_read(sc,(Ent_load_targtable / 4) + 6) |
322 1.1 bouyer ((addr & 0xff000000) >> 16));
323 1.1 bouyer #ifdef SIOP_DEBUG
324 1.1 bouyer printf("%s: target table offset %d free offset %d\n",
325 1.1 bouyer sc->sc_c.sc_dev.dv_xname, sc->sc_target_table_offset,
326 1.1 bouyer sc->sc_free_offset);
327 1.1 bouyer #endif
328 1.1 bouyer
329 1.1 bouyer /* register existing targets */
330 1.1 bouyer for (i = 0; i < sc->sc_c.sc_chan.chan_ntargets; i++) {
331 1.1 bouyer if (sc->sc_c.targets[i])
332 1.1 bouyer esiop_target_register(sc, i);
333 1.1 bouyer }
334 1.1 bouyer /* start script */
335 1.1 bouyer if ((sc->sc_c.features & SF_CHIP_RAM) == 0) {
336 1.1 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat, sc->sc_c.sc_scriptdma, 0,
337 1.1 bouyer PAGE_SIZE, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
338 1.1 bouyer }
339 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSP,
340 1.1 bouyer sc->sc_c.sc_scriptaddr + Ent_reselect);
341 1.1 bouyer }
342 1.1 bouyer
343 1.1 bouyer #if 0
344 1.1 bouyer #define CALL_SCRIPT(ent) do {\
345 1.1 bouyer printf ("start script DSA 0x%lx DSP 0x%lx\n", \
346 1.1 bouyer esiop_cmd->cmd_c.dsa, \
347 1.1 bouyer sc->sc_c.sc_scriptaddr + ent); \
348 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSP, sc->sc_c.sc_scriptaddr + ent); \
349 1.1 bouyer } while (0)
350 1.1 bouyer #else
351 1.1 bouyer #define CALL_SCRIPT(ent) do {\
352 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSP, sc->sc_c.sc_scriptaddr + ent); \
353 1.1 bouyer } while (0)
354 1.1 bouyer #endif
355 1.1 bouyer
356 1.1 bouyer int
357 1.1 bouyer esiop_intr(v)
358 1.1 bouyer void *v;
359 1.1 bouyer {
360 1.1 bouyer struct esiop_softc *sc = v;
361 1.1 bouyer struct esiop_target *esiop_target;
362 1.1 bouyer struct esiop_cmd *esiop_cmd;
363 1.1 bouyer struct esiop_lun *esiop_lun;
364 1.1 bouyer struct scsipi_xfer *xs;
365 1.1 bouyer int istat, sist, sstat1, dstat;
366 1.1 bouyer u_int32_t irqcode;
367 1.1 bouyer int need_reset = 0;
368 1.1 bouyer int offset, target, lun, tag;
369 1.1 bouyer u_int32_t tflags;
370 1.3 bouyer u_int32_t addr;
371 1.1 bouyer int freetarget = 0;
372 1.1 bouyer int slot;
373 1.1 bouyer int retval = 0;
374 1.1 bouyer
375 1.1 bouyer again:
376 1.1 bouyer istat = bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_ISTAT);
377 1.1 bouyer if ((istat & (ISTAT_INTF | ISTAT_DIP | ISTAT_SIP)) == 0) {
378 1.1 bouyer return retval;
379 1.1 bouyer }
380 1.1 bouyer retval = 1;
381 1.1 bouyer INCSTAT(esiop_stat_intr);
382 1.1 bouyer if (istat & ISTAT_INTF) {
383 1.1 bouyer bus_space_write_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
384 1.1 bouyer SIOP_ISTAT, ISTAT_INTF);
385 1.1 bouyer esiop_checkdone(sc);
386 1.9 bouyer if (sc->sc_flags & SCF_CHAN_NOSLOT) {
387 1.9 bouyer /*
388 1.9 bouyer * at last one command terminated,
389 1.9 bouyer * so we should have free slots now
390 1.9 bouyer */
391 1.9 bouyer sc->sc_flags &= ~SCF_CHAN_NOSLOT;
392 1.9 bouyer scsipi_channel_thaw(&sc->sc_c.sc_chan, 1);
393 1.9 bouyer }
394 1.1 bouyer goto again;
395 1.1 bouyer }
396 1.9 bouyer
397 1.9 bouyer if ((istat &(ISTAT_DIP | ISTAT_SIP | ISTAT_ABRT)) ==
398 1.9 bouyer (ISTAT_DIP | ISTAT_ABRT)) {
399 1.9 bouyer bus_space_write_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
400 1.9 bouyer SIOP_ISTAT, 0);
401 1.9 bouyer }
402 1.9 bouyer
403 1.1 bouyer /* get CMD from T/L/Q */
404 1.1 bouyer tflags = bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
405 1.1 bouyer SIOP_SCRATCHC);
406 1.1 bouyer #ifdef SIOP_DEBUG_INTR
407 1.1 bouyer printf("interrupt, istat=0x%x tflags=0x%x "
408 1.1 bouyer "DSA=0x%x DSP=0x%lx\n", istat, tflags,
409 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSA),
410 1.1 bouyer (u_long)(bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
411 1.1 bouyer SIOP_DSP) -
412 1.1 bouyer sc->sc_c.sc_scriptaddr));
413 1.1 bouyer #endif
414 1.1 bouyer target = (tflags & A_f_c_target) ? ((tflags >> 8) & 0xff) : -1;
415 1.1 bouyer if (target > sc->sc_c.sc_chan.chan_ntargets) target = -1;
416 1.1 bouyer lun = (tflags & A_f_c_lun) ? ((tflags >> 16) & 0xff) : -1;
417 1.1 bouyer if (lun > sc->sc_c.sc_chan.chan_nluns) lun = -1;
418 1.1 bouyer tag = (tflags & A_f_c_tag) ? ((tflags >> 24) & 0xff) : -1;
419 1.1 bouyer
420 1.1 bouyer if (target >= 0 && lun >= 0) {
421 1.1 bouyer esiop_target = (struct esiop_target *)sc->sc_c.targets[target];
422 1.1 bouyer if (esiop_target == NULL) {
423 1.1 bouyer printf("esiop_target (target %d) not valid\n", target);
424 1.1 bouyer goto none;
425 1.1 bouyer }
426 1.1 bouyer esiop_lun = esiop_target->esiop_lun[lun];
427 1.1 bouyer if (esiop_lun == NULL) {
428 1.1 bouyer printf("esiop_lun (target %d lun %d) not valid\n",
429 1.1 bouyer target, lun);
430 1.1 bouyer goto none;
431 1.1 bouyer }
432 1.2 bouyer esiop_cmd =
433 1.2 bouyer (tag >= 0) ? esiop_lun->tactive[tag] : esiop_lun->active;
434 1.1 bouyer if (esiop_cmd == NULL) {
435 1.2 bouyer printf("esiop_cmd (target %d lun %d tag %d) not valid\n",
436 1.2 bouyer target, lun, tag);
437 1.1 bouyer goto none;
438 1.1 bouyer }
439 1.1 bouyer xs = esiop_cmd->cmd_c.xs;
440 1.1 bouyer #ifdef DIAGNOSTIC
441 1.1 bouyer if (esiop_cmd->cmd_c.status != CMDST_ACTIVE) {
442 1.1 bouyer printf("esiop_cmd (target %d lun %d) "
443 1.1 bouyer "not active (%d)\n", target, lun,
444 1.1 bouyer esiop_cmd->cmd_c.status);
445 1.1 bouyer goto none;
446 1.1 bouyer }
447 1.1 bouyer #endif
448 1.3 bouyer esiop_table_sync(esiop_cmd,
449 1.3 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
450 1.1 bouyer } else {
451 1.1 bouyer none:
452 1.1 bouyer xs = NULL;
453 1.1 bouyer esiop_target = NULL;
454 1.1 bouyer esiop_lun = NULL;
455 1.1 bouyer esiop_cmd = NULL;
456 1.1 bouyer }
457 1.1 bouyer if (istat & ISTAT_DIP) {
458 1.1 bouyer dstat = bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
459 1.1 bouyer SIOP_DSTAT);
460 1.1 bouyer if (dstat & DSTAT_SSI) {
461 1.1 bouyer printf("single step dsp 0x%08x dsa 0x08%x\n",
462 1.1 bouyer (int)(bus_space_read_4(sc->sc_c.sc_rt,
463 1.1 bouyer sc->sc_c.sc_rh, SIOP_DSP) -
464 1.1 bouyer sc->sc_c.sc_scriptaddr),
465 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
466 1.1 bouyer SIOP_DSA));
467 1.1 bouyer if ((dstat & ~(DSTAT_DFE | DSTAT_SSI)) == 0 &&
468 1.1 bouyer (istat & ISTAT_SIP) == 0) {
469 1.1 bouyer bus_space_write_1(sc->sc_c.sc_rt,
470 1.1 bouyer sc->sc_c.sc_rh, SIOP_DCNTL,
471 1.1 bouyer bus_space_read_1(sc->sc_c.sc_rt,
472 1.1 bouyer sc->sc_c.sc_rh, SIOP_DCNTL) | DCNTL_STD);
473 1.1 bouyer }
474 1.1 bouyer return 1;
475 1.1 bouyer }
476 1.1 bouyer if (dstat & ~(DSTAT_SIR | DSTAT_DFE | DSTAT_SSI)) {
477 1.1 bouyer printf("%s: DMA IRQ:", sc->sc_c.sc_dev.dv_xname);
478 1.1 bouyer if (dstat & DSTAT_IID)
479 1.1 bouyer printf(" Illegal instruction");
480 1.1 bouyer if (dstat & DSTAT_ABRT)
481 1.1 bouyer printf(" abort");
482 1.1 bouyer if (dstat & DSTAT_BF)
483 1.1 bouyer printf(" bus fault");
484 1.1 bouyer if (dstat & DSTAT_MDPE)
485 1.1 bouyer printf(" parity");
486 1.1 bouyer if (dstat & DSTAT_DFE)
487 1.1 bouyer printf(" dma fifo empty");
488 1.9 bouyer else
489 1.9 bouyer siop_clearfifo(&sc->sc_c);
490 1.1 bouyer printf(", DSP=0x%x DSA=0x%x: ",
491 1.1 bouyer (int)(bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
492 1.1 bouyer SIOP_DSP) - sc->sc_c.sc_scriptaddr),
493 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSA));
494 1.1 bouyer if (esiop_cmd)
495 1.9 bouyer printf("T/L/Q=%d/%d/%d last msg_in=0x%x status=0x%x\n",
496 1.9 bouyer target, lun, tag, esiop_cmd->cmd_tables->msg_in[0],
497 1.1 bouyer le32toh(esiop_cmd->cmd_tables->status));
498 1.1 bouyer else
499 1.1 bouyer printf(" current T/L/Q invalid\n");
500 1.1 bouyer need_reset = 1;
501 1.1 bouyer }
502 1.1 bouyer }
503 1.1 bouyer if (istat & ISTAT_SIP) {
504 1.1 bouyer if (istat & ISTAT_DIP)
505 1.1 bouyer delay(10);
506 1.1 bouyer /*
507 1.1 bouyer * Can't read sist0 & sist1 independantly, or we have to
508 1.1 bouyer * insert delay
509 1.1 bouyer */
510 1.1 bouyer sist = bus_space_read_2(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
511 1.1 bouyer SIOP_SIST0);
512 1.1 bouyer sstat1 = bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
513 1.1 bouyer SIOP_SSTAT1);
514 1.1 bouyer #ifdef SIOP_DEBUG_INTR
515 1.1 bouyer printf("scsi interrupt, sist=0x%x sstat1=0x%x "
516 1.1 bouyer "DSA=0x%x DSP=0x%lx\n", sist, sstat1,
517 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSA),
518 1.1 bouyer (u_long)(bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
519 1.1 bouyer SIOP_DSP) -
520 1.1 bouyer sc->sc_c.sc_scriptaddr));
521 1.1 bouyer #endif
522 1.1 bouyer if (sist & SIST0_RST) {
523 1.1 bouyer esiop_handle_reset(sc);
524 1.1 bouyer /* no table to flush here */
525 1.1 bouyer return 1;
526 1.1 bouyer }
527 1.1 bouyer if (sist & SIST0_SGE) {
528 1.1 bouyer if (esiop_cmd)
529 1.1 bouyer scsipi_printaddr(xs->xs_periph);
530 1.1 bouyer else
531 1.1 bouyer printf("%s:", sc->sc_c.sc_dev.dv_xname);
532 1.1 bouyer printf("scsi gross error\n");
533 1.6 bouyer if (esiop_target)
534 1.6 bouyer esiop_target->target_c.flags &= ~TARF_DT;
535 1.1 bouyer goto reset;
536 1.1 bouyer }
537 1.1 bouyer if ((sist & SIST0_MA) && need_reset == 0) {
538 1.1 bouyer if (esiop_cmd) {
539 1.1 bouyer int scratchc0;
540 1.1 bouyer dstat = bus_space_read_1(sc->sc_c.sc_rt,
541 1.1 bouyer sc->sc_c.sc_rh, SIOP_DSTAT);
542 1.1 bouyer /*
543 1.1 bouyer * first restore DSA, in case we were in a S/G
544 1.1 bouyer * operation.
545 1.1 bouyer */
546 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt,
547 1.1 bouyer sc->sc_c.sc_rh,
548 1.1 bouyer SIOP_DSA, esiop_cmd->cmd_c.dsa);
549 1.1 bouyer scratchc0 = bus_space_read_1(sc->sc_c.sc_rt,
550 1.1 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHC);
551 1.1 bouyer switch (sstat1 & SSTAT1_PHASE_MASK) {
552 1.1 bouyer case SSTAT1_PHASE_STATUS:
553 1.1 bouyer /*
554 1.1 bouyer * previous phase may be aborted for any reason
555 1.1 bouyer * ( for example, the target has less data to
556 1.1 bouyer * transfer than requested). Just go to status
557 1.1 bouyer * and the command should terminate.
558 1.1 bouyer */
559 1.1 bouyer INCSTAT(esiop_stat_intr_shortxfer);
560 1.1 bouyer if ((dstat & DSTAT_DFE) == 0)
561 1.1 bouyer siop_clearfifo(&sc->sc_c);
562 1.1 bouyer /* no table to flush here */
563 1.1 bouyer CALL_SCRIPT(Ent_status);
564 1.1 bouyer return 1;
565 1.1 bouyer case SSTAT1_PHASE_MSGIN:
566 1.1 bouyer /*
567 1.1 bouyer * target may be ready to disconnect
568 1.1 bouyer * Save data pointers just in case.
569 1.1 bouyer */
570 1.1 bouyer INCSTAT(esiop_stat_intr_xferdisc);
571 1.1 bouyer if (scratchc0 & A_f_c_data)
572 1.1 bouyer siop_sdp(&esiop_cmd->cmd_c);
573 1.1 bouyer else if ((dstat & DSTAT_DFE) == 0)
574 1.1 bouyer siop_clearfifo(&sc->sc_c);
575 1.1 bouyer bus_space_write_1(sc->sc_c.sc_rt,
576 1.1 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHC,
577 1.1 bouyer scratchc0 & ~A_f_c_data);
578 1.1 bouyer esiop_table_sync(esiop_cmd,
579 1.1 bouyer BUS_DMASYNC_PREREAD |
580 1.1 bouyer BUS_DMASYNC_PREWRITE);
581 1.1 bouyer CALL_SCRIPT(Ent_msgin);
582 1.1 bouyer return 1;
583 1.1 bouyer }
584 1.1 bouyer printf("%s: unexpected phase mismatch %d\n",
585 1.1 bouyer sc->sc_c.sc_dev.dv_xname,
586 1.1 bouyer sstat1 & SSTAT1_PHASE_MASK);
587 1.1 bouyer } else {
588 1.1 bouyer printf("%s: phase mismatch without command\n",
589 1.1 bouyer sc->sc_c.sc_dev.dv_xname);
590 1.1 bouyer }
591 1.1 bouyer need_reset = 1;
592 1.1 bouyer }
593 1.1 bouyer if (sist & SIST0_PAR) {
594 1.1 bouyer /* parity error, reset */
595 1.1 bouyer if (esiop_cmd)
596 1.1 bouyer scsipi_printaddr(xs->xs_periph);
597 1.1 bouyer else
598 1.1 bouyer printf("%s:", sc->sc_c.sc_dev.dv_xname);
599 1.1 bouyer printf("parity error\n");
600 1.6 bouyer if (esiop_target)
601 1.6 bouyer esiop_target->target_c.flags &= ~TARF_DT;
602 1.1 bouyer goto reset;
603 1.1 bouyer }
604 1.1 bouyer if ((sist & (SIST1_STO << 8)) && need_reset == 0) {
605 1.1 bouyer /*
606 1.9 bouyer * selection time out, assume there's no device here
607 1.9 bouyer * We also have to update the ring pointer ourselve
608 1.1 bouyer */
609 1.1 bouyer slot = bus_space_read_1(sc->sc_c.sc_rt,
610 1.1 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHE);
611 1.1 bouyer esiop_script_sync(sc,
612 1.1 bouyer BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
613 1.9 bouyer #ifdef SIOP_DEBUG_SCHED
614 1.9 bouyer printf("sel timeout target %d, slot %d\n", target, slot);
615 1.9 bouyer #endif
616 1.3 bouyer /*
617 1.3 bouyer * mark this slot as free, and advance to next slot
618 1.3 bouyer */
619 1.8 bouyer esiop_script_write(sc,
620 1.8 bouyer sc->sc_shedoffset + slot * CMD_SLOTSIZE,
621 1.3 bouyer A_f_cmd_free);
622 1.3 bouyer addr = bus_space_read_4(sc->sc_c.sc_rt,
623 1.3 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHD);
624 1.3 bouyer if (slot < (A_ncmd_slots - 1)) {
625 1.3 bouyer bus_space_write_1(sc->sc_c.sc_rt,
626 1.3 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHE, slot + 1);
627 1.8 bouyer addr = addr + sizeof(struct esiop_slot);
628 1.3 bouyer } else {
629 1.3 bouyer bus_space_write_1(sc->sc_c.sc_rt,
630 1.3 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHE, 0);
631 1.3 bouyer addr = sc->sc_c.sc_scriptaddr +
632 1.3 bouyer sc->sc_shedoffset * sizeof(u_int32_t);
633 1.3 bouyer }
634 1.3 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
635 1.3 bouyer SIOP_SCRATCHD, addr);
636 1.3 bouyer esiop_script_sync(sc,
637 1.3 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
638 1.1 bouyer if (esiop_cmd) {
639 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_DONE;
640 1.1 bouyer xs->error = XS_SELTIMEOUT;
641 1.1 bouyer freetarget = 1;
642 1.1 bouyer goto end;
643 1.1 bouyer } else {
644 1.1 bouyer printf("%s: selection timeout without "
645 1.3 bouyer "command, target %d (sdid 0x%x), "
646 1.3 bouyer "slot %d\n",
647 1.3 bouyer sc->sc_c.sc_dev.dv_xname, target,
648 1.3 bouyer bus_space_read_1(sc->sc_c.sc_rt,
649 1.3 bouyer sc->sc_c.sc_rh, SIOP_SDID), slot);
650 1.1 bouyer need_reset = 1;
651 1.1 bouyer }
652 1.1 bouyer }
653 1.1 bouyer if (sist & SIST0_UDC) {
654 1.1 bouyer /*
655 1.1 bouyer * unexpected disconnect. Usually the target signals
656 1.1 bouyer * a fatal condition this way. Attempt to get sense.
657 1.1 bouyer */
658 1.1 bouyer if (esiop_cmd) {
659 1.1 bouyer esiop_cmd->cmd_tables->status =
660 1.1 bouyer htole32(SCSI_CHECK);
661 1.1 bouyer goto end;
662 1.1 bouyer }
663 1.1 bouyer printf("%s: unexpected disconnect without "
664 1.1 bouyer "command\n", sc->sc_c.sc_dev.dv_xname);
665 1.1 bouyer goto reset;
666 1.1 bouyer }
667 1.1 bouyer if (sist & (SIST1_SBMC << 8)) {
668 1.1 bouyer /* SCSI bus mode change */
669 1.1 bouyer if (siop_modechange(&sc->sc_c) == 0 || need_reset == 1)
670 1.1 bouyer goto reset;
671 1.1 bouyer if ((istat & ISTAT_DIP) && (dstat & DSTAT_SIR)) {
672 1.1 bouyer /*
673 1.1 bouyer * we have a script interrupt, it will
674 1.1 bouyer * restart the script.
675 1.1 bouyer */
676 1.1 bouyer goto scintr;
677 1.1 bouyer }
678 1.1 bouyer /*
679 1.1 bouyer * else we have to restart it ourselve, at the
680 1.1 bouyer * interrupted instruction.
681 1.1 bouyer */
682 1.1 bouyer bus_space_write_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
683 1.1 bouyer SIOP_DSP,
684 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
685 1.1 bouyer SIOP_DSP) - 8);
686 1.1 bouyer return 1;
687 1.1 bouyer }
688 1.1 bouyer /* Else it's an unhandled exeption (for now). */
689 1.1 bouyer printf("%s: unhandled scsi interrupt, sist=0x%x sstat1=0x%x "
690 1.1 bouyer "DSA=0x%x DSP=0x%x\n", sc->sc_c.sc_dev.dv_xname, sist,
691 1.1 bouyer bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
692 1.1 bouyer SIOP_SSTAT1),
693 1.1 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSA),
694 1.1 bouyer (int)(bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
695 1.1 bouyer SIOP_DSP) - sc->sc_c.sc_scriptaddr));
696 1.1 bouyer if (esiop_cmd) {
697 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_DONE;
698 1.1 bouyer xs->error = XS_SELTIMEOUT;
699 1.1 bouyer goto end;
700 1.1 bouyer }
701 1.1 bouyer need_reset = 1;
702 1.1 bouyer }
703 1.1 bouyer if (need_reset) {
704 1.1 bouyer reset:
705 1.1 bouyer /* fatal error, reset the bus */
706 1.1 bouyer siop_resetbus(&sc->sc_c);
707 1.1 bouyer /* no table to flush here */
708 1.1 bouyer return 1;
709 1.1 bouyer }
710 1.1 bouyer
711 1.1 bouyer scintr:
712 1.1 bouyer if ((istat & ISTAT_DIP) && (dstat & DSTAT_SIR)) { /* script interrupt */
713 1.1 bouyer irqcode = bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
714 1.1 bouyer SIOP_DSPS);
715 1.1 bouyer #ifdef SIOP_DEBUG_INTR
716 1.1 bouyer printf("script interrupt 0x%x\n", irqcode);
717 1.1 bouyer #endif
718 1.1 bouyer /*
719 1.1 bouyer * no command, or an inactive command is only valid for a
720 1.1 bouyer * reselect interrupt
721 1.1 bouyer */
722 1.1 bouyer if ((irqcode & 0x80) == 0) {
723 1.1 bouyer if (esiop_cmd == NULL) {
724 1.1 bouyer printf(
725 1.1 bouyer "%s: script interrupt (0x%x) with invalid DSA !!!\n",
726 1.1 bouyer sc->sc_c.sc_dev.dv_xname, irqcode);
727 1.1 bouyer goto reset;
728 1.1 bouyer }
729 1.1 bouyer if (esiop_cmd->cmd_c.status != CMDST_ACTIVE) {
730 1.1 bouyer printf("%s: command with invalid status "
731 1.1 bouyer "(IRQ code 0x%x current status %d) !\n",
732 1.1 bouyer sc->sc_c.sc_dev.dv_xname,
733 1.1 bouyer irqcode, esiop_cmd->cmd_c.status);
734 1.1 bouyer xs = NULL;
735 1.1 bouyer }
736 1.1 bouyer }
737 1.1 bouyer switch(irqcode) {
738 1.1 bouyer case A_int_err:
739 1.1 bouyer printf("error, DSP=0x%x\n",
740 1.1 bouyer (int)(bus_space_read_4(sc->sc_c.sc_rt,
741 1.1 bouyer sc->sc_c.sc_rh, SIOP_DSP) - sc->sc_c.sc_scriptaddr));
742 1.1 bouyer if (xs) {
743 1.1 bouyer xs->error = XS_SELTIMEOUT;
744 1.1 bouyer goto end;
745 1.1 bouyer } else {
746 1.1 bouyer goto reset;
747 1.1 bouyer }
748 1.1 bouyer case A_int_msgin:
749 1.1 bouyer {
750 1.1 bouyer int msgin = bus_space_read_1(sc->sc_c.sc_rt,
751 1.1 bouyer sc->sc_c.sc_rh, SIOP_SFBR);
752 1.1 bouyer if (msgin == MSG_MESSAGE_REJECT) {
753 1.1 bouyer int msg, extmsg;
754 1.1 bouyer if (esiop_cmd->cmd_tables->msg_out[0] & 0x80) {
755 1.1 bouyer /*
756 1.1 bouyer * message was part of a identify +
757 1.1 bouyer * something else. Identify shoudl't
758 1.1 bouyer * have been rejected.
759 1.1 bouyer */
760 1.1 bouyer msg =
761 1.1 bouyer esiop_cmd->cmd_tables->msg_out[1];
762 1.1 bouyer extmsg =
763 1.1 bouyer esiop_cmd->cmd_tables->msg_out[3];
764 1.1 bouyer } else {
765 1.1 bouyer msg =
766 1.1 bouyer esiop_cmd->cmd_tables->msg_out[0];
767 1.1 bouyer extmsg =
768 1.1 bouyer esiop_cmd->cmd_tables->msg_out[2];
769 1.1 bouyer }
770 1.1 bouyer if (msg == MSG_MESSAGE_REJECT) {
771 1.1 bouyer /* MSG_REJECT for a MSG_REJECT !*/
772 1.1 bouyer if (xs)
773 1.1 bouyer scsipi_printaddr(xs->xs_periph);
774 1.1 bouyer else
775 1.1 bouyer printf("%s: ",
776 1.1 bouyer sc->sc_c.sc_dev.dv_xname);
777 1.1 bouyer printf("our reject message was "
778 1.1 bouyer "rejected\n");
779 1.1 bouyer goto reset;
780 1.1 bouyer }
781 1.1 bouyer if (msg == MSG_EXTENDED &&
782 1.1 bouyer extmsg == MSG_EXT_WDTR) {
783 1.1 bouyer /* WDTR rejected, initiate sync */
784 1.1 bouyer if ((esiop_target->target_c.flags &
785 1.1 bouyer TARF_SYNC) == 0) {
786 1.1 bouyer esiop_target->target_c.status =
787 1.1 bouyer TARST_OK;
788 1.1 bouyer siop_update_xfer_mode(&sc->sc_c,
789 1.1 bouyer target);
790 1.1 bouyer /* no table to flush here */
791 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
792 1.1 bouyer return 1;
793 1.1 bouyer }
794 1.1 bouyer esiop_target->target_c.status =
795 1.1 bouyer TARST_SYNC_NEG;
796 1.1 bouyer siop_sdtr_msg(&esiop_cmd->cmd_c, 0,
797 1.6 bouyer sc->sc_c.st_minsync,
798 1.6 bouyer sc->sc_c.maxoff);
799 1.1 bouyer esiop_table_sync(esiop_cmd,
800 1.1 bouyer BUS_DMASYNC_PREREAD |
801 1.1 bouyer BUS_DMASYNC_PREWRITE);
802 1.1 bouyer CALL_SCRIPT(Ent_send_msgout);
803 1.1 bouyer return 1;
804 1.1 bouyer } else if (msg == MSG_EXTENDED &&
805 1.1 bouyer extmsg == MSG_EXT_SDTR) {
806 1.1 bouyer /* sync rejected */
807 1.1 bouyer esiop_target->target_c.offset = 0;
808 1.1 bouyer esiop_target->target_c.period = 0;
809 1.1 bouyer esiop_target->target_c.status =
810 1.1 bouyer TARST_OK;
811 1.1 bouyer siop_update_xfer_mode(&sc->sc_c,
812 1.1 bouyer target);
813 1.1 bouyer /* no table to flush here */
814 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
815 1.1 bouyer return 1;
816 1.6 bouyer } else if (msg == MSG_EXTENDED &&
817 1.6 bouyer extmsg == MSG_EXT_PPR) {
818 1.6 bouyer /* PPR rejected */
819 1.6 bouyer esiop_target->target_c.offset = 0;
820 1.6 bouyer esiop_target->target_c.period = 0;
821 1.6 bouyer esiop_target->target_c.status =
822 1.6 bouyer TARST_OK;
823 1.6 bouyer siop_update_xfer_mode(&sc->sc_c,
824 1.6 bouyer target);
825 1.6 bouyer /* no table to flush here */
826 1.6 bouyer CALL_SCRIPT(Ent_msgin_ack);
827 1.6 bouyer return 1;
828 1.2 bouyer } else if (msg == MSG_SIMPLE_Q_TAG ||
829 1.1 bouyer msg == MSG_HEAD_OF_Q_TAG ||
830 1.1 bouyer msg == MSG_ORDERED_Q_TAG) {
831 1.2 bouyer if (esiop_handle_qtag_reject(
832 1.1 bouyer esiop_cmd) == -1)
833 1.1 bouyer goto reset;
834 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
835 1.1 bouyer return 1;
836 1.1 bouyer }
837 1.1 bouyer if (xs)
838 1.1 bouyer scsipi_printaddr(xs->xs_periph);
839 1.1 bouyer else
840 1.1 bouyer printf("%s: ",
841 1.1 bouyer sc->sc_c.sc_dev.dv_xname);
842 1.1 bouyer if (msg == MSG_EXTENDED) {
843 1.1 bouyer printf("scsi message reject, extended "
844 1.1 bouyer "message sent was 0x%x\n", extmsg);
845 1.1 bouyer } else {
846 1.1 bouyer printf("scsi message reject, message "
847 1.1 bouyer "sent was 0x%x\n", msg);
848 1.1 bouyer }
849 1.1 bouyer /* no table to flush here */
850 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
851 1.1 bouyer return 1;
852 1.1 bouyer }
853 1.1 bouyer if (xs)
854 1.1 bouyer scsipi_printaddr(xs->xs_periph);
855 1.1 bouyer else
856 1.1 bouyer printf("%s: ", sc->sc_c.sc_dev.dv_xname);
857 1.1 bouyer printf("unhandled message 0x%x\n",
858 1.1 bouyer esiop_cmd->cmd_tables->msg_in[0]);
859 1.1 bouyer esiop_cmd->cmd_tables->msg_out[0] = MSG_MESSAGE_REJECT;
860 1.1 bouyer esiop_cmd->cmd_tables->t_msgout.count= htole32(1);
861 1.1 bouyer esiop_table_sync(esiop_cmd,
862 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
863 1.1 bouyer CALL_SCRIPT(Ent_send_msgout);
864 1.1 bouyer return 1;
865 1.1 bouyer }
866 1.1 bouyer case A_int_extmsgin:
867 1.1 bouyer #ifdef SIOP_DEBUG_INTR
868 1.1 bouyer printf("extended message: msg 0x%x len %d\n",
869 1.1 bouyer esiop_cmd->cmd_tables->msg_in[2],
870 1.1 bouyer esiop_cmd->cmd_tables->msg_in[1]);
871 1.1 bouyer #endif
872 1.5 bouyer if (esiop_cmd->cmd_tables->msg_in[1] >
873 1.5 bouyer sizeof(esiop_cmd->cmd_tables->msg_in) - 2)
874 1.1 bouyer printf("%s: extended message too big (%d)\n",
875 1.1 bouyer sc->sc_c.sc_dev.dv_xname,
876 1.1 bouyer esiop_cmd->cmd_tables->msg_in[1]);
877 1.1 bouyer esiop_cmd->cmd_tables->t_extmsgdata.count =
878 1.1 bouyer htole32(esiop_cmd->cmd_tables->msg_in[1] - 1);
879 1.1 bouyer esiop_table_sync(esiop_cmd,
880 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
881 1.1 bouyer CALL_SCRIPT(Ent_get_extmsgdata);
882 1.1 bouyer return 1;
883 1.1 bouyer case A_int_extmsgdata:
884 1.1 bouyer #ifdef SIOP_DEBUG_INTR
885 1.1 bouyer {
886 1.1 bouyer int i;
887 1.1 bouyer printf("extended message: 0x%x, data:",
888 1.1 bouyer esiop_cmd->cmd_tables->msg_in[2]);
889 1.1 bouyer for (i = 3; i < 2 + esiop_cmd->cmd_tables->msg_in[1];
890 1.1 bouyer i++)
891 1.1 bouyer printf(" 0x%x",
892 1.1 bouyer esiop_cmd->cmd_tables->msg_in[i]);
893 1.1 bouyer printf("\n");
894 1.1 bouyer }
895 1.1 bouyer #endif
896 1.6 bouyer if (esiop_cmd->cmd_tables->msg_in[2] == MSG_EXT_PPR) {
897 1.6 bouyer switch (siop_ppr_neg(&esiop_cmd->cmd_c)) {
898 1.6 bouyer case SIOP_NEG_MSGOUT:
899 1.9 bouyer esiop_update_scntl3(sc,
900 1.9 bouyer esiop_cmd->cmd_c.siop_target);
901 1.6 bouyer esiop_table_sync(esiop_cmd,
902 1.6 bouyer BUS_DMASYNC_PREREAD |
903 1.6 bouyer BUS_DMASYNC_PREWRITE);
904 1.6 bouyer CALL_SCRIPT(Ent_send_msgout);
905 1.9 bouyer return 1;
906 1.6 bouyer case SIOP_NEG_ACK:
907 1.9 bouyer esiop_update_scntl3(sc,
908 1.9 bouyer esiop_cmd->cmd_c.siop_target);
909 1.6 bouyer CALL_SCRIPT(Ent_msgin_ack);
910 1.9 bouyer return 1;
911 1.6 bouyer default:
912 1.6 bouyer panic("invalid retval from "
913 1.6 bouyer "siop_wdtr_neg()");
914 1.6 bouyer }
915 1.9 bouyer return 1;
916 1.6 bouyer }
917 1.1 bouyer if (esiop_cmd->cmd_tables->msg_in[2] == MSG_EXT_WDTR) {
918 1.1 bouyer switch (siop_wdtr_neg(&esiop_cmd->cmd_c)) {
919 1.1 bouyer case SIOP_NEG_MSGOUT:
920 1.9 bouyer esiop_update_scntl3(sc,
921 1.9 bouyer esiop_cmd->cmd_c.siop_target);
922 1.1 bouyer esiop_table_sync(esiop_cmd,
923 1.1 bouyer BUS_DMASYNC_PREREAD |
924 1.1 bouyer BUS_DMASYNC_PREWRITE);
925 1.1 bouyer CALL_SCRIPT(Ent_send_msgout);
926 1.9 bouyer return 1;
927 1.1 bouyer case SIOP_NEG_ACK:
928 1.9 bouyer esiop_update_scntl3(sc,
929 1.9 bouyer esiop_cmd->cmd_c.siop_target);
930 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
931 1.9 bouyer return 1;
932 1.1 bouyer default:
933 1.1 bouyer panic("invalid retval from "
934 1.1 bouyer "siop_wdtr_neg()");
935 1.1 bouyer }
936 1.9 bouyer return 1;
937 1.1 bouyer }
938 1.1 bouyer if (esiop_cmd->cmd_tables->msg_in[2] == MSG_EXT_SDTR) {
939 1.1 bouyer switch (siop_sdtr_neg(&esiop_cmd->cmd_c)) {
940 1.1 bouyer case SIOP_NEG_MSGOUT:
941 1.9 bouyer esiop_update_scntl3(sc,
942 1.9 bouyer esiop_cmd->cmd_c.siop_target);
943 1.1 bouyer esiop_table_sync(esiop_cmd,
944 1.1 bouyer BUS_DMASYNC_PREREAD |
945 1.1 bouyer BUS_DMASYNC_PREWRITE);
946 1.1 bouyer CALL_SCRIPT(Ent_send_msgout);
947 1.9 bouyer return 1;
948 1.1 bouyer case SIOP_NEG_ACK:
949 1.9 bouyer esiop_update_scntl3(sc,
950 1.9 bouyer esiop_cmd->cmd_c.siop_target);
951 1.1 bouyer CALL_SCRIPT(Ent_msgin_ack);
952 1.9 bouyer return 1;
953 1.1 bouyer default:
954 1.1 bouyer panic("invalid retval from "
955 1.1 bouyer "siop_wdtr_neg()");
956 1.1 bouyer }
957 1.9 bouyer return 1;
958 1.1 bouyer }
959 1.1 bouyer /* send a message reject */
960 1.1 bouyer esiop_cmd->cmd_tables->msg_out[0] = MSG_MESSAGE_REJECT;
961 1.1 bouyer esiop_cmd->cmd_tables->t_msgout.count = htole32(1);
962 1.1 bouyer esiop_table_sync(esiop_cmd,
963 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
964 1.1 bouyer CALL_SCRIPT(Ent_send_msgout);
965 1.1 bouyer return 1;
966 1.1 bouyer case A_int_disc:
967 1.1 bouyer INCSTAT(esiop_stat_intr_sdp);
968 1.1 bouyer offset = bus_space_read_1(sc->sc_c.sc_rt,
969 1.1 bouyer sc->sc_c.sc_rh, SIOP_SCRATCHA + 1);
970 1.1 bouyer #ifdef SIOP_DEBUG_DR
971 1.1 bouyer printf("disconnect offset %d\n", offset);
972 1.1 bouyer #endif
973 1.1 bouyer if (offset > SIOP_NSG) {
974 1.1 bouyer printf("%s: bad offset for disconnect (%d)\n",
975 1.1 bouyer sc->sc_c.sc_dev.dv_xname, offset);
976 1.1 bouyer goto reset;
977 1.1 bouyer }
978 1.1 bouyer /*
979 1.1 bouyer * offset == SIOP_NSG may be a valid condition if
980 1.1 bouyer * we get a sdp when the xfer is done.
981 1.1 bouyer * Don't call memmove in this case.
982 1.1 bouyer */
983 1.1 bouyer if (offset < SIOP_NSG) {
984 1.1 bouyer memmove(&esiop_cmd->cmd_tables->data[0],
985 1.1 bouyer &esiop_cmd->cmd_tables->data[offset],
986 1.1 bouyer (SIOP_NSG - offset) * sizeof(scr_table_t));
987 1.1 bouyer esiop_table_sync(esiop_cmd,
988 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
989 1.1 bouyer }
990 1.1 bouyer CALL_SCRIPT(Ent_script_sched);
991 1.1 bouyer return 1;
992 1.1 bouyer case A_int_resfail:
993 1.1 bouyer printf("reselect failed\n");
994 1.1 bouyer CALL_SCRIPT(Ent_script_sched);
995 1.9 bouyer return 1;
996 1.1 bouyer case A_int_done:
997 1.1 bouyer if (xs == NULL) {
998 1.1 bouyer printf("%s: done without command\n",
999 1.1 bouyer sc->sc_c.sc_dev.dv_xname);
1000 1.1 bouyer CALL_SCRIPT(Ent_script_sched);
1001 1.1 bouyer return 1;
1002 1.1 bouyer }
1003 1.1 bouyer #ifdef SIOP_DEBUG_INTR
1004 1.1 bouyer printf("done, DSA=0x%lx target id 0x%x last msg "
1005 1.1 bouyer "in=0x%x status=0x%x\n", (u_long)esiop_cmd->cmd_c.dsa,
1006 1.1 bouyer le32toh(esiop_cmd->cmd_tables->id),
1007 1.1 bouyer esiop_cmd->cmd_tables->msg_in[0],
1008 1.1 bouyer le32toh(esiop_cmd->cmd_tables->status));
1009 1.1 bouyer #endif
1010 1.1 bouyer INCSTAT(esiop_stat_intr_done);
1011 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_DONE;
1012 1.1 bouyer goto end;
1013 1.1 bouyer default:
1014 1.1 bouyer printf("unknown irqcode %x\n", irqcode);
1015 1.1 bouyer if (xs) {
1016 1.1 bouyer xs->error = XS_SELTIMEOUT;
1017 1.1 bouyer goto end;
1018 1.1 bouyer }
1019 1.1 bouyer goto reset;
1020 1.1 bouyer }
1021 1.1 bouyer return 1;
1022 1.1 bouyer }
1023 1.1 bouyer /* We just should't get there */
1024 1.1 bouyer panic("siop_intr: I shouldn't be there !");
1025 1.1 bouyer
1026 1.1 bouyer end:
1027 1.1 bouyer /*
1028 1.1 bouyer * restart the script now if command completed properly
1029 1.1 bouyer * Otherwise wait for siop_scsicmd_end(), we may need to cleanup the
1030 1.1 bouyer * queue
1031 1.1 bouyer */
1032 1.1 bouyer xs->status = le32toh(esiop_cmd->cmd_tables->status);
1033 1.1 bouyer #ifdef SIOP_DEBUG_INTR
1034 1.1 bouyer printf("esiop_intr end: status %d\n", xs->status);
1035 1.1 bouyer #endif
1036 1.2 bouyer if (tag >= 0)
1037 1.2 bouyer esiop_lun->tactive[tag] = NULL;
1038 1.2 bouyer else
1039 1.2 bouyer esiop_lun->active = NULL;
1040 1.1 bouyer esiop_scsicmd_end(esiop_cmd);
1041 1.1 bouyer if (freetarget && esiop_target->target_c.status == TARST_PROBING)
1042 1.1 bouyer esiop_del_dev(sc, target, lun);
1043 1.9 bouyer CALL_SCRIPT(Ent_script_sched);
1044 1.1 bouyer if (sc->sc_flags & SCF_CHAN_NOSLOT) {
1045 1.1 bouyer /* a command terminated, so we have free slots now */
1046 1.1 bouyer sc->sc_flags &= ~SCF_CHAN_NOSLOT;
1047 1.1 bouyer scsipi_channel_thaw(&sc->sc_c.sc_chan, 1);
1048 1.1 bouyer }
1049 1.1 bouyer
1050 1.9 bouyer return 1;
1051 1.1 bouyer }
1052 1.1 bouyer
1053 1.1 bouyer void
1054 1.1 bouyer esiop_scsicmd_end(esiop_cmd)
1055 1.1 bouyer struct esiop_cmd *esiop_cmd;
1056 1.1 bouyer {
1057 1.1 bouyer struct scsipi_xfer *xs = esiop_cmd->cmd_c.xs;
1058 1.1 bouyer struct esiop_softc *sc = (struct esiop_softc *)esiop_cmd->cmd_c.siop_sc;
1059 1.1 bouyer
1060 1.1 bouyer switch(xs->status) {
1061 1.1 bouyer case SCSI_OK:
1062 1.1 bouyer xs->error = XS_NOERROR;
1063 1.1 bouyer break;
1064 1.1 bouyer case SCSI_BUSY:
1065 1.1 bouyer xs->error = XS_BUSY;
1066 1.1 bouyer break;
1067 1.1 bouyer case SCSI_CHECK:
1068 1.1 bouyer xs->error = XS_BUSY;
1069 1.1 bouyer /* remove commands in the queue and scheduler */
1070 1.1 bouyer esiop_unqueue(sc, xs->xs_periph->periph_target,
1071 1.1 bouyer xs->xs_periph->periph_lun);
1072 1.1 bouyer break;
1073 1.1 bouyer case SCSI_QUEUE_FULL:
1074 1.1 bouyer INCSTAT(esiop_stat_intr_qfull);
1075 1.1 bouyer #ifdef SIOP_DEBUG
1076 1.1 bouyer printf("%s:%d:%d: queue full (tag %d)\n",
1077 1.1 bouyer sc->sc_c.sc_dev.dv_xname,
1078 1.1 bouyer xs->xs_periph->periph_target,
1079 1.1 bouyer xs->xs_periph->periph_lun, esiop_cmd->cmd_c.tag);
1080 1.1 bouyer #endif
1081 1.1 bouyer xs->error = XS_BUSY;
1082 1.1 bouyer break;
1083 1.1 bouyer case SCSI_SIOP_NOCHECK:
1084 1.1 bouyer /*
1085 1.1 bouyer * don't check status, xs->error is already valid
1086 1.1 bouyer */
1087 1.1 bouyer break;
1088 1.1 bouyer case SCSI_SIOP_NOSTATUS:
1089 1.1 bouyer /*
1090 1.1 bouyer * the status byte was not updated, cmd was
1091 1.1 bouyer * aborted
1092 1.1 bouyer */
1093 1.1 bouyer xs->error = XS_SELTIMEOUT;
1094 1.1 bouyer break;
1095 1.1 bouyer default:
1096 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1097 1.1 bouyer }
1098 1.1 bouyer if (xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
1099 1.1 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat,
1100 1.1 bouyer esiop_cmd->cmd_c.dmamap_data, 0,
1101 1.1 bouyer esiop_cmd->cmd_c.dmamap_data->dm_mapsize,
1102 1.1 bouyer (xs->xs_control & XS_CTL_DATA_IN) ?
1103 1.1 bouyer BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE);
1104 1.1 bouyer bus_dmamap_unload(sc->sc_c.sc_dmat,
1105 1.1 bouyer esiop_cmd->cmd_c.dmamap_data);
1106 1.1 bouyer }
1107 1.1 bouyer bus_dmamap_unload(sc->sc_c.sc_dmat, esiop_cmd->cmd_c.dmamap_cmd);
1108 1.1 bouyer callout_stop(&esiop_cmd->cmd_c.xs->xs_callout);
1109 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_FREE;
1110 1.1 bouyer TAILQ_INSERT_TAIL(&sc->free_list, esiop_cmd, next);
1111 1.1 bouyer xs->resid = 0;
1112 1.1 bouyer scsipi_done (xs);
1113 1.1 bouyer }
1114 1.1 bouyer
1115 1.1 bouyer void
1116 1.1 bouyer esiop_checkdone(sc)
1117 1.1 bouyer struct esiop_softc *sc;
1118 1.1 bouyer {
1119 1.2 bouyer int target, lun, tag;
1120 1.1 bouyer struct esiop_target *esiop_target;
1121 1.1 bouyer struct esiop_lun *esiop_lun;
1122 1.1 bouyer struct esiop_cmd *esiop_cmd;
1123 1.1 bouyer int status;
1124 1.1 bouyer
1125 1.1 bouyer for (target = 0; target < sc->sc_c.sc_chan.chan_ntargets; target++) {
1126 1.1 bouyer esiop_target = (struct esiop_target *)sc->sc_c.targets[target];
1127 1.1 bouyer if (esiop_target == NULL)
1128 1.1 bouyer continue;
1129 1.1 bouyer for (lun = 0; lun < sc->sc_c.sc_chan.chan_nluns; lun++) {
1130 1.1 bouyer esiop_lun = esiop_target->esiop_lun[lun];
1131 1.1 bouyer if (esiop_lun == NULL)
1132 1.1 bouyer continue;
1133 1.1 bouyer esiop_cmd = esiop_lun->active;
1134 1.2 bouyer if (esiop_cmd) {
1135 1.3 bouyer esiop_table_sync(esiop_cmd,
1136 1.3 bouyer BUS_DMASYNC_POSTREAD |
1137 1.3 bouyer BUS_DMASYNC_POSTWRITE);
1138 1.2 bouyer status = le32toh(esiop_cmd->cmd_tables->status);
1139 1.2 bouyer if (status == SCSI_OK) {
1140 1.2 bouyer /* Ok, this command has been handled */
1141 1.2 bouyer esiop_cmd->cmd_c.xs->status = status;
1142 1.2 bouyer esiop_lun->active = NULL;
1143 1.2 bouyer esiop_scsicmd_end(esiop_cmd);
1144 1.2 bouyer }
1145 1.2 bouyer }
1146 1.2 bouyer for (tag = 0; tag < ESIOP_NTAG; tag++) {
1147 1.2 bouyer esiop_cmd = esiop_lun->tactive[tag];
1148 1.2 bouyer if (esiop_cmd == NULL)
1149 1.2 bouyer continue;
1150 1.3 bouyer esiop_table_sync(esiop_cmd,
1151 1.3 bouyer BUS_DMASYNC_POSTREAD |
1152 1.3 bouyer BUS_DMASYNC_POSTWRITE);
1153 1.2 bouyer status = le32toh(esiop_cmd->cmd_tables->status);
1154 1.2 bouyer if (status == SCSI_OK) {
1155 1.2 bouyer /* Ok, this command has been handled */
1156 1.2 bouyer esiop_cmd->cmd_c.xs->status = status;
1157 1.2 bouyer esiop_lun->tactive[tag] = NULL;
1158 1.2 bouyer esiop_scsicmd_end(esiop_cmd);
1159 1.2 bouyer }
1160 1.2 bouyer }
1161 1.1 bouyer }
1162 1.1 bouyer }
1163 1.1 bouyer }
1164 1.1 bouyer
1165 1.1 bouyer void
1166 1.1 bouyer esiop_unqueue(sc, target, lun)
1167 1.1 bouyer struct esiop_softc *sc;
1168 1.1 bouyer int target;
1169 1.1 bouyer int lun;
1170 1.1 bouyer {
1171 1.1 bouyer int slot, tag;
1172 1.2 bouyer u_int32_t slotdsa;
1173 1.1 bouyer struct esiop_cmd *esiop_cmd;
1174 1.1 bouyer struct esiop_lun *esiop_lun =
1175 1.1 bouyer ((struct esiop_target *)sc->sc_c.targets[target])->esiop_lun[lun];
1176 1.1 bouyer
1177 1.1 bouyer /* first make sure to read valid data */
1178 1.1 bouyer esiop_script_sync(sc, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1179 1.1 bouyer
1180 1.2 bouyer for (tag = 0; tag < ESIOP_NTAG; tag++) {
1181 1.1 bouyer /* look for commands in the scheduler, not yet started */
1182 1.2 bouyer if (esiop_lun->tactive[tag] == NULL)
1183 1.1 bouyer continue;
1184 1.2 bouyer esiop_cmd = esiop_lun->tactive[tag];
1185 1.3 bouyer for (slot = 0; slot < A_ncmd_slots; slot++) {
1186 1.2 bouyer slotdsa = esiop_script_read(sc,
1187 1.8 bouyer sc->sc_shedoffset + slot * CMD_SLOTSIZE);
1188 1.9 bouyer /* if the slot has any flag, it won't match the DSA */
1189 1.9 bouyer if (slotdsa == esiop_cmd->cmd_c.dsa) { /* found it */
1190 1.9 bouyer /* Mark this slot as ignore */
1191 1.9 bouyer esiop_script_write(sc,
1192 1.9 bouyer sc->sc_shedoffset + slot * CMD_SLOTSIZE,
1193 1.9 bouyer esiop_cmd->cmd_c.dsa | A_f_cmd_ignore);
1194 1.9 bouyer /* ask to requeue */
1195 1.9 bouyer esiop_cmd->cmd_c.xs->error = XS_REQUEUE;
1196 1.9 bouyer esiop_cmd->cmd_c.xs->status = SCSI_SIOP_NOCHECK;
1197 1.9 bouyer esiop_lun->tactive[tag] = NULL;
1198 1.9 bouyer esiop_scsicmd_end(esiop_cmd);
1199 1.1 bouyer break;
1200 1.9 bouyer }
1201 1.1 bouyer }
1202 1.1 bouyer }
1203 1.9 bouyer esiop_script_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1204 1.1 bouyer }
1205 1.1 bouyer
1206 1.1 bouyer /*
1207 1.1 bouyer * handle a rejected queue tag message: the command will run untagged,
1208 1.1 bouyer * has to adjust the reselect script.
1209 1.1 bouyer */
1210 1.1 bouyer
1211 1.2 bouyer
1212 1.1 bouyer int
1213 1.1 bouyer esiop_handle_qtag_reject(esiop_cmd)
1214 1.1 bouyer struct esiop_cmd *esiop_cmd;
1215 1.1 bouyer {
1216 1.2 bouyer struct esiop_softc *sc = (struct esiop_softc *)esiop_cmd->cmd_c.siop_sc;
1217 1.1 bouyer int target = esiop_cmd->cmd_c.xs->xs_periph->periph_target;
1218 1.1 bouyer int lun = esiop_cmd->cmd_c.xs->xs_periph->periph_lun;
1219 1.1 bouyer int tag = esiop_cmd->cmd_tables->msg_out[2];
1220 1.2 bouyer struct esiop_target *esiop_target =
1221 1.2 bouyer (struct esiop_target*)sc->sc_c.targets[target];
1222 1.2 bouyer struct esiop_lun *esiop_lun = esiop_target->esiop_lun[lun];
1223 1.1 bouyer
1224 1.1 bouyer #ifdef SIOP_DEBUG
1225 1.1 bouyer printf("%s:%d:%d: tag message %d (%d) rejected (status %d)\n",
1226 1.1 bouyer sc->sc_c.sc_dev.dv_xname, target, lun, tag, esiop_cmd->cmd_c.tag,
1227 1.1 bouyer esiop_cmd->cmd_c.status);
1228 1.1 bouyer #endif
1229 1.1 bouyer
1230 1.2 bouyer if (esiop_lun->active != NULL) {
1231 1.1 bouyer printf("%s: untagged command already running for target %d "
1232 1.1 bouyer "lun %d (status %d)\n", sc->sc_c.sc_dev.dv_xname,
1233 1.2 bouyer target, lun, esiop_lun->active->cmd_c.status);
1234 1.1 bouyer return -1;
1235 1.1 bouyer }
1236 1.1 bouyer /* clear tag slot */
1237 1.2 bouyer esiop_lun->tactive[tag] = NULL;
1238 1.1 bouyer /* add command to non-tagged slot */
1239 1.2 bouyer esiop_lun->active = esiop_cmd;
1240 1.2 bouyer esiop_cmd->cmd_c.flags &= ~CMDFL_TAG;
1241 1.2 bouyer esiop_cmd->cmd_c.tag = -1;
1242 1.2 bouyer /* update DSA table */
1243 1.9 bouyer esiop_script_write(sc, esiop_target->lun_table_offset +
1244 1.9 bouyer lun * 2 + A_target_luntbl / sizeof(u_int32_t),
1245 1.2 bouyer esiop_cmd->cmd_c.dsa);
1246 1.2 bouyer esiop_script_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1247 1.1 bouyer return 0;
1248 1.1 bouyer }
1249 1.1 bouyer
1250 1.1 bouyer /*
1251 1.1 bouyer * handle a bus reset: reset chip, unqueue all active commands, free all
1252 1.1 bouyer * target struct and report loosage to upper layer.
1253 1.1 bouyer * As the upper layer may requeue immediatly we have to first store
1254 1.1 bouyer * all active commands in a temporary queue.
1255 1.1 bouyer */
1256 1.1 bouyer void
1257 1.1 bouyer esiop_handle_reset(sc)
1258 1.1 bouyer struct esiop_softc *sc;
1259 1.1 bouyer {
1260 1.1 bouyer struct esiop_cmd *esiop_cmd;
1261 1.1 bouyer struct esiop_lun *esiop_lun;
1262 1.1 bouyer int target, lun, tag;
1263 1.1 bouyer /*
1264 1.1 bouyer * scsi bus reset. reset the chip and restart
1265 1.1 bouyer * the queue. Need to clean up all active commands
1266 1.1 bouyer */
1267 1.1 bouyer printf("%s: scsi bus reset\n", sc->sc_c.sc_dev.dv_xname);
1268 1.1 bouyer /* stop, reset and restart the chip */
1269 1.1 bouyer esiop_reset(sc);
1270 1.9 bouyer
1271 1.1 bouyer if (sc->sc_flags & SCF_CHAN_NOSLOT) {
1272 1.1 bouyer /* chip has been reset, all slots are free now */
1273 1.1 bouyer sc->sc_flags &= ~SCF_CHAN_NOSLOT;
1274 1.1 bouyer scsipi_channel_thaw(&sc->sc_c.sc_chan, 1);
1275 1.1 bouyer }
1276 1.1 bouyer /*
1277 1.1 bouyer * Process all commands: first commmands completes, then commands
1278 1.1 bouyer * being executed
1279 1.1 bouyer */
1280 1.1 bouyer esiop_checkdone(sc);
1281 1.1 bouyer for (target = 0; target < sc->sc_c.sc_chan.chan_ntargets;
1282 1.1 bouyer target++) {
1283 1.1 bouyer struct esiop_target *esiop_target =
1284 1.1 bouyer (struct esiop_target *)sc->sc_c.targets[target];
1285 1.1 bouyer if (esiop_target == NULL)
1286 1.1 bouyer continue;
1287 1.1 bouyer for (lun = 0; lun < 8; lun++) {
1288 1.1 bouyer esiop_lun = esiop_target->esiop_lun[lun];
1289 1.1 bouyer if (esiop_lun == NULL)
1290 1.1 bouyer continue;
1291 1.2 bouyer for (tag = -1; tag <
1292 1.1 bouyer ((sc->sc_c.targets[target]->flags & TARF_TAG) ?
1293 1.2 bouyer ESIOP_NTAG : 0);
1294 1.1 bouyer tag++) {
1295 1.2 bouyer if (tag >= 0)
1296 1.2 bouyer esiop_cmd = esiop_lun->tactive[tag];
1297 1.2 bouyer else
1298 1.2 bouyer esiop_cmd = esiop_lun->active;
1299 1.1 bouyer if (esiop_cmd == NULL)
1300 1.1 bouyer continue;
1301 1.1 bouyer scsipi_printaddr(esiop_cmd->cmd_c.xs->xs_periph);
1302 1.1 bouyer printf("command with tag id %d reset\n", tag);
1303 1.1 bouyer esiop_cmd->cmd_c.xs->error =
1304 1.1 bouyer (esiop_cmd->cmd_c.flags & CMDFL_TIMEOUT) ?
1305 1.1 bouyer XS_TIMEOUT : XS_RESET;
1306 1.1 bouyer esiop_cmd->cmd_c.xs->status = SCSI_SIOP_NOCHECK;
1307 1.2 bouyer if (tag >= 0)
1308 1.2 bouyer esiop_lun->tactive[tag] = NULL;
1309 1.2 bouyer else
1310 1.2 bouyer esiop_lun->active = NULL;
1311 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_DONE;
1312 1.1 bouyer esiop_scsicmd_end(esiop_cmd);
1313 1.1 bouyer }
1314 1.1 bouyer }
1315 1.1 bouyer sc->sc_c.targets[target]->status = TARST_ASYNC;
1316 1.6 bouyer sc->sc_c.targets[target]->flags &= ~(TARF_ISWIDE | TARF_ISDT);
1317 1.1 bouyer sc->sc_c.targets[target]->period =
1318 1.1 bouyer sc->sc_c.targets[target]->offset = 0;
1319 1.1 bouyer siop_update_xfer_mode(&sc->sc_c, target);
1320 1.1 bouyer }
1321 1.1 bouyer
1322 1.1 bouyer scsipi_async_event(&sc->sc_c.sc_chan, ASYNC_EVENT_RESET, NULL);
1323 1.1 bouyer }
1324 1.1 bouyer
1325 1.1 bouyer void
1326 1.1 bouyer esiop_scsipi_request(chan, req, arg)
1327 1.1 bouyer struct scsipi_channel *chan;
1328 1.1 bouyer scsipi_adapter_req_t req;
1329 1.1 bouyer void *arg;
1330 1.1 bouyer {
1331 1.1 bouyer struct scsipi_xfer *xs;
1332 1.1 bouyer struct scsipi_periph *periph;
1333 1.1 bouyer struct esiop_softc *sc = (void *)chan->chan_adapter->adapt_dev;
1334 1.1 bouyer struct esiop_cmd *esiop_cmd;
1335 1.1 bouyer struct esiop_target *esiop_target;
1336 1.1 bouyer int s, error, i;
1337 1.1 bouyer int target;
1338 1.1 bouyer int lun;
1339 1.1 bouyer
1340 1.1 bouyer switch (req) {
1341 1.1 bouyer case ADAPTER_REQ_RUN_XFER:
1342 1.1 bouyer xs = arg;
1343 1.1 bouyer periph = xs->xs_periph;
1344 1.1 bouyer target = periph->periph_target;
1345 1.1 bouyer lun = periph->periph_lun;
1346 1.1 bouyer
1347 1.1 bouyer s = splbio();
1348 1.1 bouyer #ifdef SIOP_DEBUG_SCHED
1349 1.9 bouyer printf("starting cmd for %d:%d tag %d(%d)\n", target, lun,
1350 1.9 bouyer xs->xs_tag_type, xs->xs_tag_id);
1351 1.1 bouyer #endif
1352 1.1 bouyer esiop_cmd = TAILQ_FIRST(&sc->free_list);
1353 1.1 bouyer if (esiop_cmd == NULL) {
1354 1.1 bouyer xs->error = XS_RESOURCE_SHORTAGE;
1355 1.1 bouyer scsipi_done(xs);
1356 1.1 bouyer splx(s);
1357 1.1 bouyer return;
1358 1.1 bouyer }
1359 1.1 bouyer TAILQ_REMOVE(&sc->free_list, esiop_cmd, next);
1360 1.1 bouyer #ifdef DIAGNOSTIC
1361 1.1 bouyer if (esiop_cmd->cmd_c.status != CMDST_FREE)
1362 1.1 bouyer panic("siop_scsicmd: new cmd not free");
1363 1.1 bouyer #endif
1364 1.1 bouyer esiop_target = (struct esiop_target*)sc->sc_c.targets[target];
1365 1.1 bouyer if (esiop_target == NULL) {
1366 1.1 bouyer #ifdef SIOP_DEBUG
1367 1.1 bouyer printf("%s: alloc siop_target for target %d\n",
1368 1.1 bouyer sc->sc_c.sc_dev.dv_xname, target);
1369 1.1 bouyer #endif
1370 1.1 bouyer sc->sc_c.targets[target] =
1371 1.1 bouyer malloc(sizeof(struct esiop_target),
1372 1.1 bouyer M_DEVBUF, M_NOWAIT | M_ZERO);
1373 1.1 bouyer if (sc->sc_c.targets[target] == NULL) {
1374 1.1 bouyer printf("%s: can't malloc memory for "
1375 1.1 bouyer "target %d\n", sc->sc_c.sc_dev.dv_xname,
1376 1.1 bouyer target);
1377 1.1 bouyer xs->error = XS_RESOURCE_SHORTAGE;
1378 1.1 bouyer scsipi_done(xs);
1379 1.1 bouyer splx(s);
1380 1.1 bouyer return;
1381 1.1 bouyer }
1382 1.1 bouyer esiop_target =
1383 1.1 bouyer (struct esiop_target*)sc->sc_c.targets[target];
1384 1.1 bouyer esiop_target->target_c.status = TARST_PROBING;
1385 1.1 bouyer esiop_target->target_c.flags = 0;
1386 1.1 bouyer esiop_target->target_c.id =
1387 1.1 bouyer sc->sc_c.clock_div << 24; /* scntl3 */
1388 1.1 bouyer esiop_target->target_c.id |= target << 16; /* id */
1389 1.1 bouyer /* esiop_target->target_c.id |= 0x0 << 8; scxfer is 0 */
1390 1.1 bouyer
1391 1.1 bouyer for (i=0; i < 8; i++)
1392 1.1 bouyer esiop_target->esiop_lun[i] = NULL;
1393 1.1 bouyer esiop_target_register(sc, target);
1394 1.1 bouyer }
1395 1.1 bouyer if (esiop_target->esiop_lun[lun] == NULL) {
1396 1.1 bouyer esiop_target->esiop_lun[lun] =
1397 1.1 bouyer malloc(sizeof(struct esiop_lun), M_DEVBUF,
1398 1.1 bouyer M_NOWAIT|M_ZERO);
1399 1.1 bouyer if (esiop_target->esiop_lun[lun] == NULL) {
1400 1.1 bouyer printf("%s: can't alloc esiop_lun for "
1401 1.1 bouyer "target %d lun %d\n",
1402 1.1 bouyer sc->sc_c.sc_dev.dv_xname, target, lun);
1403 1.1 bouyer xs->error = XS_RESOURCE_SHORTAGE;
1404 1.1 bouyer scsipi_done(xs);
1405 1.1 bouyer splx(s);
1406 1.1 bouyer return;
1407 1.1 bouyer }
1408 1.1 bouyer }
1409 1.1 bouyer esiop_cmd->cmd_c.siop_target = sc->sc_c.targets[target];
1410 1.1 bouyer esiop_cmd->cmd_c.xs = xs;
1411 1.1 bouyer esiop_cmd->cmd_c.flags = 0;
1412 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_READY;
1413 1.1 bouyer
1414 1.1 bouyer /* load the DMA maps */
1415 1.1 bouyer error = bus_dmamap_load(sc->sc_c.sc_dmat,
1416 1.1 bouyer esiop_cmd->cmd_c.dmamap_cmd,
1417 1.1 bouyer xs->cmd, xs->cmdlen, NULL, BUS_DMA_NOWAIT);
1418 1.1 bouyer if (error) {
1419 1.1 bouyer printf("%s: unable to load cmd DMA map: %d\n",
1420 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1421 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1422 1.1 bouyer scsipi_done(xs);
1423 1.1 bouyer splx(s);
1424 1.1 bouyer return;
1425 1.1 bouyer }
1426 1.1 bouyer if (xs->xs_control & (XS_CTL_DATA_IN | XS_CTL_DATA_OUT)) {
1427 1.1 bouyer error = bus_dmamap_load(sc->sc_c.sc_dmat,
1428 1.1 bouyer esiop_cmd->cmd_c.dmamap_data, xs->data, xs->datalen,
1429 1.1 bouyer NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
1430 1.1 bouyer ((xs->xs_control & XS_CTL_DATA_IN) ?
1431 1.1 bouyer BUS_DMA_READ : BUS_DMA_WRITE));
1432 1.1 bouyer if (error) {
1433 1.1 bouyer printf("%s: unable to load cmd DMA map: %d",
1434 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1435 1.1 bouyer xs->error = XS_DRIVER_STUFFUP;
1436 1.1 bouyer scsipi_done(xs);
1437 1.1 bouyer bus_dmamap_unload(sc->sc_c.sc_dmat,
1438 1.1 bouyer esiop_cmd->cmd_c.dmamap_cmd);
1439 1.1 bouyer splx(s);
1440 1.1 bouyer return;
1441 1.1 bouyer }
1442 1.1 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat,
1443 1.1 bouyer esiop_cmd->cmd_c.dmamap_data, 0,
1444 1.1 bouyer esiop_cmd->cmd_c.dmamap_data->dm_mapsize,
1445 1.1 bouyer (xs->xs_control & XS_CTL_DATA_IN) ?
1446 1.1 bouyer BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE);
1447 1.1 bouyer }
1448 1.1 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat, esiop_cmd->cmd_c.dmamap_cmd,
1449 1.1 bouyer 0, esiop_cmd->cmd_c.dmamap_cmd->dm_mapsize,
1450 1.1 bouyer BUS_DMASYNC_PREWRITE);
1451 1.1 bouyer
1452 1.2 bouyer if (xs->xs_tag_type)
1453 1.2 bouyer esiop_cmd->cmd_c.tag = xs->xs_tag_id;
1454 1.2 bouyer else
1455 1.2 bouyer esiop_cmd->cmd_c.tag = -1;
1456 1.1 bouyer siop_setuptables(&esiop_cmd->cmd_c);
1457 1.1 bouyer ((struct esiop_xfer *)esiop_cmd->cmd_tables)->tlq =
1458 1.2 bouyer htole32(A_f_c_target | A_f_c_lun);
1459 1.1 bouyer ((struct esiop_xfer *)esiop_cmd->cmd_tables)->tlq |=
1460 1.2 bouyer htole32((target << 8) | (lun << 16));
1461 1.2 bouyer if (esiop_cmd->cmd_c.flags & CMDFL_TAG) {
1462 1.2 bouyer ((struct esiop_xfer *)esiop_cmd->cmd_tables)->tlq |=
1463 1.2 bouyer htole32(A_f_c_tag);
1464 1.2 bouyer ((struct esiop_xfer *)esiop_cmd->cmd_tables)->tlq |=
1465 1.2 bouyer htole32(esiop_cmd->cmd_c.tag << 24);
1466 1.2 bouyer }
1467 1.1 bouyer
1468 1.1 bouyer esiop_table_sync(esiop_cmd,
1469 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1470 1.1 bouyer esiop_start(sc, esiop_cmd);
1471 1.1 bouyer if (xs->xs_control & XS_CTL_POLL) {
1472 1.1 bouyer /* poll for command completion */
1473 1.1 bouyer while ((xs->xs_status & XS_STS_DONE) == 0) {
1474 1.1 bouyer delay(1000);
1475 1.1 bouyer esiop_intr(sc);
1476 1.1 bouyer }
1477 1.1 bouyer }
1478 1.1 bouyer splx(s);
1479 1.1 bouyer return;
1480 1.1 bouyer
1481 1.1 bouyer case ADAPTER_REQ_GROW_RESOURCES:
1482 1.1 bouyer #ifdef SIOP_DEBUG
1483 1.1 bouyer printf("%s grow resources (%d)\n", sc->sc_c.sc_dev.dv_xname,
1484 1.1 bouyer sc->sc_c.sc_adapt.adapt_openings);
1485 1.1 bouyer #endif
1486 1.1 bouyer esiop_morecbd(sc);
1487 1.1 bouyer return;
1488 1.1 bouyer
1489 1.1 bouyer case ADAPTER_REQ_SET_XFER_MODE:
1490 1.1 bouyer {
1491 1.1 bouyer struct scsipi_xfer_mode *xm = arg;
1492 1.1 bouyer if (sc->sc_c.targets[xm->xm_target] == NULL)
1493 1.1 bouyer return;
1494 1.1 bouyer s = splbio();
1495 1.9 bouyer if ((xm->xm_mode & PERIPH_CAP_TQING) &&
1496 1.9 bouyer (sc->sc_c.targets[xm->xm_target]->flags & TARF_TAG) == 0) {
1497 1.1 bouyer sc->sc_c.targets[xm->xm_target]->flags |= TARF_TAG;
1498 1.9 bouyer /* allocate tag tables for this device */
1499 1.9 bouyer for (lun = 0;
1500 1.9 bouyer lun < sc->sc_c.sc_chan.chan_nluns; lun++) {
1501 1.9 bouyer if (sc->sc_c.sc_chan.chan_periphs[
1502 1.9 bouyer xm->xm_target][lun])
1503 1.9 bouyer esiop_add_dev(sc, xm->xm_target, lun);
1504 1.9 bouyer }
1505 1.9 bouyer }
1506 1.1 bouyer if ((xm->xm_mode & PERIPH_CAP_WIDE16) &&
1507 1.1 bouyer (sc->sc_c.features & SF_BUS_WIDE))
1508 1.1 bouyer sc->sc_c.targets[xm->xm_target]->flags |= TARF_WIDE;
1509 1.1 bouyer if (xm->xm_mode & PERIPH_CAP_SYNC)
1510 1.1 bouyer sc->sc_c.targets[xm->xm_target]->flags |= TARF_SYNC;
1511 1.6 bouyer if ((xm->xm_mode & PERIPH_CAP_DT) &&
1512 1.6 bouyer (sc->sc_c.features & SF_CHIP_DT))
1513 1.6 bouyer sc->sc_c.targets[xm->xm_target]->flags |= TARF_DT;
1514 1.6 bouyer if ((xm->xm_mode &
1515 1.6 bouyer (PERIPH_CAP_SYNC | PERIPH_CAP_WIDE16 | PERIPH_CAP_DT)) ||
1516 1.1 bouyer sc->sc_c.targets[xm->xm_target]->status == TARST_PROBING)
1517 1.6 bouyer sc->sc_c.targets[xm->xm_target]->status = TARST_ASYNC;
1518 1.1 bouyer
1519 1.1 bouyer splx(s);
1520 1.1 bouyer }
1521 1.1 bouyer }
1522 1.1 bouyer }
1523 1.1 bouyer
1524 1.1 bouyer static void
1525 1.1 bouyer esiop_start(sc, esiop_cmd)
1526 1.1 bouyer struct esiop_softc *sc;
1527 1.1 bouyer struct esiop_cmd *esiop_cmd;
1528 1.1 bouyer {
1529 1.1 bouyer struct esiop_lun *esiop_lun;
1530 1.1 bouyer struct esiop_target *esiop_target;
1531 1.1 bouyer int timeout;
1532 1.1 bouyer int target, lun, slot;
1533 1.1 bouyer
1534 1.1 bouyer /*
1535 1.1 bouyer * first make sure to read valid data
1536 1.1 bouyer */
1537 1.1 bouyer esiop_script_sync(sc, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1538 1.1 bouyer
1539 1.1 bouyer /*
1540 1.1 bouyer * We use a circular queue here. sc->sc_currschedslot points to a
1541 1.1 bouyer * free slot, unless we have filled the queue. Check this.
1542 1.1 bouyer */
1543 1.1 bouyer slot = sc->sc_currschedslot;
1544 1.8 bouyer if ((esiop_script_read(sc, sc->sc_shedoffset + slot * CMD_SLOTSIZE) &
1545 1.1 bouyer A_f_cmd_free) == 0) {
1546 1.1 bouyer /*
1547 1.1 bouyer * no more free slot, no need to continue. freeze the queue
1548 1.1 bouyer * and requeue this command.
1549 1.1 bouyer */
1550 1.1 bouyer scsipi_channel_freeze(&sc->sc_c.sc_chan, 1);
1551 1.1 bouyer sc->sc_flags |= SCF_CHAN_NOSLOT;
1552 1.1 bouyer esiop_cmd->cmd_c.xs->error = XS_REQUEUE;
1553 1.1 bouyer esiop_cmd->cmd_c.xs->status = SCSI_SIOP_NOCHECK;
1554 1.1 bouyer esiop_scsicmd_end(esiop_cmd);
1555 1.1 bouyer return;
1556 1.1 bouyer }
1557 1.1 bouyer /* OK, we can use this slot */
1558 1.1 bouyer
1559 1.1 bouyer target = esiop_cmd->cmd_c.xs->xs_periph->periph_target;
1560 1.1 bouyer lun = esiop_cmd->cmd_c.xs->xs_periph->periph_lun;
1561 1.1 bouyer esiop_target = (struct esiop_target*)sc->sc_c.targets[target];
1562 1.1 bouyer esiop_lun = esiop_target->esiop_lun[lun];
1563 1.1 bouyer /* if non-tagged command active, panic: this shouldn't happen */
1564 1.1 bouyer if (esiop_lun->active != NULL) {
1565 1.1 bouyer panic("esiop_start: tagged cmd while untagged running");
1566 1.1 bouyer }
1567 1.1 bouyer #ifdef DIAGNOSTIC
1568 1.1 bouyer /* sanity check the tag if needed */
1569 1.1 bouyer if (esiop_cmd->cmd_c.flags & CMDFL_TAG) {
1570 1.2 bouyer if (esiop_lun->tactive[esiop_cmd->cmd_c.tag] != NULL)
1571 1.1 bouyer panic("esiop_start: tag not free");
1572 1.2 bouyer if (esiop_cmd->cmd_c.tag >= ESIOP_NTAG ||
1573 1.2 bouyer esiop_cmd->cmd_c.tag < 0) {
1574 1.1 bouyer scsipi_printaddr(esiop_cmd->cmd_c.xs->xs_periph);
1575 1.1 bouyer printf(": tag id %d\n", esiop_cmd->cmd_c.tag);
1576 1.1 bouyer panic("esiop_start: invalid tag id");
1577 1.1 bouyer }
1578 1.1 bouyer }
1579 1.1 bouyer #endif
1580 1.1 bouyer #ifdef SIOP_DEBUG_SCHED
1581 1.1 bouyer printf("using slot %d for DSA 0x%lx\n", slot,
1582 1.1 bouyer (u_long)esiop_cmd->cmd_c.dsa);
1583 1.1 bouyer #endif
1584 1.1 bouyer /* mark command as active */
1585 1.1 bouyer if (esiop_cmd->cmd_c.status == CMDST_READY)
1586 1.1 bouyer esiop_cmd->cmd_c.status = CMDST_ACTIVE;
1587 1.1 bouyer else
1588 1.1 bouyer panic("esiop_start: bad status");
1589 1.9 bouyer /* DSA table for reselect */
1590 1.2 bouyer if (esiop_cmd->cmd_c.flags & CMDFL_TAG) {
1591 1.2 bouyer esiop_lun->tactive[esiop_cmd->cmd_c.tag] = esiop_cmd;
1592 1.2 bouyer /* DSA table for reselect */
1593 1.2 bouyer esiop_lun->lun_tagtbl->tbl[esiop_cmd->cmd_c.tag] =
1594 1.2 bouyer htole32(esiop_cmd->cmd_c.dsa);
1595 1.2 bouyer bus_dmamap_sync(sc->sc_c.sc_dmat,
1596 1.2 bouyer esiop_lun->lun_tagtbl->tblblk->blkmap,
1597 1.2 bouyer esiop_lun->lun_tagtbl->tbl_offset,
1598 1.2 bouyer sizeof(u_int32_t) * ESIOP_NTAG, BUS_DMASYNC_PREWRITE);
1599 1.2 bouyer } else {
1600 1.2 bouyer esiop_lun->active = esiop_cmd;
1601 1.9 bouyer esiop_script_write(sc,
1602 1.9 bouyer esiop_target->lun_table_offset +
1603 1.9 bouyer lun * 2 + A_target_luntbl / sizeof(u_int32_t),
1604 1.2 bouyer esiop_cmd->cmd_c.dsa);
1605 1.2 bouyer }
1606 1.8 bouyer /* scheduler slot: DSA */
1607 1.8 bouyer esiop_script_write(sc, sc->sc_shedoffset + slot * CMD_SLOTSIZE,
1608 1.1 bouyer esiop_cmd->cmd_c.dsa);
1609 1.9 bouyer /* make sure SCRIPT processor will read valid data */
1610 1.9 bouyer esiop_script_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1611 1.1 bouyer /* handle timeout */
1612 1.1 bouyer if ((esiop_cmd->cmd_c.xs->xs_control & XS_CTL_POLL) == 0) {
1613 1.1 bouyer /* start exire timer */
1614 1.1 bouyer timeout = mstohz(esiop_cmd->cmd_c.xs->timeout);
1615 1.1 bouyer if (timeout == 0)
1616 1.1 bouyer timeout = 1;
1617 1.1 bouyer callout_reset( &esiop_cmd->cmd_c.xs->xs_callout,
1618 1.1 bouyer timeout, esiop_timeout, esiop_cmd);
1619 1.1 bouyer }
1620 1.1 bouyer /* Signal script it has some work to do */
1621 1.1 bouyer bus_space_write_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh,
1622 1.1 bouyer SIOP_ISTAT, ISTAT_SIGP);
1623 1.1 bouyer /* update the current slot, and wait for IRQ */
1624 1.1 bouyer sc->sc_currschedslot++;
1625 1.1 bouyer if (sc->sc_currschedslot >= A_ncmd_slots)
1626 1.1 bouyer sc->sc_currschedslot = 0;
1627 1.1 bouyer return;
1628 1.1 bouyer }
1629 1.1 bouyer
1630 1.1 bouyer void
1631 1.1 bouyer esiop_timeout(v)
1632 1.1 bouyer void *v;
1633 1.1 bouyer {
1634 1.1 bouyer struct esiop_cmd *esiop_cmd = v;
1635 1.1 bouyer struct esiop_softc *sc =
1636 1.1 bouyer (struct esiop_softc *)esiop_cmd->cmd_c.siop_sc;
1637 1.1 bouyer int s;
1638 1.9 bouyer #ifdef SIOP_DEBUG
1639 1.9 bouyer int slot, slotdsa;
1640 1.9 bouyer #endif
1641 1.1 bouyer
1642 1.9 bouyer s = splbio();
1643 1.9 bouyer esiop_table_sync(esiop_cmd,
1644 1.9 bouyer BUS_DMASYNC_POSTREAD |
1645 1.9 bouyer BUS_DMASYNC_POSTWRITE);
1646 1.1 bouyer scsipi_printaddr(esiop_cmd->cmd_c.xs->xs_periph);
1647 1.9 bouyer #ifdef SIOP_DEBUG
1648 1.9 bouyer printf("command timeout (status %d)\n", le32toh(esiop_cmd->cmd_tables->status));
1649 1.9 bouyer
1650 1.9 bouyer esiop_script_sync(sc, BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1651 1.9 bouyer for (slot = 0; slot < A_ncmd_slots; slot++) {
1652 1.9 bouyer slotdsa = esiop_script_read(sc,
1653 1.9 bouyer sc->sc_shedoffset + slot * CMD_SLOTSIZE);
1654 1.9 bouyer if ((slotdsa & 0x01) == 0)
1655 1.9 bouyer printf("slot %d not free (0x%x)\n", slot, slotdsa);
1656 1.9 bouyer }
1657 1.9 bouyer printf("istat 0x%x ", bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_ISTAT));
1658 1.9 bouyer printf("DSP 0x%lx DSA 0x%x\n",
1659 1.9 bouyer (u_long)(bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSP) - sc->sc_c.sc_scriptaddr),
1660 1.9 bouyer bus_space_read_4(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_DSA));
1661 1.9 bouyer bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_CTEST2);
1662 1.9 bouyer printf("istat 0x%x\n", bus_space_read_1(sc->sc_c.sc_rt, sc->sc_c.sc_rh, SIOP_ISTAT));
1663 1.9 bouyer #else
1664 1.1 bouyer printf("command timeout\n");
1665 1.9 bouyer #endif
1666 1.1 bouyer /* reset the scsi bus */
1667 1.1 bouyer siop_resetbus(&sc->sc_c);
1668 1.1 bouyer
1669 1.1 bouyer /* deactivate callout */
1670 1.1 bouyer callout_stop(&esiop_cmd->cmd_c.xs->xs_callout);
1671 1.1 bouyer /*
1672 1.1 bouyer * mark command has being timed out and just return;
1673 1.1 bouyer * the bus reset will generate an interrupt,
1674 1.1 bouyer * it will be handled in siop_intr()
1675 1.1 bouyer */
1676 1.1 bouyer esiop_cmd->cmd_c.flags |= CMDFL_TIMEOUT;
1677 1.1 bouyer splx(s);
1678 1.1 bouyer return;
1679 1.1 bouyer
1680 1.1 bouyer }
1681 1.1 bouyer
1682 1.1 bouyer void
1683 1.1 bouyer esiop_dump_script(sc)
1684 1.1 bouyer struct esiop_softc *sc;
1685 1.1 bouyer {
1686 1.1 bouyer int i;
1687 1.1 bouyer for (i = 0; i < PAGE_SIZE / 4; i += 2) {
1688 1.1 bouyer printf("0x%04x: 0x%08x 0x%08x", i * 4,
1689 1.1 bouyer le32toh(sc->sc_c.sc_script[i]),
1690 1.1 bouyer le32toh(sc->sc_c.sc_script[i+1]));
1691 1.1 bouyer if ((le32toh(sc->sc_c.sc_script[i]) & 0xe0000000) ==
1692 1.1 bouyer 0xc0000000) {
1693 1.1 bouyer i++;
1694 1.1 bouyer printf(" 0x%08x", le32toh(sc->sc_c.sc_script[i+1]));
1695 1.1 bouyer }
1696 1.1 bouyer printf("\n");
1697 1.1 bouyer }
1698 1.1 bouyer }
1699 1.1 bouyer
1700 1.1 bouyer void
1701 1.1 bouyer esiop_morecbd(sc)
1702 1.1 bouyer struct esiop_softc *sc;
1703 1.1 bouyer {
1704 1.1 bouyer int error, i, s;
1705 1.1 bouyer bus_dma_segment_t seg;
1706 1.1 bouyer int rseg;
1707 1.1 bouyer struct esiop_cbd *newcbd;
1708 1.1 bouyer struct esiop_xfer *xfer;
1709 1.1 bouyer bus_addr_t dsa;
1710 1.1 bouyer
1711 1.1 bouyer /* allocate a new list head */
1712 1.1 bouyer newcbd = malloc(sizeof(struct esiop_cbd), M_DEVBUF, M_NOWAIT|M_ZERO);
1713 1.1 bouyer if (newcbd == NULL) {
1714 1.1 bouyer printf("%s: can't allocate memory for command descriptors "
1715 1.1 bouyer "head\n", sc->sc_c.sc_dev.dv_xname);
1716 1.1 bouyer return;
1717 1.1 bouyer }
1718 1.1 bouyer
1719 1.1 bouyer /* allocate cmd list */
1720 1.1 bouyer newcbd->cmds = malloc(sizeof(struct esiop_cmd) * SIOP_NCMDPB,
1721 1.1 bouyer M_DEVBUF, M_NOWAIT|M_ZERO);
1722 1.1 bouyer if (newcbd->cmds == NULL) {
1723 1.1 bouyer printf("%s: can't allocate memory for command descriptors\n",
1724 1.1 bouyer sc->sc_c.sc_dev.dv_xname);
1725 1.1 bouyer goto bad3;
1726 1.1 bouyer }
1727 1.1 bouyer error = bus_dmamem_alloc(sc->sc_c.sc_dmat, PAGE_SIZE, PAGE_SIZE, 0,
1728 1.1 bouyer &seg, 1, &rseg, BUS_DMA_NOWAIT);
1729 1.1 bouyer if (error) {
1730 1.1 bouyer printf("%s: unable to allocate cbd DMA memory, error = %d\n",
1731 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1732 1.1 bouyer goto bad2;
1733 1.1 bouyer }
1734 1.1 bouyer error = bus_dmamem_map(sc->sc_c.sc_dmat, &seg, rseg, PAGE_SIZE,
1735 1.1 bouyer (caddr_t *)&newcbd->xfers, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
1736 1.1 bouyer if (error) {
1737 1.1 bouyer printf("%s: unable to map cbd DMA memory, error = %d\n",
1738 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1739 1.1 bouyer goto bad2;
1740 1.1 bouyer }
1741 1.1 bouyer error = bus_dmamap_create(sc->sc_c.sc_dmat, PAGE_SIZE, 1, PAGE_SIZE, 0,
1742 1.1 bouyer BUS_DMA_NOWAIT, &newcbd->xferdma);
1743 1.1 bouyer if (error) {
1744 1.1 bouyer printf("%s: unable to create cbd DMA map, error = %d\n",
1745 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1746 1.1 bouyer goto bad1;
1747 1.1 bouyer }
1748 1.1 bouyer error = bus_dmamap_load(sc->sc_c.sc_dmat, newcbd->xferdma,
1749 1.1 bouyer newcbd->xfers, PAGE_SIZE, NULL, BUS_DMA_NOWAIT);
1750 1.1 bouyer if (error) {
1751 1.1 bouyer printf("%s: unable to load cbd DMA map, error = %d\n",
1752 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1753 1.1 bouyer goto bad0;
1754 1.1 bouyer }
1755 1.1 bouyer #ifdef DEBUG
1756 1.1 bouyer printf("%s: alloc newcdb at PHY addr 0x%lx\n", sc->sc_c.sc_dev.dv_xname,
1757 1.1 bouyer (unsigned long)newcbd->xferdma->dm_segs[0].ds_addr);
1758 1.1 bouyer #endif
1759 1.1 bouyer for (i = 0; i < SIOP_NCMDPB; i++) {
1760 1.1 bouyer error = bus_dmamap_create(sc->sc_c.sc_dmat, MAXPHYS, SIOP_NSG,
1761 1.1 bouyer MAXPHYS, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
1762 1.1 bouyer &newcbd->cmds[i].cmd_c.dmamap_data);
1763 1.1 bouyer if (error) {
1764 1.1 bouyer printf("%s: unable to create data DMA map for cbd: "
1765 1.1 bouyer "error %d\n",
1766 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1767 1.1 bouyer goto bad0;
1768 1.1 bouyer }
1769 1.1 bouyer error = bus_dmamap_create(sc->sc_c.sc_dmat,
1770 1.1 bouyer sizeof(struct scsipi_generic), 1,
1771 1.1 bouyer sizeof(struct scsipi_generic), 0,
1772 1.1 bouyer BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
1773 1.1 bouyer &newcbd->cmds[i].cmd_c.dmamap_cmd);
1774 1.1 bouyer if (error) {
1775 1.1 bouyer printf("%s: unable to create cmd DMA map for cbd %d\n",
1776 1.1 bouyer sc->sc_c.sc_dev.dv_xname, error);
1777 1.1 bouyer goto bad0;
1778 1.1 bouyer }
1779 1.1 bouyer newcbd->cmds[i].cmd_c.siop_sc = &sc->sc_c;
1780 1.1 bouyer newcbd->cmds[i].esiop_cbdp = newcbd;
1781 1.1 bouyer xfer = &newcbd->xfers[i];
1782 1.1 bouyer newcbd->cmds[i].cmd_tables = (struct siop_common_xfer *)xfer;
1783 1.1 bouyer memset(newcbd->cmds[i].cmd_tables, 0,
1784 1.1 bouyer sizeof(struct esiop_xfer));
1785 1.1 bouyer dsa = newcbd->xferdma->dm_segs[0].ds_addr +
1786 1.1 bouyer i * sizeof(struct esiop_xfer);
1787 1.1 bouyer newcbd->cmds[i].cmd_c.dsa = dsa;
1788 1.1 bouyer newcbd->cmds[i].cmd_c.status = CMDST_FREE;
1789 1.1 bouyer xfer->siop_tables.t_msgout.count= htole32(1);
1790 1.1 bouyer xfer->siop_tables.t_msgout.addr = htole32(dsa);
1791 1.1 bouyer xfer->siop_tables.t_msgin.count= htole32(1);
1792 1.5 bouyer xfer->siop_tables.t_msgin.addr = htole32(dsa +
1793 1.5 bouyer offsetof(struct siop_common_xfer, msg_in));
1794 1.1 bouyer xfer->siop_tables.t_extmsgin.count= htole32(2);
1795 1.5 bouyer xfer->siop_tables.t_extmsgin.addr = htole32(dsa +
1796 1.5 bouyer offsetof(struct siop_common_xfer, msg_in) + 1);
1797 1.5 bouyer xfer->siop_tables.t_extmsgdata.addr = htole32(dsa +
1798 1.5 bouyer offsetof(struct siop_common_xfer, msg_in) + 3);
1799 1.1 bouyer xfer->siop_tables.t_status.count= htole32(1);
1800 1.5 bouyer xfer->siop_tables.t_status.addr = htole32(dsa +
1801 1.5 bouyer offsetof(struct siop_common_xfer, status));
1802 1.1 bouyer
1803 1.1 bouyer s = splbio();
1804 1.1 bouyer TAILQ_INSERT_TAIL(&sc->free_list, &newcbd->cmds[i], next);
1805 1.1 bouyer splx(s);
1806 1.1 bouyer #ifdef SIOP_DEBUG
1807 1.1 bouyer printf("tables[%d]: in=0x%x out=0x%x status=0x%x\n", i,
1808 1.1 bouyer le32toh(newcbd->cmds[i].cmd_tables->t_msgin.addr),
1809 1.1 bouyer le32toh(newcbd->cmds[i].cmd_tables->t_msgout.addr),
1810 1.1 bouyer le32toh(newcbd->cmds[i].cmd_tables->t_status.addr));
1811 1.1 bouyer #endif
1812 1.1 bouyer }
1813 1.1 bouyer s = splbio();
1814 1.1 bouyer TAILQ_INSERT_TAIL(&sc->cmds, newcbd, next);
1815 1.1 bouyer sc->sc_c.sc_adapt.adapt_openings += SIOP_NCMDPB;
1816 1.1 bouyer splx(s);
1817 1.1 bouyer return;
1818 1.1 bouyer bad0:
1819 1.1 bouyer bus_dmamap_unload(sc->sc_c.sc_dmat, newcbd->xferdma);
1820 1.1 bouyer bus_dmamap_destroy(sc->sc_c.sc_dmat, newcbd->xferdma);
1821 1.1 bouyer bad1:
1822 1.1 bouyer bus_dmamem_free(sc->sc_c.sc_dmat, &seg, rseg);
1823 1.1 bouyer bad2:
1824 1.1 bouyer free(newcbd->cmds, M_DEVBUF);
1825 1.1 bouyer bad3:
1826 1.1 bouyer free(newcbd, M_DEVBUF);
1827 1.1 bouyer return;
1828 1.1 bouyer }
1829 1.1 bouyer
1830 1.1 bouyer void
1831 1.2 bouyer esiop_moretagtbl(sc)
1832 1.2 bouyer struct esiop_softc *sc;
1833 1.2 bouyer {
1834 1.2 bouyer int error, i, j, s;
1835 1.2 bouyer bus_dma_segment_t seg;
1836 1.2 bouyer int rseg;
1837 1.2 bouyer struct esiop_dsatblblk *newtblblk;
1838 1.2 bouyer struct esiop_dsatbl *newtbls;
1839 1.2 bouyer u_int32_t *tbls;
1840 1.2 bouyer
1841 1.2 bouyer /* allocate a new list head */
1842 1.2 bouyer newtblblk = malloc(sizeof(struct esiop_dsatblblk),
1843 1.2 bouyer M_DEVBUF, M_NOWAIT|M_ZERO);
1844 1.2 bouyer if (newtblblk == NULL) {
1845 1.2 bouyer printf("%s: can't allocate memory for tag DSA table block\n",
1846 1.2 bouyer sc->sc_c.sc_dev.dv_xname);
1847 1.2 bouyer return;
1848 1.2 bouyer }
1849 1.2 bouyer
1850 1.2 bouyer /* allocate tbl list */
1851 1.2 bouyer newtbls = malloc(sizeof(struct esiop_dsatbl) * ESIOP_NTPB,
1852 1.2 bouyer M_DEVBUF, M_NOWAIT|M_ZERO);
1853 1.2 bouyer if (newtbls == NULL) {
1854 1.2 bouyer printf("%s: can't allocate memory for command descriptors\n",
1855 1.2 bouyer sc->sc_c.sc_dev.dv_xname);
1856 1.2 bouyer goto bad3;
1857 1.2 bouyer }
1858 1.2 bouyer error = bus_dmamem_alloc(sc->sc_c.sc_dmat, PAGE_SIZE, PAGE_SIZE, 0,
1859 1.2 bouyer &seg, 1, &rseg, BUS_DMA_NOWAIT);
1860 1.2 bouyer if (error) {
1861 1.2 bouyer printf("%s: unable to allocate tbl DMA memory, error = %d\n",
1862 1.2 bouyer sc->sc_c.sc_dev.dv_xname, error);
1863 1.2 bouyer goto bad2;
1864 1.2 bouyer }
1865 1.2 bouyer error = bus_dmamem_map(sc->sc_c.sc_dmat, &seg, rseg, PAGE_SIZE,
1866 1.2 bouyer (caddr_t *)&tbls, BUS_DMA_NOWAIT|BUS_DMA_COHERENT);
1867 1.2 bouyer if (error) {
1868 1.2 bouyer printf("%s: unable to map tbls DMA memory, error = %d\n",
1869 1.2 bouyer sc->sc_c.sc_dev.dv_xname, error);
1870 1.2 bouyer goto bad2;
1871 1.2 bouyer }
1872 1.2 bouyer error = bus_dmamap_create(sc->sc_c.sc_dmat, PAGE_SIZE, 1, PAGE_SIZE, 0,
1873 1.2 bouyer BUS_DMA_NOWAIT, &newtblblk->blkmap);
1874 1.2 bouyer if (error) {
1875 1.2 bouyer printf("%s: unable to create tbl DMA map, error = %d\n",
1876 1.2 bouyer sc->sc_c.sc_dev.dv_xname, error);
1877 1.2 bouyer goto bad1;
1878 1.2 bouyer }
1879 1.2 bouyer error = bus_dmamap_load(sc->sc_c.sc_dmat, newtblblk->blkmap,
1880 1.2 bouyer tbls, PAGE_SIZE, NULL, BUS_DMA_NOWAIT);
1881 1.2 bouyer if (error) {
1882 1.2 bouyer printf("%s: unable to load tbl DMA map, error = %d\n",
1883 1.2 bouyer sc->sc_c.sc_dev.dv_xname, error);
1884 1.2 bouyer goto bad0;
1885 1.2 bouyer }
1886 1.2 bouyer #ifdef DEBUG
1887 1.2 bouyer printf("%s: alloc new tag DSA table at PHY addr 0x%lx\n",
1888 1.2 bouyer sc->sc_c.sc_dev.dv_xname,
1889 1.2 bouyer (unsigned long)newtblblk->blkmap->dm_segs[0].ds_addr);
1890 1.2 bouyer #endif
1891 1.2 bouyer for (i = 0; i < ESIOP_NTPB; i++) {
1892 1.2 bouyer newtbls[i].tblblk = newtblblk;
1893 1.2 bouyer newtbls[i].tbl = &tbls[i * ESIOP_NTAG];
1894 1.2 bouyer newtbls[i].tbl_offset = i * ESIOP_NTAG * sizeof(u_int32_t);
1895 1.2 bouyer newtbls[i].tbl_dsa = newtblblk->blkmap->dm_segs[0].ds_addr +
1896 1.2 bouyer newtbls[i].tbl_offset;
1897 1.2 bouyer for (j = 0; j < ESIOP_NTAG; j++)
1898 1.2 bouyer newtbls[i].tbl[j] = j;
1899 1.2 bouyer s = splbio();
1900 1.2 bouyer TAILQ_INSERT_TAIL(&sc->free_tagtbl, &newtbls[i], next);
1901 1.2 bouyer splx(s);
1902 1.2 bouyer }
1903 1.2 bouyer s = splbio();
1904 1.2 bouyer TAILQ_INSERT_TAIL(&sc->tag_tblblk, newtblblk, next);
1905 1.2 bouyer splx(s);
1906 1.2 bouyer return;
1907 1.2 bouyer bad0:
1908 1.2 bouyer bus_dmamap_unload(sc->sc_c.sc_dmat, newtblblk->blkmap);
1909 1.2 bouyer bus_dmamap_destroy(sc->sc_c.sc_dmat, newtblblk->blkmap);
1910 1.2 bouyer bad1:
1911 1.2 bouyer bus_dmamem_free(sc->sc_c.sc_dmat, &seg, rseg);
1912 1.2 bouyer bad2:
1913 1.2 bouyer free(newtbls, M_DEVBUF);
1914 1.2 bouyer bad3:
1915 1.2 bouyer free(newtblblk, M_DEVBUF);
1916 1.2 bouyer return;
1917 1.1 bouyer }
1918 1.1 bouyer
1919 1.1 bouyer void
1920 1.9 bouyer esiop_update_scntl3(sc, _siop_target)
1921 1.9 bouyer struct esiop_softc *sc;
1922 1.9 bouyer struct siop_common_target *_siop_target;
1923 1.9 bouyer {
1924 1.9 bouyer struct esiop_target *esiop_target = (struct esiop_target *)_siop_target;
1925 1.9 bouyer esiop_script_write(sc, esiop_target->lun_table_offset,
1926 1.9 bouyer esiop_target->target_c.id);
1927 1.9 bouyer }
1928 1.9 bouyer
1929 1.9 bouyer void
1930 1.1 bouyer esiop_add_dev(sc, target, lun)
1931 1.1 bouyer struct esiop_softc *sc;
1932 1.1 bouyer int target;
1933 1.1 bouyer int lun;
1934 1.1 bouyer {
1935 1.1 bouyer struct esiop_target *esiop_target =
1936 1.1 bouyer (struct esiop_target *)sc->sc_c.targets[target];
1937 1.1 bouyer struct esiop_lun *esiop_lun = esiop_target->esiop_lun[lun];
1938 1.2 bouyer
1939 1.9 bouyer /* we need a tag DSA table */
1940 1.9 bouyer esiop_lun->lun_tagtbl= TAILQ_FIRST(&sc->free_tagtbl);
1941 1.9 bouyer if (esiop_lun->lun_tagtbl == NULL) {
1942 1.9 bouyer esiop_moretagtbl(sc);
1943 1.2 bouyer esiop_lun->lun_tagtbl= TAILQ_FIRST(&sc->free_tagtbl);
1944 1.2 bouyer if (esiop_lun->lun_tagtbl == NULL) {
1945 1.9 bouyer /* no resources, run untagged */
1946 1.9 bouyer esiop_target->target_c.flags &= ~TARF_TAG;
1947 1.9 bouyer return;
1948 1.1 bouyer }
1949 1.1 bouyer }
1950 1.9 bouyer TAILQ_REMOVE(&sc->free_tagtbl, esiop_lun->lun_tagtbl, next);
1951 1.9 bouyer /* Update LUN DSA table */
1952 1.9 bouyer esiop_script_write(sc, esiop_target->lun_table_offset +
1953 1.9 bouyer lun * 2 + A_target_luntbl_tag / sizeof(u_int32_t),
1954 1.9 bouyer esiop_lun->lun_tagtbl->tbl_dsa);
1955 1.9 bouyer esiop_script_sync(sc, BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1956 1.1 bouyer }
1957 1.1 bouyer
1958 1.1 bouyer void
1959 1.1 bouyer esiop_del_dev(sc, target, lun)
1960 1.1 bouyer struct esiop_softc *sc;
1961 1.1 bouyer int target;
1962 1.1 bouyer int lun;
1963 1.1 bouyer {
1964 1.1 bouyer struct esiop_target *esiop_target;
1965 1.1 bouyer #ifdef SIOP_DEBUG
1966 1.1 bouyer printf("%s:%d:%d: free lun sw entry\n",
1967 1.1 bouyer sc->sc_c.sc_dev.dv_xname, target, lun);
1968 1.1 bouyer #endif
1969 1.1 bouyer if (sc->sc_c.targets[target] == NULL)
1970 1.1 bouyer return;
1971 1.1 bouyer esiop_target = (struct esiop_target *)sc->sc_c.targets[target];
1972 1.1 bouyer free(esiop_target->esiop_lun[lun], M_DEVBUF);
1973 1.1 bouyer esiop_target->esiop_lun[lun] = NULL;
1974 1.1 bouyer }
1975 1.1 bouyer
1976 1.1 bouyer void
1977 1.1 bouyer esiop_target_register(sc, target)
1978 1.1 bouyer struct esiop_softc *sc;
1979 1.1 bouyer u_int32_t target;
1980 1.1 bouyer {
1981 1.1 bouyer struct esiop_target *esiop_target =
1982 1.1 bouyer (struct esiop_target *)sc->sc_c.targets[target];
1983 1.9 bouyer struct esiop_lun *esiop_lun;
1984 1.9 bouyer int lun;
1985 1.1 bouyer
1986 1.1 bouyer /* get a DSA table for this target */
1987 1.1 bouyer esiop_target->lun_table_offset = sc->sc_free_offset;
1988 1.9 bouyer sc->sc_free_offset += sc->sc_c.sc_chan.chan_nluns * 2 + 2;
1989 1.1 bouyer #ifdef SIOP_DEBUG
1990 1.1 bouyer printf("%s: lun table for target %d offset %d free offset %d\n",
1991 1.1 bouyer sc->sc_c.sc_dev.dv_xname, target, esiop_target->lun_table_offset,
1992 1.1 bouyer sc->sc_free_offset);
1993 1.1 bouyer #endif
1994 1.1 bouyer /* first 32 bytes are ID (for select) */
1995 1.1 bouyer esiop_script_write(sc, esiop_target->lun_table_offset,
1996 1.1 bouyer esiop_target->target_c.id);
1997 1.1 bouyer /* Record this table in the target DSA table */
1998 1.1 bouyer esiop_script_write(sc,
1999 1.1 bouyer sc->sc_target_table_offset + target,
2000 1.1 bouyer (esiop_target->lun_table_offset * sizeof(u_int32_t)) +
2001 1.1 bouyer sc->sc_c.sc_scriptaddr);
2002 1.9 bouyer /* if we have a tag table, register it */
2003 1.9 bouyer for (lun = 0; lun < sc->sc_c.sc_chan.chan_nluns; lun++) {
2004 1.9 bouyer esiop_lun = esiop_target->esiop_lun[lun];
2005 1.9 bouyer if (esiop_lun == NULL)
2006 1.9 bouyer continue;
2007 1.9 bouyer if (esiop_lun->lun_tagtbl)
2008 1.9 bouyer esiop_script_write(sc, esiop_target->lun_table_offset +
2009 1.9 bouyer lun * 2 + A_target_luntbl_tag / sizeof(u_int32_t),
2010 1.9 bouyer esiop_lun->lun_tagtbl->tbl_dsa);
2011 1.9 bouyer }
2012 1.1 bouyer esiop_script_sync(sc,
2013 1.1 bouyer BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
2014 1.1 bouyer }
2015 1.1 bouyer
2016 1.1 bouyer #ifdef SIOP_STATS
2017 1.1 bouyer void
2018 1.1 bouyer esiop_printstats()
2019 1.1 bouyer {
2020 1.1 bouyer printf("esiop_stat_intr %d\n", esiop_stat_intr);
2021 1.1 bouyer printf("esiop_stat_intr_shortxfer %d\n", esiop_stat_intr_shortxfer);
2022 1.1 bouyer printf("esiop_stat_intr_xferdisc %d\n", esiop_stat_intr_xferdisc);
2023 1.1 bouyer printf("esiop_stat_intr_sdp %d\n", esiop_stat_intr_sdp);
2024 1.1 bouyer printf("esiop_stat_intr_done %d\n", esiop_stat_intr_done);
2025 1.1 bouyer printf("esiop_stat_intr_lunresel %d\n", esiop_stat_intr_lunresel);
2026 1.1 bouyer printf("esiop_stat_intr_qfull %d\n", esiop_stat_intr_qfull);
2027 1.1 bouyer }
2028 1.1 bouyer #endif
2029