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