mly.c revision 1.8 1 1.8 lukem /* $NetBSD: mly.c,v 1.8 2001/11/13 07:48:46 lukem Exp $ */
2 1.1 ad
3 1.1 ad /*-
4 1.1 ad * Copyright (c) 2001 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.1 ad * by Andrew Doran, Thor Lancelot Simon, and Eric Haszlakiewicz.
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) 2000, 2001 Michael Smith
41 1.1 ad * Copyright (c) 2000 BSDi
42 1.1 ad * All rights reserved.
43 1.1 ad *
44 1.1 ad * Redistribution and use in source and binary forms, with or without
45 1.1 ad * modification, are permitted provided that the following conditions
46 1.1 ad * are met:
47 1.1 ad * 1. Redistributions of source code must retain the above copyright
48 1.1 ad * notice, this list of conditions and the following disclaimer.
49 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
50 1.1 ad * notice, this list of conditions and the following disclaimer in the
51 1.1 ad * documentation and/or other materials provided with the distribution.
52 1.1 ad *
53 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
54 1.1 ad * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55 1.1 ad * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56 1.1 ad * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
57 1.1 ad * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58 1.1 ad * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59 1.1 ad * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60 1.1 ad * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61 1.1 ad * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62 1.1 ad * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63 1.1 ad * SUCH DAMAGE.
64 1.1 ad *
65 1.1 ad * from FreeBSD: mly.c,v 1.8 2001/07/14 00:12:22 msmith Exp
66 1.1 ad */
67 1.1 ad
68 1.1 ad /*
69 1.1 ad * Driver for the Mylex AcceleRAID and eXtremeRAID family with v6 firmware.
70 1.1 ad *
71 1.1 ad * TODO:
72 1.1 ad *
73 1.1 ad * o Make mly->mly_btl a hash, then MLY_BTL_RESCAN becomes a SIMPLEQ.
74 1.1 ad * o Handle FC and multiple LUNs.
75 1.1 ad * o Fix mmbox usage.
76 1.1 ad * o Fix transfer speed fudge.
77 1.1 ad */
78 1.8 lukem
79 1.8 lukem #include <sys/cdefs.h>
80 1.8 lukem __KERNEL_RCSID(0, "$NetBSD: mly.c,v 1.8 2001/11/13 07:48:46 lukem Exp $");
81 1.1 ad
82 1.1 ad #include <sys/param.h>
83 1.1 ad #include <sys/systm.h>
84 1.1 ad #include <sys/device.h>
85 1.1 ad #include <sys/kernel.h>
86 1.1 ad #include <sys/queue.h>
87 1.1 ad #include <sys/buf.h>
88 1.1 ad #include <sys/endian.h>
89 1.1 ad #include <sys/conf.h>
90 1.1 ad #include <sys/malloc.h>
91 1.1 ad #include <sys/ioctl.h>
92 1.1 ad #include <sys/scsiio.h>
93 1.1 ad #include <sys/kthread.h>
94 1.1 ad
95 1.1 ad #include <uvm/uvm_extern.h>
96 1.1 ad
97 1.1 ad #include <machine/bus.h>
98 1.1 ad
99 1.1 ad #include <dev/scsipi/scsi_all.h>
100 1.1 ad #include <dev/scsipi/scsipi_all.h>
101 1.1 ad #include <dev/scsipi/scsiconf.h>
102 1.1 ad
103 1.1 ad #include <dev/pci/pcireg.h>
104 1.1 ad #include <dev/pci/pcivar.h>
105 1.1 ad #include <dev/pci/pcidevs.h>
106 1.1 ad
107 1.1 ad #include <dev/pci/mlyreg.h>
108 1.1 ad #include <dev/pci/mlyio.h>
109 1.1 ad #include <dev/pci/mlyvar.h>
110 1.1 ad #include <dev/pci/mly_tables.h>
111 1.1 ad
112 1.1 ad static void mly_attach(struct device *, struct device *, void *);
113 1.1 ad static int mly_match(struct device *, struct cfdata *, void *);
114 1.1 ad static const struct mly_ident *mly_find_ident(struct pci_attach_args *);
115 1.1 ad static int mly_fwhandshake(struct mly_softc *);
116 1.1 ad static int mly_flush(struct mly_softc *);
117 1.1 ad static int mly_intr(void *);
118 1.1 ad static void mly_shutdown(void *);
119 1.1 ad
120 1.1 ad static int mly_alloc_ccbs(struct mly_softc *);
121 1.1 ad static void mly_check_event(struct mly_softc *);
122 1.1 ad static void mly_complete_event(struct mly_softc *, struct mly_ccb *);
123 1.1 ad static void mly_complete_rescan(struct mly_softc *, struct mly_ccb *);
124 1.1 ad static int mly_dmamem_alloc(struct mly_softc *, int, bus_dmamap_t *,
125 1.1 ad caddr_t *, bus_addr_t *, bus_dma_segment_t *);
126 1.1 ad static void mly_dmamem_free(struct mly_softc *, int, bus_dmamap_t,
127 1.1 ad caddr_t, bus_dma_segment_t *);
128 1.1 ad static int mly_enable_mmbox(struct mly_softc *);
129 1.1 ad static void mly_fetch_event(struct mly_softc *);
130 1.1 ad static int mly_get_controllerinfo(struct mly_softc *);
131 1.1 ad static int mly_get_eventstatus(struct mly_softc *);
132 1.1 ad static int mly_ioctl(struct mly_softc *, struct mly_cmd_ioctl *,
133 1.1 ad void **, size_t, void *, size_t *);
134 1.1 ad static void mly_padstr(char *, const char *, int);
135 1.1 ad static void mly_process_event(struct mly_softc *, struct mly_event *);
136 1.1 ad static void mly_release_ccbs(struct mly_softc *);
137 1.1 ad static int mly_scan_btl(struct mly_softc *, int, int);
138 1.1 ad static void mly_scan_channel(struct mly_softc *, int);
139 1.1 ad static void mly_thread(void *);
140 1.1 ad static void mly_thread_create(void *);
141 1.1 ad
142 1.1 ad static int mly_ccb_alloc(struct mly_softc *, struct mly_ccb **);
143 1.1 ad static void mly_ccb_complete(struct mly_softc *, struct mly_ccb *);
144 1.1 ad static void mly_ccb_enqueue(struct mly_softc *, struct mly_ccb *);
145 1.1 ad static void mly_ccb_free(struct mly_softc *, struct mly_ccb *);
146 1.1 ad static int mly_ccb_map(struct mly_softc *, struct mly_ccb *);
147 1.1 ad static int mly_ccb_poll(struct mly_softc *, struct mly_ccb *, int);
148 1.1 ad static int mly_ccb_submit(struct mly_softc *, struct mly_ccb *);
149 1.1 ad static void mly_ccb_unmap(struct mly_softc *, struct mly_ccb *);
150 1.1 ad static int mly_ccb_wait(struct mly_softc *, struct mly_ccb *, int);
151 1.1 ad
152 1.1 ad static void mly_get_xfer_mode(struct mly_softc *, int,
153 1.1 ad struct scsipi_xfer_mode *);
154 1.1 ad static void mly_scsipi_complete(struct mly_softc *, struct mly_ccb *);
155 1.1 ad static int mly_scsipi_ioctl(struct scsipi_channel *, u_long, caddr_t,
156 1.1 ad int, struct proc *);
157 1.1 ad static void mly_scsipi_minphys(struct buf *);
158 1.1 ad static void mly_scsipi_request(struct scsipi_channel *,
159 1.1 ad scsipi_adapter_req_t, void *);
160 1.1 ad
161 1.1 ad static int mly_user_command(struct mly_softc *, struct mly_user_command *);
162 1.1 ad static int mly_user_health(struct mly_softc *, struct mly_user_health *);
163 1.1 ad
164 1.1 ad cdev_decl(mly);
165 1.1 ad
166 1.1 ad extern struct cfdriver mly_cd;
167 1.1 ad
168 1.1 ad struct cfattach mly_ca = {
169 1.1 ad sizeof(struct mly_softc), mly_match, mly_attach
170 1.1 ad };
171 1.1 ad
172 1.1 ad struct mly_ident {
173 1.1 ad u_short vendor;
174 1.1 ad u_short product;
175 1.1 ad u_short subvendor;
176 1.1 ad u_short subproduct;
177 1.1 ad int hwif;
178 1.1 ad const char *desc;
179 1.1 ad } static const mly_ident[] = {
180 1.1 ad {
181 1.1 ad PCI_VENDOR_MYLEX,
182 1.1 ad PCI_PRODUCT_MYLEX_EXTREMERAID,
183 1.1 ad PCI_VENDOR_MYLEX,
184 1.1 ad 0x0040,
185 1.1 ad MLY_HWIF_STRONGARM,
186 1.1 ad "eXtremeRAID 2000"
187 1.1 ad },
188 1.1 ad {
189 1.1 ad PCI_VENDOR_MYLEX,
190 1.1 ad PCI_PRODUCT_MYLEX_EXTREMERAID,
191 1.1 ad PCI_VENDOR_MYLEX,
192 1.1 ad 0x0030,
193 1.1 ad MLY_HWIF_STRONGARM,
194 1.1 ad "eXtremeRAID 3000"
195 1.1 ad },
196 1.1 ad {
197 1.1 ad PCI_VENDOR_MYLEX,
198 1.1 ad PCI_PRODUCT_MYLEX_ACCELERAID,
199 1.1 ad PCI_VENDOR_MYLEX,
200 1.1 ad 0x0050,
201 1.1 ad MLY_HWIF_I960RX,
202 1.1 ad "AcceleRAID 352"
203 1.1 ad },
204 1.1 ad {
205 1.1 ad PCI_VENDOR_MYLEX,
206 1.1 ad PCI_PRODUCT_MYLEX_ACCELERAID,
207 1.1 ad PCI_VENDOR_MYLEX,
208 1.1 ad 0x0052,
209 1.1 ad MLY_HWIF_I960RX,
210 1.1 ad "AcceleRAID 170"
211 1.1 ad },
212 1.1 ad {
213 1.1 ad PCI_VENDOR_MYLEX,
214 1.1 ad PCI_PRODUCT_MYLEX_ACCELERAID,
215 1.1 ad PCI_VENDOR_MYLEX,
216 1.1 ad 0x0054,
217 1.1 ad MLY_HWIF_I960RX,
218 1.1 ad "AcceleRAID 160"
219 1.1 ad },
220 1.1 ad };
221 1.1 ad
222 1.1 ad static void *mly_sdh;
223 1.1 ad
224 1.1 ad /*
225 1.1 ad * Try to find a `mly_ident' entry corresponding to this board.
226 1.1 ad */
227 1.1 ad static const struct mly_ident *
228 1.1 ad mly_find_ident(struct pci_attach_args *pa)
229 1.1 ad {
230 1.1 ad const struct mly_ident *mpi, *maxmpi;
231 1.1 ad pcireg_t reg;
232 1.1 ad
233 1.1 ad mpi = mly_ident;
234 1.1 ad maxmpi = mpi + sizeof(mly_ident) / sizeof(mly_ident[0]);
235 1.2 ad
236 1.2 ad if (PCI_CLASS(pa->pa_class) == PCI_CLASS_I2O)
237 1.2 ad return (NULL);
238 1.1 ad
239 1.1 ad for (; mpi < maxmpi; mpi++) {
240 1.1 ad if (PCI_VENDOR(pa->pa_id) != mpi->vendor ||
241 1.1 ad PCI_PRODUCT(pa->pa_id) != mpi->product)
242 1.1 ad continue;
243 1.1 ad
244 1.1 ad if (mpi->subvendor == 0x0000)
245 1.1 ad return (mpi);
246 1.1 ad
247 1.1 ad reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_SUBSYS_ID_REG);
248 1.1 ad
249 1.1 ad if (PCI_VENDOR(reg) == mpi->subvendor &&
250 1.1 ad PCI_PRODUCT(reg) == mpi->subproduct)
251 1.1 ad return (mpi);
252 1.1 ad }
253 1.1 ad
254 1.1 ad return (NULL);
255 1.1 ad }
256 1.1 ad
257 1.1 ad /*
258 1.1 ad * Match a supported board.
259 1.1 ad */
260 1.1 ad static int
261 1.1 ad mly_match(struct device *parent, struct cfdata *cfdata, void *aux)
262 1.1 ad {
263 1.1 ad
264 1.1 ad return (mly_find_ident(aux) != NULL);
265 1.1 ad }
266 1.1 ad
267 1.1 ad /*
268 1.1 ad * Attach a supported board.
269 1.1 ad */
270 1.1 ad static void
271 1.1 ad mly_attach(struct device *parent, struct device *self, void *aux)
272 1.1 ad {
273 1.1 ad struct pci_attach_args *pa;
274 1.1 ad struct mly_softc *mly;
275 1.1 ad struct mly_ioctl_getcontrollerinfo *mi;
276 1.1 ad const struct mly_ident *ident;
277 1.1 ad pci_chipset_tag_t pc;
278 1.1 ad pci_intr_handle_t ih;
279 1.1 ad bus_space_handle_t memh, ioh;
280 1.1 ad bus_space_tag_t memt, iot;
281 1.1 ad pcireg_t reg;
282 1.1 ad const char *intrstr;
283 1.1 ad int ior, memr, i, rv, state;
284 1.1 ad struct scsipi_adapter *adapt;
285 1.1 ad struct scsipi_channel *chan;
286 1.1 ad
287 1.1 ad mly = (struct mly_softc *)self;
288 1.1 ad pa = aux;
289 1.1 ad pc = pa->pa_pc;
290 1.1 ad ident = mly_find_ident(pa);
291 1.1 ad state = 0;
292 1.1 ad
293 1.1 ad mly->mly_dmat = pa->pa_dmat;
294 1.1 ad mly->mly_hwif = ident->hwif;
295 1.1 ad
296 1.1 ad printf(": Mylex %s\n", ident->desc);
297 1.1 ad
298 1.1 ad /*
299 1.1 ad * Map the PCI register window.
300 1.1 ad */
301 1.1 ad memr = -1;
302 1.1 ad ior = -1;
303 1.1 ad
304 1.1 ad for (i = 0x10; i <= 0x14; i += 4) {
305 1.1 ad reg = pci_conf_read(pa->pa_pc, pa->pa_tag, i);
306 1.1 ad
307 1.1 ad if (PCI_MAPREG_TYPE(reg) == PCI_MAPREG_TYPE_IO) {
308 1.1 ad if (ior == -1 && PCI_MAPREG_IO_SIZE(reg) != 0)
309 1.1 ad ior = i;
310 1.1 ad } else {
311 1.1 ad if (memr == -1 && PCI_MAPREG_MEM_SIZE(reg) != 0)
312 1.1 ad memr = i;
313 1.1 ad }
314 1.1 ad }
315 1.1 ad
316 1.1 ad if (memr != -1)
317 1.1 ad if (pci_mapreg_map(pa, memr, PCI_MAPREG_TYPE_MEM, 0,
318 1.1 ad &memt, &memh, NULL, NULL))
319 1.1 ad memr = -1;
320 1.1 ad if (ior != -1)
321 1.1 ad if (pci_mapreg_map(pa, ior, PCI_MAPREG_TYPE_IO, 0,
322 1.1 ad &iot, &ioh, NULL, NULL))
323 1.1 ad ior = -1;
324 1.1 ad
325 1.1 ad if (memr != -1) {
326 1.1 ad mly->mly_iot = memt;
327 1.1 ad mly->mly_ioh = memh;
328 1.1 ad } else if (ior != -1) {
329 1.1 ad mly->mly_iot = iot;
330 1.1 ad mly->mly_ioh = ioh;
331 1.1 ad } else {
332 1.1 ad printf("%s: can't map i/o or memory space\n", self->dv_xname);
333 1.1 ad return;
334 1.1 ad }
335 1.1 ad
336 1.1 ad /*
337 1.1 ad * Enable the device.
338 1.1 ad */
339 1.1 ad reg = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
340 1.1 ad pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
341 1.1 ad reg | PCI_COMMAND_MASTER_ENABLE);
342 1.1 ad
343 1.1 ad /*
344 1.1 ad * Map and establish the interrupt.
345 1.1 ad */
346 1.1 ad if (pci_intr_map(pa, &ih)) {
347 1.1 ad printf("%s: can't map interrupt\n", self->dv_xname);
348 1.1 ad return;
349 1.1 ad }
350 1.1 ad intrstr = pci_intr_string(pc, ih);
351 1.1 ad mly->mly_ih = pci_intr_establish(pc, ih, IPL_BIO, mly_intr, mly);
352 1.1 ad if (mly->mly_ih == NULL) {
353 1.1 ad printf("%s: can't establish interrupt", self->dv_xname);
354 1.1 ad if (intrstr != NULL)
355 1.1 ad printf(" at %s", intrstr);
356 1.1 ad printf("\n");
357 1.1 ad return;
358 1.1 ad }
359 1.1 ad
360 1.1 ad if (intrstr != NULL)
361 1.1 ad printf("%s: interrupting at %s\n", mly->mly_dv.dv_xname,
362 1.1 ad intrstr);
363 1.1 ad
364 1.1 ad /*
365 1.1 ad * Take care of interface-specific tasks.
366 1.1 ad */
367 1.1 ad switch (mly->mly_hwif) {
368 1.1 ad case MLY_HWIF_I960RX:
369 1.1 ad mly->mly_doorbell_true = 0x00;
370 1.1 ad mly->mly_cmd_mailbox = MLY_I960RX_COMMAND_MAILBOX;
371 1.1 ad mly->mly_status_mailbox = MLY_I960RX_STATUS_MAILBOX;
372 1.1 ad mly->mly_idbr = MLY_I960RX_IDBR;
373 1.1 ad mly->mly_odbr = MLY_I960RX_ODBR;
374 1.1 ad mly->mly_error_status = MLY_I960RX_ERROR_STATUS;
375 1.1 ad mly->mly_interrupt_status = MLY_I960RX_INTERRUPT_STATUS;
376 1.1 ad mly->mly_interrupt_mask = MLY_I960RX_INTERRUPT_MASK;
377 1.1 ad break;
378 1.1 ad
379 1.1 ad case MLY_HWIF_STRONGARM:
380 1.1 ad mly->mly_doorbell_true = 0xff;
381 1.1 ad mly->mly_cmd_mailbox = MLY_STRONGARM_COMMAND_MAILBOX;
382 1.1 ad mly->mly_status_mailbox = MLY_STRONGARM_STATUS_MAILBOX;
383 1.1 ad mly->mly_idbr = MLY_STRONGARM_IDBR;
384 1.1 ad mly->mly_odbr = MLY_STRONGARM_ODBR;
385 1.1 ad mly->mly_error_status = MLY_STRONGARM_ERROR_STATUS;
386 1.1 ad mly->mly_interrupt_status = MLY_STRONGARM_INTERRUPT_STATUS;
387 1.1 ad mly->mly_interrupt_mask = MLY_STRONGARM_INTERRUPT_MASK;
388 1.1 ad break;
389 1.1 ad }
390 1.1 ad
391 1.1 ad /*
392 1.1 ad * Allocate and map the scatter/gather lists.
393 1.1 ad */
394 1.1 ad rv = mly_dmamem_alloc(mly, MLY_SGL_SIZE * MLY_MAX_CCBS,
395 1.1 ad &mly->mly_sg_dmamap, (caddr_t *)&mly->mly_sg,
396 1.1 ad &mly->mly_sg_busaddr, &mly->mly_sg_seg);
397 1.1 ad if (rv) {
398 1.1 ad printf("%s: unable to allocate S/G maps\n",
399 1.1 ad mly->mly_dv.dv_xname);
400 1.1 ad goto bad;
401 1.1 ad }
402 1.1 ad state++;
403 1.1 ad
404 1.1 ad /*
405 1.1 ad * Allocate and map the memory mailbox.
406 1.1 ad */
407 1.1 ad rv = mly_dmamem_alloc(mly, sizeof(struct mly_mmbox),
408 1.1 ad &mly->mly_mmbox_dmamap, (caddr_t *)&mly->mly_mmbox,
409 1.1 ad &mly->mly_mmbox_busaddr, &mly->mly_mmbox_seg);
410 1.1 ad if (rv) {
411 1.1 ad printf("%s: unable to allocate mailboxes\n",
412 1.1 ad mly->mly_dv.dv_xname);
413 1.1 ad goto bad;
414 1.1 ad }
415 1.1 ad state++;
416 1.1 ad
417 1.1 ad /*
418 1.1 ad * Initialise per-controller queues.
419 1.1 ad */
420 1.1 ad SLIST_INIT(&mly->mly_ccb_free);
421 1.1 ad SIMPLEQ_INIT(&mly->mly_ccb_queue);
422 1.1 ad
423 1.1 ad /*
424 1.1 ad * Disable interrupts before we start talking to the controller.
425 1.1 ad */
426 1.1 ad mly_outb(mly, mly->mly_interrupt_mask, MLY_INTERRUPT_MASK_DISABLE);
427 1.1 ad
428 1.1 ad /*
429 1.1 ad * Wait for the controller to come ready, handshaking with the
430 1.1 ad * firmware if required. This is typically only necessary on
431 1.1 ad * platforms where the controller BIOS does not run.
432 1.1 ad */
433 1.1 ad if (mly_fwhandshake(mly)) {
434 1.1 ad printf("%s: unable to bring controller online\n",
435 1.1 ad mly->mly_dv.dv_xname);
436 1.1 ad goto bad;
437 1.1 ad }
438 1.1 ad
439 1.1 ad /*
440 1.1 ad * Allocate initial command buffers, obtain controller feature
441 1.1 ad * information, and then reallocate command buffers, since we'll
442 1.1 ad * know how many we want.
443 1.1 ad */
444 1.1 ad if (mly_alloc_ccbs(mly)) {
445 1.1 ad printf("%s: unable to allocate CCBs\n",
446 1.1 ad mly->mly_dv.dv_xname);
447 1.1 ad goto bad;
448 1.1 ad }
449 1.1 ad state++;
450 1.1 ad if (mly_get_controllerinfo(mly)) {
451 1.1 ad printf("%s: unable to retrieve controller info\n",
452 1.1 ad mly->mly_dv.dv_xname);
453 1.1 ad goto bad;
454 1.1 ad }
455 1.1 ad mly_release_ccbs(mly);
456 1.1 ad if (mly_alloc_ccbs(mly)) {
457 1.1 ad printf("%s: unable to allocate CCBs\n",
458 1.1 ad mly->mly_dv.dv_xname);
459 1.1 ad state--;
460 1.1 ad goto bad;
461 1.1 ad }
462 1.1 ad
463 1.1 ad /*
464 1.1 ad * Get the current event counter for health purposes, populate the
465 1.1 ad * initial health status buffer.
466 1.1 ad */
467 1.1 ad if (mly_get_eventstatus(mly)) {
468 1.1 ad printf("%s: unable to retrieve event status\n",
469 1.1 ad mly->mly_dv.dv_xname);
470 1.1 ad goto bad;
471 1.1 ad }
472 1.1 ad
473 1.1 ad /*
474 1.1 ad * Enable memory-mailbox mode.
475 1.1 ad */
476 1.1 ad if (mly_enable_mmbox(mly)) {
477 1.1 ad printf("%s: unable to enable memory mailbox\n",
478 1.1 ad mly->mly_dv.dv_xname);
479 1.1 ad goto bad;
480 1.1 ad }
481 1.1 ad
482 1.1 ad /*
483 1.1 ad * Print a little information about the controller.
484 1.1 ad */
485 1.1 ad mi = mly->mly_controllerinfo;
486 1.1 ad
487 1.1 ad printf("%s: %d physical channel%s, firmware %d.%02d-%d-%02d "
488 1.1 ad "(%02d%02d%02d%02d), %dMB RAM\n", mly->mly_dv.dv_xname,
489 1.1 ad mi->physical_channels_present,
490 1.1 ad (mi->physical_channels_present) > 1 ? "s" : "",
491 1.1 ad mi->fw_major, mi->fw_minor, mi->fw_turn, mi->fw_build,
492 1.1 ad mi->fw_century, mi->fw_year, mi->fw_month, mi->fw_day,
493 1.1 ad le16toh(mi->memory_size));
494 1.1 ad
495 1.1 ad /*
496 1.1 ad * Register our `shutdownhook'.
497 1.1 ad */
498 1.1 ad if (mly_sdh == NULL)
499 1.1 ad shutdownhook_establish(mly_shutdown, NULL);
500 1.1 ad
501 1.1 ad /*
502 1.1 ad * Clear any previous BTL information. For each bus that scsipi
503 1.1 ad * wants to scan, we'll receive the SCBUSIOLLSCAN ioctl and retrieve
504 1.1 ad * all BTL info at that point.
505 1.1 ad */
506 1.1 ad memset(&mly->mly_btl, 0, sizeof(mly->mly_btl));
507 1.1 ad
508 1.1 ad mly->mly_nchans = mly->mly_controllerinfo->physical_channels_present +
509 1.1 ad mly->mly_controllerinfo->virtual_channels_present;
510 1.1 ad
511 1.1 ad /*
512 1.1 ad * Attach to scsipi.
513 1.1 ad */
514 1.1 ad adapt = &mly->mly_adapt;
515 1.1 ad memset(adapt, 0, sizeof(*adapt));
516 1.1 ad adapt->adapt_dev = &mly->mly_dv;
517 1.1 ad adapt->adapt_nchannels = mly->mly_nchans;
518 1.1 ad adapt->adapt_openings = mly->mly_ncmds - MLY_CCBS_RESV;
519 1.1 ad adapt->adapt_max_periph = mly->mly_ncmds - MLY_CCBS_RESV;
520 1.1 ad adapt->adapt_request = mly_scsipi_request;
521 1.1 ad adapt->adapt_minphys = mly_scsipi_minphys;
522 1.1 ad adapt->adapt_ioctl = mly_scsipi_ioctl;
523 1.1 ad
524 1.1 ad for (i = 0; i < mly->mly_nchans; i++) {
525 1.1 ad chan = &mly->mly_chans[i];
526 1.1 ad memset(chan, 0, sizeof(*chan));
527 1.1 ad chan->chan_adapter = adapt;
528 1.1 ad chan->chan_bustype = &scsi_bustype;
529 1.1 ad chan->chan_channel = i;
530 1.1 ad chan->chan_ntargets = MLY_MAX_TARGETS;
531 1.1 ad chan->chan_nluns = MLY_MAX_LUNS;
532 1.1 ad chan->chan_id = mly->mly_controllerparam->initiator_id;
533 1.1 ad chan->chan_flags = SCSIPI_CHAN_NOSETTLE;
534 1.1 ad config_found(&mly->mly_dv, chan, scsiprint);
535 1.1 ad }
536 1.1 ad
537 1.1 ad /*
538 1.1 ad * Now enable interrupts...
539 1.1 ad */
540 1.1 ad mly_outb(mly, mly->mly_interrupt_mask, MLY_INTERRUPT_MASK_ENABLE);
541 1.1 ad
542 1.1 ad /*
543 1.1 ad * Finally, create our monitoring thread.
544 1.1 ad */
545 1.1 ad kthread_create(mly_thread_create, mly);
546 1.1 ad
547 1.1 ad mly->mly_state |= MLY_STATE_INITOK;
548 1.1 ad return;
549 1.1 ad
550 1.1 ad bad:
551 1.1 ad if (state > 2)
552 1.1 ad mly_release_ccbs(mly);
553 1.1 ad if (state > 1)
554 1.1 ad mly_dmamem_free(mly, sizeof(struct mly_mmbox),
555 1.1 ad mly->mly_mmbox_dmamap, (caddr_t)mly->mly_mmbox,
556 1.1 ad &mly->mly_mmbox_seg);
557 1.1 ad if (state > 0)
558 1.1 ad mly_dmamem_free(mly, MLY_SGL_SIZE * MLY_MAX_CCBS,
559 1.1 ad mly->mly_sg_dmamap, (caddr_t)mly->mly_sg,
560 1.1 ad &mly->mly_sg_seg);
561 1.1 ad }
562 1.1 ad
563 1.1 ad /*
564 1.1 ad * Scan all possible devices on the specified channel.
565 1.1 ad */
566 1.1 ad static void
567 1.1 ad mly_scan_channel(struct mly_softc *mly, int bus)
568 1.1 ad {
569 1.3 ad int s, target;
570 1.1 ad
571 1.3 ad for (target = 0; target < MLY_MAX_TARGETS; target++) {
572 1.3 ad s = splbio();
573 1.3 ad if (!mly_scan_btl(mly, bus, target)) {
574 1.3 ad tsleep(&mly->mly_btl[bus][target], PRIBIO, "mlyscan",
575 1.3 ad 0);
576 1.3 ad }
577 1.3 ad splx(s);
578 1.1 ad }
579 1.1 ad }
580 1.1 ad
581 1.1 ad /*
582 1.1 ad * Shut down all configured `mly' devices.
583 1.1 ad */
584 1.1 ad static void
585 1.1 ad mly_shutdown(void *cookie)
586 1.1 ad {
587 1.1 ad struct mly_softc *mly;
588 1.1 ad int i;
589 1.1 ad
590 1.1 ad for (i = 0; i < mly_cd.cd_ndevs; i++) {
591 1.1 ad if ((mly = device_lookup(&mly_cd, i)) == NULL)
592 1.1 ad continue;
593 1.1 ad
594 1.1 ad if (mly_flush(mly))
595 1.1 ad printf("%s: unable to flush cache\n",
596 1.1 ad mly->mly_dv.dv_xname);
597 1.1 ad }
598 1.1 ad }
599 1.1 ad
600 1.1 ad /*
601 1.1 ad * Fill in the mly_controllerinfo and mly_controllerparam fields in the
602 1.1 ad * softc.
603 1.1 ad */
604 1.1 ad static int
605 1.1 ad mly_get_controllerinfo(struct mly_softc *mly)
606 1.1 ad {
607 1.1 ad struct mly_cmd_ioctl mci;
608 1.1 ad int rv;
609 1.1 ad
610 1.1 ad /*
611 1.1 ad * Build the getcontrollerinfo ioctl and send it.
612 1.1 ad */
613 1.1 ad memset(&mci, 0, sizeof(mci));
614 1.1 ad mci.sub_ioctl = MDACIOCTL_GETCONTROLLERINFO;
615 1.1 ad rv = mly_ioctl(mly, &mci, (void **)&mly->mly_controllerinfo,
616 1.1 ad sizeof(*mly->mly_controllerinfo), NULL, NULL);
617 1.1 ad if (rv != 0)
618 1.1 ad return (rv);
619 1.1 ad
620 1.1 ad /*
621 1.1 ad * Build the getcontrollerparameter ioctl and send it.
622 1.1 ad */
623 1.1 ad memset(&mci, 0, sizeof(mci));
624 1.1 ad mci.sub_ioctl = MDACIOCTL_GETCONTROLLERPARAMETER;
625 1.1 ad rv = mly_ioctl(mly, &mci, (void **)&mly->mly_controllerparam,
626 1.1 ad sizeof(*mly->mly_controllerparam), NULL, NULL);
627 1.1 ad
628 1.1 ad return (rv);
629 1.1 ad }
630 1.1 ad
631 1.1 ad /*
632 1.1 ad * Rescan a device, possibly as a consequence of getting an event which
633 1.1 ad * suggests that it may have changed. Must be called with interrupts
634 1.1 ad * blocked.
635 1.1 ad */
636 1.1 ad static int
637 1.1 ad mly_scan_btl(struct mly_softc *mly, int bus, int target)
638 1.1 ad {
639 1.1 ad struct mly_ccb *mc;
640 1.1 ad struct mly_cmd_ioctl *mci;
641 1.1 ad int rv;
642 1.1 ad
643 1.1 ad if (target == mly->mly_controllerparam->initiator_id) {
644 1.1 ad mly->mly_btl[bus][target].mb_flags = MLY_BTL_PROTECTED;
645 1.1 ad return (EIO);
646 1.1 ad }
647 1.1 ad
648 1.1 ad /* Don't re-scan if a scan is already in progress. */
649 1.1 ad if ((mly->mly_btl[bus][target].mb_flags & MLY_BTL_SCANNING) != 0)
650 1.1 ad return (EBUSY);
651 1.1 ad
652 1.1 ad /* Get a command. */
653 1.1 ad if ((rv = mly_ccb_alloc(mly, &mc)) != 0)
654 1.1 ad return (rv);
655 1.1 ad
656 1.1 ad /* Set up the data buffer. */
657 1.1 ad mc->mc_data = malloc(sizeof(union mly_devinfo),
658 1.1 ad M_DEVBUF, M_NOWAIT);
659 1.1 ad memset(mc->mc_data, 0, sizeof(union mly_devinfo));
660 1.1 ad
661 1.1 ad mc->mc_flags |= MLY_CCB_DATAIN;
662 1.1 ad mc->mc_complete = mly_complete_rescan;
663 1.1 ad
664 1.1 ad /*
665 1.1 ad * Build the ioctl.
666 1.1 ad */
667 1.1 ad mci = (struct mly_cmd_ioctl *)&mc->mc_packet->ioctl;
668 1.1 ad mci->opcode = MDACMD_IOCTL;
669 1.1 ad mci->timeout = 30 | MLY_TIMEOUT_SECONDS;
670 1.1 ad memset(&mci->param, 0, sizeof(mci->param));
671 1.1 ad
672 1.1 ad if (MLY_BUS_IS_VIRTUAL(mly, bus)) {
673 1.1 ad mc->mc_length = sizeof(struct mly_ioctl_getlogdevinfovalid);
674 1.1 ad mci->data_size = htole32(mc->mc_length);
675 1.1 ad mci->sub_ioctl = MDACIOCTL_GETLOGDEVINFOVALID;
676 1.1 ad _lto3l(MLY_LOGADDR(0, MLY_LOGDEV_ID(mly, bus, target)),
677 1.1 ad mci->addr);
678 1.1 ad } else {
679 1.1 ad mc->mc_length = sizeof(struct mly_ioctl_getphysdevinfovalid);
680 1.1 ad mci->data_size = htole32(mc->mc_length);
681 1.1 ad mci->sub_ioctl = MDACIOCTL_GETPHYSDEVINFOVALID;
682 1.1 ad _lto3l(MLY_PHYADDR(0, bus, target, 0), mci->addr);
683 1.1 ad }
684 1.1 ad
685 1.1 ad /*
686 1.1 ad * Dispatch the command.
687 1.1 ad */
688 1.3 ad if ((rv = mly_ccb_map(mly, mc)) != 0) {
689 1.3 ad free(mc->mc_data, M_DEVBUF);
690 1.3 ad mly_ccb_free(mly, mc);
691 1.3 ad return(rv);
692 1.3 ad }
693 1.3 ad
694 1.1 ad mly->mly_btl[bus][target].mb_flags |= MLY_BTL_SCANNING;
695 1.1 ad mly_ccb_enqueue(mly, mc);
696 1.1 ad return (0);
697 1.1 ad }
698 1.1 ad
699 1.1 ad /*
700 1.1 ad * Handle the completion of a rescan operation.
701 1.1 ad */
702 1.1 ad static void
703 1.1 ad mly_complete_rescan(struct mly_softc *mly, struct mly_ccb *mc)
704 1.1 ad {
705 1.1 ad struct mly_ioctl_getlogdevinfovalid *ldi;
706 1.1 ad struct mly_ioctl_getphysdevinfovalid *pdi;
707 1.1 ad struct mly_cmd_ioctl *mci;
708 1.1 ad struct mly_btl btl, *btlp;
709 1.1 ad struct scsipi_xfer_mode xm;
710 1.1 ad int bus, target, rescan;
711 1.1 ad u_int tmp;
712 1.1 ad
713 1.1 ad mly_ccb_unmap(mly, mc);
714 1.1 ad
715 1.1 ad /*
716 1.1 ad * Recover the bus and target from the command. We need these even
717 1.1 ad * in the case where we don't have a useful response.
718 1.1 ad */
719 1.1 ad mci = (struct mly_cmd_ioctl *)&mc->mc_packet->ioctl;
720 1.1 ad tmp = _3ltol(mci->addr);
721 1.1 ad rescan = 0;
722 1.1 ad
723 1.1 ad if (mci->sub_ioctl == MDACIOCTL_GETLOGDEVINFOVALID) {
724 1.1 ad bus = MLY_LOGDEV_BUS(mly, MLY_LOGADDR_DEV(tmp));
725 1.1 ad target = MLY_LOGDEV_TARGET(mly, MLY_LOGADDR_DEV(tmp));
726 1.1 ad } else {
727 1.1 ad bus = MLY_PHYADDR_CHANNEL(tmp);
728 1.1 ad target = MLY_PHYADDR_TARGET(tmp);
729 1.1 ad }
730 1.1 ad
731 1.1 ad btlp = &mly->mly_btl[bus][target];
732 1.1 ad
733 1.1 ad /* The default result is 'no device'. */
734 1.1 ad memset(&btl, 0, sizeof(btl));
735 1.1 ad btl.mb_flags = MLY_BTL_PROTECTED;
736 1.1 ad
737 1.1 ad /* If the rescan completed OK, we have possibly-new BTL data. */
738 1.1 ad if (mc->mc_status != 0)
739 1.1 ad goto out;
740 1.1 ad
741 1.1 ad if (mc->mc_length == sizeof(*ldi)) {
742 1.1 ad ldi = (struct mly_ioctl_getlogdevinfovalid *)mc->mc_data;
743 1.1 ad tmp = le32toh(ldi->logical_device_number);
744 1.1 ad
745 1.1 ad if (MLY_LOGDEV_BUS(mly, tmp) != bus ||
746 1.1 ad MLY_LOGDEV_TARGET(mly, tmp) != target) {
747 1.3 ad #ifdef MLYDEBUG
748 1.1 ad printf("%s: WARNING: BTL rescan (logical) for %d:%d "
749 1.1 ad "returned data for %d:%d instead\n",
750 1.1 ad mly->mly_dv.dv_xname, bus, target,
751 1.1 ad MLY_LOGDEV_BUS(mly, tmp),
752 1.1 ad MLY_LOGDEV_TARGET(mly, tmp));
753 1.1 ad #endif
754 1.1 ad goto out;
755 1.1 ad }
756 1.1 ad
757 1.1 ad btl.mb_flags = MLY_BTL_LOGICAL | MLY_BTL_TQING;
758 1.1 ad btl.mb_type = ldi->raid_level;
759 1.1 ad btl.mb_state = ldi->state;
760 1.1 ad } else if (mc->mc_length == sizeof(*pdi)) {
761 1.1 ad pdi = (struct mly_ioctl_getphysdevinfovalid *)mc->mc_data;
762 1.1 ad
763 1.1 ad if (pdi->channel != bus || pdi->target != target) {
764 1.3 ad #ifdef MLYDEBUG
765 1.1 ad printf("%s: WARNING: BTL rescan (physical) for %d:%d "
766 1.1 ad " returned data for %d:%d instead\n",
767 1.1 ad mly->mly_dv.dv_xname,
768 1.1 ad bus, target, pdi->channel, pdi->target);
769 1.1 ad #endif
770 1.1 ad goto out;
771 1.1 ad }
772 1.1 ad
773 1.1 ad btl.mb_flags = MLY_BTL_PHYSICAL;
774 1.1 ad btl.mb_type = MLY_DEVICE_TYPE_PHYSICAL;
775 1.1 ad btl.mb_state = pdi->state;
776 1.1 ad btl.mb_speed = pdi->speed;
777 1.1 ad btl.mb_width = pdi->width;
778 1.1 ad
779 1.1 ad if (pdi->state != MLY_DEVICE_STATE_UNCONFIGURED)
780 1.1 ad btl.mb_flags |= MLY_BTL_PROTECTED;
781 1.1 ad if (pdi->command_tags != 0)
782 1.1 ad btl.mb_flags |= MLY_BTL_TQING;
783 1.1 ad } else {
784 1.1 ad printf("%s: BTL rescan result invalid\n", mly->mly_dv.dv_xname);
785 1.1 ad goto out;
786 1.1 ad }
787 1.1 ad
788 1.1 ad /* Decide whether we need to rescan the device. */
789 1.1 ad if (btl.mb_flags != btlp->mb_flags ||
790 1.1 ad btl.mb_speed != btlp->mb_speed ||
791 1.1 ad btl.mb_width != btlp->mb_width)
792 1.1 ad rescan = 1;
793 1.1 ad
794 1.1 ad out:
795 1.1 ad *btlp = btl;
796 1.1 ad
797 1.1 ad if (rescan && (btl.mb_flags & MLY_BTL_PROTECTED) == 0) {
798 1.1 ad xm.xm_target = target;
799 1.1 ad mly_get_xfer_mode(mly, bus, &xm);
800 1.1 ad /* XXX SCSI mid-layer rescan goes here. */
801 1.1 ad }
802 1.1 ad
803 1.1 ad /* Wake anybody waiting on the device to be rescanned. */
804 1.1 ad wakeup(btlp);
805 1.1 ad
806 1.1 ad free(mc->mc_data, M_DEVBUF);
807 1.1 ad mly_ccb_free(mly, mc);
808 1.1 ad }
809 1.1 ad
810 1.1 ad /*
811 1.1 ad * Get the current health status and set the 'next event' counter to suit.
812 1.1 ad */
813 1.1 ad static int
814 1.1 ad mly_get_eventstatus(struct mly_softc *mly)
815 1.1 ad {
816 1.1 ad struct mly_cmd_ioctl mci;
817 1.1 ad struct mly_health_status *mh;
818 1.1 ad int rv;
819 1.1 ad
820 1.1 ad /* Build the gethealthstatus ioctl and send it. */
821 1.1 ad memset(&mci, 0, sizeof(mci));
822 1.1 ad mh = NULL;
823 1.1 ad mci.sub_ioctl = MDACIOCTL_GETHEALTHSTATUS;
824 1.1 ad
825 1.1 ad rv = mly_ioctl(mly, &mci, (void **)&mh, sizeof(*mh), NULL, NULL);
826 1.1 ad if (rv)
827 1.1 ad return (rv);
828 1.1 ad
829 1.1 ad /* Get the event counter. */
830 1.1 ad mly->mly_event_change = le32toh(mh->change_counter);
831 1.1 ad mly->mly_event_waiting = le32toh(mh->next_event);
832 1.1 ad mly->mly_event_counter = le32toh(mh->next_event);
833 1.1 ad
834 1.1 ad /* Save the health status into the memory mailbox */
835 1.1 ad memcpy(&mly->mly_mmbox->mmm_health.status, mh, sizeof(*mh));
836 1.1 ad
837 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
838 1.1 ad offsetof(struct mly_mmbox, mmm_health),
839 1.1 ad sizeof(mly->mly_mmbox->mmm_health),
840 1.1 ad BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
841 1.1 ad
842 1.1 ad free(mh, M_DEVBUF);
843 1.1 ad return (0);
844 1.1 ad }
845 1.1 ad
846 1.1 ad /*
847 1.3 ad * Enable memory mailbox mode.
848 1.1 ad */
849 1.1 ad static int
850 1.1 ad mly_enable_mmbox(struct mly_softc *mly)
851 1.1 ad {
852 1.1 ad struct mly_cmd_ioctl mci;
853 1.1 ad u_int8_t *sp;
854 1.1 ad u_int64_t tmp;
855 1.1 ad int rv;
856 1.1 ad
857 1.1 ad /* Build the ioctl and send it. */
858 1.1 ad memset(&mci, 0, sizeof(mci));
859 1.1 ad mci.sub_ioctl = MDACIOCTL_SETMEMORYMAILBOX;
860 1.1 ad
861 1.1 ad /* Set buffer addresses. */
862 1.1 ad tmp = mly->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_command);
863 1.1 ad mci.param.setmemorymailbox.command_mailbox_physaddr = htole64(tmp);
864 1.1 ad
865 1.1 ad tmp = mly->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_status);
866 1.1 ad mci.param.setmemorymailbox.status_mailbox_physaddr = htole64(tmp);
867 1.1 ad
868 1.1 ad tmp = mly->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_health);
869 1.1 ad mci.param.setmemorymailbox.health_buffer_physaddr = htole64(tmp);
870 1.1 ad
871 1.1 ad /* Set buffer sizes - abuse of data_size field is revolting. */
872 1.1 ad sp = (u_int8_t *)&mci.data_size;
873 1.1 ad sp[0] = (sizeof(union mly_cmd_packet) * MLY_MMBOX_COMMANDS) >> 10;
874 1.1 ad sp[1] = (sizeof(union mly_status_packet) * MLY_MMBOX_STATUS) >> 10;
875 1.1 ad mci.param.setmemorymailbox.health_buffer_size =
876 1.1 ad sizeof(union mly_health_region) >> 10;
877 1.1 ad
878 1.1 ad rv = mly_ioctl(mly, &mci, NULL, 0, NULL, NULL);
879 1.1 ad if (rv)
880 1.1 ad return (rv);
881 1.1 ad
882 1.1 ad mly->mly_state |= MLY_STATE_MMBOX_ACTIVE;
883 1.1 ad return (0);
884 1.1 ad }
885 1.1 ad
886 1.1 ad /*
887 1.1 ad * Flush all pending I/O from the controller.
888 1.1 ad */
889 1.1 ad static int
890 1.1 ad mly_flush(struct mly_softc *mly)
891 1.1 ad {
892 1.1 ad struct mly_cmd_ioctl mci;
893 1.1 ad
894 1.1 ad /* Build the ioctl */
895 1.1 ad memset(&mci, 0, sizeof(mci));
896 1.1 ad mci.sub_ioctl = MDACIOCTL_FLUSHDEVICEDATA;
897 1.1 ad mci.param.deviceoperation.operation_device =
898 1.1 ad MLY_OPDEVICE_PHYSICAL_CONTROLLER;
899 1.1 ad
900 1.1 ad /* Pass it off to the controller */
901 1.1 ad return (mly_ioctl(mly, &mci, NULL, 0, NULL, NULL));
902 1.1 ad }
903 1.1 ad
904 1.1 ad /*
905 1.1 ad * Perform an ioctl command.
906 1.1 ad *
907 1.3 ad * If (data) is not NULL, the command requires data transfer to the
908 1.3 ad * controller. If (*data) is NULL the command requires data transfer from
909 1.3 ad * the controller, and we will allocate a buffer for it.
910 1.1 ad */
911 1.1 ad static int
912 1.1 ad mly_ioctl(struct mly_softc *mly, struct mly_cmd_ioctl *ioctl, void **data,
913 1.1 ad size_t datasize, void *sense_buffer,
914 1.1 ad size_t *sense_length)
915 1.1 ad {
916 1.1 ad struct mly_ccb *mc;
917 1.1 ad struct mly_cmd_ioctl *mci;
918 1.1 ad u_int8_t status;
919 1.1 ad int rv;
920 1.1 ad
921 1.1 ad mc = NULL;
922 1.1 ad if ((rv = mly_ccb_alloc(mly, &mc)) != 0)
923 1.1 ad goto bad;
924 1.1 ad
925 1.1 ad /*
926 1.1 ad * Copy the ioctl structure, but save some important fields and then
927 1.1 ad * fixup.
928 1.1 ad */
929 1.1 ad mci = &mc->mc_packet->ioctl;
930 1.1 ad ioctl->sense_buffer_address = htole64(mci->sense_buffer_address);
931 1.1 ad ioctl->maximum_sense_size = mci->maximum_sense_size;
932 1.1 ad *mci = *ioctl;
933 1.1 ad mci->opcode = MDACMD_IOCTL;
934 1.1 ad mci->timeout = 30 | MLY_TIMEOUT_SECONDS;
935 1.1 ad
936 1.1 ad /* Handle the data buffer. */
937 1.1 ad if (data != NULL) {
938 1.1 ad if (*data == NULL) {
939 1.1 ad /* Allocate data buffer */
940 1.1 ad mc->mc_data = malloc(datasize, M_DEVBUF, M_NOWAIT);
941 1.1 ad mc->mc_flags |= MLY_CCB_DATAIN;
942 1.1 ad } else {
943 1.1 ad mc->mc_data = *data;
944 1.1 ad mc->mc_flags |= MLY_CCB_DATAOUT;
945 1.1 ad }
946 1.1 ad mc->mc_length = datasize;
947 1.1 ad mc->mc_packet->generic.data_size = htole32(datasize);
948 1.1 ad }
949 1.1 ad
950 1.1 ad /* Run the command. */
951 1.1 ad if (datasize > 0)
952 1.1 ad if ((rv = mly_ccb_map(mly, mc)) != 0)
953 1.1 ad goto bad;
954 1.1 ad rv = mly_ccb_poll(mly, mc, 30000);
955 1.1 ad if (datasize > 0)
956 1.1 ad mly_ccb_unmap(mly, mc);
957 1.1 ad if (rv != 0)
958 1.1 ad goto bad;
959 1.1 ad
960 1.1 ad /* Clean up and return any data. */
961 1.1 ad status = mc->mc_status;
962 1.1 ad
963 1.1 ad if (status != 0)
964 1.1 ad printf("mly_ioctl: command status %d\n", status);
965 1.1 ad
966 1.1 ad if (mc->mc_sense > 0 && sense_buffer != NULL) {
967 1.1 ad memcpy(sense_buffer, mc->mc_packet, mc->mc_sense);
968 1.1 ad *sense_length = mc->mc_sense;
969 1.1 ad goto bad;
970 1.1 ad }
971 1.1 ad
972 1.1 ad /* Should we return a data pointer? */
973 1.1 ad if (data != NULL && *data == NULL)
974 1.1 ad *data = mc->mc_data;
975 1.1 ad
976 1.1 ad /* Command completed OK. */
977 1.1 ad rv = (status != 0 ? EIO : 0);
978 1.1 ad
979 1.1 ad bad:
980 1.1 ad if (mc != NULL) {
981 1.1 ad /* Do we need to free a data buffer we allocated? */
982 1.1 ad if (rv != 0 && mc->mc_data != NULL && *data == NULL)
983 1.1 ad free(mc->mc_data, M_DEVBUF);
984 1.1 ad mly_ccb_free(mly, mc);
985 1.1 ad }
986 1.1 ad
987 1.1 ad return (rv);
988 1.1 ad }
989 1.1 ad
990 1.1 ad /*
991 1.1 ad * Check for event(s) outstanding in the controller.
992 1.1 ad */
993 1.1 ad static void
994 1.1 ad mly_check_event(struct mly_softc *mly)
995 1.1 ad {
996 1.1 ad
997 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
998 1.1 ad offsetof(struct mly_mmbox, mmm_health),
999 1.1 ad sizeof(mly->mly_mmbox->mmm_health),
1000 1.1 ad BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1001 1.1 ad
1002 1.1 ad /*
1003 1.1 ad * The controller may have updated the health status information, so
1004 1.1 ad * check for it here. Note that the counters are all in host
1005 1.1 ad * memory, so this check is very cheap. Also note that we depend on
1006 1.1 ad * checking on completion
1007 1.1 ad */
1008 1.1 ad if (le32toh(mly->mly_mmbox->mmm_health.status.change_counter) !=
1009 1.1 ad mly->mly_event_change) {
1010 1.1 ad mly->mly_event_change =
1011 1.1 ad le32toh(mly->mly_mmbox->mmm_health.status.change_counter);
1012 1.1 ad mly->mly_event_waiting =
1013 1.1 ad le32toh(mly->mly_mmbox->mmm_health.status.next_event);
1014 1.1 ad
1015 1.1 ad /* Wake up anyone that might be interested in this. */
1016 1.1 ad wakeup(&mly->mly_event_change);
1017 1.1 ad }
1018 1.1 ad
1019 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
1020 1.1 ad offsetof(struct mly_mmbox, mmm_health),
1021 1.1 ad sizeof(mly->mly_mmbox->mmm_health),
1022 1.1 ad BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1023 1.1 ad
1024 1.1 ad if (mly->mly_event_counter != mly->mly_event_waiting)
1025 1.1 ad mly_fetch_event(mly);
1026 1.1 ad }
1027 1.1 ad
1028 1.1 ad /*
1029 1.1 ad * Fetch one event from the controller. If we fail due to resource
1030 1.1 ad * starvation, we'll be retried the next time a command completes.
1031 1.1 ad */
1032 1.1 ad static void
1033 1.1 ad mly_fetch_event(struct mly_softc *mly)
1034 1.1 ad {
1035 1.1 ad struct mly_ccb *mc;
1036 1.1 ad struct mly_cmd_ioctl *mci;
1037 1.1 ad int s;
1038 1.1 ad u_int32_t event;
1039 1.1 ad
1040 1.1 ad /* Get a command. */
1041 1.1 ad if (mly_ccb_alloc(mly, &mc))
1042 1.1 ad return;
1043 1.1 ad
1044 1.1 ad /* Set up the data buffer. */
1045 1.1 ad mc->mc_data = malloc(sizeof(struct mly_event), M_DEVBUF, M_NOWAIT);
1046 1.1 ad memset(mc->mc_data, 0, sizeof(struct mly_event));
1047 1.1 ad
1048 1.1 ad mc->mc_length = sizeof(struct mly_event);
1049 1.1 ad mc->mc_flags |= MLY_CCB_DATAIN;
1050 1.1 ad mc->mc_complete = mly_complete_event;
1051 1.1 ad
1052 1.1 ad /*
1053 1.1 ad * Get an event number to fetch. It's possible that we've raced
1054 1.1 ad * with another context for the last event, in which case there will
1055 1.1 ad * be no more events.
1056 1.1 ad */
1057 1.1 ad s = splbio();
1058 1.1 ad if (mly->mly_event_counter == mly->mly_event_waiting) {
1059 1.1 ad splx(s);
1060 1.1 ad free(mc->mc_data, M_DEVBUF);
1061 1.1 ad mly_ccb_free(mly, mc);
1062 1.1 ad return;
1063 1.1 ad }
1064 1.1 ad event = mly->mly_event_counter++;
1065 1.1 ad splx(s);
1066 1.1 ad
1067 1.1 ad /*
1068 1.1 ad * Build the ioctl.
1069 1.1 ad *
1070 1.1 ad * At this point we are committed to sending this request, as it
1071 1.1 ad * will be the only one constructed for this particular event
1072 1.1 ad * number.
1073 1.1 ad */
1074 1.1 ad mci = (struct mly_cmd_ioctl *)&mc->mc_packet->ioctl;
1075 1.1 ad mci->opcode = MDACMD_IOCTL;
1076 1.1 ad mci->data_size = htole32(sizeof(struct mly_event));
1077 1.1 ad _lto3l(MLY_PHYADDR(0, 0, (event >> 16) & 0xff, (event >> 24) & 0xff),
1078 1.1 ad mci->addr);
1079 1.1 ad mci->timeout = 30 | MLY_TIMEOUT_SECONDS;
1080 1.1 ad mci->sub_ioctl = MDACIOCTL_GETEVENT;
1081 1.1 ad mci->param.getevent.sequence_number_low = htole16(event & 0xffff);
1082 1.1 ad
1083 1.1 ad /*
1084 1.1 ad * Submit the command.
1085 1.1 ad */
1086 1.1 ad if (mly_ccb_map(mly, mc) != 0)
1087 1.1 ad goto bad;
1088 1.1 ad mly_ccb_enqueue(mly, mc);
1089 1.1 ad return;
1090 1.1 ad
1091 1.1 ad bad:
1092 1.1 ad printf("%s: couldn't fetch event %u\n", mly->mly_dv.dv_xname, event);
1093 1.1 ad free(mc->mc_data, M_DEVBUF);
1094 1.1 ad mly_ccb_free(mly, mc);
1095 1.1 ad }
1096 1.1 ad
1097 1.1 ad /*
1098 1.1 ad * Handle the completion of an event poll.
1099 1.1 ad */
1100 1.1 ad static void
1101 1.1 ad mly_complete_event(struct mly_softc *mly, struct mly_ccb *mc)
1102 1.1 ad {
1103 1.1 ad struct mly_event *me;
1104 1.1 ad
1105 1.1 ad me = (struct mly_event *)mc->mc_data;
1106 1.1 ad mly_ccb_unmap(mly, mc);
1107 1.1 ad mly_ccb_free(mly, mc);
1108 1.1 ad
1109 1.1 ad /* If the event was successfully fetched, process it. */
1110 1.1 ad if (mc->mc_status == SCSI_OK)
1111 1.1 ad mly_process_event(mly, me);
1112 1.1 ad else
1113 1.1 ad printf("%s: unable to fetch event; status = 0x%x\n",
1114 1.1 ad mly->mly_dv.dv_xname, mc->mc_status);
1115 1.1 ad
1116 1.1 ad free(me, M_DEVBUF);
1117 1.1 ad
1118 1.1 ad /* Check for another event. */
1119 1.1 ad mly_check_event(mly);
1120 1.1 ad }
1121 1.1 ad
1122 1.1 ad /*
1123 1.1 ad * Process a controller event. Called with interupts blocked (i.e., at
1124 1.1 ad * interrupt time).
1125 1.1 ad */
1126 1.1 ad static void
1127 1.1 ad mly_process_event(struct mly_softc *mly, struct mly_event *me)
1128 1.1 ad {
1129 1.1 ad struct scsipi_sense_data *ssd;
1130 1.1 ad int bus, target, event, class, action;
1131 1.1 ad const char *fp, *tp;
1132 1.1 ad
1133 1.1 ad ssd = (struct scsipi_sense_data *)&me->sense[0];
1134 1.1 ad
1135 1.1 ad /*
1136 1.1 ad * Errors can be reported using vendor-unique sense data. In this
1137 1.1 ad * case, the event code will be 0x1c (Request sense data present),
1138 1.1 ad * the sense key will be 0x09 (vendor specific), the MSB of the ASC
1139 1.1 ad * will be set, and the actual event code will be a 16-bit value
1140 1.1 ad * comprised of the ASCQ (low byte) and low seven bits of the ASC
1141 1.1 ad * (low seven bits of the high byte).
1142 1.1 ad */
1143 1.1 ad if (le32toh(me->code) == 0x1c &&
1144 1.1 ad (ssd->flags & SSD_KEY) == SKEY_VENDOR_UNIQUE &&
1145 1.1 ad (ssd->add_sense_code & 0x80) != 0) {
1146 1.1 ad event = ((int)(ssd->add_sense_code & ~0x80) << 8) +
1147 1.1 ad ssd->add_sense_code_qual;
1148 1.1 ad } else
1149 1.1 ad event = le32toh(me->code);
1150 1.1 ad
1151 1.1 ad /* Look up event, get codes. */
1152 1.1 ad fp = mly_describe_code(mly_table_event, event);
1153 1.1 ad
1154 1.1 ad /* Quiet event? */
1155 1.1 ad class = fp[0];
1156 1.1 ad #ifdef notyet
1157 1.1 ad if (isupper(class) && bootverbose)
1158 1.1 ad class = tolower(class);
1159 1.1 ad #endif
1160 1.1 ad
1161 1.1 ad /* Get action code, text string. */
1162 1.1 ad action = fp[1];
1163 1.1 ad tp = fp + 3;
1164 1.1 ad
1165 1.1 ad /*
1166 1.1 ad * Print some information about the event.
1167 1.1 ad *
1168 1.1 ad * This code uses a table derived from the corresponding portion of
1169 1.1 ad * the Linux driver, and thus the parser is very similar.
1170 1.1 ad */
1171 1.1 ad switch (class) {
1172 1.1 ad case 'p':
1173 1.1 ad /*
1174 1.1 ad * Error on physical drive.
1175 1.1 ad */
1176 1.1 ad printf("%s: physical device %d:%d %s\n", mly->mly_dv.dv_xname,
1177 1.1 ad me->channel, me->target, tp);
1178 1.1 ad if (action == 'r')
1179 1.1 ad mly->mly_btl[me->channel][me->target].mb_flags |=
1180 1.1 ad MLY_BTL_RESCAN;
1181 1.1 ad break;
1182 1.1 ad
1183 1.1 ad case 'l':
1184 1.1 ad case 'm':
1185 1.1 ad /*
1186 1.1 ad * Error on logical unit, or message about logical unit.
1187 1.1 ad */
1188 1.1 ad bus = MLY_LOGDEV_BUS(mly, me->lun);
1189 1.1 ad target = MLY_LOGDEV_TARGET(mly, me->lun);
1190 1.4 ad printf("%s: logical device %d:%d %s\n", mly->mly_dv.dv_xname,
1191 1.4 ad bus, target, tp);
1192 1.1 ad if (action == 'r')
1193 1.1 ad mly->mly_btl[bus][target].mb_flags |= MLY_BTL_RESCAN;
1194 1.1 ad break;
1195 1.1 ad
1196 1.1 ad case 's':
1197 1.1 ad /*
1198 1.1 ad * Report of sense data.
1199 1.1 ad */
1200 1.1 ad if (((ssd->flags & SSD_KEY) == SKEY_NO_SENSE ||
1201 1.1 ad (ssd->flags & SSD_KEY) == SKEY_NOT_READY) &&
1202 1.1 ad ssd->add_sense_code == 0x04 &&
1203 1.1 ad (ssd->add_sense_code_qual == 0x01 ||
1204 1.1 ad ssd->add_sense_code_qual == 0x02)) {
1205 1.1 ad /* Ignore NO_SENSE or NOT_READY in one case */
1206 1.1 ad break;
1207 1.1 ad }
1208 1.1 ad
1209 1.1 ad /*
1210 1.1 ad * XXX Should translate this if SCSIVERBOSE.
1211 1.1 ad */
1212 1.1 ad printf("%s: physical device %d:%d %s\n", mly->mly_dv.dv_xname,
1213 1.1 ad me->channel, me->target, tp);
1214 1.1 ad printf("%s: sense key %d asc %02x ascq %02x\n",
1215 1.1 ad mly->mly_dv.dv_xname, ssd->flags & SSD_KEY,
1216 1.1 ad ssd->add_sense_code, ssd->add_sense_code_qual);
1217 1.1 ad printf("%s: info %x%x%x%x csi %x%x%x%x\n",
1218 1.1 ad mly->mly_dv.dv_xname, ssd->info[0], ssd->info[1],
1219 1.1 ad ssd->info[2], ssd->info[3], ssd->cmd_spec_info[0],
1220 1.1 ad ssd->cmd_spec_info[1], ssd->cmd_spec_info[2],
1221 1.1 ad ssd->cmd_spec_info[3]);
1222 1.1 ad if (action == 'r')
1223 1.1 ad mly->mly_btl[me->channel][me->target].mb_flags |=
1224 1.1 ad MLY_BTL_RESCAN;
1225 1.1 ad break;
1226 1.1 ad
1227 1.1 ad case 'e':
1228 1.1 ad printf("%s: ", mly->mly_dv.dv_xname);
1229 1.1 ad printf(tp, me->target, me->lun);
1230 1.1 ad break;
1231 1.1 ad
1232 1.1 ad case 'c':
1233 1.1 ad printf("%s: controller %s\n", mly->mly_dv.dv_xname, tp);
1234 1.1 ad break;
1235 1.1 ad
1236 1.1 ad case '?':
1237 1.1 ad printf("%s: %s - %d\n", mly->mly_dv.dv_xname, tp, event);
1238 1.1 ad break;
1239 1.1 ad
1240 1.1 ad default:
1241 1.1 ad /* Probably a 'noisy' event being ignored. */
1242 1.1 ad break;
1243 1.1 ad }
1244 1.1 ad }
1245 1.1 ad
1246 1.1 ad /*
1247 1.1 ad * Create the monitoring thread. Called after the standard kernel threads
1248 1.1 ad * have been created.
1249 1.1 ad */
1250 1.1 ad static void
1251 1.1 ad mly_thread_create(void *cookie)
1252 1.1 ad {
1253 1.1 ad struct mly_softc *mly;
1254 1.1 ad int rv;
1255 1.1 ad
1256 1.1 ad mly = cookie;
1257 1.1 ad
1258 1.1 ad rv = kthread_create1(mly_thread, mly, &mly->mly_thread, "%s",
1259 1.1 ad mly->mly_dv.dv_xname);
1260 1.1 ad if (rv != 0)
1261 1.1 ad printf("%s: unable to create thread (%d)\n",
1262 1.1 ad mly->mly_dv.dv_xname, rv);
1263 1.1 ad }
1264 1.1 ad
1265 1.1 ad /*
1266 1.1 ad * Perform periodic activities.
1267 1.1 ad */
1268 1.1 ad static void
1269 1.1 ad mly_thread(void *cookie)
1270 1.1 ad {
1271 1.1 ad struct mly_softc *mly;
1272 1.1 ad struct mly_btl *btl;
1273 1.1 ad int s, bus, target, done;
1274 1.1 ad
1275 1.1 ad mly = (struct mly_softc *)cookie;
1276 1.1 ad
1277 1.1 ad for (;;) {
1278 1.1 ad /* Check for new events. */
1279 1.1 ad mly_check_event(mly);
1280 1.1 ad
1281 1.1 ad /* Re-scan up to 1 device. */
1282 1.1 ad s = splbio();
1283 1.5 ad done = 0;
1284 1.1 ad for (bus = 0; bus < mly->mly_nchans && !done; bus++) {
1285 1.1 ad for (target = 0; target < MLY_MAX_TARGETS; target++) {
1286 1.1 ad /* Perform device rescan? */
1287 1.1 ad btl = &mly->mly_btl[bus][target];
1288 1.1 ad if ((btl->mb_flags & MLY_BTL_RESCAN) != 0) {
1289 1.1 ad btl->mb_flags ^= MLY_BTL_RESCAN;
1290 1.1 ad mly_scan_btl(mly, bus, target);
1291 1.1 ad done = 1;
1292 1.1 ad break;
1293 1.1 ad }
1294 1.1 ad }
1295 1.1 ad }
1296 1.1 ad splx(s);
1297 1.1 ad
1298 1.1 ad /* Sleep for N seconds. */
1299 1.1 ad tsleep(mly_thread, PWAIT, "mlyzzz",
1300 1.1 ad hz * MLY_PERIODIC_INTERVAL);
1301 1.1 ad }
1302 1.1 ad }
1303 1.1 ad
1304 1.1 ad /*
1305 1.1 ad * Submit a command to the controller and poll on completion. Return
1306 1.1 ad * non-zero on timeout.
1307 1.1 ad */
1308 1.1 ad static int
1309 1.1 ad mly_ccb_poll(struct mly_softc *mly, struct mly_ccb *mc, int timo)
1310 1.1 ad {
1311 1.1 ad int rv;
1312 1.1 ad
1313 1.1 ad if ((rv = mly_ccb_submit(mly, mc)) != 0)
1314 1.1 ad return (rv);
1315 1.1 ad
1316 1.1 ad for (timo *= 10; timo != 0; timo--) {
1317 1.1 ad if ((mc->mc_flags & MLY_CCB_COMPLETE) != 0)
1318 1.1 ad break;
1319 1.1 ad mly_intr(mly);
1320 1.1 ad DELAY(100);
1321 1.1 ad }
1322 1.1 ad
1323 1.1 ad return (timo == 0);
1324 1.1 ad }
1325 1.1 ad
1326 1.1 ad /*
1327 1.1 ad * Submit a command to the controller and sleep on completion. Return
1328 1.1 ad * non-zero on timeout.
1329 1.1 ad */
1330 1.1 ad static int
1331 1.1 ad mly_ccb_wait(struct mly_softc *mly, struct mly_ccb *mc, int timo)
1332 1.1 ad {
1333 1.1 ad int rv, s;
1334 1.1 ad
1335 1.1 ad mly_ccb_enqueue(mly, mc);
1336 1.1 ad
1337 1.1 ad s = splbio();
1338 1.1 ad if ((mc->mc_flags & MLY_CCB_COMPLETE) != 0) {
1339 1.1 ad splx(s);
1340 1.1 ad return (0);
1341 1.1 ad }
1342 1.1 ad rv = tsleep(mc, PRIBIO, "mlywccb", timo * hz / 1000);
1343 1.1 ad splx(s);
1344 1.1 ad
1345 1.1 ad return (rv);
1346 1.1 ad }
1347 1.1 ad
1348 1.1 ad /*
1349 1.1 ad * If a CCB is specified, enqueue it. Pull CCBs off the software queue in
1350 1.1 ad * the order that they were enqueued and try to submit their command blocks
1351 1.1 ad * to the controller for execution.
1352 1.1 ad */
1353 1.1 ad void
1354 1.1 ad mly_ccb_enqueue(struct mly_softc *mly, struct mly_ccb *mc)
1355 1.1 ad {
1356 1.1 ad int s;
1357 1.1 ad
1358 1.1 ad s = splbio();
1359 1.1 ad
1360 1.1 ad if (mc != NULL)
1361 1.1 ad SIMPLEQ_INSERT_TAIL(&mly->mly_ccb_queue, mc, mc_link.simpleq);
1362 1.1 ad
1363 1.1 ad while ((mc = SIMPLEQ_FIRST(&mly->mly_ccb_queue)) != NULL) {
1364 1.1 ad if (mly_ccb_submit(mly, mc))
1365 1.1 ad break;
1366 1.1 ad SIMPLEQ_REMOVE_HEAD(&mly->mly_ccb_queue, mc, mc_link.simpleq);
1367 1.1 ad }
1368 1.1 ad
1369 1.1 ad splx(s);
1370 1.1 ad }
1371 1.1 ad
1372 1.1 ad /*
1373 1.1 ad * Deliver a command to the controller.
1374 1.1 ad */
1375 1.1 ad static int
1376 1.1 ad mly_ccb_submit(struct mly_softc *mly, struct mly_ccb *mc)
1377 1.1 ad {
1378 1.1 ad union mly_cmd_packet *pkt;
1379 1.1 ad int s, off;
1380 1.1 ad
1381 1.1 ad mc->mc_packet->generic.command_id = htole16(mc->mc_slot);
1382 1.1 ad
1383 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_pkt_dmamap,
1384 1.1 ad mc->mc_packetphys - mly->mly_pkt_busaddr,
1385 1.1 ad sizeof(union mly_cmd_packet),
1386 1.1 ad BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
1387 1.1 ad
1388 1.1 ad s = splbio();
1389 1.1 ad
1390 1.1 ad /*
1391 1.1 ad * Do we have to use the hardware mailbox?
1392 1.1 ad */
1393 1.1 ad if ((mly->mly_state & MLY_STATE_MMBOX_ACTIVE) == 0) {
1394 1.1 ad /*
1395 1.1 ad * Check to see if the controller is ready for us.
1396 1.1 ad */
1397 1.1 ad if (mly_idbr_true(mly, MLY_HM_CMDSENT)) {
1398 1.1 ad splx(s);
1399 1.1 ad return (EBUSY);
1400 1.1 ad }
1401 1.1 ad
1402 1.1 ad /*
1403 1.1 ad * It's ready, send the command.
1404 1.1 ad */
1405 1.1 ad mly_outl(mly, mly->mly_cmd_mailbox,
1406 1.1 ad (u_int64_t)mc->mc_packetphys & 0xffffffff);
1407 1.1 ad mly_outl(mly, mly->mly_cmd_mailbox + 4,
1408 1.1 ad (u_int64_t)mc->mc_packetphys >> 32);
1409 1.1 ad mly_outb(mly, mly->mly_idbr, MLY_HM_CMDSENT);
1410 1.1 ad } else {
1411 1.1 ad pkt = &mly->mly_mmbox->mmm_command[mly->mly_mmbox_cmd_idx];
1412 1.1 ad off = (caddr_t)pkt - (caddr_t)mly->mly_mmbox;
1413 1.1 ad
1414 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
1415 1.1 ad off, sizeof(mly->mly_mmbox->mmm_command[0]),
1416 1.1 ad BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1417 1.1 ad
1418 1.1 ad /* Check to see if the next index is free yet. */
1419 1.1 ad if (pkt->mmbox.flag != 0) {
1420 1.1 ad splx(s);
1421 1.1 ad return (EBUSY);
1422 1.1 ad }
1423 1.1 ad
1424 1.1 ad /* Copy in new command */
1425 1.1 ad memcpy(pkt->mmbox.data, mc->mc_packet->mmbox.data,
1426 1.1 ad sizeof(pkt->mmbox.data));
1427 1.1 ad
1428 1.1 ad /* Copy flag last. */
1429 1.1 ad pkt->mmbox.flag = mc->mc_packet->mmbox.flag;
1430 1.1 ad
1431 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
1432 1.1 ad off, sizeof(mly->mly_mmbox->mmm_command[0]),
1433 1.1 ad BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1434 1.1 ad
1435 1.1 ad /* Signal controller and update index. */
1436 1.1 ad mly_outb(mly, mly->mly_idbr, MLY_AM_CMDSENT);
1437 1.1 ad mly->mly_mmbox_cmd_idx =
1438 1.1 ad (mly->mly_mmbox_cmd_idx + 1) % MLY_MMBOX_COMMANDS;
1439 1.1 ad }
1440 1.1 ad
1441 1.1 ad splx(s);
1442 1.1 ad return (0);
1443 1.1 ad }
1444 1.1 ad
1445 1.1 ad /*
1446 1.1 ad * Pick up completed commands from the controller and handle accordingly.
1447 1.1 ad */
1448 1.1 ad int
1449 1.1 ad mly_intr(void *cookie)
1450 1.1 ad {
1451 1.1 ad struct mly_ccb *mc;
1452 1.1 ad union mly_status_packet *sp;
1453 1.1 ad u_int16_t slot;
1454 1.1 ad int forus, off;
1455 1.1 ad struct mly_softc *mly;
1456 1.1 ad
1457 1.1 ad mly = cookie;
1458 1.1 ad forus = 0;
1459 1.1 ad
1460 1.1 ad /*
1461 1.1 ad * Pick up hardware-mailbox commands.
1462 1.1 ad */
1463 1.1 ad if (mly_odbr_true(mly, MLY_HM_STSREADY)) {
1464 1.1 ad slot = mly_inw(mly, mly->mly_status_mailbox);
1465 1.1 ad
1466 1.1 ad if (slot < MLY_SLOT_MAX) {
1467 1.1 ad mc = mly->mly_ccbs + (slot - MLY_SLOT_START);
1468 1.1 ad mc->mc_status =
1469 1.1 ad mly_inb(mly, mly->mly_status_mailbox + 2);
1470 1.1 ad mc->mc_sense =
1471 1.1 ad mly_inb(mly, mly->mly_status_mailbox + 3);
1472 1.1 ad mc->mc_resid =
1473 1.1 ad mly_inl(mly, mly->mly_status_mailbox + 4);
1474 1.1 ad
1475 1.1 ad mly_ccb_complete(mly, mc);
1476 1.1 ad } else {
1477 1.1 ad /* Slot 0xffff may mean "extremely bogus command". */
1478 1.1 ad printf("%s: got HM completion for illegal slot %u\n",
1479 1.1 ad mly->mly_dv.dv_xname, slot);
1480 1.1 ad }
1481 1.1 ad
1482 1.1 ad /* Unconditionally acknowledge status. */
1483 1.1 ad mly_outb(mly, mly->mly_odbr, MLY_HM_STSREADY);
1484 1.1 ad mly_outb(mly, mly->mly_idbr, MLY_HM_STSACK);
1485 1.1 ad forus = 1;
1486 1.1 ad }
1487 1.1 ad
1488 1.1 ad /*
1489 1.1 ad * Pick up memory-mailbox commands.
1490 1.1 ad */
1491 1.1 ad if (mly_odbr_true(mly, MLY_AM_STSREADY)) {
1492 1.1 ad for (;;) {
1493 1.1 ad sp = &mly->mly_mmbox->mmm_status[mly->mly_mmbox_sts_idx];
1494 1.1 ad off = (caddr_t)sp - (caddr_t)mly->mly_mmbox;
1495 1.1 ad
1496 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_mmbox_dmamap,
1497 1.1 ad off, sizeof(mly->mly_mmbox->mmm_command[0]),
1498 1.1 ad BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD);
1499 1.1 ad
1500 1.1 ad /* Check for more status. */
1501 1.1 ad if (sp->mmbox.flag == 0)
1502 1.1 ad break;
1503 1.1 ad
1504 1.1 ad /* Get slot number. */
1505 1.1 ad slot = le16toh(sp->status.command_id);
1506 1.1 ad if (slot < MLY_SLOT_MAX) {
1507 1.1 ad mc = mly->mly_ccbs + (slot - MLY_SLOT_START);
1508 1.1 ad mc->mc_status = sp->status.status;
1509 1.1 ad mc->mc_sense = sp->status.sense_length;
1510 1.1 ad mc->mc_resid = le32toh(sp->status.residue);
1511 1.1 ad mly_ccb_complete(mly, mc);
1512 1.1 ad } else {
1513 1.1 ad /*
1514 1.1 ad * Slot 0xffff may mean "extremely bogus
1515 1.1 ad * command".
1516 1.1 ad */
1517 1.1 ad printf("%s: got AM completion for illegal "
1518 1.1 ad "slot %u at %d\n", mly->mly_dv.dv_xname,
1519 1.1 ad slot, mly->mly_mmbox_sts_idx);
1520 1.1 ad }
1521 1.1 ad
1522 1.1 ad /* Clear and move to next index. */
1523 1.1 ad sp->mmbox.flag = 0;
1524 1.1 ad mly->mly_mmbox_sts_idx =
1525 1.1 ad (mly->mly_mmbox_sts_idx + 1) % MLY_MMBOX_STATUS;
1526 1.1 ad }
1527 1.1 ad
1528 1.1 ad /* Acknowledge that we have collected status value(s). */
1529 1.1 ad mly_outb(mly, mly->mly_odbr, MLY_AM_STSREADY);
1530 1.1 ad forus = 1;
1531 1.1 ad }
1532 1.1 ad
1533 1.1 ad /*
1534 1.1 ad * Run the queue.
1535 1.1 ad */
1536 1.1 ad if (forus && SIMPLEQ_FIRST(&mly->mly_ccb_queue) != NULL)
1537 1.1 ad mly_ccb_enqueue(mly, NULL);
1538 1.1 ad
1539 1.1 ad return (forus);
1540 1.1 ad }
1541 1.1 ad
1542 1.1 ad /*
1543 1.1 ad * Process completed commands
1544 1.1 ad */
1545 1.1 ad static void
1546 1.1 ad mly_ccb_complete(struct mly_softc *mly, struct mly_ccb *mc)
1547 1.1 ad {
1548 1.1 ad void (*complete)(struct mly_softc *, struct mly_ccb *);
1549 1.1 ad
1550 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_pkt_dmamap,
1551 1.1 ad mc->mc_packetphys - mly->mly_pkt_busaddr,
1552 1.1 ad sizeof(union mly_cmd_packet),
1553 1.1 ad BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1554 1.1 ad
1555 1.1 ad complete = mc->mc_complete;
1556 1.1 ad mc->mc_flags |= MLY_CCB_COMPLETE;
1557 1.1 ad
1558 1.1 ad /*
1559 1.1 ad * Call completion handler or wake up sleeping consumer.
1560 1.1 ad */
1561 1.1 ad if (complete != NULL)
1562 1.1 ad (*complete)(mly, mc);
1563 1.1 ad else
1564 1.1 ad wakeup(mc);
1565 1.1 ad }
1566 1.1 ad
1567 1.1 ad /*
1568 1.1 ad * Allocate a command.
1569 1.1 ad */
1570 1.1 ad int
1571 1.1 ad mly_ccb_alloc(struct mly_softc *mly, struct mly_ccb **mcp)
1572 1.1 ad {
1573 1.1 ad struct mly_ccb *mc;
1574 1.1 ad int s;
1575 1.1 ad
1576 1.1 ad s = splbio();
1577 1.1 ad mc = SLIST_FIRST(&mly->mly_ccb_free);
1578 1.1 ad if (mc != NULL)
1579 1.1 ad SLIST_REMOVE_HEAD(&mly->mly_ccb_free, mc_link.slist);
1580 1.1 ad splx(s);
1581 1.1 ad
1582 1.1 ad *mcp = mc;
1583 1.1 ad return (mc == NULL ? EAGAIN : 0);
1584 1.1 ad }
1585 1.1 ad
1586 1.1 ad /*
1587 1.1 ad * Release a command back to the freelist.
1588 1.1 ad */
1589 1.1 ad void
1590 1.1 ad mly_ccb_free(struct mly_softc *mly, struct mly_ccb *mc)
1591 1.1 ad {
1592 1.1 ad int s;
1593 1.1 ad
1594 1.1 ad /*
1595 1.1 ad * Fill in parts of the command that may cause confusion if a
1596 1.1 ad * consumer doesn't when we are later allocated.
1597 1.1 ad */
1598 1.1 ad mc->mc_data = NULL;
1599 1.1 ad mc->mc_flags = 0;
1600 1.1 ad mc->mc_complete = NULL;
1601 1.1 ad mc->mc_private = NULL;
1602 1.3 ad mc->mc_packet->generic.command_control = 0;
1603 1.1 ad
1604 1.1 ad /*
1605 1.1 ad * By default, we set up to overwrite the command packet with sense
1606 1.1 ad * information.
1607 1.1 ad */
1608 1.1 ad mc->mc_packet->generic.sense_buffer_address =
1609 1.1 ad htole64(mc->mc_packetphys);
1610 1.1 ad mc->mc_packet->generic.maximum_sense_size =
1611 1.1 ad sizeof(union mly_cmd_packet);
1612 1.1 ad
1613 1.1 ad s = splbio();
1614 1.1 ad SLIST_INSERT_HEAD(&mly->mly_ccb_free, mc, mc_link.slist);
1615 1.1 ad splx(s);
1616 1.1 ad }
1617 1.1 ad
1618 1.1 ad /*
1619 1.1 ad * Allocate and initialise command and packet structures.
1620 1.1 ad *
1621 1.1 ad * If the controller supports fewer than MLY_MAX_CCBS commands, limit our
1622 1.1 ad * allocation to that number. If we don't yet know how many commands the
1623 1.1 ad * controller supports, allocate a very small set (suitable for initialisation
1624 1.1 ad * purposes only).
1625 1.1 ad */
1626 1.1 ad static int
1627 1.1 ad mly_alloc_ccbs(struct mly_softc *mly)
1628 1.1 ad {
1629 1.1 ad struct mly_ccb *mc;
1630 1.1 ad int i, rv;
1631 1.1 ad
1632 1.1 ad if (mly->mly_controllerinfo == NULL)
1633 1.1 ad mly->mly_ncmds = MLY_CCBS_RESV;
1634 1.1 ad else {
1635 1.1 ad i = le16toh(mly->mly_controllerinfo->maximum_parallel_commands);
1636 1.1 ad mly->mly_ncmds = min(MLY_MAX_CCBS, i);
1637 1.1 ad }
1638 1.1 ad
1639 1.1 ad /*
1640 1.1 ad * Allocate enough space for all the command packets in one chunk
1641 1.1 ad * and map them permanently into controller-visible space.
1642 1.1 ad */
1643 1.1 ad rv = mly_dmamem_alloc(mly,
1644 1.1 ad mly->mly_ncmds * sizeof(union mly_cmd_packet),
1645 1.1 ad &mly->mly_pkt_dmamap, (caddr_t *)&mly->mly_pkt,
1646 1.1 ad &mly->mly_pkt_busaddr, &mly->mly_pkt_seg);
1647 1.1 ad if (rv)
1648 1.1 ad return (rv);
1649 1.1 ad
1650 1.1 ad mly->mly_ccbs = malloc(sizeof(struct mly_ccb) * mly->mly_ncmds,
1651 1.1 ad M_DEVBUF, M_NOWAIT);
1652 1.1 ad memset(mly->mly_ccbs, 0, sizeof(struct mly_ccb) * mly->mly_ncmds);
1653 1.1 ad
1654 1.1 ad for (i = 0; i < mly->mly_ncmds; i++) {
1655 1.1 ad mc = mly->mly_ccbs + i;
1656 1.1 ad mc->mc_slot = MLY_SLOT_START + i;
1657 1.1 ad mc->mc_packet = mly->mly_pkt + i;
1658 1.1 ad mc->mc_packetphys = mly->mly_pkt_busaddr +
1659 1.1 ad (i * sizeof(union mly_cmd_packet));
1660 1.1 ad
1661 1.1 ad rv = bus_dmamap_create(mly->mly_dmat, MLY_MAX_XFER,
1662 1.1 ad MLY_MAX_SEGS, MLY_MAX_XFER, 0,
1663 1.1 ad BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
1664 1.1 ad &mc->mc_datamap);
1665 1.1 ad if (rv) {
1666 1.1 ad mly_release_ccbs(mly);
1667 1.1 ad return (rv);
1668 1.1 ad }
1669 1.1 ad
1670 1.1 ad mly_ccb_free(mly, mc);
1671 1.1 ad }
1672 1.1 ad
1673 1.1 ad return (0);
1674 1.1 ad }
1675 1.1 ad
1676 1.1 ad /*
1677 1.1 ad * Free all the storage held by commands.
1678 1.1 ad *
1679 1.1 ad * Must be called with all commands on the free list.
1680 1.1 ad */
1681 1.1 ad static void
1682 1.1 ad mly_release_ccbs(struct mly_softc *mly)
1683 1.1 ad {
1684 1.1 ad struct mly_ccb *mc;
1685 1.1 ad
1686 1.1 ad /* Throw away command buffer DMA maps. */
1687 1.1 ad while (mly_ccb_alloc(mly, &mc) == 0)
1688 1.1 ad bus_dmamap_destroy(mly->mly_dmat, mc->mc_datamap);
1689 1.1 ad
1690 1.1 ad /* Release CCB storage. */
1691 1.1 ad free(mly->mly_ccbs, M_DEVBUF);
1692 1.1 ad
1693 1.1 ad /* Release the packet storage. */
1694 1.1 ad mly_dmamem_free(mly, mly->mly_ncmds * sizeof(union mly_cmd_packet),
1695 1.1 ad mly->mly_pkt_dmamap, (caddr_t)mly->mly_pkt, &mly->mly_pkt_seg);
1696 1.1 ad }
1697 1.1 ad
1698 1.1 ad /*
1699 1.1 ad * Map a command into controller-visible space.
1700 1.1 ad */
1701 1.1 ad static int
1702 1.1 ad mly_ccb_map(struct mly_softc *mly, struct mly_ccb *mc)
1703 1.1 ad {
1704 1.1 ad struct mly_cmd_generic *gen;
1705 1.1 ad struct mly_sg_entry *sg;
1706 1.1 ad bus_dma_segment_t *ds;
1707 1.1 ad int flg, nseg, rv;
1708 1.1 ad
1709 1.1 ad #ifdef DIAGNOSTIC
1710 1.1 ad /* Don't map more than once. */
1711 1.1 ad if ((mc->mc_flags & MLY_CCB_MAPPED) != 0)
1712 1.1 ad panic("mly_ccb_map: already mapped");
1713 1.1 ad mc->mc_flags |= MLY_CCB_MAPPED;
1714 1.1 ad
1715 1.1 ad /* Does the command have a data buffer? */
1716 1.1 ad if (mc->mc_data == NULL)
1717 1.1 ad panic("mly_ccb_map: no data buffer");
1718 1.1 ad #endif
1719 1.1 ad
1720 1.1 ad rv = bus_dmamap_load(mly->mly_dmat, mc->mc_datamap, mc->mc_data,
1721 1.1 ad mc->mc_length, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
1722 1.1 ad ((mc->mc_flags & MLY_CCB_DATAIN) != 0 ?
1723 1.1 ad BUS_DMA_READ : BUS_DMA_WRITE));
1724 1.1 ad if (rv != 0)
1725 1.1 ad return (rv);
1726 1.1 ad
1727 1.1 ad gen = &mc->mc_packet->generic;
1728 1.1 ad
1729 1.1 ad /*
1730 1.1 ad * Can we use the transfer structure directly?
1731 1.1 ad */
1732 1.1 ad if ((nseg = mc->mc_datamap->dm_nsegs) <= 2) {
1733 1.1 ad mc->mc_sgoff = -1;
1734 1.1 ad sg = &gen->transfer.direct.sg[0];
1735 1.1 ad } else {
1736 1.1 ad mc->mc_sgoff = (mc->mc_slot - MLY_SLOT_START) *
1737 1.1 ad MLY_MAX_SEGS;
1738 1.1 ad sg = mly->mly_sg + mc->mc_sgoff;
1739 1.1 ad gen->command_control |= MLY_CMDCTL_EXTENDED_SG_TABLE;
1740 1.1 ad gen->transfer.indirect.entries[0] = htole16(nseg);
1741 1.1 ad gen->transfer.indirect.table_physaddr[0] =
1742 1.1 ad htole64(mly->mly_sg_busaddr +
1743 1.1 ad (mc->mc_sgoff * sizeof(struct mly_sg_entry)));
1744 1.1 ad }
1745 1.1 ad
1746 1.1 ad /*
1747 1.1 ad * Fill the S/G table.
1748 1.1 ad */
1749 1.1 ad for (ds = mc->mc_datamap->dm_segs; nseg != 0; nseg--, sg++, ds++) {
1750 1.1 ad sg->physaddr = htole64(ds->ds_addr);
1751 1.1 ad sg->length = htole64(ds->ds_len);
1752 1.1 ad }
1753 1.1 ad
1754 1.1 ad /*
1755 1.1 ad * Sync up the data map.
1756 1.1 ad */
1757 1.1 ad if ((mc->mc_flags & MLY_CCB_DATAIN) != 0)
1758 1.1 ad flg = BUS_DMASYNC_PREREAD;
1759 1.1 ad else /* if ((mc->mc_flags & MLY_CCB_DATAOUT) != 0) */ {
1760 1.1 ad gen->command_control |= MLY_CMDCTL_DATA_DIRECTION;
1761 1.1 ad flg = BUS_DMASYNC_PREWRITE;
1762 1.1 ad }
1763 1.1 ad
1764 1.1 ad bus_dmamap_sync(mly->mly_dmat, mc->mc_datamap, 0, mc->mc_length, flg);
1765 1.1 ad
1766 1.1 ad /*
1767 1.1 ad * Sync up the chained S/G table, if we're using one.
1768 1.1 ad */
1769 1.1 ad if (mc->mc_sgoff == -1)
1770 1.1 ad return (0);
1771 1.1 ad
1772 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_sg_dmamap, mc->mc_sgoff,
1773 1.1 ad MLY_SGL_SIZE, BUS_DMASYNC_PREWRITE);
1774 1.1 ad
1775 1.1 ad return (0);
1776 1.1 ad }
1777 1.1 ad
1778 1.1 ad /*
1779 1.1 ad * Unmap a command from controller-visible space.
1780 1.1 ad */
1781 1.1 ad static void
1782 1.1 ad mly_ccb_unmap(struct mly_softc *mly, struct mly_ccb *mc)
1783 1.1 ad {
1784 1.1 ad int flg;
1785 1.1 ad
1786 1.1 ad #ifdef DIAGNOSTIC
1787 1.1 ad if ((mc->mc_flags & MLY_CCB_MAPPED) == 0)
1788 1.1 ad panic("mly_ccb_unmap: not mapped");
1789 1.1 ad mc->mc_flags &= ~MLY_CCB_MAPPED;
1790 1.1 ad #endif
1791 1.1 ad
1792 1.1 ad if ((mc->mc_flags & MLY_CCB_DATAIN) != 0)
1793 1.1 ad flg = BUS_DMASYNC_POSTREAD;
1794 1.1 ad else /* if ((mc->mc_flags & MLY_CCB_DATAOUT) != 0) */
1795 1.1 ad flg = BUS_DMASYNC_POSTWRITE;
1796 1.1 ad
1797 1.1 ad bus_dmamap_sync(mly->mly_dmat, mc->mc_datamap, 0, mc->mc_length, flg);
1798 1.1 ad bus_dmamap_unload(mly->mly_dmat, mc->mc_datamap);
1799 1.1 ad
1800 1.1 ad if (mc->mc_sgoff == -1)
1801 1.1 ad return;
1802 1.1 ad
1803 1.1 ad bus_dmamap_sync(mly->mly_dmat, mly->mly_sg_dmamap, mc->mc_sgoff,
1804 1.1 ad MLY_SGL_SIZE, BUS_DMASYNC_POSTWRITE);
1805 1.1 ad }
1806 1.1 ad
1807 1.1 ad /*
1808 1.1 ad * Adjust the size of each I/O before it passes to the SCSI layer.
1809 1.1 ad */
1810 1.1 ad static void
1811 1.1 ad mly_scsipi_minphys(struct buf *bp)
1812 1.1 ad {
1813 1.1 ad
1814 1.1 ad if (bp->b_bcount > MLY_MAX_XFER)
1815 1.1 ad bp->b_bcount = MLY_MAX_XFER;
1816 1.1 ad minphys(bp);
1817 1.1 ad }
1818 1.1 ad
1819 1.1 ad /*
1820 1.1 ad * Start a SCSI command.
1821 1.1 ad */
1822 1.1 ad static void
1823 1.1 ad mly_scsipi_request(struct scsipi_channel *chan, scsipi_adapter_req_t req,
1824 1.1 ad void *arg)
1825 1.1 ad {
1826 1.1 ad struct mly_ccb *mc;
1827 1.1 ad struct mly_cmd_scsi_small *ss;
1828 1.1 ad struct scsipi_xfer *xs;
1829 1.1 ad struct scsipi_periph *periph;
1830 1.1 ad struct mly_softc *mly;
1831 1.1 ad struct mly_btl *btl;
1832 1.1 ad int s, tmp;
1833 1.1 ad
1834 1.1 ad mly = (void *)chan->chan_adapter->adapt_dev;
1835 1.1 ad
1836 1.1 ad switch (req) {
1837 1.1 ad case ADAPTER_REQ_RUN_XFER:
1838 1.1 ad xs = arg;
1839 1.1 ad periph = xs->xs_periph;
1840 1.1 ad btl = &mly->mly_btl[chan->chan_channel][periph->periph_target];
1841 1.1 ad s = splbio();
1842 1.1 ad tmp = btl->mb_flags;
1843 1.1 ad splx(s);
1844 1.1 ad
1845 1.1 ad /*
1846 1.1 ad * Check for I/O attempt to a protected or non-existant
1847 1.1 ad * device.
1848 1.1 ad */
1849 1.1 ad if ((tmp & MLY_BTL_PROTECTED) != 0) {
1850 1.1 ad xs->error = XS_SELTIMEOUT;
1851 1.1 ad scsipi_done(xs);
1852 1.1 ad break;
1853 1.1 ad }
1854 1.1 ad
1855 1.1 ad #ifdef DIAGNOSTIC
1856 1.1 ad /* XXX Increase if/when we support large SCSI commands. */
1857 1.1 ad if (xs->cmdlen > MLY_CMD_SCSI_SMALL_CDB) {
1858 1.1 ad printf("%s: cmd too large\n", mly->mly_dv.dv_xname);
1859 1.1 ad xs->error = XS_DRIVER_STUFFUP;
1860 1.1 ad scsipi_done(xs);
1861 1.1 ad break;
1862 1.1 ad }
1863 1.1 ad #endif
1864 1.1 ad
1865 1.1 ad if (mly_ccb_alloc(mly, &mc)) {
1866 1.1 ad xs->error = XS_RESOURCE_SHORTAGE;
1867 1.1 ad scsipi_done(xs);
1868 1.1 ad break;
1869 1.1 ad }
1870 1.1 ad
1871 1.1 ad /* Build the command. */
1872 1.1 ad mc->mc_data = xs->data;
1873 1.1 ad mc->mc_length = xs->datalen;
1874 1.1 ad mc->mc_complete = mly_scsipi_complete;
1875 1.1 ad mc->mc_private = xs;
1876 1.1 ad
1877 1.1 ad /* Build the packet for the controller. */
1878 1.1 ad ss = &mc->mc_packet->scsi_small;
1879 1.1 ad ss->opcode = MDACMD_SCSI;
1880 1.1 ad #ifdef notdef
1881 1.1 ad /*
1882 1.1 ad * XXX FreeBSD does this, but it doesn't fix anything,
1883 1.1 ad * XXX and appears potentially harmful.
1884 1.1 ad */
1885 1.1 ad ss->command_control |= MLY_CMDCTL_DISABLE_DISCONNECT;
1886 1.1 ad #endif
1887 1.3 ad
1888 1.1 ad ss->data_size = htole32(xs->datalen);
1889 1.1 ad _lto3l(MLY_PHYADDR(0, chan->chan_channel,
1890 1.1 ad periph->periph_target, periph->periph_lun), ss->addr);
1891 1.1 ad
1892 1.1 ad if (xs->timeout < 60 * 1000)
1893 1.1 ad ss->timeout = xs->timeout / 1000 |
1894 1.1 ad MLY_TIMEOUT_SECONDS;
1895 1.1 ad else if (xs->timeout < 60 * 60 * 1000)
1896 1.1 ad ss->timeout = xs->timeout / (60 * 1000) |
1897 1.1 ad MLY_TIMEOUT_MINUTES;
1898 1.1 ad else
1899 1.1 ad ss->timeout = xs->timeout / (60 * 60 * 1000) |
1900 1.1 ad MLY_TIMEOUT_HOURS;
1901 1.1 ad
1902 1.1 ad ss->maximum_sense_size = sizeof(xs->sense);
1903 1.1 ad ss->cdb_length = xs->cmdlen;
1904 1.1 ad memcpy(ss->cdb, xs->cmd, xs->cmdlen);
1905 1.1 ad
1906 1.7 ad if (mc->mc_length != 0) {
1907 1.7 ad if ((xs->xs_control & XS_CTL_DATA_OUT) != 0)
1908 1.7 ad mc->mc_flags |= MLY_CCB_DATAOUT;
1909 1.7 ad else /* if ((xs->xs_control & XS_CTL_DATA_IN) != 0) */
1910 1.7 ad mc->mc_flags |= MLY_CCB_DATAIN;
1911 1.7 ad
1912 1.1 ad if (mly_ccb_map(mly, mc) != 0) {
1913 1.1 ad xs->error = XS_DRIVER_STUFFUP;
1914 1.1 ad mly_ccb_free(mly, mc);
1915 1.1 ad scsipi_done(xs);
1916 1.1 ad break;
1917 1.1 ad }
1918 1.7 ad }
1919 1.1 ad
1920 1.1 ad /*
1921 1.1 ad * Give the command to the controller.
1922 1.1 ad */
1923 1.1 ad if ((xs->xs_control & XS_CTL_POLL) != 0) {
1924 1.1 ad if (mly_ccb_poll(mly, mc, xs->timeout + 5000)) {
1925 1.1 ad xs->error = XS_REQUEUE;
1926 1.1 ad if (mc->mc_length != 0)
1927 1.1 ad mly_ccb_unmap(mly, mc);
1928 1.1 ad mly_ccb_free(mly, mc);
1929 1.1 ad scsipi_done(xs);
1930 1.1 ad }
1931 1.1 ad } else
1932 1.1 ad mly_ccb_enqueue(mly, mc);
1933 1.1 ad
1934 1.1 ad break;
1935 1.1 ad
1936 1.1 ad case ADAPTER_REQ_GROW_RESOURCES:
1937 1.1 ad /*
1938 1.1 ad * Not supported.
1939 1.1 ad */
1940 1.1 ad break;
1941 1.1 ad
1942 1.1 ad case ADAPTER_REQ_SET_XFER_MODE:
1943 1.1 ad /*
1944 1.1 ad * We can't change the transfer mode, but at least let
1945 1.1 ad * scsipi know what the adapter has negotiated.
1946 1.1 ad */
1947 1.1 ad mly_get_xfer_mode(mly, chan->chan_channel, arg);
1948 1.1 ad break;
1949 1.1 ad }
1950 1.1 ad }
1951 1.1 ad
1952 1.1 ad /*
1953 1.1 ad * Handle completion of a SCSI command.
1954 1.1 ad */
1955 1.1 ad static void
1956 1.1 ad mly_scsipi_complete(struct mly_softc *mly, struct mly_ccb *mc)
1957 1.1 ad {
1958 1.1 ad struct scsipi_xfer *xs;
1959 1.1 ad struct scsipi_channel *chan;
1960 1.1 ad struct scsipi_inquiry_data *inq;
1961 1.1 ad struct mly_btl *btl;
1962 1.1 ad int target, sl, s;
1963 1.1 ad const char *p;
1964 1.1 ad
1965 1.1 ad xs = mc->mc_private;
1966 1.1 ad xs->status = mc->mc_status;
1967 1.1 ad
1968 1.1 ad /*
1969 1.1 ad * XXX The `resid' value as returned by the controller appears to be
1970 1.1 ad * bogus, so we always set it to zero. Is it perhaps the transfer
1971 1.1 ad * count?
1972 1.1 ad */
1973 1.1 ad xs->resid = 0; /* mc->mc_resid; */
1974 1.1 ad
1975 1.1 ad if (mc->mc_length != 0)
1976 1.1 ad mly_ccb_unmap(mly, mc);
1977 1.1 ad
1978 1.1 ad switch (mc->mc_status) {
1979 1.1 ad case SCSI_OK:
1980 1.1 ad /*
1981 1.1 ad * In order to report logical device type and status, we
1982 1.1 ad * overwrite the result of the INQUIRY command to logical
1983 1.1 ad * devices.
1984 1.1 ad */
1985 1.1 ad if (xs->cmd->opcode == INQUIRY) {
1986 1.1 ad chan = xs->xs_periph->periph_channel;
1987 1.1 ad target = xs->xs_periph->periph_target;
1988 1.1 ad btl = &mly->mly_btl[chan->chan_channel][target];
1989 1.1 ad
1990 1.1 ad s = splbio();
1991 1.1 ad if ((btl->mb_flags & MLY_BTL_LOGICAL) != 0) {
1992 1.1 ad inq = (struct scsipi_inquiry_data *)xs->data;
1993 1.1 ad mly_padstr(inq->vendor, "MYLEX", 8);
1994 1.1 ad p = mly_describe_code(mly_table_device_type,
1995 1.1 ad btl->mb_type);
1996 1.1 ad mly_padstr(inq->product, p, 16);
1997 1.1 ad p = mly_describe_code(mly_table_device_state,
1998 1.1 ad btl->mb_state);
1999 1.1 ad mly_padstr(inq->revision, p, 4);
2000 1.1 ad }
2001 1.1 ad splx(s);
2002 1.1 ad }
2003 1.1 ad
2004 1.1 ad xs->error = XS_NOERROR;
2005 1.1 ad break;
2006 1.1 ad
2007 1.1 ad case SCSI_CHECK:
2008 1.1 ad sl = mc->mc_sense;
2009 1.1 ad if (sl > sizeof(xs->sense.scsi_sense))
2010 1.1 ad sl = sizeof(xs->sense.scsi_sense);
2011 1.1 ad memcpy(&xs->sense.scsi_sense, mc->mc_packet, sl);
2012 1.1 ad xs->error = XS_SENSE;
2013 1.1 ad break;
2014 1.1 ad
2015 1.1 ad case SCSI_BUSY:
2016 1.1 ad case SCSI_QUEUE_FULL:
2017 1.1 ad xs->error = XS_BUSY;
2018 1.1 ad break;
2019 1.1 ad
2020 1.1 ad default:
2021 1.1 ad printf("%s: unknown SCSI status 0x%x\n",
2022 1.1 ad mly->mly_dv.dv_xname, xs->status);
2023 1.1 ad xs->error = XS_DRIVER_STUFFUP;
2024 1.1 ad break;
2025 1.1 ad }
2026 1.1 ad
2027 1.1 ad mly_ccb_free(mly, mc);
2028 1.1 ad scsipi_done(xs);
2029 1.1 ad }
2030 1.1 ad
2031 1.1 ad /*
2032 1.1 ad * Notify scsipi about a target's transfer mode.
2033 1.1 ad */
2034 1.1 ad static void
2035 1.1 ad mly_get_xfer_mode(struct mly_softc *mly, int bus, struct scsipi_xfer_mode *xm)
2036 1.1 ad {
2037 1.1 ad struct mly_btl *btl;
2038 1.1 ad int s;
2039 1.1 ad
2040 1.1 ad btl = &mly->mly_btl[bus][xm->xm_target];
2041 1.1 ad xm->xm_mode = 0;
2042 1.1 ad
2043 1.1 ad s = splbio();
2044 1.1 ad
2045 1.1 ad if ((btl->mb_flags & MLY_BTL_PHYSICAL) != 0) {
2046 1.1 ad if (btl->mb_speed == 0) {
2047 1.1 ad xm->xm_period = 0;
2048 1.1 ad xm->xm_offset = 0;
2049 1.1 ad } else {
2050 1.1 ad xm->xm_period = 12; /* XXX */
2051 1.1 ad xm->xm_offset = 8; /* XXX */
2052 1.1 ad xm->xm_mode |= PERIPH_CAP_SYNC; /* XXX */
2053 1.1 ad }
2054 1.1 ad
2055 1.1 ad switch (btl->mb_width) {
2056 1.1 ad case 32:
2057 1.1 ad xm->xm_mode = PERIPH_CAP_WIDE32;
2058 1.1 ad break;
2059 1.1 ad case 16:
2060 1.1 ad xm->xm_mode = PERIPH_CAP_WIDE16;
2061 1.1 ad break;
2062 1.1 ad default:
2063 1.1 ad xm->xm_mode = 0;
2064 1.1 ad break;
2065 1.1 ad }
2066 1.1 ad } else /* ((btl->mb_flags & MLY_BTL_LOGICAL) != 0) */ {
2067 1.1 ad xm->xm_mode = PERIPH_CAP_WIDE16 | PERIPH_CAP_SYNC;
2068 1.1 ad xm->xm_period = 12;
2069 1.1 ad xm->xm_offset = 8;
2070 1.1 ad }
2071 1.1 ad
2072 1.1 ad if ((btl->mb_flags & MLY_BTL_TQING) != 0)
2073 1.1 ad xm->xm_mode |= PERIPH_CAP_TQING;
2074 1.1 ad
2075 1.1 ad splx(s);
2076 1.1 ad
2077 1.1 ad scsipi_async_event(&mly->mly_chans[bus], ASYNC_EVENT_XFER_MODE, xm);
2078 1.1 ad }
2079 1.1 ad
2080 1.1 ad /*
2081 1.1 ad * ioctl hook; used here only to initiate low-level rescans.
2082 1.1 ad */
2083 1.1 ad static int
2084 1.1 ad mly_scsipi_ioctl(struct scsipi_channel *chan, u_long cmd, caddr_t data,
2085 1.1 ad int flag, struct proc *p)
2086 1.1 ad {
2087 1.1 ad struct mly_softc *mly;
2088 1.1 ad int rv;
2089 1.1 ad
2090 1.1 ad mly = (struct mly_softc *)chan->chan_adapter->adapt_dev;
2091 1.1 ad
2092 1.1 ad switch (cmd) {
2093 1.1 ad case SCBUSIOLLSCAN:
2094 1.1 ad mly_scan_channel(mly, chan->chan_channel);
2095 1.1 ad rv = 0;
2096 1.1 ad break;
2097 1.1 ad default:
2098 1.1 ad rv = ENOTTY;
2099 1.1 ad break;
2100 1.1 ad }
2101 1.1 ad
2102 1.1 ad return (rv);
2103 1.1 ad }
2104 1.1 ad
2105 1.1 ad /*
2106 1.1 ad * Handshake with the firmware while the card is being initialised.
2107 1.1 ad */
2108 1.1 ad static int
2109 1.1 ad mly_fwhandshake(struct mly_softc *mly)
2110 1.1 ad {
2111 1.1 ad u_int8_t error, param0, param1;
2112 1.1 ad int spinup;
2113 1.1 ad
2114 1.1 ad spinup = 0;
2115 1.1 ad
2116 1.1 ad /* Set HM_STSACK and let the firmware initialise. */
2117 1.1 ad mly_outb(mly, mly->mly_idbr, MLY_HM_STSACK);
2118 1.1 ad DELAY(1000); /* too short? */
2119 1.1 ad
2120 1.1 ad /* If HM_STSACK is still true, the controller is initialising. */
2121 1.1 ad if (!mly_idbr_true(mly, MLY_HM_STSACK))
2122 1.1 ad return (0);
2123 1.1 ad
2124 1.1 ad printf("%s: controller initialisation started\n",
2125 1.1 ad mly->mly_dv.dv_xname);
2126 1.1 ad
2127 1.1 ad /*
2128 1.1 ad * Spin waiting for initialisation to finish, or for a message to be
2129 1.1 ad * delivered.
2130 1.1 ad */
2131 1.1 ad while (mly_idbr_true(mly, MLY_HM_STSACK)) {
2132 1.1 ad /* Check for a message */
2133 1.1 ad if (!mly_error_valid(mly))
2134 1.1 ad continue;
2135 1.1 ad
2136 1.1 ad error = mly_inb(mly, mly->mly_error_status) & ~MLY_MSG_EMPTY;
2137 1.1 ad param0 = mly_inb(mly, mly->mly_cmd_mailbox);
2138 1.1 ad param1 = mly_inb(mly, mly->mly_cmd_mailbox + 1);
2139 1.1 ad
2140 1.1 ad switch (error) {
2141 1.1 ad case MLY_MSG_SPINUP:
2142 1.1 ad if (!spinup) {
2143 1.1 ad printf("%s: drive spinup in progress\n",
2144 1.1 ad mly->mly_dv.dv_xname);
2145 1.1 ad spinup = 1;
2146 1.1 ad }
2147 1.1 ad break;
2148 1.1 ad
2149 1.1 ad case MLY_MSG_RACE_RECOVERY_FAIL:
2150 1.1 ad printf("%s: mirror race recovery failed - \n",
2151 1.1 ad mly->mly_dv.dv_xname);
2152 1.1 ad printf("%s: one or more drives offline\n",
2153 1.1 ad mly->mly_dv.dv_xname);
2154 1.1 ad break;
2155 1.1 ad
2156 1.1 ad case MLY_MSG_RACE_IN_PROGRESS:
2157 1.1 ad printf("%s: mirror race recovery in progress\n",
2158 1.1 ad mly->mly_dv.dv_xname);
2159 1.1 ad break;
2160 1.1 ad
2161 1.1 ad case MLY_MSG_RACE_ON_CRITICAL:
2162 1.1 ad printf("%s: mirror race recovery on critical drive\n",
2163 1.1 ad mly->mly_dv.dv_xname);
2164 1.1 ad break;
2165 1.1 ad
2166 1.1 ad case MLY_MSG_PARITY_ERROR:
2167 1.1 ad printf("%s: FATAL MEMORY PARITY ERROR\n",
2168 1.1 ad mly->mly_dv.dv_xname);
2169 1.1 ad return (ENXIO);
2170 1.1 ad
2171 1.1 ad default:
2172 1.1 ad printf("%s: unknown initialisation code 0x%x\n",
2173 1.1 ad mly->mly_dv.dv_xname, error);
2174 1.1 ad break;
2175 1.1 ad }
2176 1.1 ad }
2177 1.1 ad
2178 1.1 ad return (0);
2179 1.1 ad }
2180 1.1 ad
2181 1.1 ad /*
2182 1.1 ad * Space-fill a character string
2183 1.1 ad */
2184 1.1 ad static void
2185 1.1 ad mly_padstr(char *dst, const char *src, int len)
2186 1.1 ad {
2187 1.1 ad
2188 1.1 ad while (len-- > 0) {
2189 1.1 ad if (*src != '\0')
2190 1.1 ad *dst++ = *src++;
2191 1.1 ad else
2192 1.1 ad *dst++ = ' ';
2193 1.1 ad }
2194 1.1 ad }
2195 1.1 ad
2196 1.1 ad /*
2197 1.1 ad * Allocate DMA safe memory.
2198 1.1 ad */
2199 1.1 ad static int
2200 1.1 ad mly_dmamem_alloc(struct mly_softc *mly, int size, bus_dmamap_t *dmamap,
2201 1.1 ad caddr_t *kva, bus_addr_t *paddr, bus_dma_segment_t *seg)
2202 1.1 ad {
2203 1.1 ad int rseg, rv, state;
2204 1.1 ad
2205 1.1 ad state = 0;
2206 1.1 ad
2207 1.1 ad if ((rv = bus_dmamem_alloc(mly->mly_dmat, size, NBPG, 0,
2208 1.1 ad seg, 1, &rseg, BUS_DMA_NOWAIT)) != 0) {
2209 1.1 ad printf("%s: dmamem_alloc = %d\n", mly->mly_dv.dv_xname, rv);
2210 1.1 ad goto bad;
2211 1.1 ad }
2212 1.1 ad
2213 1.1 ad state++;
2214 1.1 ad
2215 1.1 ad if ((rv = bus_dmamem_map(mly->mly_dmat, seg, 1, size, kva,
2216 1.1 ad BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
2217 1.1 ad printf("%s: dmamem_map = %d\n", mly->mly_dv.dv_xname, rv);
2218 1.1 ad goto bad;
2219 1.1 ad }
2220 1.1 ad
2221 1.1 ad state++;
2222 1.1 ad
2223 1.1 ad if ((rv = bus_dmamap_create(mly->mly_dmat, size, size, 1, 0,
2224 1.1 ad BUS_DMA_NOWAIT, dmamap)) != 0) {
2225 1.1 ad printf("%s: dmamap_create = %d\n", mly->mly_dv.dv_xname, rv);
2226 1.1 ad goto bad;
2227 1.1 ad }
2228 1.1 ad
2229 1.1 ad state++;
2230 1.1 ad
2231 1.1 ad if ((rv = bus_dmamap_load(mly->mly_dmat, *dmamap, *kva, size,
2232 1.1 ad NULL, BUS_DMA_NOWAIT)) != 0) {
2233 1.1 ad printf("%s: dmamap_load = %d\n", mly->mly_dv.dv_xname, rv);
2234 1.1 ad goto bad;
2235 1.1 ad }
2236 1.1 ad
2237 1.1 ad *paddr = (*dmamap)->dm_segs[0].ds_addr;
2238 1.1 ad memset(*kva, 0, size);
2239 1.1 ad return (0);
2240 1.1 ad
2241 1.1 ad bad:
2242 1.1 ad if (state > 2)
2243 1.1 ad bus_dmamap_destroy(mly->mly_dmat, *dmamap);
2244 1.1 ad if (state > 1)
2245 1.1 ad bus_dmamem_unmap(mly->mly_dmat, *kva, size);
2246 1.1 ad if (state > 0)
2247 1.1 ad bus_dmamem_free(mly->mly_dmat, seg, 1);
2248 1.1 ad
2249 1.1 ad return (rv);
2250 1.1 ad }
2251 1.1 ad
2252 1.1 ad /*
2253 1.1 ad * Free DMA safe memory.
2254 1.1 ad */
2255 1.1 ad static void
2256 1.1 ad mly_dmamem_free(struct mly_softc *mly, int size, bus_dmamap_t dmamap,
2257 1.1 ad caddr_t kva, bus_dma_segment_t *seg)
2258 1.1 ad {
2259 1.1 ad
2260 1.1 ad bus_dmamap_unload(mly->mly_dmat, dmamap);
2261 1.1 ad bus_dmamap_destroy(mly->mly_dmat, dmamap);
2262 1.1 ad bus_dmamem_unmap(mly->mly_dmat, kva, size);
2263 1.1 ad bus_dmamem_free(mly->mly_dmat, seg, 1);
2264 1.1 ad }
2265 1.1 ad
2266 1.1 ad
2267 1.1 ad /*
2268 1.1 ad * Accept an open operation on the control device.
2269 1.1 ad */
2270 1.1 ad int
2271 1.1 ad mlyopen(dev_t dev, int flag, int mode, struct proc *p)
2272 1.1 ad {
2273 1.1 ad struct mly_softc *mly;
2274 1.1 ad
2275 1.1 ad if ((mly = device_lookup(&mly_cd, minor(dev))) == NULL)
2276 1.1 ad return (ENXIO);
2277 1.1 ad if ((mly->mly_state & MLY_STATE_INITOK) == 0)
2278 1.1 ad return (ENXIO);
2279 1.1 ad if ((mly->mly_state & MLY_STATE_OPEN) != 0)
2280 1.1 ad return (EBUSY);
2281 1.1 ad
2282 1.1 ad mly->mly_state |= MLY_STATE_OPEN;
2283 1.1 ad return (0);
2284 1.1 ad }
2285 1.1 ad
2286 1.1 ad /*
2287 1.1 ad * Accept the last close on the control device.
2288 1.1 ad */
2289 1.1 ad int
2290 1.1 ad mlyclose(dev_t dev, int flag, int mode, struct proc *p)
2291 1.1 ad {
2292 1.1 ad struct mly_softc *mly;
2293 1.1 ad
2294 1.1 ad mly = device_lookup(&mly_cd, minor(dev));
2295 1.1 ad mly->mly_state &= ~MLY_STATE_OPEN;
2296 1.1 ad return (0);
2297 1.1 ad }
2298 1.1 ad
2299 1.1 ad /*
2300 1.1 ad * Handle control operations.
2301 1.1 ad */
2302 1.1 ad int
2303 1.1 ad mlyioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
2304 1.1 ad {
2305 1.1 ad struct mly_softc *mly;
2306 1.1 ad int rv;
2307 1.1 ad
2308 1.1 ad if (securelevel >= 2)
2309 1.1 ad return (EPERM);
2310 1.1 ad
2311 1.1 ad mly = device_lookup(&mly_cd, minor(dev));
2312 1.1 ad
2313 1.1 ad switch (cmd) {
2314 1.1 ad case MLYIO_COMMAND:
2315 1.1 ad rv = mly_user_command(mly, (void *)data);
2316 1.1 ad break;
2317 1.1 ad case MLYIO_HEALTH:
2318 1.1 ad rv = mly_user_health(mly, (void *)data);
2319 1.1 ad break;
2320 1.1 ad default:
2321 1.1 ad rv = ENOTTY;
2322 1.1 ad break;
2323 1.1 ad }
2324 1.1 ad
2325 1.1 ad return (rv);
2326 1.1 ad }
2327 1.1 ad
2328 1.1 ad /*
2329 1.1 ad * Execute a command passed in from userspace.
2330 1.1 ad *
2331 1.1 ad * The control structure contains the actual command for the controller, as
2332 1.1 ad * well as the user-space data pointer and data size, and an optional sense
2333 1.1 ad * buffer size/pointer. On completion, the data size is adjusted to the
2334 1.1 ad * command residual, and the sense buffer size to the size of the returned
2335 1.1 ad * sense data.
2336 1.1 ad */
2337 1.1 ad static int
2338 1.1 ad mly_user_command(struct mly_softc *mly, struct mly_user_command *uc)
2339 1.1 ad {
2340 1.1 ad struct mly_ccb *mc;
2341 1.1 ad int rv, mapped;
2342 1.1 ad
2343 1.1 ad if ((rv = mly_ccb_alloc(mly, &mc)) != 0)
2344 1.1 ad return (rv);
2345 1.1 ad
2346 1.1 ad mapped = 0;
2347 1.1 ad mc->mc_data = NULL;
2348 1.1 ad
2349 1.1 ad /*
2350 1.1 ad * Handle data size/direction.
2351 1.1 ad */
2352 1.1 ad if ((mc->mc_length = abs(uc->DataTransferLength)) != 0) {
2353 1.6 ad if (mc->mc_length > MAXPHYS) {
2354 1.6 ad rv = EINVAL;
2355 1.6 ad goto out;
2356 1.6 ad }
2357 1.6 ad
2358 1.1 ad mc->mc_data = malloc(mc->mc_length, M_DEVBUF, M_WAITOK);
2359 1.1 ad if (mc->mc_data == NULL) {
2360 1.1 ad rv = ENOMEM;
2361 1.1 ad goto out;
2362 1.1 ad }
2363 1.1 ad
2364 1.1 ad if (uc->DataTransferLength > 0) {
2365 1.1 ad mc->mc_flags |= MLY_CCB_DATAIN;
2366 1.1 ad memset(mc->mc_data, 0, mc->mc_length);
2367 1.1 ad }
2368 1.1 ad
2369 1.1 ad if (uc->DataTransferLength < 0) {
2370 1.1 ad mc->mc_flags |= MLY_CCB_DATAOUT;
2371 1.1 ad rv = copyin(uc->DataTransferBuffer, mc->mc_data,
2372 1.1 ad mc->mc_length);
2373 1.1 ad if (rv != 0)
2374 1.1 ad goto out;
2375 1.1 ad }
2376 1.1 ad
2377 1.1 ad if ((rv = mly_ccb_map(mly, mc)) != 0)
2378 1.1 ad goto out;
2379 1.1 ad mapped = 1;
2380 1.1 ad }
2381 1.1 ad
2382 1.1 ad /* Copy in the command and execute it. */
2383 1.1 ad memcpy(mc->mc_packet, &uc->CommandMailbox, sizeof(uc->CommandMailbox));
2384 1.1 ad
2385 1.1 ad if ((rv = mly_ccb_wait(mly, mc, 60000)) != 0)
2386 1.1 ad goto out;
2387 1.1 ad
2388 1.1 ad /* Return the data to userspace. */
2389 1.1 ad if (uc->DataTransferLength > 0) {
2390 1.1 ad rv = copyout(mc->mc_data, uc->DataTransferBuffer,
2391 1.1 ad mc->mc_length);
2392 1.1 ad if (rv != 0)
2393 1.1 ad goto out;
2394 1.1 ad }
2395 1.1 ad
2396 1.1 ad /* Return the sense buffer to userspace. */
2397 1.1 ad if (uc->RequestSenseLength > 0 && mc->mc_sense > 0) {
2398 1.1 ad rv = copyout(mc->mc_packet, uc->RequestSenseBuffer,
2399 1.1 ad min(uc->RequestSenseLength, mc->mc_sense));
2400 1.1 ad if (rv != 0)
2401 1.1 ad goto out;
2402 1.1 ad }
2403 1.1 ad
2404 1.1 ad /* Return command results to userspace (caller will copy out). */
2405 1.1 ad uc->DataTransferLength = mc->mc_resid;
2406 1.1 ad uc->RequestSenseLength = min(uc->RequestSenseLength, mc->mc_sense);
2407 1.1 ad uc->CommandStatus = mc->mc_status;
2408 1.1 ad rv = 0;
2409 1.1 ad
2410 1.1 ad out:
2411 1.1 ad if (mapped)
2412 1.1 ad mly_ccb_unmap(mly, mc);
2413 1.1 ad if (mc->mc_data != NULL)
2414 1.1 ad free(mc->mc_data, M_DEVBUF);
2415 1.1 ad if (mc != NULL)
2416 1.1 ad mly_ccb_free(mly, mc);
2417 1.1 ad
2418 1.1 ad return (rv);
2419 1.1 ad }
2420 1.1 ad
2421 1.1 ad /*
2422 1.1 ad * Return health status to userspace. If the health change index in the
2423 1.1 ad * user structure does not match that currently exported by the controller,
2424 1.1 ad * we return the current status immediately. Otherwise, we block until
2425 1.1 ad * either interrupted or new status is delivered.
2426 1.1 ad */
2427 1.1 ad static int
2428 1.1 ad mly_user_health(struct mly_softc *mly, struct mly_user_health *uh)
2429 1.1 ad {
2430 1.1 ad struct mly_health_status mh;
2431 1.1 ad int rv, s;
2432 1.1 ad
2433 1.1 ad /* Fetch the current health status from userspace. */
2434 1.1 ad rv = copyin(uh->HealthStatusBuffer, &mh, sizeof(mh));
2435 1.1 ad if (rv != 0)
2436 1.1 ad return (rv);
2437 1.1 ad
2438 1.1 ad /* spin waiting for a status update */
2439 1.1 ad s = splbio();
2440 1.1 ad if (mly->mly_event_change == mh.change_counter)
2441 1.1 ad rv = tsleep(&mly->mly_event_change, PRIBIO | PCATCH,
2442 1.1 ad "mlyhealth", 0);
2443 1.1 ad splx(s);
2444 1.1 ad
2445 1.1 ad if (rv == 0) {
2446 1.1 ad /*
2447 1.1 ad * Copy the controller's health status buffer out (there is
2448 1.1 ad * a race here if it changes again).
2449 1.1 ad */
2450 1.1 ad rv = copyout(&mly->mly_mmbox->mmm_health.status,
2451 1.1 ad uh->HealthStatusBuffer, sizeof(uh->HealthStatusBuffer));
2452 1.1 ad }
2453 1.1 ad
2454 1.1 ad return (rv);
2455 1.1 ad }
2456