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