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