icp.c revision 1.10 1 1.10 thorpej /* $NetBSD: icp.c,v 1.10 2003/06/13 05:57:30 thorpej Exp $ */
2 1.1 ad
3 1.1 ad /*-
4 1.8 thorpej * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.1 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.8 thorpej * by Andrew Doran, and by Jason R. Thorpe of Wasabi Systems, Inc.
9 1.1 ad *
10 1.1 ad * Redistribution and use in source and binary forms, with or without
11 1.1 ad * modification, are permitted provided that the following conditions
12 1.1 ad * are met:
13 1.1 ad * 1. Redistributions of source code must retain the above copyright
14 1.1 ad * notice, this list of conditions and the following disclaimer.
15 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 ad * notice, this list of conditions and the following disclaimer in the
17 1.1 ad * documentation and/or other materials provided with the distribution.
18 1.1 ad * 3. All advertising materials mentioning features or use of this software
19 1.1 ad * must display the following acknowledgement:
20 1.1 ad * This product includes software developed by the NetBSD
21 1.1 ad * Foundation, Inc. and its contributors.
22 1.1 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 ad * contributors may be used to endorse or promote products derived
24 1.1 ad * from this software without specific prior written permission.
25 1.1 ad *
26 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.1 ad */
38 1.1 ad
39 1.1 ad /*
40 1.1 ad * Copyright (c) 1999, 2000 Niklas Hallqvist. All rights reserved.
41 1.1 ad *
42 1.1 ad * Redistribution and use in source and binary forms, with or without
43 1.1 ad * modification, are permitted provided that the following conditions
44 1.1 ad * are met:
45 1.1 ad * 1. Redistributions of source code must retain the above copyright
46 1.1 ad * notice, this list of conditions and the following disclaimer.
47 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
48 1.1 ad * notice, this list of conditions and the following disclaimer in the
49 1.1 ad * documentation and/or other materials provided with the distribution.
50 1.1 ad * 3. All advertising materials mentioning features or use of this software
51 1.1 ad * must display the following acknowledgement:
52 1.1 ad * This product includes software developed by Niklas Hallqvist.
53 1.1 ad * 4. The name of the author may not be used to endorse or promote products
54 1.1 ad * derived from this software without specific prior written permission.
55 1.1 ad *
56 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
57 1.1 ad * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
58 1.1 ad * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
59 1.1 ad * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
60 1.1 ad * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
61 1.1 ad * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
62 1.1 ad * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
63 1.1 ad * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
64 1.1 ad * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
65 1.1 ad * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
66 1.1 ad *
67 1.1 ad * from OpenBSD: gdt_common.c,v 1.12 2001/07/04 06:43:18 niklas Exp
68 1.1 ad */
69 1.1 ad
70 1.1 ad /*
71 1.1 ad * This driver would not have written if it was not for the hardware donations
72 1.1 ad * from both ICP-Vortex and ko.neT. I want to thank them for their support.
73 1.1 ad *
74 1.1 ad * Re-worked for NetBSD by Andrew Doran. Test hardware kindly supplied by
75 1.1 ad * Intel.
76 1.8 thorpej *
77 1.8 thorpej * Support for the ICP-Vortex management tools added by
78 1.8 thorpej * Jason R. Thorpe of Wasabi Systems, Inc., based on code
79 1.10 thorpej * provided by Achim Leubner <achim.leubner (at) intel.com>.
80 1.10 thorpej *
81 1.10 thorpej * Additional support for dynamic rescan of cacheservice drives by
82 1.10 thorpej * Jason R. Thorpe of Wasabi Systems, Inc.
83 1.1 ad */
84 1.1 ad
85 1.1 ad #include <sys/cdefs.h>
86 1.10 thorpej __KERNEL_RCSID(0, "$NetBSD: icp.c,v 1.10 2003/06/13 05:57:30 thorpej Exp $");
87 1.1 ad
88 1.1 ad #include <sys/param.h>
89 1.1 ad #include <sys/systm.h>
90 1.1 ad #include <sys/kernel.h>
91 1.1 ad #include <sys/device.h>
92 1.1 ad #include <sys/queue.h>
93 1.1 ad #include <sys/proc.h>
94 1.1 ad #include <sys/buf.h>
95 1.1 ad #include <sys/endian.h>
96 1.1 ad #include <sys/malloc.h>
97 1.1 ad #include <sys/disk.h>
98 1.1 ad
99 1.1 ad #include <uvm/uvm_extern.h>
100 1.1 ad
101 1.1 ad #include <machine/bswap.h>
102 1.1 ad #include <machine/bus.h>
103 1.1 ad
104 1.1 ad #include <dev/pci/pcireg.h>
105 1.1 ad #include <dev/pci/pcivar.h>
106 1.1 ad #include <dev/pci/pcidevs.h>
107 1.1 ad
108 1.1 ad #include <dev/ic/icpreg.h>
109 1.1 ad #include <dev/ic/icpvar.h>
110 1.1 ad
111 1.8 thorpej #include <dev/scsipi/scsipi_all.h>
112 1.8 thorpej #include <dev/scsipi/scsiconf.h>
113 1.8 thorpej
114 1.1 ad int icp_async_event(struct icp_softc *, int);
115 1.1 ad void icp_ccb_submit(struct icp_softc *icp, struct icp_ccb *ic);
116 1.1 ad void icp_chain(struct icp_softc *);
117 1.1 ad int icp_print(void *, const char *);
118 1.1 ad int icp_submatch(struct device *, struct cfdata *, void *);
119 1.1 ad void icp_watchdog(void *);
120 1.8 thorpej void icp_ucmd_intr(struct icp_ccb *);
121 1.10 thorpej void icp_recompute_openings(struct icp_softc *);
122 1.8 thorpej
123 1.8 thorpej int icp_count; /* total # of controllers, for ioctl interface */
124 1.8 thorpej
125 1.8 thorpej /*
126 1.8 thorpej * Statistics for the ioctl interface to query.
127 1.8 thorpej *
128 1.8 thorpej * XXX Global. They should probably be made per-controller
129 1.8 thorpej * XXX at some point.
130 1.8 thorpej */
131 1.8 thorpej gdt_statist_t icp_stats;
132 1.1 ad
133 1.1 ad int
134 1.1 ad icp_init(struct icp_softc *icp, const char *intrstr)
135 1.1 ad {
136 1.1 ad struct icp_attach_args icpa;
137 1.1 ad struct icp_binfo binfo;
138 1.1 ad struct icp_ccb *ic;
139 1.1 ad u_int16_t cdev_cnt;
140 1.10 thorpej int i, j, state, feat, nsegs, rv;
141 1.1 ad
142 1.5 simonb state = 0;
143 1.1 ad
144 1.1 ad if (intrstr != NULL)
145 1.7 thorpej aprint_normal("%s: interrupting at %s\n", icp->icp_dv.dv_xname,
146 1.1 ad intrstr);
147 1.1 ad
148 1.1 ad SIMPLEQ_INIT(&icp->icp_ccb_queue);
149 1.1 ad SIMPLEQ_INIT(&icp->icp_ccb_freelist);
150 1.8 thorpej SIMPLEQ_INIT(&icp->icp_ucmd_queue);
151 1.1 ad callout_init(&icp->icp_wdog_callout);
152 1.1 ad
153 1.1 ad /*
154 1.1 ad * Allocate a scratch area.
155 1.1 ad */
156 1.1 ad if (bus_dmamap_create(icp->icp_dmat, ICP_SCRATCH_SIZE, 1,
157 1.1 ad ICP_SCRATCH_SIZE, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
158 1.1 ad &icp->icp_scr_dmamap) != 0) {
159 1.7 thorpej aprint_error("%s: cannot create scratch dmamap\n",
160 1.1 ad icp->icp_dv.dv_xname);
161 1.1 ad return (1);
162 1.1 ad }
163 1.1 ad state++;
164 1.1 ad
165 1.1 ad if (bus_dmamem_alloc(icp->icp_dmat, ICP_SCRATCH_SIZE, PAGE_SIZE, 0,
166 1.1 ad icp->icp_scr_seg, 1, &nsegs, BUS_DMA_NOWAIT) != 0) {
167 1.7 thorpej aprint_error("%s: cannot alloc scratch dmamem\n",
168 1.1 ad icp->icp_dv.dv_xname);
169 1.1 ad goto bail_out;
170 1.1 ad }
171 1.1 ad state++;
172 1.1 ad
173 1.1 ad if (bus_dmamem_map(icp->icp_dmat, icp->icp_scr_seg, nsegs,
174 1.1 ad ICP_SCRATCH_SIZE, &icp->icp_scr, 0)) {
175 1.7 thorpej aprint_error("%s: cannot map scratch dmamem\n",
176 1.7 thorpej icp->icp_dv.dv_xname);
177 1.1 ad goto bail_out;
178 1.1 ad }
179 1.1 ad state++;
180 1.1 ad
181 1.1 ad if (bus_dmamap_load(icp->icp_dmat, icp->icp_scr_dmamap, icp->icp_scr,
182 1.1 ad ICP_SCRATCH_SIZE, NULL, BUS_DMA_NOWAIT)) {
183 1.7 thorpej aprint_error("%s: cannot load scratch dmamap\n",
184 1.7 thorpej icp->icp_dv.dv_xname);
185 1.1 ad goto bail_out;
186 1.1 ad }
187 1.1 ad state++;
188 1.1 ad
189 1.1 ad /*
190 1.1 ad * Allocate and initialize the command control blocks.
191 1.1 ad */
192 1.1 ad ic = malloc(sizeof(*ic) * ICP_NCCBS, M_DEVBUF, M_NOWAIT | M_ZERO);
193 1.1 ad if ((icp->icp_ccbs = ic) == NULL) {
194 1.7 thorpej aprint_error("%s: malloc() failed\n", icp->icp_dv.dv_xname);
195 1.1 ad goto bail_out;
196 1.1 ad }
197 1.1 ad state++;
198 1.1 ad
199 1.1 ad for (i = 0; i < ICP_NCCBS; i++, ic++) {
200 1.1 ad /*
201 1.1 ad * The first two command indexes have special meanings, so
202 1.1 ad * we can't use them.
203 1.1 ad */
204 1.1 ad ic->ic_ident = i + 2;
205 1.1 ad rv = bus_dmamap_create(icp->icp_dmat, ICP_MAX_XFER,
206 1.1 ad ICP_MAXSG, ICP_MAX_XFER, 0,
207 1.1 ad BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
208 1.1 ad &ic->ic_xfer_map);
209 1.1 ad if (rv != 0)
210 1.1 ad break;
211 1.1 ad icp->icp_nccbs++;
212 1.1 ad icp_ccb_free(icp, ic);
213 1.1 ad }
214 1.1 ad #ifdef DIAGNOSTIC
215 1.1 ad if (icp->icp_nccbs != ICP_NCCBS)
216 1.7 thorpej aprint_error("%s: %d/%d CCBs usable\n", icp->icp_dv.dv_xname,
217 1.1 ad icp->icp_nccbs, ICP_NCCBS);
218 1.1 ad #endif
219 1.1 ad
220 1.1 ad /*
221 1.1 ad * Initalize the controller.
222 1.1 ad */
223 1.1 ad if (!icp_cmd(icp, ICP_SCREENSERVICE, ICP_INIT, 0, 0, 0)) {
224 1.7 thorpej aprint_error("%s: screen service init error %d\n",
225 1.1 ad icp->icp_dv.dv_xname, icp->icp_status);
226 1.1 ad goto bail_out;
227 1.1 ad }
228 1.1 ad
229 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
230 1.7 thorpej aprint_error("%s: cache service init error %d\n",
231 1.1 ad icp->icp_dv.dv_xname, icp->icp_status);
232 1.1 ad goto bail_out;
233 1.1 ad }
234 1.1 ad
235 1.1 ad icp_cmd(icp, ICP_CACHESERVICE, ICP_UNFREEZE_IO, 0, 0, 0);
236 1.1 ad
237 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_MOUNT, 0xffff, 1, 0)) {
238 1.7 thorpej aprint_error("%s: cache service mount error %d\n",
239 1.1 ad icp->icp_dv.dv_xname, icp->icp_status);
240 1.1 ad goto bail_out;
241 1.1 ad }
242 1.1 ad
243 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
244 1.7 thorpej aprint_error("%s: cache service post-mount init error %d\n",
245 1.1 ad icp->icp_dv.dv_xname, icp->icp_status);
246 1.1 ad goto bail_out;
247 1.1 ad }
248 1.1 ad cdev_cnt = (u_int16_t)icp->icp_info;
249 1.8 thorpej icp->icp_fw_vers = icp->icp_service;
250 1.1 ad
251 1.1 ad if (!icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_INIT, 0, 0, 0)) {
252 1.7 thorpej aprint_error("%s: raw service init error %d\n",
253 1.1 ad icp->icp_dv.dv_xname, icp->icp_status);
254 1.1 ad goto bail_out;
255 1.1 ad }
256 1.1 ad
257 1.1 ad /*
258 1.1 ad * Set/get raw service features (scatter/gather).
259 1.1 ad */
260 1.1 ad feat = 0;
261 1.1 ad if (icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_SET_FEAT, ICP_SCATTER_GATHER,
262 1.1 ad 0, 0))
263 1.1 ad if (icp_cmd(icp, ICP_SCSIRAWSERVICE, ICP_GET_FEAT, 0, 0, 0))
264 1.1 ad feat = icp->icp_info;
265 1.1 ad
266 1.1 ad if ((feat & ICP_SCATTER_GATHER) == 0) {
267 1.1 ad #ifdef DIAGNOSTIC
268 1.7 thorpej aprint_normal(
269 1.7 thorpej "%s: scatter/gather not supported (raw service)\n",
270 1.1 ad icp->icp_dv.dv_xname);
271 1.1 ad #endif
272 1.10 thorpej } else
273 1.10 thorpej icp->icp_features |= ICP_FEAT_RAWSERVICE;
274 1.1 ad
275 1.1 ad /*
276 1.1 ad * Set/get cache service features (scatter/gather).
277 1.1 ad */
278 1.1 ad feat = 0;
279 1.1 ad if (icp_cmd(icp, ICP_CACHESERVICE, ICP_SET_FEAT, 0,
280 1.1 ad ICP_SCATTER_GATHER, 0))
281 1.1 ad if (icp_cmd(icp, ICP_CACHESERVICE, ICP_GET_FEAT, 0, 0, 0))
282 1.1 ad feat = icp->icp_info;
283 1.1 ad
284 1.1 ad if ((feat & ICP_SCATTER_GATHER) == 0) {
285 1.1 ad #ifdef DIAGNOSTIC
286 1.7 thorpej aprint_normal(
287 1.7 thorpej "%s: scatter/gather not supported (cache service)\n",
288 1.1 ad icp->icp_dv.dv_xname);
289 1.1 ad #endif
290 1.10 thorpej } else
291 1.10 thorpej icp->icp_features |= ICP_FEAT_CACHESERVICE;
292 1.1 ad
293 1.1 ad /*
294 1.1 ad * Pull some information from the board and dump.
295 1.1 ad */
296 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL, ICP_BOARD_INFO,
297 1.1 ad ICP_INVALID_CHANNEL, sizeof(struct icp_binfo))) {
298 1.7 thorpej aprint_error("%s: unable to retrive board info\n",
299 1.1 ad icp->icp_dv.dv_xname);
300 1.1 ad goto bail_out;
301 1.1 ad }
302 1.1 ad memcpy(&binfo, icp->icp_scr, sizeof(binfo));
303 1.1 ad
304 1.7 thorpej aprint_normal(
305 1.7 thorpej "%s: model <%s>, firmware <%s>, %d channel(s), %dMB memory\n",
306 1.1 ad icp->icp_dv.dv_xname, binfo.bi_type_string, binfo.bi_raid_string,
307 1.1 ad binfo.bi_chan_count, le32toh(binfo.bi_memsize) >> 20);
308 1.1 ad
309 1.1 ad /*
310 1.1 ad * Determine the number of devices, and number of openings per
311 1.1 ad * device.
312 1.1 ad */
313 1.10 thorpej if (icp->icp_features & ICP_FEAT_CACHESERVICE) {
314 1.1 ad for (j = 0; j < cdev_cnt && j < ICP_MAX_HDRIVES; j++) {
315 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INFO, j, 0,
316 1.1 ad 0))
317 1.1 ad continue;
318 1.1 ad
319 1.1 ad icp->icp_cdr[j].cd_size = icp->icp_info;
320 1.10 thorpej if (icp->icp_cdr[j].cd_size != 0)
321 1.10 thorpej icp->icp_ndevs++;
322 1.1 ad
323 1.1 ad if (icp_cmd(icp, ICP_CACHESERVICE, ICP_DEVTYPE, j, 0,
324 1.1 ad 0))
325 1.1 ad icp->icp_cdr[j].cd_type = icp->icp_info;
326 1.1 ad }
327 1.1 ad }
328 1.1 ad
329 1.10 thorpej if (icp->icp_features & ICP_FEAT_RAWSERVICE) {
330 1.10 thorpej icp->icp_nchan = binfo.bi_chan_count;
331 1.10 thorpej icp->icp_ndevs += icp->icp_nchan;
332 1.10 thorpej }
333 1.1 ad
334 1.10 thorpej icp_recompute_openings(icp);
335 1.1 ad
336 1.1 ad /*
337 1.1 ad * Attach SCSI channels.
338 1.1 ad */
339 1.10 thorpej if (icp->icp_features & ICP_FEAT_RAWSERVICE) {
340 1.1 ad struct icp_ioc_version *iv;
341 1.1 ad struct icp_rawioc *ri;
342 1.1 ad struct icp_getch *gc;
343 1.1 ad
344 1.1 ad iv = (struct icp_ioc_version *)icp->icp_scr;
345 1.1 ad iv->iv_version = htole32(ICP_IOC_NEWEST);
346 1.1 ad iv->iv_listents = ICP_MAXBUS;
347 1.1 ad iv->iv_firstchan = 0;
348 1.1 ad iv->iv_lastchan = ICP_MAXBUS - 1;
349 1.1 ad iv->iv_listoffset = htole32(sizeof(*iv));
350 1.1 ad
351 1.1 ad if (icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL,
352 1.1 ad ICP_IOCHAN_RAW_DESC, ICP_INVALID_CHANNEL,
353 1.1 ad sizeof(*iv) + ICP_MAXBUS * sizeof(*ri))) {
354 1.1 ad ri = (struct icp_rawioc *)(iv + 1);
355 1.1 ad for (j = 0; j < binfo.bi_chan_count; j++, ri++)
356 1.1 ad icp->icp_bus_id[j] = ri->ri_procid;
357 1.1 ad } else {
358 1.1 ad /*
359 1.1 ad * Fall back to the old method.
360 1.1 ad */
361 1.1 ad gc = (struct icp_getch *)icp->icp_scr;
362 1.1 ad
363 1.1 ad for (i = 0; j < binfo.bi_chan_count; j++) {
364 1.1 ad if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_IOCTL,
365 1.1 ad ICP_SCSI_CHAN_CNT | ICP_L_CTRL_PATTERN,
366 1.1 ad ICP_IO_CHANNEL | ICP_INVALID_CHANNEL,
367 1.1 ad sizeof(*gc))) {
368 1.7 thorpej aprint_error(
369 1.7 thorpej "%s: unable to get chan info",
370 1.1 ad icp->icp_dv.dv_xname);
371 1.1 ad goto bail_out;
372 1.1 ad }
373 1.1 ad icp->icp_bus_id[j] = gc->gc_scsiid;
374 1.1 ad }
375 1.1 ad }
376 1.1 ad
377 1.1 ad for (j = 0; j < binfo.bi_chan_count; j++) {
378 1.1 ad if (icp->icp_bus_id[j] > ICP_MAXID_FC)
379 1.1 ad icp->icp_bus_id[j] = ICP_MAXID_FC;
380 1.1 ad
381 1.1 ad icpa.icpa_unit = j + ICPA_UNIT_SCSI;
382 1.10 thorpej icp->icp_children[icpa.icpa_unit] =
383 1.10 thorpej config_found_sm(&icp->icp_dv, &icpa, icp_print,
384 1.1 ad icp_submatch);
385 1.1 ad }
386 1.1 ad }
387 1.1 ad
388 1.1 ad /*
389 1.1 ad * Attach cache devices.
390 1.1 ad */
391 1.10 thorpej if (icp->icp_features & ICP_FEAT_CACHESERVICE) {
392 1.1 ad for (j = 0; j < cdev_cnt && j < ICP_MAX_HDRIVES; j++) {
393 1.1 ad if (icp->icp_cdr[j].cd_size == 0)
394 1.1 ad continue;
395 1.1 ad
396 1.1 ad icpa.icpa_unit = j;
397 1.10 thorpej icp->icp_children[icpa.icpa_unit] =
398 1.10 thorpej config_found_sm(&icp->icp_dv, &icpa, icp_print,
399 1.1 ad icp_submatch);
400 1.1 ad }
401 1.1 ad }
402 1.1 ad
403 1.1 ad /*
404 1.1 ad * Start the watchdog.
405 1.1 ad */
406 1.1 ad icp_watchdog(icp);
407 1.8 thorpej
408 1.8 thorpej /*
409 1.8 thorpej * Count the controller, and we're done!
410 1.8 thorpej */
411 1.8 thorpej icp_count++;
412 1.8 thorpej
413 1.1 ad return (0);
414 1.1 ad
415 1.1 ad bail_out:
416 1.1 ad if (state > 4)
417 1.1 ad for (j = 0; j < i; j++)
418 1.1 ad bus_dmamap_destroy(icp->icp_dmat,
419 1.1 ad icp->icp_ccbs[j].ic_xfer_map);
420 1.1 ad if (state > 3)
421 1.1 ad free(icp->icp_ccbs, M_DEVBUF);
422 1.1 ad if (state > 2)
423 1.1 ad bus_dmamap_unload(icp->icp_dmat, icp->icp_scr_dmamap);
424 1.1 ad if (state > 1)
425 1.1 ad bus_dmamem_unmap(icp->icp_dmat, icp->icp_scr,
426 1.1 ad ICP_SCRATCH_SIZE);
427 1.1 ad if (state > 0)
428 1.1 ad bus_dmamem_free(icp->icp_dmat, icp->icp_scr_seg, nsegs);
429 1.1 ad bus_dmamap_destroy(icp->icp_dmat, icp->icp_scr_dmamap);
430 1.1 ad
431 1.1 ad return (1);
432 1.1 ad }
433 1.1 ad
434 1.1 ad void
435 1.10 thorpej icp_register_servicecb(struct icp_softc *icp, int unit,
436 1.10 thorpej const struct icp_servicecb *cb)
437 1.10 thorpej {
438 1.10 thorpej
439 1.10 thorpej icp->icp_servicecb[unit] = cb;
440 1.10 thorpej }
441 1.10 thorpej
442 1.10 thorpej void
443 1.10 thorpej icp_rescan(struct icp_softc *icp, int unit)
444 1.10 thorpej {
445 1.10 thorpej struct icp_attach_args icpa;
446 1.10 thorpej u_int newsize, newtype;
447 1.10 thorpej
448 1.10 thorpej /*
449 1.10 thorpej * NOTE: It is very important that the queue be frozen and not
450 1.10 thorpej * commands running when this is called. The ioctl mutex must
451 1.10 thorpej * also be held.
452 1.10 thorpej */
453 1.10 thorpej
454 1.10 thorpej KASSERT(icp->icp_qfreeze != 0);
455 1.10 thorpej KASSERT(icp->icp_running == 0);
456 1.10 thorpej KASSERT(unit < ICP_MAX_HDRIVES);
457 1.10 thorpej
458 1.10 thorpej if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INFO, unit, 0, 0)) {
459 1.10 thorpej #ifdef ICP_DEBUG
460 1.10 thorpej printf("%s: rescan: unit %d ICP_INFO failed -> 0x%04x\n",
461 1.10 thorpej icp->icp_dv.dv_xname, unit, icp->icp_status);
462 1.10 thorpej #endif
463 1.10 thorpej goto gone;
464 1.10 thorpej }
465 1.10 thorpej if ((newsize = icp->icp_info) == 0) {
466 1.10 thorpej #ifdef ICP_DEBUG
467 1.10 thorpej printf("%s: rescan: unit %d has zero size\n",
468 1.10 thorpej icp->icp_dv.dv_xname, unit);
469 1.10 thorpej #endif
470 1.10 thorpej gone:
471 1.10 thorpej /*
472 1.10 thorpej * Host drive is no longer present; detach if a child
473 1.10 thorpej * is currently there.
474 1.10 thorpej */
475 1.10 thorpej if (icp->icp_cdr[unit].cd_size != 0)
476 1.10 thorpej icp->icp_ndevs--;
477 1.10 thorpej icp->icp_cdr[unit].cd_size = 0;
478 1.10 thorpej if (icp->icp_children[unit] != NULL) {
479 1.10 thorpej (void) config_detach(icp->icp_children[unit],
480 1.10 thorpej DETACH_FORCE);
481 1.10 thorpej icp->icp_children[unit] = NULL;
482 1.10 thorpej }
483 1.10 thorpej return;
484 1.10 thorpej }
485 1.10 thorpej
486 1.10 thorpej if (icp_cmd(icp, ICP_CACHESERVICE, ICP_DEVTYPE, unit, 0, 0))
487 1.10 thorpej newtype = icp->icp_info;
488 1.10 thorpej else {
489 1.10 thorpej #ifdef ICP_DEBUG
490 1.10 thorpej printf("%s: rescan: unit %d ICP_DEVTYPE failed\n",
491 1.10 thorpej icp->icp_dv.dv_xname, unit);
492 1.10 thorpej #endif
493 1.10 thorpej newtype = 0; /* XXX? */
494 1.10 thorpej }
495 1.10 thorpej
496 1.10 thorpej #ifdef ICP_DEBUG
497 1.10 thorpej printf("%s: rescan: unit %d old %u/%u, new %u/%u\n",
498 1.10 thorpej icp->icp_dv.dv_xname, unit, icp->icp_cdr[unit].cd_size,
499 1.10 thorpej icp->icp_cdr[unit].cd_type, newsize, newtype);
500 1.10 thorpej #endif
501 1.10 thorpej
502 1.10 thorpej /*
503 1.10 thorpej * If the type or size changed, detach any old child (if it exists)
504 1.10 thorpej * and attach a new one.
505 1.10 thorpej */
506 1.10 thorpej if (icp->icp_children[unit] == NULL ||
507 1.10 thorpej newsize != icp->icp_cdr[unit].cd_size ||
508 1.10 thorpej newtype != icp->icp_cdr[unit].cd_type) {
509 1.10 thorpej if (icp->icp_cdr[unit].cd_size == 0)
510 1.10 thorpej icp->icp_ndevs++;
511 1.10 thorpej icp->icp_cdr[unit].cd_size = newsize;
512 1.10 thorpej icp->icp_cdr[unit].cd_type = newtype;
513 1.10 thorpej if (icp->icp_children[unit] != NULL)
514 1.10 thorpej (void) config_detach(icp->icp_children[unit],
515 1.10 thorpej DETACH_FORCE);
516 1.10 thorpej
517 1.10 thorpej icpa.icpa_unit = unit;
518 1.10 thorpej icp->icp_children[unit] = config_found_sm(&icp->icp_dv, &icpa,
519 1.10 thorpej icp_print, icp_submatch);
520 1.10 thorpej }
521 1.10 thorpej
522 1.10 thorpej icp_recompute_openings(icp);
523 1.10 thorpej }
524 1.10 thorpej
525 1.10 thorpej void
526 1.10 thorpej icp_rescan_all(struct icp_softc *icp)
527 1.10 thorpej {
528 1.10 thorpej int unit;
529 1.10 thorpej u_int16_t cdev_cnt;
530 1.10 thorpej
531 1.10 thorpej /*
532 1.10 thorpej * This is the old method of rescanning the host drives. We
533 1.10 thorpej * start by reinitializing the cache service.
534 1.10 thorpej */
535 1.10 thorpej if (!icp_cmd(icp, ICP_CACHESERVICE, ICP_INIT, ICP_LINUX_OS, 0, 0)) {
536 1.10 thorpej printf("%s: unable to re-initialize cache service for rescan\n",
537 1.10 thorpej icp->icp_dv.dv_xname);
538 1.10 thorpej return;
539 1.10 thorpej }
540 1.10 thorpej cdev_cnt = (u_int16_t) icp->icp_info;
541 1.10 thorpej
542 1.10 thorpej /* For each host drive, do the new-style rescan. */
543 1.10 thorpej for (unit = 0; unit < cdev_cnt && unit < ICP_MAX_HDRIVES; unit++)
544 1.10 thorpej icp_rescan(icp, unit);
545 1.10 thorpej
546 1.10 thorpej /* Now detach anything in the slots after cdev_cnt. */
547 1.10 thorpej for (; unit < ICP_MAX_HDRIVES; unit++) {
548 1.10 thorpej if (icp->icp_cdr[unit].cd_size != 0) {
549 1.10 thorpej #ifdef ICP_DEBUG
550 1.10 thorpej printf("%s: rescan all: unit %d < new cdev_cnt (%d)\n",
551 1.10 thorpej icp->icp_dv.dv_xname, unit, cdev_cnt);
552 1.10 thorpej #endif
553 1.10 thorpej icp->icp_ndevs--;
554 1.10 thorpej icp->icp_cdr[unit].cd_size = 0;
555 1.10 thorpej if (icp->icp_children[unit] != NULL) {
556 1.10 thorpej (void) config_detach(icp->icp_children[unit],
557 1.10 thorpej DETACH_FORCE);
558 1.10 thorpej icp->icp_children[unit] = NULL;
559 1.10 thorpej }
560 1.10 thorpej }
561 1.10 thorpej }
562 1.10 thorpej
563 1.10 thorpej icp_recompute_openings(icp);
564 1.10 thorpej }
565 1.10 thorpej
566 1.10 thorpej void
567 1.10 thorpej icp_recompute_openings(struct icp_softc *icp)
568 1.10 thorpej {
569 1.10 thorpej int unit, openings;
570 1.10 thorpej
571 1.10 thorpej if (icp->icp_ndevs != 0)
572 1.10 thorpej openings =
573 1.10 thorpej (icp->icp_nccbs - ICP_NCCB_RESERVE) / icp->icp_ndevs;
574 1.10 thorpej else
575 1.10 thorpej openings = 0;
576 1.10 thorpej if (openings == icp->icp_openings)
577 1.10 thorpej return;
578 1.10 thorpej icp->icp_openings = openings;
579 1.10 thorpej
580 1.10 thorpej #ifdef ICP_DEBUG
581 1.10 thorpej printf("%s: %d device%s, %d openings per device\n",
582 1.10 thorpej icp->icp_dv.dv_xname, icp->icp_ndevs,
583 1.10 thorpej icp->icp_ndevs == 1 ? "" : "s", icp->icp_openings);
584 1.10 thorpej #endif
585 1.10 thorpej
586 1.10 thorpej for (unit = 0; unit < ICP_MAX_HDRIVES + ICP_MAXBUS; unit++) {
587 1.10 thorpej if (icp->icp_children[unit] != NULL)
588 1.10 thorpej (*icp->icp_servicecb[unit]->iscb_openings)(
589 1.10 thorpej icp->icp_children[unit], icp->icp_openings);
590 1.10 thorpej }
591 1.10 thorpej }
592 1.10 thorpej
593 1.10 thorpej void
594 1.1 ad icp_watchdog(void *cookie)
595 1.1 ad {
596 1.1 ad struct icp_softc *icp;
597 1.1 ad int s;
598 1.1 ad
599 1.1 ad icp = cookie;
600 1.1 ad
601 1.1 ad s = splbio();
602 1.1 ad icp_intr(icp);
603 1.8 thorpej if (ICP_HAS_WORK(icp))
604 1.1 ad icp_ccb_enqueue(icp, NULL);
605 1.1 ad splx(s);
606 1.1 ad
607 1.1 ad callout_reset(&icp->icp_wdog_callout, hz * ICP_WATCHDOG_FREQ,
608 1.1 ad icp_watchdog, icp);
609 1.1 ad }
610 1.1 ad
611 1.1 ad int
612 1.1 ad icp_print(void *aux, const char *pnp)
613 1.1 ad {
614 1.1 ad struct icp_attach_args *icpa;
615 1.1 ad const char *str;
616 1.1 ad
617 1.1 ad icpa = (struct icp_attach_args *)aux;
618 1.1 ad
619 1.1 ad if (pnp != NULL) {
620 1.1 ad if (icpa->icpa_unit < ICPA_UNIT_SCSI)
621 1.1 ad str = "block device";
622 1.1 ad else
623 1.1 ad str = "SCSI channel";
624 1.6 thorpej aprint_normal("%s at %s", str, pnp);
625 1.1 ad }
626 1.6 thorpej aprint_normal(" unit %d", icpa->icpa_unit);
627 1.1 ad
628 1.1 ad return (UNCONF);
629 1.1 ad }
630 1.1 ad
631 1.1 ad int
632 1.1 ad icp_submatch(struct device *parent, struct cfdata *cf, void *aux)
633 1.1 ad {
634 1.1 ad struct icp_attach_args *icpa;
635 1.1 ad
636 1.1 ad icpa = (struct icp_attach_args *)aux;
637 1.1 ad
638 1.1 ad if (cf->icpacf_unit != ICPCF_UNIT_DEFAULT &&
639 1.1 ad cf->icpacf_unit != icpa->icpa_unit)
640 1.1 ad return (0);
641 1.1 ad
642 1.3 thorpej return (config_match(parent, cf, aux));
643 1.1 ad }
644 1.1 ad
645 1.1 ad int
646 1.8 thorpej icp_async_event(struct icp_softc *icp, int service)
647 1.1 ad {
648 1.1 ad
649 1.8 thorpej if (service == ICP_SCREENSERVICE) {
650 1.8 thorpej if (icp->icp_status == ICP_S_MSG_REQUEST) {
651 1.8 thorpej /* XXX */
652 1.8 thorpej }
653 1.8 thorpej } else {
654 1.8 thorpej if ((icp->icp_fw_vers & 0xff) >= 0x1a) {
655 1.8 thorpej icp->icp_evt.size = 0;
656 1.8 thorpej icp->icp_evt.eu.async.ionode = icp->icp_dv.dv_unit;
657 1.8 thorpej icp->icp_evt.eu.async.status = icp->icp_status;
658 1.8 thorpej /*
659 1.8 thorpej * Severity and event string are filled in by the
660 1.8 thorpej * hardware interface interrupt handler.
661 1.8 thorpej */
662 1.8 thorpej printf("%s: %s\n", icp->icp_dv.dv_xname,
663 1.8 thorpej icp->icp_evt.event_string);
664 1.8 thorpej } else {
665 1.8 thorpej icp->icp_evt.size = sizeof(icp->icp_evt.eu.async);
666 1.8 thorpej icp->icp_evt.eu.async.ionode = icp->icp_dv.dv_unit;
667 1.8 thorpej icp->icp_evt.eu.async.service = service;
668 1.8 thorpej icp->icp_evt.eu.async.status = icp->icp_status;
669 1.8 thorpej icp->icp_evt.eu.async.info = icp->icp_info;
670 1.8 thorpej /* XXXJRT FIX THIS */
671 1.8 thorpej *(u_int32_t *) icp->icp_evt.eu.async.scsi_coord =
672 1.8 thorpej icp->icp_info2;
673 1.8 thorpej }
674 1.8 thorpej icp_store_event(icp, GDT_ES_ASYNC, service, &icp->icp_evt);
675 1.8 thorpej }
676 1.8 thorpej
677 1.8 thorpej return (0);
678 1.1 ad }
679 1.1 ad
680 1.1 ad int
681 1.1 ad icp_intr(void *cookie)
682 1.1 ad {
683 1.1 ad struct icp_softc *icp;
684 1.1 ad struct icp_intr_ctx ctx;
685 1.1 ad struct icp_ccb *ic;
686 1.1 ad
687 1.1 ad icp = cookie;
688 1.1 ad
689 1.1 ad ctx.istatus = (*icp->icp_get_status)(icp);
690 1.1 ad if (!ctx.istatus) {
691 1.1 ad icp->icp_status = ICP_S_NO_STATUS;
692 1.1 ad return (0);
693 1.1 ad }
694 1.1 ad
695 1.1 ad (*icp->icp_intr)(icp, &ctx);
696 1.1 ad
697 1.1 ad icp->icp_status = ctx.cmd_status;
698 1.8 thorpej icp->icp_service = ctx.service;
699 1.1 ad icp->icp_info = ctx.info;
700 1.1 ad icp->icp_info2 = ctx.info2;
701 1.1 ad
702 1.1 ad switch (ctx.istatus) {
703 1.1 ad case ICP_ASYNCINDEX:
704 1.1 ad icp_async_event(icp, ctx.service);
705 1.1 ad return (1);
706 1.1 ad
707 1.1 ad case ICP_SPEZINDEX:
708 1.1 ad printf("%s: uninitialized or unknown service (%d/%d)\n",
709 1.1 ad icp->icp_dv.dv_xname, ctx.info, ctx.info2);
710 1.8 thorpej icp->icp_evt.size = sizeof(icp->icp_evt.eu.driver);
711 1.8 thorpej icp->icp_evt.eu.driver.ionode = icp->icp_dv.dv_unit;
712 1.8 thorpej icp_store_event(icp, GDT_ES_DRIVER, 4, &icp->icp_evt);
713 1.1 ad return (1);
714 1.1 ad }
715 1.1 ad
716 1.1 ad if ((ctx.istatus - 2) > icp->icp_nccbs)
717 1.1 ad panic("icp_intr: bad command index returned");
718 1.1 ad
719 1.1 ad ic = &icp->icp_ccbs[ctx.istatus - 2];
720 1.1 ad ic->ic_status = icp->icp_status;
721 1.1 ad
722 1.8 thorpej if ((ic->ic_flags & IC_ALLOCED) == 0) {
723 1.8 thorpej /* XXX ICP's "iir" driver just sends an event here. */
724 1.1 ad panic("icp_intr: inactive CCB identified");
725 1.8 thorpej }
726 1.1 ad
727 1.10 thorpej /*
728 1.10 thorpej * Try to protect ourselves from the running command count already
729 1.10 thorpej * being 0 (e.g. if a polled command times out).
730 1.10 thorpej */
731 1.10 thorpej KDASSERT(icp->icp_running != 0);
732 1.10 thorpej if (--icp->icp_running == 0 &&
733 1.10 thorpej (icp->icp_flags & ICP_F_WAIT_FREEZE) != 0) {
734 1.10 thorpej icp->icp_flags &= ~ICP_F_WAIT_FREEZE;
735 1.10 thorpej wakeup(&icp->icp_qfreeze);
736 1.10 thorpej }
737 1.10 thorpej
738 1.1 ad switch (icp->icp_status) {
739 1.1 ad case ICP_S_BSY:
740 1.1 ad #ifdef ICP_DEBUG
741 1.1 ad printf("%s: ICP_S_BSY received\n", icp->icp_dv.dv_xname);
742 1.1 ad #endif
743 1.8 thorpej if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
744 1.8 thorpej SIMPLEQ_INSERT_HEAD(&icp->icp_ucmd_queue, ic, ic_chain);
745 1.8 thorpej else
746 1.8 thorpej SIMPLEQ_INSERT_HEAD(&icp->icp_ccb_queue, ic, ic_chain);
747 1.1 ad break;
748 1.1 ad
749 1.1 ad default:
750 1.1 ad ic->ic_flags |= IC_COMPLETE;
751 1.1 ad
752 1.1 ad if ((ic->ic_flags & IC_WAITING) != 0)
753 1.1 ad wakeup(ic);
754 1.1 ad else if (ic->ic_intr != NULL)
755 1.1 ad (*ic->ic_intr)(ic);
756 1.1 ad
757 1.8 thorpej if (ICP_HAS_WORK(icp))
758 1.1 ad icp_ccb_enqueue(icp, NULL);
759 1.1 ad
760 1.1 ad break;
761 1.1 ad }
762 1.1 ad
763 1.1 ad return (1);
764 1.1 ad }
765 1.1 ad
766 1.8 thorpej struct icp_ucmd_ctx {
767 1.8 thorpej gdt_ucmd_t *iu_ucmd;
768 1.8 thorpej u_int32_t iu_cnt;
769 1.8 thorpej };
770 1.8 thorpej
771 1.8 thorpej void
772 1.8 thorpej icp_ucmd_intr(struct icp_ccb *ic)
773 1.8 thorpej {
774 1.8 thorpej struct icp_softc *icp = (void *) ic->ic_dv;
775 1.8 thorpej struct icp_ucmd_ctx *iu = ic->ic_context;
776 1.8 thorpej gdt_ucmd_t *ucmd = iu->iu_ucmd;
777 1.8 thorpej
778 1.8 thorpej ucmd->status = icp->icp_status;
779 1.8 thorpej ucmd->info = icp->icp_info;
780 1.8 thorpej
781 1.8 thorpej if (iu->iu_cnt != 0) {
782 1.8 thorpej bus_dmamap_sync(icp->icp_dmat,
783 1.8 thorpej icp->icp_scr_dmamap,
784 1.8 thorpej ICP_SCRATCH_UCMD, iu->iu_cnt,
785 1.8 thorpej BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
786 1.8 thorpej memcpy(ucmd->data,
787 1.8 thorpej icp->icp_scr + ICP_SCRATCH_UCMD, iu->iu_cnt);
788 1.8 thorpej }
789 1.8 thorpej
790 1.8 thorpej icp->icp_ucmd_ccb = NULL;
791 1.8 thorpej
792 1.8 thorpej ic->ic_flags |= IC_COMPLETE;
793 1.8 thorpej wakeup(ic);
794 1.8 thorpej }
795 1.8 thorpej
796 1.8 thorpej /*
797 1.8 thorpej * NOTE: We assume that it is safe to sleep here!
798 1.8 thorpej */
799 1.1 ad int
800 1.1 ad icp_cmd(struct icp_softc *icp, u_int8_t service, u_int16_t opcode,
801 1.1 ad u_int32_t arg1, u_int32_t arg2, u_int32_t arg3)
802 1.1 ad {
803 1.1 ad struct icp_ioctlcmd *icmd;
804 1.1 ad struct icp_cachecmd *cc;
805 1.1 ad struct icp_rawcmd *rc;
806 1.1 ad int retries, rv;
807 1.1 ad struct icp_ccb *ic;
808 1.1 ad
809 1.1 ad retries = ICP_RETRIES;
810 1.1 ad
811 1.1 ad do {
812 1.8 thorpej ic = icp_ccb_alloc_wait(icp);
813 1.1 ad memset(&ic->ic_cmd, 0, sizeof(ic->ic_cmd));
814 1.1 ad ic->ic_cmd.cmd_opcode = htole16(opcode);
815 1.1 ad
816 1.1 ad switch (service) {
817 1.1 ad case ICP_CACHESERVICE:
818 1.1 ad if (opcode == ICP_IOCTL) {
819 1.1 ad icmd = &ic->ic_cmd.cmd_packet.ic;
820 1.1 ad icmd->ic_subfunc = htole16(arg1);
821 1.1 ad icmd->ic_channel = htole32(arg2);
822 1.1 ad icmd->ic_bufsize = htole32(arg3);
823 1.1 ad icmd->ic_addr =
824 1.1 ad htole32(icp->icp_scr_seg[0].ds_addr);
825 1.1 ad
826 1.1 ad bus_dmamap_sync(icp->icp_dmat,
827 1.1 ad icp->icp_scr_dmamap, 0, arg3,
828 1.1 ad BUS_DMASYNC_PREWRITE |
829 1.1 ad BUS_DMASYNC_PREREAD);
830 1.1 ad } else {
831 1.1 ad cc = &ic->ic_cmd.cmd_packet.cc;
832 1.1 ad cc->cc_deviceno = htole16(arg1);
833 1.1 ad cc->cc_blockno = htole32(arg2);
834 1.1 ad }
835 1.1 ad break;
836 1.1 ad
837 1.1 ad case ICP_SCSIRAWSERVICE:
838 1.1 ad rc = &ic->ic_cmd.cmd_packet.rc;
839 1.1 ad rc->rc_direction = htole32(arg1);
840 1.1 ad rc->rc_bus = arg2;
841 1.1 ad rc->rc_target = arg3;
842 1.1 ad rc->rc_lun = arg3 >> 8;
843 1.1 ad break;
844 1.1 ad }
845 1.1 ad
846 1.1 ad ic->ic_service = service;
847 1.1 ad ic->ic_cmdlen = sizeof(ic->ic_cmd);
848 1.1 ad rv = icp_ccb_poll(icp, ic, 10000);
849 1.1 ad
850 1.1 ad switch (service) {
851 1.1 ad case ICP_CACHESERVICE:
852 1.1 ad if (opcode == ICP_IOCTL) {
853 1.1 ad bus_dmamap_sync(icp->icp_dmat,
854 1.1 ad icp->icp_scr_dmamap, 0, arg3,
855 1.1 ad BUS_DMASYNC_POSTWRITE |
856 1.1 ad BUS_DMASYNC_POSTREAD);
857 1.1 ad }
858 1.1 ad break;
859 1.1 ad }
860 1.1 ad
861 1.1 ad icp_ccb_free(icp, ic);
862 1.1 ad } while (rv != 0 && --retries > 0);
863 1.1 ad
864 1.1 ad return (icp->icp_status == ICP_S_OK);
865 1.1 ad }
866 1.1 ad
867 1.8 thorpej int
868 1.8 thorpej icp_ucmd(struct icp_softc *icp, gdt_ucmd_t *ucmd)
869 1.8 thorpej {
870 1.8 thorpej struct icp_ccb *ic;
871 1.8 thorpej struct icp_ucmd_ctx iu;
872 1.8 thorpej u_int32_t cnt;
873 1.8 thorpej int error;
874 1.8 thorpej
875 1.8 thorpej if (ucmd->service == ICP_CACHESERVICE) {
876 1.8 thorpej if (ucmd->command.cmd_opcode == ICP_IOCTL) {
877 1.8 thorpej cnt = ucmd->command.cmd_packet.ic.ic_bufsize;
878 1.8 thorpej if (cnt > GDT_SCRATCH_SZ) {
879 1.8 thorpej printf("%s: scratch buffer too small (%d/%d)\n",
880 1.8 thorpej icp->icp_dv.dv_xname, GDT_SCRATCH_SZ, cnt);
881 1.8 thorpej return (EINVAL);
882 1.8 thorpej }
883 1.8 thorpej } else {
884 1.8 thorpej cnt = ucmd->command.cmd_packet.cc.cc_blockcnt *
885 1.8 thorpej ICP_SECTOR_SIZE;
886 1.8 thorpej if (cnt > GDT_SCRATCH_SZ) {
887 1.8 thorpej printf("%s: scratch buffer too small (%d/%d)\n",
888 1.8 thorpej icp->icp_dv.dv_xname, GDT_SCRATCH_SZ, cnt);
889 1.8 thorpej return (EINVAL);
890 1.8 thorpej }
891 1.8 thorpej }
892 1.8 thorpej } else {
893 1.8 thorpej cnt = ucmd->command.cmd_packet.rc.rc_sdlen +
894 1.8 thorpej ucmd->command.cmd_packet.rc.rc_sense_len;
895 1.8 thorpej if (cnt > GDT_SCRATCH_SZ) {
896 1.8 thorpej printf("%s: scratch buffer too small (%d/%d)\n",
897 1.8 thorpej icp->icp_dv.dv_xname, GDT_SCRATCH_SZ, cnt);
898 1.8 thorpej return (EINVAL);
899 1.8 thorpej }
900 1.8 thorpej }
901 1.8 thorpej
902 1.8 thorpej iu.iu_ucmd = ucmd;
903 1.8 thorpej iu.iu_cnt = cnt;
904 1.8 thorpej
905 1.8 thorpej ic = icp_ccb_alloc_wait(icp);
906 1.8 thorpej memset(&ic->ic_cmd, 0, sizeof(ic->ic_cmd));
907 1.8 thorpej ic->ic_cmd.cmd_opcode = htole16(ucmd->command.cmd_opcode);
908 1.8 thorpej
909 1.8 thorpej if (ucmd->service == ICP_CACHESERVICE) {
910 1.8 thorpej if (ucmd->command.cmd_opcode == ICP_IOCTL) {
911 1.8 thorpej struct icp_ioctlcmd *icmd, *uicmd;
912 1.8 thorpej
913 1.8 thorpej icmd = &ic->ic_cmd.cmd_packet.ic;
914 1.8 thorpej uicmd = &ucmd->command.cmd_packet.ic;
915 1.8 thorpej
916 1.8 thorpej icmd->ic_subfunc = htole16(uicmd->ic_subfunc);
917 1.8 thorpej icmd->ic_channel = htole32(uicmd->ic_channel);
918 1.8 thorpej icmd->ic_bufsize = htole32(uicmd->ic_bufsize);
919 1.8 thorpej icmd->ic_addr =
920 1.8 thorpej htole32(icp->icp_scr_seg[0].ds_addr +
921 1.8 thorpej ICP_SCRATCH_UCMD);
922 1.8 thorpej } else {
923 1.8 thorpej struct icp_cachecmd *cc, *ucc;
924 1.8 thorpej
925 1.8 thorpej cc = &ic->ic_cmd.cmd_packet.cc;
926 1.8 thorpej ucc = &ucmd->command.cmd_packet.cc;
927 1.8 thorpej
928 1.8 thorpej cc->cc_deviceno = htole16(ucc->cc_deviceno);
929 1.8 thorpej cc->cc_blockno = htole32(ucc->cc_blockno);
930 1.8 thorpej cc->cc_blockcnt = htole32(ucc->cc_blockcnt);
931 1.8 thorpej cc->cc_addr = htole32(0xffffffffU);
932 1.8 thorpej cc->cc_nsgent = htole32(1);
933 1.8 thorpej cc->cc_sg[0].sg_addr =
934 1.8 thorpej htole32(icp->icp_scr_seg[0].ds_addr +
935 1.8 thorpej ICP_SCRATCH_UCMD);
936 1.8 thorpej cc->cc_sg[0].sg_len = htole32(cnt);
937 1.8 thorpej }
938 1.8 thorpej } else {
939 1.8 thorpej struct icp_rawcmd *rc, *urc;
940 1.8 thorpej
941 1.8 thorpej rc = &ic->ic_cmd.cmd_packet.rc;
942 1.8 thorpej urc = &ucmd->command.cmd_packet.rc;
943 1.8 thorpej
944 1.8 thorpej rc->rc_direction = htole32(urc->rc_direction);
945 1.8 thorpej rc->rc_sdata = htole32(0xffffffffU);
946 1.8 thorpej rc->rc_sdlen = htole32(urc->rc_sdlen);
947 1.8 thorpej rc->rc_clen = htole32(urc->rc_clen);
948 1.8 thorpej memcpy(rc->rc_cdb, urc->rc_cdb, sizeof(rc->rc_cdb));
949 1.8 thorpej rc->rc_target = urc->rc_target;
950 1.8 thorpej rc->rc_lun = urc->rc_lun;
951 1.8 thorpej rc->rc_bus = urc->rc_bus;
952 1.8 thorpej rc->rc_sense_len = htole32(urc->rc_sense_len);
953 1.8 thorpej rc->rc_sense_addr =
954 1.8 thorpej htole32(icp->icp_scr_seg[0].ds_addr +
955 1.8 thorpej ICP_SCRATCH_UCMD + urc->rc_sdlen);
956 1.8 thorpej rc->rc_nsgent = htole32(1);
957 1.8 thorpej rc->rc_sg[0].sg_addr =
958 1.8 thorpej htole32(icp->icp_scr_seg[0].ds_addr + ICP_SCRATCH_UCMD);
959 1.8 thorpej rc->rc_sg[0].sg_len = htole32(cnt - urc->rc_sense_len);
960 1.8 thorpej }
961 1.8 thorpej
962 1.8 thorpej ic->ic_service = ucmd->service;
963 1.8 thorpej ic->ic_cmdlen = sizeof(ic->ic_cmd);
964 1.8 thorpej ic->ic_context = &iu;
965 1.8 thorpej
966 1.8 thorpej /*
967 1.8 thorpej * XXX What units are ucmd->timeout in? Until we know, we
968 1.8 thorpej * XXX just pull a number out of thin air.
969 1.8 thorpej */
970 1.8 thorpej if (__predict_false((error = icp_ccb_wait_user(icp, ic, 30000)) != 0))
971 1.8 thorpej printf("%s: error %d waiting for ucmd to complete\n",
972 1.8 thorpej icp->icp_dv.dv_xname, error);
973 1.8 thorpej
974 1.8 thorpej /* icp_ucmd_intr() has updated ucmd. */
975 1.8 thorpej icp_ccb_free(icp, ic);
976 1.8 thorpej
977 1.8 thorpej return (error);
978 1.8 thorpej }
979 1.8 thorpej
980 1.1 ad struct icp_ccb *
981 1.1 ad icp_ccb_alloc(struct icp_softc *icp)
982 1.1 ad {
983 1.1 ad struct icp_ccb *ic;
984 1.1 ad int s;
985 1.1 ad
986 1.1 ad s = splbio();
987 1.8 thorpej if (__predict_false((ic =
988 1.8 thorpej SIMPLEQ_FIRST(&icp->icp_ccb_freelist)) == NULL)) {
989 1.8 thorpej splx(s);
990 1.8 thorpej return (NULL);
991 1.8 thorpej }
992 1.8 thorpej SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_freelist, ic_chain);
993 1.8 thorpej splx(s);
994 1.8 thorpej
995 1.8 thorpej ic->ic_flags = IC_ALLOCED;
996 1.8 thorpej return (ic);
997 1.8 thorpej }
998 1.8 thorpej
999 1.8 thorpej struct icp_ccb *
1000 1.8 thorpej icp_ccb_alloc_wait(struct icp_softc *icp)
1001 1.8 thorpej {
1002 1.8 thorpej struct icp_ccb *ic;
1003 1.8 thorpej int s;
1004 1.8 thorpej
1005 1.8 thorpej s = splbio();
1006 1.8 thorpej while ((ic = SIMPLEQ_FIRST(&icp->icp_ccb_freelist)) == NULL) {
1007 1.8 thorpej icp->icp_flags |= ICP_F_WAIT_CCB;
1008 1.8 thorpej (void) tsleep(&icp->icp_ccb_freelist, PRIBIO, "icpccb", 0);
1009 1.8 thorpej }
1010 1.2 lukem SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_freelist, ic_chain);
1011 1.1 ad splx(s);
1012 1.1 ad
1013 1.1 ad ic->ic_flags = IC_ALLOCED;
1014 1.1 ad return (ic);
1015 1.1 ad }
1016 1.1 ad
1017 1.1 ad void
1018 1.1 ad icp_ccb_free(struct icp_softc *icp, struct icp_ccb *ic)
1019 1.1 ad {
1020 1.1 ad int s;
1021 1.1 ad
1022 1.1 ad s = splbio();
1023 1.1 ad ic->ic_flags = 0;
1024 1.1 ad ic->ic_intr = NULL;
1025 1.1 ad SIMPLEQ_INSERT_HEAD(&icp->icp_ccb_freelist, ic, ic_chain);
1026 1.8 thorpej if (__predict_false((icp->icp_flags & ICP_F_WAIT_CCB) != 0)) {
1027 1.8 thorpej icp->icp_flags &= ~ICP_F_WAIT_CCB;
1028 1.8 thorpej wakeup(&icp->icp_ccb_freelist);
1029 1.8 thorpej }
1030 1.1 ad splx(s);
1031 1.1 ad }
1032 1.1 ad
1033 1.1 ad void
1034 1.1 ad icp_ccb_enqueue(struct icp_softc *icp, struct icp_ccb *ic)
1035 1.1 ad {
1036 1.1 ad int s;
1037 1.1 ad
1038 1.1 ad s = splbio();
1039 1.1 ad
1040 1.8 thorpej if (ic != NULL) {
1041 1.8 thorpej if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
1042 1.8 thorpej SIMPLEQ_INSERT_TAIL(&icp->icp_ucmd_queue, ic, ic_chain);
1043 1.8 thorpej else
1044 1.8 thorpej SIMPLEQ_INSERT_TAIL(&icp->icp_ccb_queue, ic, ic_chain);
1045 1.8 thorpej }
1046 1.8 thorpej
1047 1.10 thorpej for (; icp->icp_qfreeze == 0;) {
1048 1.8 thorpej if (__predict_false((ic =
1049 1.8 thorpej SIMPLEQ_FIRST(&icp->icp_ucmd_queue)) != NULL)) {
1050 1.8 thorpej struct icp_ucmd_ctx *iu = ic->ic_context;
1051 1.8 thorpej gdt_ucmd_t *ucmd = iu->iu_ucmd;
1052 1.1 ad
1053 1.8 thorpej /*
1054 1.8 thorpej * All user-generated commands share the same
1055 1.8 thorpej * scratch space, so if one is already running,
1056 1.8 thorpej * we have to stall the command queue.
1057 1.8 thorpej */
1058 1.8 thorpej if (icp->icp_ucmd_ccb != NULL)
1059 1.8 thorpej break;
1060 1.9 thorpej if ((*icp->icp_test_busy)(icp))
1061 1.9 thorpej break;
1062 1.8 thorpej icp->icp_ucmd_ccb = ic;
1063 1.8 thorpej
1064 1.8 thorpej if (iu->iu_cnt != 0) {
1065 1.8 thorpej memcpy(icp->icp_scr + ICP_SCRATCH_UCMD,
1066 1.8 thorpej ucmd->data, iu->iu_cnt);
1067 1.8 thorpej bus_dmamap_sync(icp->icp_dmat,
1068 1.8 thorpej icp->icp_scr_dmamap,
1069 1.8 thorpej ICP_SCRATCH_UCMD, iu->iu_cnt,
1070 1.8 thorpej BUS_DMASYNC_PREREAD |
1071 1.8 thorpej BUS_DMASYNC_PREWRITE);
1072 1.8 thorpej }
1073 1.9 thorpej } else if (__predict_true((ic =
1074 1.9 thorpej SIMPLEQ_FIRST(&icp->icp_ccb_queue)) != NULL)) {
1075 1.9 thorpej if ((*icp->icp_test_busy)(icp))
1076 1.9 thorpej break;
1077 1.9 thorpej } else {
1078 1.9 thorpej /* no command found */
1079 1.1 ad break;
1080 1.9 thorpej }
1081 1.1 ad icp_ccb_submit(icp, ic);
1082 1.8 thorpej if (__predict_false((ic->ic_flags & IC_UCMD) != 0))
1083 1.8 thorpej SIMPLEQ_REMOVE_HEAD(&icp->icp_ucmd_queue, ic_chain);
1084 1.8 thorpej else
1085 1.8 thorpej SIMPLEQ_REMOVE_HEAD(&icp->icp_ccb_queue, ic_chain);
1086 1.1 ad }
1087 1.1 ad
1088 1.1 ad splx(s);
1089 1.1 ad }
1090 1.1 ad
1091 1.1 ad int
1092 1.1 ad icp_ccb_map(struct icp_softc *icp, struct icp_ccb *ic, void *data, int size,
1093 1.1 ad int dir)
1094 1.1 ad {
1095 1.1 ad struct icp_sg *sg;
1096 1.1 ad int nsegs, i, rv;
1097 1.1 ad bus_dmamap_t xfer;
1098 1.1 ad
1099 1.1 ad xfer = ic->ic_xfer_map;
1100 1.1 ad
1101 1.1 ad rv = bus_dmamap_load(icp->icp_dmat, xfer, data, size, NULL,
1102 1.1 ad BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
1103 1.1 ad ((dir & IC_XFER_IN) ? BUS_DMA_READ : BUS_DMA_WRITE));
1104 1.1 ad if (rv != 0)
1105 1.1 ad return (rv);
1106 1.1 ad
1107 1.1 ad nsegs = xfer->dm_nsegs;
1108 1.1 ad ic->ic_xfer_size = size;
1109 1.1 ad ic->ic_nsgent = nsegs;
1110 1.1 ad ic->ic_flags |= dir;
1111 1.1 ad sg = ic->ic_sg;
1112 1.1 ad
1113 1.1 ad if (sg != NULL) {
1114 1.1 ad for (i = 0; i < nsegs; i++, sg++) {
1115 1.1 ad sg->sg_addr = htole32(xfer->dm_segs[i].ds_addr);
1116 1.1 ad sg->sg_len = htole32(xfer->dm_segs[i].ds_len);
1117 1.1 ad }
1118 1.1 ad } else if (nsegs > 1)
1119 1.4 provos panic("icp_ccb_map: no SG list specified, but nsegs > 1");
1120 1.1 ad
1121 1.1 ad if ((dir & IC_XFER_OUT) != 0)
1122 1.1 ad i = BUS_DMASYNC_PREWRITE;
1123 1.1 ad else /* if ((dir & IC_XFER_IN) != 0) */
1124 1.1 ad i = BUS_DMASYNC_PREREAD;
1125 1.1 ad
1126 1.1 ad bus_dmamap_sync(icp->icp_dmat, xfer, 0, ic->ic_xfer_size, i);
1127 1.1 ad return (0);
1128 1.1 ad }
1129 1.1 ad
1130 1.1 ad void
1131 1.1 ad icp_ccb_unmap(struct icp_softc *icp, struct icp_ccb *ic)
1132 1.1 ad {
1133 1.1 ad int i;
1134 1.1 ad
1135 1.1 ad if ((ic->ic_flags & IC_XFER_OUT) != 0)
1136 1.1 ad i = BUS_DMASYNC_POSTWRITE;
1137 1.1 ad else /* if ((ic->ic_flags & IC_XFER_IN) != 0) */
1138 1.1 ad i = BUS_DMASYNC_POSTREAD;
1139 1.1 ad
1140 1.1 ad bus_dmamap_sync(icp->icp_dmat, ic->ic_xfer_map, 0, ic->ic_xfer_size, i);
1141 1.1 ad bus_dmamap_unload(icp->icp_dmat, ic->ic_xfer_map);
1142 1.1 ad }
1143 1.1 ad
1144 1.1 ad int
1145 1.1 ad icp_ccb_poll(struct icp_softc *icp, struct icp_ccb *ic, int timo)
1146 1.1 ad {
1147 1.10 thorpej int s, rv;
1148 1.10 thorpej
1149 1.10 thorpej s = splbio();
1150 1.1 ad
1151 1.1 ad for (timo = ICP_BUSY_WAIT_MS * 100; timo != 0; timo--) {
1152 1.1 ad if (!(*icp->icp_test_busy)(icp))
1153 1.1 ad break;
1154 1.1 ad DELAY(10);
1155 1.1 ad }
1156 1.1 ad if (timo == 0) {
1157 1.1 ad printf("%s: submit: busy\n", icp->icp_dv.dv_xname);
1158 1.1 ad return (EAGAIN);
1159 1.1 ad }
1160 1.1 ad
1161 1.1 ad icp_ccb_submit(icp, ic);
1162 1.1 ad
1163 1.10 thorpej if (cold) {
1164 1.10 thorpej for (timo *= 10; timo != 0; timo--) {
1165 1.10 thorpej DELAY(100);
1166 1.10 thorpej icp_intr(icp);
1167 1.10 thorpej if ((ic->ic_flags & IC_COMPLETE) != 0)
1168 1.10 thorpej break;
1169 1.10 thorpej }
1170 1.10 thorpej } else {
1171 1.10 thorpej ic->ic_flags |= IC_WAITING;
1172 1.10 thorpej while ((ic->ic_flags & IC_COMPLETE) == 0) {
1173 1.10 thorpej if ((rv = tsleep(ic, PRIBIO, "icpwccb",
1174 1.10 thorpej mstohz(timo))) != 0) {
1175 1.10 thorpej timo = 0;
1176 1.10 thorpej break;
1177 1.10 thorpej }
1178 1.10 thorpej }
1179 1.1 ad }
1180 1.1 ad
1181 1.1 ad if (timo != 0) {
1182 1.1 ad if (ic->ic_status != ICP_S_OK) {
1183 1.1 ad #ifdef ICP_DEBUG
1184 1.1 ad printf("%s: request failed; status=0x%04x\n",
1185 1.1 ad icp->icp_dv.dv_xname, ic->ic_status);
1186 1.1 ad #endif
1187 1.1 ad rv = EIO;
1188 1.1 ad } else
1189 1.1 ad rv = 0;
1190 1.1 ad } else {
1191 1.1 ad printf("%s: command timed out\n", icp->icp_dv.dv_xname);
1192 1.1 ad rv = EIO;
1193 1.1 ad }
1194 1.1 ad
1195 1.1 ad while ((*icp->icp_test_busy)(icp) != 0)
1196 1.1 ad DELAY(10);
1197 1.1 ad
1198 1.10 thorpej splx(s);
1199 1.10 thorpej
1200 1.1 ad return (rv);
1201 1.1 ad }
1202 1.1 ad
1203 1.1 ad int
1204 1.1 ad icp_ccb_wait(struct icp_softc *icp, struct icp_ccb *ic, int timo)
1205 1.1 ad {
1206 1.1 ad int s, rv;
1207 1.1 ad
1208 1.1 ad ic->ic_flags |= IC_WAITING;
1209 1.1 ad
1210 1.1 ad s = splbio();
1211 1.1 ad icp_ccb_enqueue(icp, ic);
1212 1.8 thorpej while ((ic->ic_flags & IC_COMPLETE) == 0) {
1213 1.8 thorpej if ((rv = tsleep(ic, PRIBIO, "icpwccb", mstohz(timo))) != 0) {
1214 1.8 thorpej splx(s);
1215 1.8 thorpej return (rv);
1216 1.8 thorpej }
1217 1.1 ad }
1218 1.1 ad splx(s);
1219 1.1 ad
1220 1.1 ad if (ic->ic_status != ICP_S_OK) {
1221 1.1 ad printf("%s: command failed; status=%x\n", icp->icp_dv.dv_xname,
1222 1.1 ad ic->ic_status);
1223 1.1 ad return (EIO);
1224 1.1 ad }
1225 1.1 ad
1226 1.1 ad return (0);
1227 1.1 ad }
1228 1.1 ad
1229 1.8 thorpej int
1230 1.8 thorpej icp_ccb_wait_user(struct icp_softc *icp, struct icp_ccb *ic, int timo)
1231 1.8 thorpej {
1232 1.8 thorpej int s, rv;
1233 1.8 thorpej
1234 1.8 thorpej ic->ic_dv = &icp->icp_dv;
1235 1.8 thorpej ic->ic_intr = icp_ucmd_intr;
1236 1.8 thorpej ic->ic_flags |= IC_UCMD;
1237 1.8 thorpej
1238 1.8 thorpej s = splbio();
1239 1.8 thorpej icp_ccb_enqueue(icp, ic);
1240 1.8 thorpej while ((ic->ic_flags & IC_COMPLETE) == 0) {
1241 1.8 thorpej if ((rv = tsleep(ic, PRIBIO, "icpwuccb", mstohz(timo))) != 0) {
1242 1.8 thorpej splx(s);
1243 1.8 thorpej return (rv);
1244 1.8 thorpej }
1245 1.8 thorpej }
1246 1.8 thorpej splx(s);
1247 1.8 thorpej
1248 1.8 thorpej return (0);
1249 1.8 thorpej }
1250 1.8 thorpej
1251 1.1 ad void
1252 1.1 ad icp_ccb_submit(struct icp_softc *icp, struct icp_ccb *ic)
1253 1.1 ad {
1254 1.1 ad
1255 1.1 ad ic->ic_cmdlen = (ic->ic_cmdlen + 3) & ~3;
1256 1.1 ad
1257 1.1 ad (*icp->icp_set_sema0)(icp);
1258 1.1 ad DELAY(10);
1259 1.1 ad
1260 1.1 ad ic->ic_cmd.cmd_boardnode = htole32(ICP_LOCALBOARD);
1261 1.1 ad ic->ic_cmd.cmd_cmdindex = htole32(ic->ic_ident);
1262 1.1 ad
1263 1.10 thorpej icp->icp_running++;
1264 1.10 thorpej
1265 1.1 ad (*icp->icp_copy_cmd)(icp, ic);
1266 1.1 ad (*icp->icp_release_event)(icp, ic);
1267 1.10 thorpej }
1268 1.10 thorpej
1269 1.10 thorpej int
1270 1.10 thorpej icp_freeze(struct icp_softc *icp)
1271 1.10 thorpej {
1272 1.10 thorpej int s, error = 0;
1273 1.10 thorpej
1274 1.10 thorpej s = splbio();
1275 1.10 thorpej if (icp->icp_qfreeze++ == 0) {
1276 1.10 thorpej while (icp->icp_running != 0) {
1277 1.10 thorpej icp->icp_flags |= ICP_F_WAIT_FREEZE;
1278 1.10 thorpej error = tsleep(&icp->icp_qfreeze, PRIBIO|PCATCH,
1279 1.10 thorpej "icpqfrz", 0);
1280 1.10 thorpej if (error != 0 && --icp->icp_qfreeze == 0 &&
1281 1.10 thorpej ICP_HAS_WORK(icp)) {
1282 1.10 thorpej icp_ccb_enqueue(icp, NULL);
1283 1.10 thorpej break;
1284 1.10 thorpej }
1285 1.10 thorpej }
1286 1.10 thorpej }
1287 1.10 thorpej splx(s);
1288 1.10 thorpej
1289 1.10 thorpej return (error);
1290 1.10 thorpej }
1291 1.10 thorpej
1292 1.10 thorpej void
1293 1.10 thorpej icp_unfreeze(struct icp_softc *icp)
1294 1.10 thorpej {
1295 1.10 thorpej int s;
1296 1.10 thorpej
1297 1.10 thorpej s = splbio();
1298 1.10 thorpej KDASSERT(icp->icp_qfreeze != 0);
1299 1.10 thorpej if (--icp->icp_qfreeze == 0 && ICP_HAS_WORK(icp))
1300 1.10 thorpej icp_ccb_enqueue(icp, NULL);
1301 1.10 thorpej splx(s);
1302 1.8 thorpej }
1303 1.8 thorpej
1304 1.8 thorpej /* XXX Global - should be per-controller? XXX */
1305 1.8 thorpej static gdt_evt_str icp_event_buffer[ICP_MAX_EVENTS];
1306 1.8 thorpej static int icp_event_oldidx;
1307 1.8 thorpej static int icp_event_lastidx;
1308 1.8 thorpej
1309 1.8 thorpej gdt_evt_str *
1310 1.8 thorpej icp_store_event(struct icp_softc *icp, u_int16_t source, u_int16_t idx,
1311 1.8 thorpej gdt_evt_data *evt)
1312 1.8 thorpej {
1313 1.8 thorpej gdt_evt_str *e;
1314 1.8 thorpej
1315 1.8 thorpej /* no source == no event */
1316 1.8 thorpej if (source == 0)
1317 1.8 thorpej return (NULL);
1318 1.8 thorpej
1319 1.8 thorpej e = &icp_event_buffer[icp_event_lastidx];
1320 1.8 thorpej if (e->event_source == source && e->event_idx == idx &&
1321 1.8 thorpej ((evt->size != 0 && e->event_data.size != 0 &&
1322 1.8 thorpej memcmp(&e->event_data.eu, &evt->eu, evt->size) == 0) ||
1323 1.8 thorpej (evt->size == 0 && e->event_data.size == 0 &&
1324 1.8 thorpej strcmp((char *) e->event_data.event_string,
1325 1.8 thorpej (char *) evt->event_string) == 0))) {
1326 1.8 thorpej e->last_stamp = time.tv_sec;
1327 1.8 thorpej e->same_count++;
1328 1.8 thorpej } else {
1329 1.8 thorpej if (icp_event_buffer[icp_event_lastidx].event_source != 0) {
1330 1.8 thorpej icp_event_lastidx++;
1331 1.8 thorpej if (icp_event_lastidx == ICP_MAX_EVENTS)
1332 1.8 thorpej icp_event_lastidx = 0;
1333 1.8 thorpej if (icp_event_lastidx == icp_event_oldidx) {
1334 1.8 thorpej icp_event_oldidx++;
1335 1.8 thorpej if (icp_event_oldidx == ICP_MAX_EVENTS)
1336 1.8 thorpej icp_event_oldidx = 0;
1337 1.8 thorpej }
1338 1.8 thorpej }
1339 1.8 thorpej e = &icp_event_buffer[icp_event_lastidx];
1340 1.8 thorpej e->event_source = source;
1341 1.8 thorpej e->event_idx = idx;
1342 1.8 thorpej e->first_stamp = e->last_stamp = time.tv_sec;
1343 1.8 thorpej e->same_count = 1;
1344 1.8 thorpej e->event_data = *evt;
1345 1.8 thorpej e->application = 0;
1346 1.8 thorpej }
1347 1.8 thorpej return (e);
1348 1.8 thorpej }
1349 1.8 thorpej
1350 1.8 thorpej int
1351 1.8 thorpej icp_read_event(struct icp_softc *icp, int handle, gdt_evt_str *estr)
1352 1.8 thorpej {
1353 1.8 thorpej gdt_evt_str *e;
1354 1.8 thorpej int eindex, s;
1355 1.8 thorpej
1356 1.8 thorpej s = splbio();
1357 1.8 thorpej
1358 1.8 thorpej if (handle == -1)
1359 1.8 thorpej eindex = icp_event_oldidx;
1360 1.8 thorpej else
1361 1.8 thorpej eindex = handle;
1362 1.8 thorpej
1363 1.8 thorpej estr->event_source = 0;
1364 1.8 thorpej
1365 1.8 thorpej if (eindex < 0 || eindex >= ICP_MAX_EVENTS) {
1366 1.8 thorpej splx(s);
1367 1.8 thorpej return (eindex);
1368 1.8 thorpej }
1369 1.8 thorpej
1370 1.8 thorpej e = &icp_event_buffer[eindex];
1371 1.8 thorpej if (e->event_source != 0) {
1372 1.8 thorpej if (eindex != icp_event_lastidx) {
1373 1.8 thorpej eindex++;
1374 1.8 thorpej if (eindex == ICP_MAX_EVENTS)
1375 1.8 thorpej eindex = 0;
1376 1.8 thorpej } else
1377 1.8 thorpej eindex = -1;
1378 1.8 thorpej memcpy(estr, e, sizeof(gdt_evt_str));
1379 1.8 thorpej }
1380 1.8 thorpej
1381 1.8 thorpej splx(s);
1382 1.8 thorpej
1383 1.8 thorpej return (eindex);
1384 1.8 thorpej }
1385 1.8 thorpej
1386 1.8 thorpej void
1387 1.8 thorpej icp_readapp_event(struct icp_softc *icp, u_int8_t application,
1388 1.8 thorpej gdt_evt_str *estr)
1389 1.8 thorpej {
1390 1.8 thorpej gdt_evt_str *e;
1391 1.8 thorpej int found = 0, eindex, s;
1392 1.8 thorpej
1393 1.8 thorpej s = splbio();
1394 1.8 thorpej
1395 1.8 thorpej eindex = icp_event_oldidx;
1396 1.8 thorpej for (;;) {
1397 1.8 thorpej e = &icp_event_buffer[eindex];
1398 1.8 thorpej if (e->event_source == 0)
1399 1.8 thorpej break;
1400 1.8 thorpej if ((e->application & application) == 0) {
1401 1.8 thorpej e->application |= application;
1402 1.8 thorpej found = 1;
1403 1.8 thorpej break;
1404 1.8 thorpej }
1405 1.8 thorpej if (eindex == icp_event_lastidx)
1406 1.8 thorpej break;
1407 1.8 thorpej eindex++;
1408 1.8 thorpej if (eindex == ICP_MAX_EVENTS)
1409 1.8 thorpej eindex = 0;
1410 1.8 thorpej }
1411 1.8 thorpej if (found)
1412 1.8 thorpej memcpy(estr, e, sizeof(gdt_evt_str));
1413 1.8 thorpej else
1414 1.8 thorpej estr->event_source = 0;
1415 1.8 thorpej
1416 1.8 thorpej splx(s);
1417 1.8 thorpej }
1418 1.8 thorpej
1419 1.8 thorpej void
1420 1.8 thorpej icp_clear_events(struct icp_softc *icp)
1421 1.8 thorpej {
1422 1.8 thorpej int s;
1423 1.8 thorpej
1424 1.8 thorpej s = splbio();
1425 1.8 thorpej icp_event_oldidx = icp_event_lastidx = 0;
1426 1.8 thorpej memset(icp_event_buffer, 0, sizeof(icp_event_buffer));
1427 1.8 thorpej splx(s);
1428 1.1 ad }
1429