twe.c revision 1.45 1 1.45 thorpej /* $NetBSD: twe.c,v 1.45 2003/09/22 01:13:02 thorpej Exp $ */
2 1.1 ad
3 1.1 ad /*-
4 1.42 thorpej * Copyright (c) 2000, 2001, 2002, 2003 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.1 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.42 thorpej * by Andrew Doran; and by Jason R. Thorpe of Wasabi Systems, Inc.
9 1.1 ad *
10 1.1 ad * Redistribution and use in source and binary forms, with or without
11 1.1 ad * modification, are permitted provided that the following conditions
12 1.1 ad * are met:
13 1.1 ad * 1. Redistributions of source code must retain the above copyright
14 1.1 ad * notice, this list of conditions and the following disclaimer.
15 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 ad * notice, this list of conditions and the following disclaimer in the
17 1.1 ad * documentation and/or other materials provided with the distribution.
18 1.1 ad * 3. All advertising materials mentioning features or use of this software
19 1.1 ad * must display the following acknowledgement:
20 1.1 ad * This product includes software developed by the NetBSD
21 1.1 ad * Foundation, Inc. and its contributors.
22 1.1 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 ad * contributors may be used to endorse or promote products derived
24 1.1 ad * from this software without specific prior written permission.
25 1.1 ad *
26 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.1 ad */
38 1.1 ad
39 1.1 ad /*-
40 1.1 ad * Copyright (c) 2000 Michael Smith
41 1.1 ad * Copyright (c) 2000 BSDi
42 1.1 ad * All rights reserved.
43 1.1 ad *
44 1.1 ad * Redistribution and use in source and binary forms, with or without
45 1.1 ad * modification, are permitted provided that the following conditions
46 1.1 ad * are met:
47 1.1 ad * 1. Redistributions of source code must retain the above copyright
48 1.1 ad * notice, this list of conditions and the following disclaimer.
49 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
50 1.1 ad * notice, this list of conditions and the following disclaimer in the
51 1.1 ad * documentation and/or other materials provided with the distribution.
52 1.1 ad *
53 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
54 1.1 ad * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
55 1.1 ad * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
56 1.1 ad * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
57 1.1 ad * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
58 1.1 ad * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
59 1.1 ad * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
60 1.1 ad * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
61 1.1 ad * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
62 1.1 ad * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
63 1.1 ad * SUCH DAMAGE.
64 1.1 ad *
65 1.1 ad * from FreeBSD: twe.c,v 1.1 2000/05/24 23:35:23 msmith Exp
66 1.1 ad */
67 1.1 ad
68 1.1 ad /*
69 1.1 ad * Driver for the 3ware Escalade family of RAID controllers.
70 1.1 ad */
71 1.21 lukem
72 1.21 lukem #include <sys/cdefs.h>
73 1.45 thorpej __KERNEL_RCSID(0, "$NetBSD: twe.c,v 1.45 2003/09/22 01:13:02 thorpej Exp $");
74 1.1 ad
75 1.1 ad #include <sys/param.h>
76 1.1 ad #include <sys/systm.h>
77 1.1 ad #include <sys/kernel.h>
78 1.1 ad #include <sys/device.h>
79 1.1 ad #include <sys/queue.h>
80 1.1 ad #include <sys/proc.h>
81 1.1 ad #include <sys/buf.h>
82 1.1 ad #include <sys/endian.h>
83 1.1 ad #include <sys/malloc.h>
84 1.33 christos #include <sys/conf.h>
85 1.1 ad #include <sys/disk.h>
86 1.1 ad
87 1.1 ad #include <uvm/uvm_extern.h>
88 1.1 ad
89 1.1 ad #include <machine/bswap.h>
90 1.1 ad #include <machine/bus.h>
91 1.1 ad
92 1.1 ad #include <dev/pci/pcireg.h>
93 1.1 ad #include <dev/pci/pcivar.h>
94 1.1 ad #include <dev/pci/pcidevs.h>
95 1.1 ad #include <dev/pci/twereg.h>
96 1.1 ad #include <dev/pci/twevar.h>
97 1.33 christos #include <dev/pci/tweio.h>
98 1.1 ad
99 1.1 ad #define PCI_CBIO 0x10
100 1.1 ad
101 1.1 ad static void twe_aen_handler(struct twe_ccb *, int);
102 1.45 thorpej static void twe_aen_enqueue(struct twe_softc *sc, uint16_t, int);
103 1.45 thorpej static uint16_t twe_aen_dequeue(struct twe_softc *);
104 1.45 thorpej
105 1.1 ad static void twe_attach(struct device *, struct device *, void *);
106 1.1 ad static int twe_init_connection(struct twe_softc *);
107 1.1 ad static int twe_intr(void *);
108 1.1 ad static int twe_match(struct device *, struct cfdata *, void *);
109 1.33 christos static int twe_param_set(struct twe_softc *, int, int, size_t, void *);
110 1.1 ad static void twe_poll(struct twe_softc *);
111 1.1 ad static int twe_print(void *, const char *);
112 1.1 ad static int twe_reset(struct twe_softc *);
113 1.1 ad static int twe_submatch(struct device *, struct cfdata *, void *);
114 1.1 ad static int twe_status_check(struct twe_softc *, u_int);
115 1.1 ad static int twe_status_wait(struct twe_softc *, u_int, int);
116 1.38 jdolecek static void twe_describe_controller(struct twe_softc *);
117 1.1 ad
118 1.22 ad static inline u_int32_t twe_inl(struct twe_softc *, int);
119 1.33 christos static inline void twe_outl(struct twe_softc *, int, u_int32_t);
120 1.33 christos
121 1.33 christos dev_type_open(tweopen);
122 1.33 christos dev_type_close(tweclose);
123 1.33 christos dev_type_ioctl(tweioctl);
124 1.33 christos
125 1.33 christos const struct cdevsw twe_cdevsw = {
126 1.33 christos tweopen, tweclose, noread, nowrite, tweioctl,
127 1.33 christos nostop, notty, nopoll, nommap,
128 1.33 christos };
129 1.33 christos
130 1.33 christos extern struct cfdriver twe_cd;
131 1.22 ad
132 1.30 thorpej CFATTACH_DECL(twe, sizeof(struct twe_softc),
133 1.31 thorpej twe_match, twe_attach, NULL, NULL);
134 1.1 ad
135 1.40 thorpej /*
136 1.40 thorpej * Tables to convert numeric codes to strings.
137 1.40 thorpej */
138 1.40 thorpej const struct twe_code_table twe_table_status[] = {
139 1.40 thorpej { 0x00, "successful completion" },
140 1.40 thorpej
141 1.40 thorpej /* info */
142 1.40 thorpej { 0x42, "command in progress" },
143 1.40 thorpej { 0x6c, "retrying interface CRC error from UDMA command" },
144 1.40 thorpej
145 1.40 thorpej /* warning */
146 1.40 thorpej { 0x81, "redundant/inconsequential request ignored" },
147 1.40 thorpej { 0x8e, "failed to write zeroes to LBA 0" },
148 1.40 thorpej { 0x8f, "failed to profile TwinStor zones" },
149 1.40 thorpej
150 1.40 thorpej /* fatal */
151 1.40 thorpej { 0xc1, "aborted due to system command or reconfiguration" },
152 1.40 thorpej { 0xc4, "aborted" },
153 1.40 thorpej { 0xc5, "access error" },
154 1.40 thorpej { 0xc6, "access violation" },
155 1.40 thorpej { 0xc7, "device failure" }, /* high byte may be port # */
156 1.40 thorpej { 0xc8, "controller error" },
157 1.40 thorpej { 0xc9, "timed out" },
158 1.40 thorpej { 0xcb, "invalid unit number" },
159 1.40 thorpej { 0xcf, "unit not available" },
160 1.40 thorpej { 0xd2, "undefined opcode" },
161 1.40 thorpej { 0xdb, "request incompatible with unit" },
162 1.40 thorpej { 0xdc, "invalid request" },
163 1.40 thorpej { 0xff, "firmware error, reset requested" },
164 1.40 thorpej
165 1.40 thorpej { 0, NULL }
166 1.40 thorpej };
167 1.40 thorpej
168 1.40 thorpej const struct twe_code_table twe_table_unitstate[] = {
169 1.40 thorpej { TWE_PARAM_UNITSTATUS_Normal, "Normal" },
170 1.40 thorpej { TWE_PARAM_UNITSTATUS_Initialising, "Initializing" },
171 1.40 thorpej { TWE_PARAM_UNITSTATUS_Degraded, "Degraded" },
172 1.40 thorpej { TWE_PARAM_UNITSTATUS_Rebuilding, "Rebuilding" },
173 1.40 thorpej { TWE_PARAM_UNITSTATUS_Verifying, "Verifying" },
174 1.40 thorpej { TWE_PARAM_UNITSTATUS_Corrupt, "Corrupt" },
175 1.40 thorpej { TWE_PARAM_UNITSTATUS_Missing, "Missing" },
176 1.40 thorpej
177 1.40 thorpej { 0, NULL }
178 1.40 thorpej };
179 1.40 thorpej
180 1.40 thorpej const struct twe_code_table twe_table_unittype[] = {
181 1.40 thorpej /* array descriptor configuration */
182 1.40 thorpej { TWE_AD_CONFIG_RAID0, "RAID0" },
183 1.40 thorpej { TWE_AD_CONFIG_RAID1, "RAID1" },
184 1.40 thorpej { TWE_AD_CONFIG_TwinStor, "TwinStor" },
185 1.40 thorpej { TWE_AD_CONFIG_RAID5, "RAID5" },
186 1.40 thorpej { TWE_AD_CONFIG_RAID10, "RAID10" },
187 1.40 thorpej
188 1.40 thorpej { 0, NULL }
189 1.40 thorpej };
190 1.40 thorpej
191 1.40 thorpej const struct twe_code_table twe_table_stripedepth[] = {
192 1.40 thorpej { TWE_AD_STRIPE_4k, "4K" },
193 1.40 thorpej { TWE_AD_STRIPE_8k, "8K" },
194 1.40 thorpej { TWE_AD_STRIPE_16k, "16K" },
195 1.40 thorpej { TWE_AD_STRIPE_32k, "32K" },
196 1.40 thorpej { TWE_AD_STRIPE_64k, "64K" },
197 1.40 thorpej
198 1.40 thorpej { 0, NULL }
199 1.40 thorpej };
200 1.40 thorpej
201 1.45 thorpej /*
202 1.45 thorpej * Asynchronous event notification messages are qualified:
203 1.45 thorpej * a - not unit/port specific
204 1.45 thorpej * u - unit specific
205 1.45 thorpej * p - port specific
206 1.45 thorpej */
207 1.45 thorpej const struct twe_code_table twe_table_aen[] = {
208 1.45 thorpej { 0x00, "a queue empty" },
209 1.45 thorpej { 0x01, "a soft reset" },
210 1.45 thorpej { 0x02, "u degraded mode" },
211 1.45 thorpej { 0x03, "a controller error" },
212 1.45 thorpej { 0x04, "u rebuild fail" },
213 1.45 thorpej { 0x05, "u rebuild done" },
214 1.45 thorpej { 0x06, "u incomplete unit" },
215 1.45 thorpej { 0x07, "u initialization done" },
216 1.45 thorpej { 0x08, "u unclean shutdown detected" },
217 1.45 thorpej { 0x09, "p drive timeout" },
218 1.45 thorpej { 0x0a, "p drive error" },
219 1.45 thorpej { 0x0b, "u rebuild started" },
220 1.45 thorpej { 0x0c, "u initialization started" },
221 1.45 thorpej { 0x0d, "u logical unit deleted" },
222 1.45 thorpej { 0x0f, "p SMART threshold exceeded" },
223 1.45 thorpej { 0x15, "a table undefined" }, /* XXX: Not in FreeBSD's table */
224 1.45 thorpej { 0x21, "p ATA UDMA downgrade" },
225 1.45 thorpej { 0x22, "p ATA UDMA upgrade" },
226 1.45 thorpej { 0x23, "p sector repair occurred" },
227 1.45 thorpej { 0x24, "a SBUF integrity check failure" },
228 1.45 thorpej { 0x25, "p lost cached write" },
229 1.45 thorpej { 0x26, "p drive ECC error detected" },
230 1.45 thorpej { 0x27, "p DCB checksum error" },
231 1.45 thorpej { 0x28, "p DCB unsupported version" },
232 1.45 thorpej { 0x29, "u verify started" },
233 1.45 thorpej { 0x2a, "u verify failed" },
234 1.45 thorpej { 0x2b, "u verify complete" },
235 1.45 thorpej { 0x2c, "p overwrote bad sector during rebuild" },
236 1.45 thorpej { 0x2d, "p encountered bad sector during rebuild" },
237 1.45 thorpej { 0x2e, "p replacement drive too small" },
238 1.45 thorpej { 0x2f, "u array not previously initialized" },
239 1.45 thorpej { 0x30, "p drive not supported" },
240 1.45 thorpej { 0xff, "a aen queue full" },
241 1.45 thorpej
242 1.45 thorpej { 0, NULL },
243 1.45 thorpej };
244 1.45 thorpej
245 1.40 thorpej const char *
246 1.40 thorpej twe_describe_code(const struct twe_code_table *table, uint32_t code)
247 1.40 thorpej {
248 1.40 thorpej
249 1.40 thorpej for (; table->string != NULL; table++) {
250 1.40 thorpej if (table->code == code)
251 1.40 thorpej return (table->string);
252 1.40 thorpej }
253 1.40 thorpej return (NULL);
254 1.40 thorpej }
255 1.40 thorpej
256 1.22 ad static inline u_int32_t
257 1.22 ad twe_inl(struct twe_softc *sc, int off)
258 1.22 ad {
259 1.22 ad
260 1.22 ad bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
261 1.22 ad BUS_SPACE_BARRIER_WRITE | BUS_SPACE_BARRIER_READ);
262 1.22 ad return (bus_space_read_4(sc->sc_iot, sc->sc_ioh, off));
263 1.22 ad }
264 1.22 ad
265 1.22 ad static inline void
266 1.22 ad twe_outl(struct twe_softc *sc, int off, u_int32_t val)
267 1.22 ad {
268 1.22 ad
269 1.22 ad bus_space_write_4(sc->sc_iot, sc->sc_ioh, off, val);
270 1.22 ad bus_space_barrier(sc->sc_iot, sc->sc_ioh, off, 4,
271 1.22 ad BUS_SPACE_BARRIER_WRITE);
272 1.22 ad }
273 1.22 ad
274 1.1 ad /*
275 1.1 ad * Match a supported board.
276 1.1 ad */
277 1.1 ad static int
278 1.1 ad twe_match(struct device *parent, struct cfdata *cfdata, void *aux)
279 1.1 ad {
280 1.1 ad struct pci_attach_args *pa;
281 1.1 ad
282 1.1 ad pa = aux;
283 1.1 ad
284 1.1 ad return (PCI_VENDOR(pa->pa_id) == PCI_VENDOR_3WARE &&
285 1.10 ad (PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE ||
286 1.10 ad PCI_PRODUCT(pa->pa_id) == PCI_PRODUCT_3WARE_ESCALADE_ASIC));
287 1.1 ad }
288 1.1 ad
289 1.1 ad /*
290 1.1 ad * Attach a supported board.
291 1.1 ad *
292 1.1 ad * XXX This doesn't fail gracefully.
293 1.1 ad */
294 1.1 ad static void
295 1.1 ad twe_attach(struct device *parent, struct device *self, void *aux)
296 1.1 ad {
297 1.1 ad struct pci_attach_args *pa;
298 1.1 ad struct twe_softc *sc;
299 1.1 ad pci_chipset_tag_t pc;
300 1.1 ad pci_intr_handle_t ih;
301 1.1 ad pcireg_t csr;
302 1.1 ad const char *intrstr;
303 1.1 ad int size, i, rv, rseg;
304 1.23 christos size_t max_segs, max_xfer;
305 1.42 thorpej struct twe_param *dtp, *atp;
306 1.42 thorpej struct twe_array_descriptor *ad;
307 1.42 thorpej struct twe_drive *td;
308 1.1 ad bus_dma_segment_t seg;
309 1.1 ad struct twe_cmd *tc;
310 1.1 ad struct twe_attach_args twea;
311 1.1 ad struct twe_ccb *ccb;
312 1.42 thorpej uint16_t dsize;
313 1.1 ad
314 1.1 ad sc = (struct twe_softc *)self;
315 1.1 ad pa = aux;
316 1.1 ad pc = pa->pa_pc;
317 1.1 ad sc->sc_dmat = pa->pa_dmat;
318 1.1 ad SIMPLEQ_INIT(&sc->sc_ccb_queue);
319 1.1 ad SLIST_INIT(&sc->sc_ccb_freelist);
320 1.1 ad
321 1.40 thorpej aprint_naive(": RAID controller\n");
322 1.38 jdolecek aprint_normal(": 3ware Escalade\n");
323 1.1 ad
324 1.33 christos ccb = malloc(sizeof(*ccb) * TWE_MAX_QUEUECNT, M_DEVBUF, M_NOWAIT);
325 1.33 christos if (ccb == NULL) {
326 1.38 jdolecek aprint_error("%s: unable to allocate memory for ccbs\n",
327 1.33 christos sc->sc_dv.dv_xname);
328 1.33 christos return;
329 1.33 christos }
330 1.33 christos
331 1.1 ad if (pci_mapreg_map(pa, PCI_CBIO, PCI_MAPREG_TYPE_IO, 0,
332 1.1 ad &sc->sc_iot, &sc->sc_ioh, NULL, NULL)) {
333 1.38 jdolecek aprint_error("%s: can't map i/o space\n", sc->sc_dv.dv_xname);
334 1.1 ad return;
335 1.1 ad }
336 1.1 ad
337 1.1 ad /* Enable the device. */
338 1.1 ad csr = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
339 1.1 ad pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG,
340 1.1 ad csr | PCI_COMMAND_MASTER_ENABLE);
341 1.1 ad
342 1.1 ad /* Map and establish the interrupt. */
343 1.5 sommerfe if (pci_intr_map(pa, &ih)) {
344 1.38 jdolecek aprint_error("%s: can't map interrupt\n", sc->sc_dv.dv_xname);
345 1.1 ad return;
346 1.1 ad }
347 1.38 jdolecek
348 1.1 ad intrstr = pci_intr_string(pc, ih);
349 1.1 ad sc->sc_ih = pci_intr_establish(pc, ih, IPL_BIO, twe_intr, sc);
350 1.1 ad if (sc->sc_ih == NULL) {
351 1.38 jdolecek aprint_error("%s: can't establish interrupt%s%s\n",
352 1.38 jdolecek sc->sc_dv.dv_xname,
353 1.38 jdolecek (intrstr) ? " at " : "",
354 1.38 jdolecek (intrstr) ? intrstr : "");
355 1.1 ad return;
356 1.1 ad }
357 1.38 jdolecek
358 1.1 ad if (intrstr != NULL)
359 1.38 jdolecek aprint_normal("%s: interrupting at %s\n",
360 1.38 jdolecek sc->sc_dv.dv_xname, intrstr);
361 1.1 ad
362 1.1 ad /*
363 1.1 ad * Allocate and initialise the command blocks and CCBs.
364 1.1 ad */
365 1.7 ad size = sizeof(struct twe_cmd) * TWE_MAX_QUEUECNT;
366 1.1 ad
367 1.4 thorpej if ((rv = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &seg, 1,
368 1.1 ad &rseg, BUS_DMA_NOWAIT)) != 0) {
369 1.38 jdolecek aprint_error("%s: unable to allocate commands, rv = %d\n",
370 1.1 ad sc->sc_dv.dv_xname, rv);
371 1.1 ad return;
372 1.1 ad }
373 1.1 ad
374 1.1 ad if ((rv = bus_dmamem_map(sc->sc_dmat, &seg, rseg, size,
375 1.1 ad (caddr_t *)&sc->sc_cmds,
376 1.1 ad BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) {
377 1.38 jdolecek aprint_error("%s: unable to map commands, rv = %d\n",
378 1.1 ad sc->sc_dv.dv_xname, rv);
379 1.1 ad return;
380 1.1 ad }
381 1.1 ad
382 1.1 ad if ((rv = bus_dmamap_create(sc->sc_dmat, size, size, 1, 0,
383 1.1 ad BUS_DMA_NOWAIT, &sc->sc_dmamap)) != 0) {
384 1.38 jdolecek aprint_error("%s: unable to create command DMA map, rv = %d\n",
385 1.1 ad sc->sc_dv.dv_xname, rv);
386 1.1 ad return;
387 1.1 ad }
388 1.1 ad
389 1.1 ad if ((rv = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap, sc->sc_cmds,
390 1.1 ad size, NULL, BUS_DMA_NOWAIT)) != 0) {
391 1.38 jdolecek aprint_error("%s: unable to load command DMA map, rv = %d\n",
392 1.1 ad sc->sc_dv.dv_xname, rv);
393 1.1 ad return;
394 1.1 ad }
395 1.1 ad
396 1.1 ad sc->sc_cmds_paddr = sc->sc_dmamap->dm_segs[0].ds_addr;
397 1.1 ad memset(sc->sc_cmds, 0, size);
398 1.1 ad
399 1.1 ad sc->sc_ccbs = ccb;
400 1.1 ad tc = (struct twe_cmd *)sc->sc_cmds;
401 1.24 christos max_segs = twe_get_maxsegs();
402 1.24 christos max_xfer = twe_get_maxxfer(max_segs);
403 1.1 ad
404 1.7 ad for (i = 0; i < TWE_MAX_QUEUECNT; i++, tc++, ccb++) {
405 1.1 ad ccb->ccb_cmd = tc;
406 1.1 ad ccb->ccb_cmdid = i;
407 1.1 ad ccb->ccb_flags = 0;
408 1.23 christos rv = bus_dmamap_create(sc->sc_dmat, max_xfer,
409 1.23 christos max_segs, PAGE_SIZE, 0,
410 1.4 thorpej BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW,
411 1.1 ad &ccb->ccb_dmamap_xfer);
412 1.7 ad if (rv != 0) {
413 1.38 jdolecek aprint_error("%s: can't create dmamap, rv = %d\n",
414 1.7 ad sc->sc_dv.dv_xname, rv);
415 1.7 ad return;
416 1.7 ad }
417 1.3 ad /* Save one CCB for parameter retrieval. */
418 1.3 ad if (i != 0)
419 1.3 ad SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb,
420 1.3 ad ccb_chain.slist);
421 1.3 ad }
422 1.1 ad
423 1.1 ad /* Wait for the controller to become ready. */
424 1.1 ad if (twe_status_wait(sc, TWE_STS_MICROCONTROLLER_READY, 6)) {
425 1.38 jdolecek aprint_error("%s: microcontroller not ready\n",
426 1.38 jdolecek sc->sc_dv.dv_xname);
427 1.1 ad return;
428 1.1 ad }
429 1.1 ad
430 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_DISABLE_INTRS);
431 1.1 ad
432 1.1 ad /* Reset the controller. */
433 1.1 ad if (twe_reset(sc)) {
434 1.38 jdolecek aprint_error("%s: reset failed\n", sc->sc_dv.dv_xname);
435 1.1 ad return;
436 1.1 ad }
437 1.1 ad
438 1.3 ad /* Find attached units. */
439 1.7 ad rv = twe_param_get(sc, TWE_PARAM_UNITSUMMARY,
440 1.38 jdolecek TWE_PARAM_UNITSUMMARY_Status, TWE_MAX_UNITS, NULL, &dtp);
441 1.7 ad if (rv != 0) {
442 1.38 jdolecek aprint_error("%s: can't detect attached units (%d)\n",
443 1.7 ad sc->sc_dv.dv_xname, rv);
444 1.1 ad return;
445 1.1 ad }
446 1.1 ad
447 1.1 ad /* For each detected unit, collect size and store in an array. */
448 1.3 ad for (i = 0, sc->sc_nunits = 0; i < TWE_MAX_UNITS; i++) {
449 1.42 thorpej td = &sc->sc_units[i];
450 1.42 thorpej
451 1.1 ad /* Unit present? */
452 1.3 ad if ((dtp->tp_data[i] & TWE_PARAM_UNITSTATUS_Online) == 0) {
453 1.42 thorpej td->td_size = 0;
454 1.42 thorpej td->td_type = 0;
455 1.42 thorpej td->td_stripe = 0;
456 1.1 ad continue;
457 1.1 ad }
458 1.1 ad
459 1.42 thorpej rv = twe_param_get_2(sc, TWE_PARAM_UNITINFO + i,
460 1.42 thorpej TWE_PARAM_UNITINFO_DescriptorSize, &dsize);
461 1.42 thorpej if (rv != 0) {
462 1.42 thorpej aprint_error("%s: error %d fetching descriptor size "
463 1.42 thorpej "for unit %d\n", sc->sc_dv.dv_xname, rv, i);
464 1.42 thorpej td->td_size = 0;
465 1.42 thorpej td->td_type = 0;
466 1.42 thorpej td->td_stripe = 0;
467 1.42 thorpej continue;
468 1.42 thorpej }
469 1.42 thorpej
470 1.42 thorpej rv = twe_param_get(sc, TWE_PARAM_UNITINFO + i,
471 1.42 thorpej TWE_PARAM_UNITINFO_Descriptor, dsize - 3, NULL, &atp);
472 1.42 thorpej if (rv != 0) {
473 1.42 thorpej aprint_error("%s: error %d fetching array descriptor "
474 1.42 thorpej "for unit %d\n", sc->sc_dv.dv_xname, rv, i);
475 1.42 thorpej td->td_size = 0;
476 1.42 thorpej td->td_type = 0;
477 1.42 thorpej td->td_stripe = 0;
478 1.42 thorpej continue;
479 1.42 thorpej }
480 1.42 thorpej ad = (struct twe_array_descriptor *)atp->tp_data;
481 1.42 thorpej td->td_type = ad->configuration;
482 1.42 thorpej td->td_stripe = ad->stripe_size;
483 1.42 thorpej free(atp, M_DEVBUF);
484 1.42 thorpej
485 1.41 thorpej rv = twe_param_get_4(sc, TWE_PARAM_UNITINFO + i,
486 1.42 thorpej TWE_PARAM_UNITINFO_Capacity, &td->td_size);
487 1.7 ad if (rv != 0) {
488 1.42 thorpej aprint_error(
489 1.42 thorpej "%s: error %d fetching capacity for unit %d\n",
490 1.7 ad sc->sc_dv.dv_xname, rv, i);
491 1.42 thorpej td->td_size = 0;
492 1.42 thorpej td->td_type = 0;
493 1.42 thorpej td->td_stripe = 0;
494 1.1 ad continue;
495 1.1 ad }
496 1.1 ad
497 1.3 ad sc->sc_nunits++;
498 1.1 ad }
499 1.1 ad free(dtp, M_DEVBUF);
500 1.1 ad
501 1.1 ad /* Initialise connection with controller and enable interrupts. */
502 1.1 ad twe_init_connection(sc);
503 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR |
504 1.1 ad TWE_CTL_UNMASK_RESP_INTR |
505 1.1 ad TWE_CTL_ENABLE_INTRS);
506 1.1 ad
507 1.38 jdolecek twe_describe_controller(sc);
508 1.38 jdolecek
509 1.1 ad /* Attach sub-devices. */
510 1.1 ad for (i = 0; i < TWE_MAX_UNITS; i++) {
511 1.42 thorpej td = &sc->sc_units[i];
512 1.42 thorpej if (td->td_size == 0)
513 1.1 ad continue;
514 1.1 ad twea.twea_unit = i;
515 1.42 thorpej td->td_dev = config_found_sm(&sc->sc_dv, &twea, twe_print,
516 1.42 thorpej twe_submatch);
517 1.1 ad }
518 1.1 ad }
519 1.1 ad
520 1.1 ad /*
521 1.1 ad * Reset the controller. Currently only useful at attach time; must be
522 1.1 ad * called with interrupts blocked.
523 1.1 ad */
524 1.1 ad static int
525 1.1 ad twe_reset(struct twe_softc *sc)
526 1.1 ad {
527 1.41 thorpej uint16_t aen;
528 1.41 thorpej u_int status;
529 1.1 ad volatile u_int32_t junk;
530 1.7 ad int got, rv;
531 1.1 ad
532 1.1 ad /* Issue a soft reset. */
533 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_ISSUE_SOFT_RESET |
534 1.1 ad TWE_CTL_CLEAR_HOST_INTR |
535 1.1 ad TWE_CTL_CLEAR_ATTN_INTR |
536 1.1 ad TWE_CTL_MASK_CMD_INTR |
537 1.1 ad TWE_CTL_MASK_RESP_INTR |
538 1.1 ad TWE_CTL_CLEAR_ERROR_STS |
539 1.1 ad TWE_CTL_DISABLE_INTRS);
540 1.1 ad
541 1.45 thorpej /* Wait for attention... */
542 1.1 ad if (twe_status_wait(sc, TWE_STS_ATTN_INTR, 15)) {
543 1.1 ad printf("%s: no attention interrupt\n",
544 1.1 ad sc->sc_dv.dv_xname);
545 1.1 ad return (-1);
546 1.1 ad }
547 1.1 ad
548 1.45 thorpej /* ...and ACK it. */
549 1.45 thorpej twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
550 1.45 thorpej
551 1.45 thorpej /*
552 1.45 thorpej * Pull AENs out of the controller; look for a soft reset AEN.
553 1.45 thorpej * Open code this, since we want to detect reset even if the
554 1.45 thorpej * queue for management tools is full.
555 1.45 thorpej */
556 1.1 ad for (got = 0;;) {
557 1.41 thorpej rv = twe_param_get_2(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode,
558 1.41 thorpej &aen);
559 1.7 ad if (rv != 0)
560 1.45 thorpej printf("%s: error %d while draining event queue\n",
561 1.7 ad sc->sc_dv.dv_xname, rv);
562 1.41 thorpej if (TWE_AEN_CODE(aen) == TWE_AEN_QUEUE_EMPTY)
563 1.1 ad break;
564 1.41 thorpej if (TWE_AEN_CODE(aen) == TWE_AEN_SOFT_RESET)
565 1.1 ad got = 1;
566 1.45 thorpej twe_aen_enqueue(sc, aen, 1);
567 1.1 ad }
568 1.45 thorpej
569 1.1 ad if (!got) {
570 1.1 ad printf("%s: reset not reported\n", sc->sc_dv.dv_xname);
571 1.1 ad return (-1);
572 1.1 ad }
573 1.1 ad
574 1.1 ad /* Check controller status. */
575 1.22 ad status = twe_inl(sc, TWE_REG_STS);
576 1.1 ad if (twe_status_check(sc, status)) {
577 1.1 ad printf("%s: controller errors detected\n",
578 1.1 ad sc->sc_dv.dv_xname);
579 1.1 ad return (-1);
580 1.1 ad }
581 1.1 ad
582 1.1 ad /* Drain the response queue. */
583 1.1 ad for (;;) {
584 1.22 ad status = twe_inl(sc, TWE_REG_STS);
585 1.1 ad if (twe_status_check(sc, status) != 0) {
586 1.1 ad printf("%s: can't drain response queue\n",
587 1.1 ad sc->sc_dv.dv_xname);
588 1.1 ad return (-1);
589 1.1 ad }
590 1.1 ad if ((status & TWE_STS_RESP_QUEUE_EMPTY) != 0)
591 1.1 ad break;
592 1.22 ad junk = twe_inl(sc, TWE_REG_RESP_QUEUE);
593 1.1 ad }
594 1.1 ad
595 1.1 ad return (0);
596 1.1 ad }
597 1.1 ad
598 1.1 ad /*
599 1.1 ad * Print autoconfiguration message for a sub-device.
600 1.1 ad */
601 1.1 ad static int
602 1.1 ad twe_print(void *aux, const char *pnp)
603 1.1 ad {
604 1.1 ad struct twe_attach_args *twea;
605 1.1 ad
606 1.1 ad twea = aux;
607 1.1 ad
608 1.1 ad if (pnp != NULL)
609 1.35 thorpej aprint_normal("block device at %s", pnp);
610 1.35 thorpej aprint_normal(" unit %d", twea->twea_unit);
611 1.1 ad return (UNCONF);
612 1.1 ad }
613 1.1 ad
614 1.1 ad /*
615 1.1 ad * Match a sub-device.
616 1.1 ad */
617 1.1 ad static int
618 1.1 ad twe_submatch(struct device *parent, struct cfdata *cf, void *aux)
619 1.1 ad {
620 1.1 ad struct twe_attach_args *twea;
621 1.1 ad
622 1.1 ad twea = aux;
623 1.1 ad
624 1.1 ad if (cf->tweacf_unit != TWECF_UNIT_DEFAULT &&
625 1.1 ad cf->tweacf_unit != twea->twea_unit)
626 1.1 ad return (0);
627 1.1 ad
628 1.28 thorpej return (config_match(parent, cf, aux));
629 1.1 ad }
630 1.1 ad
631 1.1 ad /*
632 1.1 ad * Interrupt service routine.
633 1.1 ad */
634 1.1 ad static int
635 1.1 ad twe_intr(void *arg)
636 1.1 ad {
637 1.1 ad struct twe_softc *sc;
638 1.1 ad u_int status;
639 1.7 ad int caught, rv;
640 1.1 ad
641 1.1 ad sc = arg;
642 1.1 ad caught = 0;
643 1.22 ad status = twe_inl(sc, TWE_REG_STS);
644 1.1 ad twe_status_check(sc, status);
645 1.1 ad
646 1.1 ad /* Host interrupts - purpose unknown. */
647 1.1 ad if ((status & TWE_STS_HOST_INTR) != 0) {
648 1.38 jdolecek #ifdef DEBUG
649 1.1 ad printf("%s: host interrupt\n", sc->sc_dv.dv_xname);
650 1.1 ad #endif
651 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_HOST_INTR);
652 1.1 ad caught = 1;
653 1.1 ad }
654 1.1 ad
655 1.1 ad /*
656 1.1 ad * Attention interrupts, signalled when a controller or child device
657 1.18 wiz * state change has occurred.
658 1.1 ad */
659 1.1 ad if ((status & TWE_STS_ATTN_INTR) != 0) {
660 1.45 thorpej rv = twe_param_get(sc, TWE_PARAM_AEN,
661 1.45 thorpej TWE_PARAM_AEN_UnitCode, 2, twe_aen_handler,
662 1.45 thorpej NULL);
663 1.45 thorpej if (rv != 0)
664 1.45 thorpej printf("%s: unable to retrieve AEN (%d)\n",
665 1.45 thorpej sc->sc_dv.dv_xname, rv);
666 1.45 thorpej else
667 1.45 thorpej twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
668 1.1 ad caught = 1;
669 1.1 ad }
670 1.1 ad
671 1.1 ad /*
672 1.1 ad * Command interrupts, signalled when the controller can accept more
673 1.1 ad * commands. We don't use this; instead, we try to submit commands
674 1.1 ad * when we receive them, and when other commands have completed.
675 1.1 ad * Mask it so we don't get another one.
676 1.1 ad */
677 1.1 ad if ((status & TWE_STS_CMD_INTR) != 0) {
678 1.38 jdolecek #ifdef DEBUG
679 1.1 ad printf("%s: command interrupt\n", sc->sc_dv.dv_xname);
680 1.1 ad #endif
681 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_MASK_CMD_INTR);
682 1.1 ad caught = 1;
683 1.1 ad }
684 1.1 ad
685 1.1 ad if ((status & TWE_STS_RESP_INTR) != 0) {
686 1.1 ad twe_poll(sc);
687 1.1 ad caught = 1;
688 1.1 ad }
689 1.1 ad
690 1.1 ad return (caught);
691 1.1 ad }
692 1.1 ad
693 1.1 ad /*
694 1.1 ad * Handle an AEN returned by the controller.
695 1.1 ad */
696 1.1 ad static void
697 1.1 ad twe_aen_handler(struct twe_ccb *ccb, int error)
698 1.1 ad {
699 1.1 ad struct twe_softc *sc;
700 1.1 ad struct twe_param *tp;
701 1.45 thorpej uint16_t aen;
702 1.45 thorpej int rv;
703 1.1 ad
704 1.1 ad sc = (struct twe_softc *)ccb->ccb_tx.tx_dv;
705 1.1 ad tp = ccb->ccb_tx.tx_context;
706 1.1 ad twe_ccb_unmap(sc, ccb);
707 1.1 ad
708 1.3 ad if (error) {
709 1.1 ad printf("%s: error retrieving AEN\n", sc->sc_dv.dv_xname);
710 1.3 ad aen = TWE_AEN_QUEUE_EMPTY;
711 1.3 ad } else
712 1.1 ad aen = le16toh(*(u_int16_t *)tp->tp_data);
713 1.3 ad free(tp, M_DEVBUF);
714 1.3 ad twe_ccb_free(sc, ccb);
715 1.3 ad
716 1.7 ad if (TWE_AEN_CODE(aen) == TWE_AEN_QUEUE_EMPTY) {
717 1.22 ad twe_outl(sc, TWE_REG_CTL, TWE_CTL_CLEAR_ATTN_INTR);
718 1.7 ad return;
719 1.7 ad }
720 1.7 ad
721 1.45 thorpej twe_aen_enqueue(sc, aen, 0);
722 1.3 ad
723 1.7 ad /*
724 1.7 ad * Chain another retrieval in case interrupts have been
725 1.7 ad * coalesced.
726 1.7 ad */
727 1.7 ad rv = twe_param_get(sc, TWE_PARAM_AEN, TWE_PARAM_AEN_UnitCode, 2,
728 1.7 ad twe_aen_handler, NULL);
729 1.7 ad if (rv != 0)
730 1.7 ad printf("%s: unable to retrieve AEN (%d)\n",
731 1.7 ad sc->sc_dv.dv_xname, rv);
732 1.1 ad }
733 1.1 ad
734 1.45 thorpej static void
735 1.45 thorpej twe_aen_enqueue(struct twe_softc *sc, uint16_t aen, int quiet)
736 1.45 thorpej {
737 1.45 thorpej const char *str, *msg;
738 1.45 thorpej int s, next, nextnext;
739 1.45 thorpej
740 1.45 thorpej /*
741 1.45 thorpej * First report the AEN on the console. Maybe.
742 1.45 thorpej */
743 1.45 thorpej if (! quiet) {
744 1.45 thorpej str = twe_describe_code(twe_table_aen, TWE_AEN_CODE(aen));
745 1.45 thorpej if (str == NULL) {
746 1.45 thorpej printf("%s: unknown AEN 0x%04x\n",
747 1.45 thorpej sc->sc_dv.dv_xname, aen);
748 1.45 thorpej } else {
749 1.45 thorpej msg = str + 2;
750 1.45 thorpej switch (*str) {
751 1.45 thorpej case 'u':
752 1.45 thorpej printf("%s: unit %d: %s\n",
753 1.45 thorpej sc->sc_dv.dv_xname, TWE_AEN_UNIT(aen), msg);
754 1.45 thorpej break;
755 1.45 thorpej
756 1.45 thorpej case 'p':
757 1.45 thorpej printf("%s: port %d: %s\n",
758 1.45 thorpej sc->sc_dv.dv_xname, TWE_AEN_UNIT(aen), msg);
759 1.45 thorpej break;
760 1.45 thorpej
761 1.45 thorpej default:
762 1.45 thorpej printf("%s: %s\n", sc->sc_dv.dv_xname, msg);
763 1.45 thorpej }
764 1.45 thorpej }
765 1.45 thorpej }
766 1.45 thorpej
767 1.45 thorpej /* Now enqueue the AEN for mangement tools. */
768 1.45 thorpej s = splbio();
769 1.45 thorpej
770 1.45 thorpej next = (sc->sc_aen_head + 1) % TWE_AEN_Q_LENGTH;
771 1.45 thorpej nextnext = (sc->sc_aen_head + 2) % TWE_AEN_Q_LENGTH;
772 1.45 thorpej
773 1.45 thorpej /*
774 1.45 thorpej * If this is the last free slot, then queue up a "queue
775 1.45 thorpej * full" message.
776 1.45 thorpej */
777 1.45 thorpej if (nextnext == sc->sc_aen_tail)
778 1.45 thorpej aen = TWE_AEN_QUEUE_FULL;
779 1.45 thorpej
780 1.45 thorpej if (next != sc->sc_aen_tail) {
781 1.45 thorpej sc->sc_aen_queue[sc->sc_aen_head] = aen;
782 1.45 thorpej sc->sc_aen_head = next;
783 1.45 thorpej }
784 1.45 thorpej
785 1.45 thorpej if (sc->sc_flags & TWEF_AENQ_WAIT) {
786 1.45 thorpej sc->sc_flags &= ~TWEF_AENQ_WAIT;
787 1.45 thorpej wakeup(&sc->sc_aen_queue);
788 1.45 thorpej }
789 1.45 thorpej
790 1.45 thorpej splx(s);
791 1.45 thorpej }
792 1.45 thorpej
793 1.45 thorpej /* NOTE: Must be called at splbio(). */
794 1.45 thorpej static uint16_t
795 1.45 thorpej twe_aen_dequeue(struct twe_softc *sc)
796 1.45 thorpej {
797 1.45 thorpej uint16_t aen;
798 1.45 thorpej
799 1.45 thorpej if (sc->sc_aen_tail == sc->sc_aen_head)
800 1.45 thorpej aen = TWE_AEN_QUEUE_EMPTY;
801 1.45 thorpej else {
802 1.45 thorpej aen = sc->sc_aen_queue[sc->sc_aen_tail];
803 1.45 thorpej sc->sc_aen_tail = (sc->sc_aen_tail + 1) & TWE_AEN_Q_LENGTH;
804 1.45 thorpej }
805 1.45 thorpej
806 1.45 thorpej return (aen);
807 1.45 thorpej }
808 1.45 thorpej
809 1.1 ad /*
810 1.41 thorpej * These are short-hand functions that execute TWE_OP_GET_PARAM to
811 1.41 thorpej * fetch 1, 2, and 4 byte parameter values, respectively.
812 1.41 thorpej */
813 1.43 thorpej int
814 1.41 thorpej twe_param_get_1(struct twe_softc *sc, int table_id, int param_id,
815 1.41 thorpej uint8_t *valp)
816 1.41 thorpej {
817 1.41 thorpej struct twe_param *tp;
818 1.41 thorpej int rv;
819 1.41 thorpej
820 1.41 thorpej rv = twe_param_get(sc, table_id, param_id, 1, NULL, &tp);
821 1.41 thorpej if (rv != 0)
822 1.41 thorpej return (rv);
823 1.41 thorpej *valp = *(uint8_t *)tp->tp_data;
824 1.41 thorpej free(tp, M_DEVBUF);
825 1.41 thorpej return (0);
826 1.41 thorpej }
827 1.41 thorpej
828 1.43 thorpej int
829 1.41 thorpej twe_param_get_2(struct twe_softc *sc, int table_id, int param_id,
830 1.41 thorpej uint16_t *valp)
831 1.41 thorpej {
832 1.41 thorpej struct twe_param *tp;
833 1.41 thorpej int rv;
834 1.41 thorpej
835 1.41 thorpej rv = twe_param_get(sc, table_id, param_id, 2, NULL, &tp);
836 1.41 thorpej if (rv != 0)
837 1.41 thorpej return (rv);
838 1.41 thorpej *valp = le16toh(*(uint16_t *)tp->tp_data);
839 1.41 thorpej free(tp, M_DEVBUF);
840 1.41 thorpej return (0);
841 1.41 thorpej }
842 1.41 thorpej
843 1.43 thorpej int
844 1.41 thorpej twe_param_get_4(struct twe_softc *sc, int table_id, int param_id,
845 1.41 thorpej uint32_t *valp)
846 1.41 thorpej {
847 1.41 thorpej struct twe_param *tp;
848 1.41 thorpej int rv;
849 1.41 thorpej
850 1.41 thorpej rv = twe_param_get(sc, table_id, param_id, 4, NULL, &tp);
851 1.41 thorpej if (rv != 0)
852 1.41 thorpej return (rv);
853 1.41 thorpej *valp = le32toh(*(uint32_t *)tp->tp_data);
854 1.41 thorpej free(tp, M_DEVBUF);
855 1.41 thorpej return (0);
856 1.41 thorpej }
857 1.41 thorpej
858 1.41 thorpej /*
859 1.1 ad * Execute a TWE_OP_GET_PARAM command. If a callback function is provided,
860 1.1 ad * it will be called with generated context when the command has completed.
861 1.1 ad * If no callback is provided, the command will be executed synchronously
862 1.3 ad * and a pointer to a buffer containing the data returned.
863 1.1 ad *
864 1.3 ad * The caller or callback is responsible for freeing the buffer.
865 1.1 ad */
866 1.43 thorpej int
867 1.1 ad twe_param_get(struct twe_softc *sc, int table_id, int param_id, size_t size,
868 1.38 jdolecek void (*func)(struct twe_ccb *, int), struct twe_param **pbuf)
869 1.1 ad {
870 1.1 ad struct twe_ccb *ccb;
871 1.1 ad struct twe_cmd *tc;
872 1.1 ad struct twe_param *tp;
873 1.1 ad int rv, s;
874 1.1 ad
875 1.33 christos tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
876 1.33 christos if (tp == NULL)
877 1.33 christos return ENOMEM;
878 1.33 christos
879 1.7 ad rv = twe_ccb_alloc(sc, &ccb,
880 1.7 ad TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
881 1.7 ad if (rv != 0)
882 1.33 christos goto done;
883 1.1 ad
884 1.1 ad ccb->ccb_data = tp;
885 1.1 ad ccb->ccb_datasize = TWE_SECTOR_SIZE;
886 1.1 ad ccb->ccb_tx.tx_handler = func;
887 1.1 ad ccb->ccb_tx.tx_context = tp;
888 1.1 ad ccb->ccb_tx.tx_dv = &sc->sc_dv;
889 1.1 ad
890 1.1 ad tc = ccb->ccb_cmd;
891 1.1 ad tc->tc_size = 2;
892 1.1 ad tc->tc_opcode = TWE_OP_GET_PARAM | (tc->tc_size << 5);
893 1.1 ad tc->tc_unit = 0;
894 1.1 ad tc->tc_count = htole16(1);
895 1.1 ad
896 1.1 ad /* Fill in the outbound parameter data. */
897 1.1 ad tp->tp_table_id = htole16(table_id);
898 1.1 ad tp->tp_param_id = param_id;
899 1.1 ad tp->tp_param_size = size;
900 1.1 ad
901 1.1 ad /* Map the transfer. */
902 1.7 ad if ((rv = twe_ccb_map(sc, ccb)) != 0) {
903 1.2 ad twe_ccb_free(sc, ccb);
904 1.33 christos goto done;
905 1.1 ad }
906 1.1 ad
907 1.1 ad /* Submit the command and either wait or let the callback handle it. */
908 1.1 ad if (func == NULL) {
909 1.1 ad s = splbio();
910 1.7 ad rv = twe_ccb_poll(sc, ccb, 5);
911 1.1 ad twe_ccb_unmap(sc, ccb);
912 1.2 ad twe_ccb_free(sc, ccb);
913 1.1 ad splx(s);
914 1.1 ad } else {
915 1.38 jdolecek #ifdef DEBUG
916 1.33 christos if (pbuf != NULL)
917 1.33 christos panic("both func and pbuf defined");
918 1.33 christos #endif
919 1.1 ad twe_ccb_enqueue(sc, ccb);
920 1.33 christos return 0;
921 1.33 christos }
922 1.33 christos
923 1.33 christos done:
924 1.33 christos if (pbuf == NULL || rv != 0)
925 1.33 christos free(tp, M_DEVBUF);
926 1.33 christos else if (pbuf != NULL && rv == 0)
927 1.33 christos *pbuf = tp;
928 1.33 christos return rv;
929 1.33 christos }
930 1.33 christos
931 1.33 christos /*
932 1.33 christos * Execute a TWE_OP_SET_PARAM command.
933 1.33 christos */
934 1.33 christos static int
935 1.33 christos twe_param_set(struct twe_softc *sc, int table_id, int param_id, size_t size,
936 1.33 christos void *buf)
937 1.33 christos {
938 1.33 christos struct twe_ccb *ccb;
939 1.33 christos struct twe_cmd *tc;
940 1.33 christos struct twe_param *tp;
941 1.33 christos int rv, s;
942 1.33 christos
943 1.33 christos tp = malloc(TWE_SECTOR_SIZE, M_DEVBUF, M_NOWAIT);
944 1.33 christos if (tp == NULL)
945 1.33 christos return ENOMEM;
946 1.33 christos
947 1.33 christos rv = twe_ccb_alloc(sc, &ccb,
948 1.33 christos TWE_CCB_PARAM | TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
949 1.33 christos if (rv != 0)
950 1.33 christos goto done;
951 1.33 christos
952 1.33 christos ccb->ccb_data = tp;
953 1.33 christos ccb->ccb_datasize = TWE_SECTOR_SIZE;
954 1.33 christos ccb->ccb_tx.tx_handler = 0;
955 1.33 christos ccb->ccb_tx.tx_context = tp;
956 1.33 christos ccb->ccb_tx.tx_dv = &sc->sc_dv;
957 1.33 christos
958 1.33 christos tc = ccb->ccb_cmd;
959 1.33 christos tc->tc_size = 2;
960 1.33 christos tc->tc_opcode = TWE_OP_SET_PARAM | (tc->tc_size << 5);
961 1.33 christos tc->tc_unit = 0;
962 1.33 christos tc->tc_count = htole16(1);
963 1.33 christos
964 1.33 christos /* Fill in the outbound parameter data. */
965 1.33 christos tp->tp_table_id = htole16(table_id);
966 1.33 christos tp->tp_param_id = param_id;
967 1.33 christos tp->tp_param_size = size;
968 1.33 christos memcpy(tp->tp_data, buf, size);
969 1.33 christos
970 1.33 christos /* Map the transfer. */
971 1.33 christos if ((rv = twe_ccb_map(sc, ccb)) != 0) {
972 1.33 christos twe_ccb_free(sc, ccb);
973 1.33 christos goto done;
974 1.1 ad }
975 1.1 ad
976 1.33 christos /* Submit the command and wait. */
977 1.33 christos s = splbio();
978 1.33 christos rv = twe_ccb_poll(sc, ccb, 5);
979 1.33 christos twe_ccb_unmap(sc, ccb);
980 1.33 christos twe_ccb_free(sc, ccb);
981 1.33 christos splx(s);
982 1.33 christos done:
983 1.33 christos free(tp, M_DEVBUF);
984 1.7 ad return (rv);
985 1.1 ad }
986 1.1 ad
987 1.1 ad /*
988 1.1 ad * Execute a TWE_OP_INIT_CONNECTION command. Return non-zero on error.
989 1.1 ad * Must be called with interrupts blocked.
990 1.1 ad */
991 1.1 ad static int
992 1.1 ad twe_init_connection(struct twe_softc *sc)
993 1.33 christos /*###762 [cc] warning: `twe_init_connection' was used with no prototype before its definition%%%*/
994 1.33 christos /*###762 [cc] warning: `twe_init_connection' was declared implicitly `extern' and later `static'%%%*/
995 1.1 ad {
996 1.1 ad struct twe_ccb *ccb;
997 1.1 ad struct twe_cmd *tc;
998 1.1 ad int rv;
999 1.1 ad
1000 1.3 ad if ((rv = twe_ccb_alloc(sc, &ccb, 0)) != 0)
1001 1.1 ad return (rv);
1002 1.1 ad
1003 1.1 ad /* Build the command. */
1004 1.1 ad tc = ccb->ccb_cmd;
1005 1.1 ad tc->tc_size = 3;
1006 1.1 ad tc->tc_opcode = TWE_OP_INIT_CONNECTION;
1007 1.1 ad tc->tc_unit = 0;
1008 1.3 ad tc->tc_count = htole16(TWE_MAX_CMDS);
1009 1.1 ad tc->tc_args.init_connection.response_queue_pointer = 0;
1010 1.1 ad
1011 1.1 ad /* Submit the command for immediate execution. */
1012 1.7 ad rv = twe_ccb_poll(sc, ccb, 5);
1013 1.2 ad twe_ccb_free(sc, ccb);
1014 1.1 ad return (rv);
1015 1.1 ad }
1016 1.1 ad
1017 1.1 ad /*
1018 1.1 ad * Poll the controller for completed commands. Must be called with
1019 1.1 ad * interrupts blocked.
1020 1.1 ad */
1021 1.1 ad static void
1022 1.1 ad twe_poll(struct twe_softc *sc)
1023 1.1 ad {
1024 1.1 ad struct twe_ccb *ccb;
1025 1.1 ad int found;
1026 1.1 ad u_int status, cmdid;
1027 1.1 ad
1028 1.1 ad found = 0;
1029 1.1 ad
1030 1.1 ad for (;;) {
1031 1.22 ad status = twe_inl(sc, TWE_REG_STS);
1032 1.1 ad twe_status_check(sc, status);
1033 1.1 ad
1034 1.1 ad if ((status & TWE_STS_RESP_QUEUE_EMPTY))
1035 1.1 ad break;
1036 1.1 ad
1037 1.1 ad found = 1;
1038 1.22 ad cmdid = twe_inl(sc, TWE_REG_RESP_QUEUE);
1039 1.1 ad cmdid = (cmdid & TWE_RESP_MASK) >> TWE_RESP_SHIFT;
1040 1.7 ad if (cmdid >= TWE_MAX_QUEUECNT) {
1041 1.1 ad printf("%s: bad completion\n", sc->sc_dv.dv_xname);
1042 1.1 ad continue;
1043 1.1 ad }
1044 1.1 ad
1045 1.1 ad ccb = sc->sc_ccbs + cmdid;
1046 1.1 ad if ((ccb->ccb_flags & TWE_CCB_ACTIVE) == 0) {
1047 1.1 ad printf("%s: bad completion (not active)\n",
1048 1.1 ad sc->sc_dv.dv_xname);
1049 1.1 ad continue;
1050 1.1 ad }
1051 1.1 ad ccb->ccb_flags ^= TWE_CCB_COMPLETE | TWE_CCB_ACTIVE;
1052 1.1 ad
1053 1.1 ad bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1054 1.1 ad (caddr_t)ccb->ccb_cmd - sc->sc_cmds,
1055 1.1 ad sizeof(struct twe_cmd),
1056 1.1 ad BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
1057 1.1 ad
1058 1.1 ad /* Pass notification to upper layers. */
1059 1.1 ad if (ccb->ccb_tx.tx_handler != NULL)
1060 1.1 ad (*ccb->ccb_tx.tx_handler)(ccb,
1061 1.1 ad ccb->ccb_cmd->tc_status != 0 ? EIO : 0);
1062 1.1 ad }
1063 1.1 ad
1064 1.1 ad /* If any commands have completed, run the software queue. */
1065 1.1 ad if (found)
1066 1.1 ad twe_ccb_enqueue(sc, NULL);
1067 1.1 ad }
1068 1.1 ad
1069 1.1 ad /*
1070 1.1 ad * Wait for `status' to be set in the controller status register. Return
1071 1.1 ad * zero if found, non-zero if the operation timed out.
1072 1.1 ad */
1073 1.1 ad static int
1074 1.1 ad twe_status_wait(struct twe_softc *sc, u_int32_t status, int timo)
1075 1.1 ad {
1076 1.1 ad
1077 1.11 ad for (timo *= 10; timo != 0; timo--) {
1078 1.22 ad if ((twe_inl(sc, TWE_REG_STS) & status) == status)
1079 1.1 ad break;
1080 1.1 ad delay(100000);
1081 1.1 ad }
1082 1.1 ad
1083 1.1 ad return (timo == 0);
1084 1.1 ad }
1085 1.1 ad
1086 1.1 ad /*
1087 1.1 ad * Complain if the status bits aren't what we expect.
1088 1.1 ad */
1089 1.1 ad static int
1090 1.1 ad twe_status_check(struct twe_softc *sc, u_int status)
1091 1.1 ad {
1092 1.1 ad int rv;
1093 1.1 ad
1094 1.1 ad rv = 0;
1095 1.1 ad
1096 1.1 ad if ((status & TWE_STS_EXPECTED_BITS) != TWE_STS_EXPECTED_BITS) {
1097 1.1 ad printf("%s: missing status bits: 0x%08x\n", sc->sc_dv.dv_xname,
1098 1.1 ad status & ~TWE_STS_EXPECTED_BITS);
1099 1.1 ad rv = -1;
1100 1.1 ad }
1101 1.1 ad
1102 1.1 ad if ((status & TWE_STS_UNEXPECTED_BITS) != 0) {
1103 1.1 ad printf("%s: unexpected status bits: 0x%08x\n",
1104 1.1 ad sc->sc_dv.dv_xname, status & TWE_STS_UNEXPECTED_BITS);
1105 1.1 ad rv = -1;
1106 1.1 ad }
1107 1.1 ad
1108 1.1 ad return (rv);
1109 1.1 ad }
1110 1.1 ad
1111 1.1 ad /*
1112 1.1 ad * Allocate and initialise a CCB.
1113 1.1 ad */
1114 1.1 ad int
1115 1.3 ad twe_ccb_alloc(struct twe_softc *sc, struct twe_ccb **ccbp, int flags)
1116 1.1 ad {
1117 1.1 ad struct twe_cmd *tc;
1118 1.1 ad struct twe_ccb *ccb;
1119 1.1 ad int s;
1120 1.1 ad
1121 1.7 ad s = splbio();
1122 1.3 ad if ((flags & TWE_CCB_PARAM) != 0)
1123 1.3 ad ccb = sc->sc_ccbs;
1124 1.3 ad else {
1125 1.3 ad /* Allocate a CCB and command block. */
1126 1.3 ad if (SLIST_FIRST(&sc->sc_ccb_freelist) == NULL) {
1127 1.1 ad splx(s);
1128 1.1 ad return (EAGAIN);
1129 1.1 ad }
1130 1.3 ad ccb = SLIST_FIRST(&sc->sc_ccb_freelist);
1131 1.3 ad SLIST_REMOVE_HEAD(&sc->sc_ccb_freelist, ccb_chain.slist);
1132 1.1 ad }
1133 1.3 ad #ifdef DIAGNOSTIC
1134 1.3 ad if ((ccb->ccb_flags & TWE_CCB_ALLOCED) != 0)
1135 1.3 ad panic("twe_ccb_alloc: CCB already allocated");
1136 1.3 ad flags |= TWE_CCB_ALLOCED;
1137 1.3 ad #endif
1138 1.7 ad splx(s);
1139 1.1 ad
1140 1.1 ad /* Initialise some fields and return. */
1141 1.1 ad ccb->ccb_tx.tx_handler = NULL;
1142 1.3 ad ccb->ccb_flags = flags;
1143 1.1 ad tc = ccb->ccb_cmd;
1144 1.1 ad tc->tc_status = 0;
1145 1.1 ad tc->tc_flags = 0;
1146 1.1 ad tc->tc_cmdid = ccb->ccb_cmdid;
1147 1.3 ad *ccbp = ccb;
1148 1.1 ad
1149 1.1 ad return (0);
1150 1.1 ad }
1151 1.1 ad
1152 1.1 ad /*
1153 1.3 ad * Free a CCB.
1154 1.1 ad */
1155 1.1 ad void
1156 1.2 ad twe_ccb_free(struct twe_softc *sc, struct twe_ccb *ccb)
1157 1.1 ad {
1158 1.1 ad int s;
1159 1.1 ad
1160 1.3 ad s = splbio();
1161 1.3 ad if ((ccb->ccb_flags & TWE_CCB_PARAM) == 0)
1162 1.3 ad SLIST_INSERT_HEAD(&sc->sc_ccb_freelist, ccb, ccb_chain.slist);
1163 1.1 ad ccb->ccb_flags = 0;
1164 1.1 ad splx(s);
1165 1.1 ad }
1166 1.1 ad
1167 1.1 ad /*
1168 1.1 ad * Map the specified CCB's command block and data buffer (if any) into
1169 1.1 ad * controller visible space. Perform DMA synchronisation.
1170 1.1 ad */
1171 1.1 ad int
1172 1.1 ad twe_ccb_map(struct twe_softc *sc, struct twe_ccb *ccb)
1173 1.1 ad {
1174 1.1 ad struct twe_cmd *tc;
1175 1.20 ad int flags, nsegs, i, s, rv;
1176 1.1 ad void *data;
1177 1.1 ad
1178 1.7 ad /*
1179 1.7 ad * The data as a whole must be 512-byte aligned.
1180 1.7 ad */
1181 1.1 ad if (((u_long)ccb->ccb_data & (TWE_ALIGNMENT - 1)) != 0) {
1182 1.20 ad s = splvm();
1183 1.20 ad /* XXX */
1184 1.20 ad ccb->ccb_abuf = uvm_km_kmemalloc(kmem_map, NULL,
1185 1.20 ad ccb->ccb_datasize, UVM_KMF_NOWAIT);
1186 1.20 ad splx(s);
1187 1.20 ad data = (void *)ccb->ccb_abuf;
1188 1.2 ad if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
1189 1.2 ad memcpy(data, ccb->ccb_data, ccb->ccb_datasize);
1190 1.1 ad } else {
1191 1.20 ad ccb->ccb_abuf = (vaddr_t)0;
1192 1.1 ad data = ccb->ccb_data;
1193 1.1 ad }
1194 1.1 ad
1195 1.7 ad /*
1196 1.7 ad * Map the data buffer into bus space and build the S/G list.
1197 1.7 ad */
1198 1.7 ad rv = bus_dmamap_load(sc->sc_dmat, ccb->ccb_dmamap_xfer, data,
1199 1.16 thorpej ccb->ccb_datasize, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING |
1200 1.16 thorpej ((ccb->ccb_flags & TWE_CCB_DATA_IN) ?
1201 1.22 ad BUS_DMA_READ : BUS_DMA_WRITE));
1202 1.7 ad if (rv != 0) {
1203 1.20 ad if (ccb->ccb_abuf != (vaddr_t)0) {
1204 1.20 ad s = splvm();
1205 1.20 ad /* XXX */
1206 1.20 ad uvm_km_free(kmem_map, ccb->ccb_abuf,
1207 1.7 ad ccb->ccb_datasize);
1208 1.20 ad splx(s);
1209 1.7 ad }
1210 1.7 ad return (rv);
1211 1.7 ad }
1212 1.1 ad
1213 1.1 ad nsegs = ccb->ccb_dmamap_xfer->dm_nsegs;
1214 1.1 ad tc = ccb->ccb_cmd;
1215 1.1 ad tc->tc_size += 2 * nsegs;
1216 1.1 ad
1217 1.1 ad /* The location of the S/G list is dependant upon command type. */
1218 1.1 ad switch (tc->tc_opcode >> 5) {
1219 1.1 ad case 2:
1220 1.1 ad for (i = 0; i < nsegs; i++) {
1221 1.1 ad tc->tc_args.param.sgl[i].tsg_address =
1222 1.1 ad htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
1223 1.1 ad tc->tc_args.param.sgl[i].tsg_length =
1224 1.1 ad htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
1225 1.1 ad }
1226 1.1 ad /* XXX Needed? */
1227 1.1 ad for (; i < TWE_SG_SIZE; i++) {
1228 1.1 ad tc->tc_args.param.sgl[i].tsg_address = 0;
1229 1.1 ad tc->tc_args.param.sgl[i].tsg_length = 0;
1230 1.1 ad }
1231 1.1 ad break;
1232 1.1 ad case 3:
1233 1.1 ad for (i = 0; i < nsegs; i++) {
1234 1.1 ad tc->tc_args.io.sgl[i].tsg_address =
1235 1.1 ad htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr);
1236 1.1 ad tc->tc_args.io.sgl[i].tsg_length =
1237 1.1 ad htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len);
1238 1.1 ad }
1239 1.1 ad /* XXX Needed? */
1240 1.1 ad for (; i < TWE_SG_SIZE; i++) {
1241 1.1 ad tc->tc_args.io.sgl[i].tsg_address = 0;
1242 1.1 ad tc->tc_args.io.sgl[i].tsg_length = 0;
1243 1.1 ad }
1244 1.1 ad break;
1245 1.1 ad #ifdef DEBUG
1246 1.1 ad default:
1247 1.1 ad panic("twe_ccb_map: oops");
1248 1.1 ad #endif
1249 1.1 ad }
1250 1.1 ad
1251 1.1 ad if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
1252 1.1 ad flags = BUS_DMASYNC_PREREAD;
1253 1.1 ad else
1254 1.1 ad flags = 0;
1255 1.1 ad if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
1256 1.1 ad flags |= BUS_DMASYNC_PREWRITE;
1257 1.1 ad
1258 1.1 ad bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
1259 1.1 ad ccb->ccb_datasize, flags);
1260 1.1 ad return (0);
1261 1.1 ad }
1262 1.1 ad
1263 1.1 ad /*
1264 1.1 ad * Unmap the specified CCB's command block and data buffer (if any) and
1265 1.1 ad * perform DMA synchronisation.
1266 1.1 ad */
1267 1.1 ad void
1268 1.1 ad twe_ccb_unmap(struct twe_softc *sc, struct twe_ccb *ccb)
1269 1.1 ad {
1270 1.20 ad int flags, s;
1271 1.1 ad
1272 1.1 ad if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
1273 1.1 ad flags = BUS_DMASYNC_POSTREAD;
1274 1.1 ad else
1275 1.1 ad flags = 0;
1276 1.1 ad if ((ccb->ccb_flags & TWE_CCB_DATA_OUT) != 0)
1277 1.1 ad flags |= BUS_DMASYNC_POSTWRITE;
1278 1.1 ad
1279 1.1 ad bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0,
1280 1.1 ad ccb->ccb_datasize, flags);
1281 1.1 ad bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap_xfer);
1282 1.1 ad
1283 1.20 ad if (ccb->ccb_abuf != (vaddr_t)0) {
1284 1.2 ad if ((ccb->ccb_flags & TWE_CCB_DATA_IN) != 0)
1285 1.20 ad memcpy(ccb->ccb_data, (void *)ccb->ccb_abuf,
1286 1.2 ad ccb->ccb_datasize);
1287 1.20 ad s = splvm();
1288 1.20 ad /* XXX */
1289 1.20 ad uvm_km_free(kmem_map, ccb->ccb_abuf, ccb->ccb_datasize);
1290 1.20 ad splx(s);
1291 1.1 ad }
1292 1.1 ad }
1293 1.1 ad
1294 1.1 ad /*
1295 1.7 ad * Submit a command to the controller and poll on completion. Return
1296 1.7 ad * non-zero on timeout (but don't check status, as some command types don't
1297 1.7 ad * return status). Must be called with interrupts blocked.
1298 1.1 ad */
1299 1.1 ad int
1300 1.1 ad twe_ccb_poll(struct twe_softc *sc, struct twe_ccb *ccb, int timo)
1301 1.1 ad {
1302 1.7 ad int rv;
1303 1.7 ad
1304 1.7 ad if ((rv = twe_ccb_submit(sc, ccb)) != 0)
1305 1.7 ad return (rv);
1306 1.1 ad
1307 1.15 ad for (timo *= 1000; timo != 0; timo--) {
1308 1.1 ad twe_poll(sc);
1309 1.1 ad if ((ccb->ccb_flags & TWE_CCB_COMPLETE) != 0)
1310 1.1 ad break;
1311 1.15 ad DELAY(100);
1312 1.1 ad }
1313 1.1 ad
1314 1.1 ad return (timo == 0);
1315 1.1 ad }
1316 1.1 ad
1317 1.1 ad /*
1318 1.1 ad * If a CCB is specified, enqueue it. Pull CCBs off the software queue in
1319 1.1 ad * the order that they were enqueued and try to submit their command blocks
1320 1.1 ad * to the controller for execution.
1321 1.1 ad */
1322 1.1 ad void
1323 1.1 ad twe_ccb_enqueue(struct twe_softc *sc, struct twe_ccb *ccb)
1324 1.1 ad {
1325 1.1 ad int s;
1326 1.1 ad
1327 1.1 ad s = splbio();
1328 1.1 ad
1329 1.1 ad if (ccb != NULL)
1330 1.1 ad SIMPLEQ_INSERT_TAIL(&sc->sc_ccb_queue, ccb, ccb_chain.simpleq);
1331 1.1 ad
1332 1.1 ad while ((ccb = SIMPLEQ_FIRST(&sc->sc_ccb_queue)) != NULL) {
1333 1.1 ad if (twe_ccb_submit(sc, ccb))
1334 1.1 ad break;
1335 1.25 lukem SIMPLEQ_REMOVE_HEAD(&sc->sc_ccb_queue, ccb_chain.simpleq);
1336 1.1 ad }
1337 1.1 ad
1338 1.1 ad splx(s);
1339 1.1 ad }
1340 1.1 ad
1341 1.1 ad /*
1342 1.1 ad * Submit the command block associated with the specified CCB to the
1343 1.1 ad * controller for execution. Must be called with interrupts blocked.
1344 1.1 ad */
1345 1.1 ad int
1346 1.1 ad twe_ccb_submit(struct twe_softc *sc, struct twe_ccb *ccb)
1347 1.1 ad {
1348 1.1 ad bus_addr_t pa;
1349 1.1 ad int rv;
1350 1.1 ad u_int status;
1351 1.1 ad
1352 1.1 ad /* Check to see if we can post a command. */
1353 1.22 ad status = twe_inl(sc, TWE_REG_STS);
1354 1.1 ad twe_status_check(sc, status);
1355 1.1 ad
1356 1.1 ad if ((status & TWE_STS_CMD_QUEUE_FULL) == 0) {
1357 1.1 ad bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap,
1358 1.1 ad (caddr_t)ccb->ccb_cmd - sc->sc_cmds, sizeof(struct twe_cmd),
1359 1.1 ad BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
1360 1.1 ad ccb->ccb_flags |= TWE_CCB_ACTIVE;
1361 1.1 ad pa = sc->sc_cmds_paddr +
1362 1.1 ad ccb->ccb_cmdid * sizeof(struct twe_cmd);
1363 1.22 ad twe_outl(sc, TWE_REG_CMD_QUEUE, (u_int32_t)pa);
1364 1.1 ad rv = 0;
1365 1.1 ad } else
1366 1.1 ad rv = EBUSY;
1367 1.1 ad
1368 1.1 ad return (rv);
1369 1.33 christos }
1370 1.33 christos
1371 1.33 christos
1372 1.33 christos /*
1373 1.33 christos * Accept an open operation on the control device.
1374 1.33 christos */
1375 1.33 christos int
1376 1.37 fvdl tweopen(dev_t dev, int flag, int mode, struct proc *p)
1377 1.33 christos {
1378 1.33 christos struct twe_softc *twe;
1379 1.33 christos
1380 1.33 christos if ((twe = device_lookup(&twe_cd, minor(dev))) == NULL)
1381 1.33 christos return (ENXIO);
1382 1.33 christos if ((twe->sc_flags & TWEF_OPEN) != 0)
1383 1.33 christos return (EBUSY);
1384 1.33 christos
1385 1.33 christos twe->sc_flags |= TWEF_OPEN;
1386 1.33 christos return (0);
1387 1.33 christos }
1388 1.33 christos
1389 1.33 christos /*
1390 1.33 christos * Accept the last close on the control device.
1391 1.33 christos */
1392 1.33 christos int
1393 1.37 fvdl tweclose(dev_t dev, int flag, int mode, struct proc *p)
1394 1.33 christos {
1395 1.33 christos struct twe_softc *twe;
1396 1.33 christos
1397 1.33 christos twe = device_lookup(&twe_cd, minor(dev));
1398 1.33 christos twe->sc_flags &= ~TWEF_OPEN;
1399 1.33 christos return (0);
1400 1.33 christos }
1401 1.33 christos
1402 1.33 christos /*
1403 1.33 christos * Handle control operations.
1404 1.33 christos */
1405 1.33 christos int
1406 1.37 fvdl tweioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
1407 1.33 christos {
1408 1.33 christos struct twe_softc *twe;
1409 1.33 christos struct twe_ccb *ccb;
1410 1.33 christos struct twe_param *param;
1411 1.33 christos struct twe_usercommand *tu;
1412 1.33 christos struct twe_paramcommand *tp;
1413 1.33 christos union twe_statrequest *ts;
1414 1.33 christos void *pdata = NULL;
1415 1.33 christos int rv, s, error = 0;
1416 1.33 christos u_int8_t cmdid;
1417 1.33 christos
1418 1.33 christos if (securelevel >= 2)
1419 1.33 christos return (EPERM);
1420 1.33 christos
1421 1.33 christos twe = device_lookup(&twe_cd, minor(dev));
1422 1.33 christos tu = (struct twe_usercommand *)data;
1423 1.33 christos tp = (struct twe_paramcommand *)data;
1424 1.33 christos ts = (union twe_statrequest *)data;
1425 1.33 christos
1426 1.33 christos /* Hmm, compatible with FreeBSD */
1427 1.33 christos switch (cmd) {
1428 1.33 christos case TWEIO_COMMAND:
1429 1.33 christos if (tu->tu_size > 0) {
1430 1.33 christos if (tu->tu_size > TWE_SECTOR_SIZE)
1431 1.33 christos return EINVAL;
1432 1.33 christos pdata = malloc(tu->tu_size, M_DEVBUF, M_WAITOK);
1433 1.33 christos error = copyin(tu->tu_data, pdata, tu->tu_size);
1434 1.33 christos if (error != 0)
1435 1.33 christos goto done;
1436 1.33 christos error = twe_ccb_alloc(twe, &ccb, TWE_CCB_PARAM |
1437 1.33 christos TWE_CCB_DATA_IN | TWE_CCB_DATA_OUT);
1438 1.33 christos } else {
1439 1.33 christos error = twe_ccb_alloc(twe, &ccb, 0);
1440 1.33 christos }
1441 1.33 christos if (rv != 0)
1442 1.33 christos goto done;
1443 1.33 christos cmdid = ccb->ccb_cmdid;
1444 1.33 christos memcpy(ccb->ccb_cmd, &tu->tu_cmd, sizeof(struct twe_cmd));
1445 1.33 christos ccb->ccb_cmdid = cmdid;
1446 1.33 christos if (ccb->ccb_flags & TWE_CCB_PARAM) {
1447 1.33 christos ccb->ccb_data = pdata;
1448 1.33 christos ccb->ccb_datasize = TWE_SECTOR_SIZE;
1449 1.33 christos ccb->ccb_tx.tx_handler = 0;
1450 1.33 christos ccb->ccb_tx.tx_context = pdata;
1451 1.33 christos ccb->ccb_tx.tx_dv = &twe->sc_dv;
1452 1.33 christos }
1453 1.33 christos /* Map the transfer. */
1454 1.33 christos if ((error = twe_ccb_map(twe, ccb)) != 0) {
1455 1.33 christos twe_ccb_free(twe, ccb);
1456 1.33 christos goto done;
1457 1.33 christos }
1458 1.33 christos
1459 1.33 christos /* Submit the command and wait. */
1460 1.33 christos s = splbio();
1461 1.33 christos rv = twe_ccb_poll(twe, ccb, 5);
1462 1.33 christos twe_ccb_unmap(twe, ccb);
1463 1.33 christos twe_ccb_free(twe, ccb);
1464 1.33 christos splx(s);
1465 1.33 christos
1466 1.33 christos if (tu->tu_size > 0)
1467 1.33 christos error = copyout(pdata, tu->tu_data, tu->tu_size);
1468 1.33 christos goto done;
1469 1.33 christos
1470 1.33 christos case TWEIO_STATS:
1471 1.33 christos return (ENOENT);
1472 1.33 christos
1473 1.33 christos case TWEIO_AEN_POLL:
1474 1.45 thorpej s = splbio();
1475 1.45 thorpej *(u_int *)data = twe_aen_dequeue(twe);
1476 1.45 thorpej splx(s);
1477 1.33 christos return (0);
1478 1.33 christos
1479 1.33 christos case TWEIO_AEN_WAIT:
1480 1.33 christos s = splbio();
1481 1.45 thorpej while ((*(u_int *)data =
1482 1.45 thorpej twe_aen_dequeue(twe)) == TWE_AEN_QUEUE_EMPTY) {
1483 1.45 thorpej twe->sc_flags |= TWEF_AENQ_WAIT;
1484 1.45 thorpej error = tsleep(&twe->sc_aen_queue, PRIBIO | PCATCH,
1485 1.45 thorpej "tweaen", 0);
1486 1.45 thorpej if (error == EINTR) {
1487 1.45 thorpej splx(s);
1488 1.45 thorpej return (error);
1489 1.45 thorpej }
1490 1.33 christos }
1491 1.33 christos splx(s);
1492 1.33 christos return (0);
1493 1.33 christos
1494 1.33 christos case TWEIO_GET_PARAM:
1495 1.33 christos error = twe_param_get(twe, tp->tp_table_id, tp->tp_param_id,
1496 1.39 jdolecek tp->tp_size, 0, ¶m);
1497 1.33 christos if (error != 0)
1498 1.33 christos return (error);
1499 1.33 christos if (param->tp_param_size > tp->tp_size) {
1500 1.33 christos error = EFAULT;
1501 1.33 christos goto done;
1502 1.33 christos }
1503 1.33 christos error = copyout(param->tp_data, tp->tp_data,
1504 1.33 christos param->tp_param_size);
1505 1.33 christos goto done;
1506 1.33 christos
1507 1.33 christos case TWEIO_SET_PARAM:
1508 1.33 christos pdata = malloc(tp->tp_size, M_DEVBUF, M_WAITOK);
1509 1.33 christos if ((error = copyin(tp->tp_data, pdata, tp->tp_size)) != 0)
1510 1.33 christos goto done;
1511 1.33 christos error = twe_param_set(twe, tp->tp_table_id, tp->tp_param_id,
1512 1.33 christos tp->tp_size, pdata);
1513 1.33 christos goto done;
1514 1.33 christos
1515 1.33 christos case TWEIO_RESET:
1516 1.33 christos twe_reset(twe);
1517 1.33 christos return (0);
1518 1.33 christos
1519 1.33 christos default:
1520 1.33 christos return EINVAL;
1521 1.33 christos }
1522 1.33 christos done:
1523 1.33 christos if (pdata)
1524 1.33 christos free(pdata, M_DEVBUF);
1525 1.33 christos return error;
1526 1.38 jdolecek }
1527 1.38 jdolecek
1528 1.38 jdolecek /*
1529 1.38 jdolecek * Print some information about the controller
1530 1.38 jdolecek */
1531 1.38 jdolecek static void
1532 1.38 jdolecek twe_describe_controller(struct twe_softc *sc)
1533 1.38 jdolecek {
1534 1.41 thorpej struct twe_param *p[6];
1535 1.44 thorpej int i, rv = 0;
1536 1.44 thorpej uint32_t dsize;
1537 1.41 thorpej uint8_t ports;
1538 1.41 thorpej
1539 1.38 jdolecek /* get the port count */
1540 1.41 thorpej rv |= twe_param_get_1(sc, TWE_PARAM_CONTROLLER,
1541 1.41 thorpej TWE_PARAM_CONTROLLER_PortCount, &ports);
1542 1.38 jdolecek
1543 1.38 jdolecek /* get version strings */
1544 1.38 jdolecek rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_Mon,
1545 1.41 thorpej 16, NULL, &p[0]);
1546 1.41 thorpej rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_FW,
1547 1.38 jdolecek 16, NULL, &p[1]);
1548 1.41 thorpej rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_BIOS,
1549 1.38 jdolecek 16, NULL, &p[2]);
1550 1.38 jdolecek rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCB,
1551 1.41 thorpej 8, NULL, &p[3]);
1552 1.41 thorpej rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_ATA,
1553 1.38 jdolecek 8, NULL, &p[4]);
1554 1.41 thorpej rv |= twe_param_get(sc, TWE_PARAM_VERSION, TWE_PARAM_VERSION_PCI,
1555 1.38 jdolecek 8, NULL, &p[5]);
1556 1.38 jdolecek
1557 1.38 jdolecek if (rv) {
1558 1.38 jdolecek /* some error occurred */
1559 1.38 jdolecek aprint_error("%s: failed to fetch version information\n",
1560 1.38 jdolecek sc->sc_dv.dv_xname);
1561 1.38 jdolecek return;
1562 1.38 jdolecek }
1563 1.38 jdolecek
1564 1.38 jdolecek aprint_normal("%s: %d ports, Firmware %.16s, BIOS %.16s\n",
1565 1.41 thorpej sc->sc_dv.dv_xname, ports,
1566 1.41 thorpej p[1]->tp_data, p[2]->tp_data);
1567 1.38 jdolecek
1568 1.38 jdolecek aprint_verbose("%s: Monitor %.16s, PCB %.8s, Achip %.8s, Pchip %.8s\n",
1569 1.38 jdolecek sc->sc_dv.dv_xname,
1570 1.41 thorpej p[0]->tp_data, p[3]->tp_data,
1571 1.41 thorpej p[4]->tp_data, p[5]->tp_data);
1572 1.38 jdolecek
1573 1.38 jdolecek free(p[0], M_DEVBUF);
1574 1.38 jdolecek free(p[1], M_DEVBUF);
1575 1.38 jdolecek free(p[2], M_DEVBUF);
1576 1.38 jdolecek free(p[3], M_DEVBUF);
1577 1.38 jdolecek free(p[4], M_DEVBUF);
1578 1.38 jdolecek free(p[5], M_DEVBUF);
1579 1.44 thorpej
1580 1.44 thorpej rv = twe_param_get(sc, TWE_PARAM_DRIVESUMMARY,
1581 1.44 thorpej TWE_PARAM_DRIVESUMMARY_Status, 16, NULL, &p[0]);
1582 1.44 thorpej if (rv) {
1583 1.44 thorpej aprint_error("%s: failed to get drive status summary\n",
1584 1.44 thorpej sc->sc_dv.dv_xname);
1585 1.44 thorpej return;
1586 1.44 thorpej }
1587 1.44 thorpej for (i = 0; i < ports; i++) {
1588 1.44 thorpej if (p[0]->tp_data[i] != TWE_PARAM_DRIVESTATUS_Present)
1589 1.44 thorpej continue;
1590 1.44 thorpej rv = twe_param_get_4(sc, TWE_PARAM_DRIVEINFO + i,
1591 1.44 thorpej TWE_PARAM_DRIVEINFO_Size, &dsize);
1592 1.44 thorpej if (rv) {
1593 1.44 thorpej aprint_error(
1594 1.44 thorpej "%s: unable to get drive size for port %d\n",
1595 1.44 thorpej sc->sc_dv.dv_xname, i);
1596 1.44 thorpej continue;
1597 1.44 thorpej }
1598 1.44 thorpej rv = twe_param_get(sc, TWE_PARAM_DRIVEINFO + i,
1599 1.44 thorpej TWE_PARAM_DRIVEINFO_Model, 40, NULL, &p[1]);
1600 1.44 thorpej if (rv) {
1601 1.44 thorpej aprint_error(
1602 1.44 thorpej "%s: unable to get drive model for port %d\n",
1603 1.44 thorpej sc->sc_dv.dv_xname, i);
1604 1.44 thorpej continue;
1605 1.44 thorpej }
1606 1.44 thorpej aprint_verbose("%s: port %d: %.40s %d MB\n", sc->sc_dv.dv_xname,
1607 1.44 thorpej i, p[1]->tp_data, dsize / 2048);
1608 1.44 thorpej free(p[1], M_DEVBUF);
1609 1.44 thorpej }
1610 1.44 thorpej free(p[0], M_DEVBUF);
1611 1.1 ad }
1612