1 /*-
2  * Copyright (c) 1999,2000 Michael Smith
3  * Copyright (c) 2000 BSDi
4  * Copyright (c) 2005 Scott Long
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without
8  * modification, are permitted provided that the following conditions
9  * are met:
10  * 1. Redistributions of source code must retain the above copyright
11  *    notice, this list of conditions and the following disclaimer.
12  * 2. Redistributions in binary form must reproduce the above copyright
13  *    notice, this list of conditions and the following disclaimer in the
14  *    documentation and/or other materials provided with the distribution.
15  *
16  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26  * SUCH DAMAGE.
27  */
28 /*-
29  * Copyright (c) 2002 Eric Moore
30  * Copyright (c) 2002, 2004 LSI Logic Corporation
31  * All rights reserved.
32  *
33  * Redistribution and use in source and binary forms, with or without
34  * modification, are permitted provided that the following conditions
35  * are met:
36  * 1. Redistributions of source code must retain the above copyright
37  *    notice, this list of conditions and the following disclaimer.
38  * 2. Redistributions in binary form must reproduce the above copyright
39  *    notice, this list of conditions and the following disclaimer in the
40  *    documentation and/or other materials provided with the distribution.
41  * 3. The party using or redistributing the source code and binary forms
42  *    agrees to the disclaimer below and the terms and conditions set forth
43  *    herein.
44  *
45  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
46  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
49  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
50  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
51  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
52  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
53  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
54  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
55  * SUCH DAMAGE.
56  */
57 
58 #include <sys/cdefs.h>
59 __FBSDID("$FreeBSD: stable/9/sys/dev/amr/amr.c 249132 2013-04-05 08:22:11Z mav $");
60 
61 /*
62  * Driver for the AMI MegaRaid family of controllers.
63  */
64 
65 #include <sys/param.h>
66 #include <sys/systm.h>
67 #include <sys/malloc.h>
68 #include <sys/kernel.h>
69 #include <sys/proc.h>
70 #include <sys/sysctl.h>
71 
72 #include <sys/bio.h>
73 #include <sys/bus.h>
74 #include <sys/conf.h>
75 #include <sys/stat.h>
76 
77 #include <machine/bus.h>
78 #include <machine/cpu.h>
79 #include <machine/resource.h>
80 #include <sys/rman.h>
81 
82 #include <dev/pci/pcireg.h>
83 #include <dev/pci/pcivar.h>
84 
85 #include <dev/amr/amrio.h>
86 #include <dev/amr/amrreg.h>
87 #include <dev/amr/amrvar.h>
88 #define AMR_DEFINE_TABLES
89 #include <dev/amr/amr_tables.h>
90 
91 SYSCTL_NODE(_hw, OID_AUTO, amr, CTLFLAG_RD, 0, "AMR driver parameters");
92 
93 static d_open_t         amr_open;
94 static d_close_t        amr_close;
95 static d_ioctl_t        amr_ioctl;
96 
97 static struct cdevsw amr_cdevsw = {
98 	.d_version =	D_VERSION,
99 	.d_flags =	D_NEEDGIANT,
100 	.d_open =	amr_open,
101 	.d_close =	amr_close,
102 	.d_ioctl =	amr_ioctl,
103 	.d_name =	"amr",
104 };
105 
106 int linux_no_adapter = 0;
107 /*
108  * Initialisation, bus interface.
109  */
110 static void	amr_startup(void *arg);
111 
112 /*
113  * Command wrappers
114  */
115 static int	amr_query_controller(struct amr_softc *sc);
116 static void	*amr_enquiry(struct amr_softc *sc, size_t bufsize,
117 			     u_int8_t cmd, u_int8_t cmdsub, u_int8_t cmdqual, int *status);
118 static void	amr_completeio(struct amr_command *ac);
119 static int	amr_support_ext_cdb(struct amr_softc *sc);
120 
121 /*
122  * Command buffer allocation.
123  */
124 static void	amr_alloccmd_cluster(struct amr_softc *sc);
125 static void	amr_freecmd_cluster(struct amr_command_cluster *acc);
126 
127 /*
128  * Command processing.
129  */
130 static int	amr_bio_command(struct amr_softc *sc, struct amr_command **acp);
131 static int	amr_wait_command(struct amr_command *ac) __unused;
132 static int	amr_mapcmd(struct amr_command *ac);
133 static void	amr_unmapcmd(struct amr_command *ac);
134 static int	amr_start(struct amr_command *ac);
135 static void	amr_complete(void *context, ac_qhead_t *head);
136 static void	amr_setup_sg(void *arg, bus_dma_segment_t *segs, int nsegments, int error);
137 static void	amr_setup_data(void *arg, bus_dma_segment_t *segs, int nsegments, int error);
138 static void	amr_setup_ccb(void *arg, bus_dma_segment_t *segs, int nsegments, int error);
139 static void	amr_abort_load(struct amr_command *ac);
140 
141 /*
142  * Status monitoring
143  */
144 static void	amr_periodic(void *data);
145 
146 /*
147  * Interface-specific shims
148  */
149 static int	amr_quartz_submit_command(struct amr_command *ac);
150 static int	amr_quartz_get_work(struct amr_softc *sc, struct amr_mailbox *mbsave);
151 static int	amr_quartz_poll_command(struct amr_command *ac);
152 static int	amr_quartz_poll_command1(struct amr_softc *sc, struct amr_command *ac);
153 
154 static int	amr_std_submit_command(struct amr_command *ac);
155 static int	amr_std_get_work(struct amr_softc *sc, struct amr_mailbox *mbsave);
156 static int	amr_std_poll_command(struct amr_command *ac);
157 static void	amr_std_attach_mailbox(struct amr_softc *sc);
158 
159 #ifdef AMR_BOARD_INIT
160 static int	amr_quartz_init(struct amr_softc *sc);
161 static int	amr_std_init(struct amr_softc *sc);
162 #endif
163 
164 /*
165  * Debugging
166  */
167 static void	amr_describe_controller(struct amr_softc *sc);
168 #ifdef AMR_DEBUG
169 #if 0
170 static void	amr_printcommand(struct amr_command *ac);
171 #endif
172 #endif
173 
174 static void	amr_init_sysctl(struct amr_softc *sc);
175 static int	amr_linux_ioctl_int(struct cdev *dev, u_long cmd, caddr_t addr,
176 		    int32_t flag, struct thread *td);
177 
178 static MALLOC_DEFINE(M_AMR, "amr", "AMR memory");
179 
180 /********************************************************************************
181  ********************************************************************************
182                                                                       Inline Glue
183  ********************************************************************************
184  ********************************************************************************/
185 
186 /********************************************************************************
187  ********************************************************************************
188                                                                 Public Interfaces
189  ********************************************************************************
190  ********************************************************************************/
191 
192 /********************************************************************************
193  * Initialise the controller and softc.
194  */
195 int
amr_attach(struct amr_softc * sc)196 amr_attach(struct amr_softc *sc)
197 {
198     device_t child;
199 
200     debug_called(1);
201 
202     /*
203      * Initialise per-controller queues.
204      */
205     amr_init_qhead(&sc->amr_freecmds);
206     amr_init_qhead(&sc->amr_ready);
207     TAILQ_INIT(&sc->amr_cmd_clusters);
208     bioq_init(&sc->amr_bioq);
209 
210     debug(2, "queue init done");
211 
212     /*
213      * Configure for this controller type.
214      */
215     if (AMR_IS_QUARTZ(sc)) {
216 	sc->amr_submit_command = amr_quartz_submit_command;
217 	sc->amr_get_work       = amr_quartz_get_work;
218 	sc->amr_poll_command   = amr_quartz_poll_command;
219 	sc->amr_poll_command1  = amr_quartz_poll_command1;
220     } else {
221 	sc->amr_submit_command = amr_std_submit_command;
222 	sc->amr_get_work       = amr_std_get_work;
223 	sc->amr_poll_command   = amr_std_poll_command;
224 	amr_std_attach_mailbox(sc);
225     }
226 
227 #ifdef AMR_BOARD_INIT
228     if ((AMR_IS_QUARTZ(sc) ? amr_quartz_init(sc) : amr_std_init(sc)))
229 	return(ENXIO);
230 #endif
231 
232     /*
233      * Allocate initial commands.
234      */
235     amr_alloccmd_cluster(sc);
236 
237     /*
238      * Quiz controller for features and limits.
239      */
240     if (amr_query_controller(sc))
241 	return(ENXIO);
242 
243     debug(2, "controller query complete");
244 
245     /*
246      * preallocate the remaining commands.
247      */
248     while (sc->amr_nextslot < sc->amr_maxio)
249 	amr_alloccmd_cluster(sc);
250 
251     /*
252      * Setup sysctls.
253      */
254     amr_init_sysctl(sc);
255 
256     /*
257      * Attach our 'real' SCSI channels to CAM.
258      */
259     child = device_add_child(sc->amr_dev, "amrp", -1);
260     sc->amr_pass = child;
261     if (child != NULL) {
262 	device_set_softc(child, sc);
263 	device_set_desc(child, "SCSI Passthrough Bus");
264 	bus_generic_attach(sc->amr_dev);
265     }
266 
267     /*
268      * Create the control device.
269      */
270     sc->amr_dev_t = make_dev(&amr_cdevsw, device_get_unit(sc->amr_dev), UID_ROOT, GID_OPERATOR,
271 			     S_IRUSR | S_IWUSR, "amr%d", device_get_unit(sc->amr_dev));
272     sc->amr_dev_t->si_drv1 = sc;
273     linux_no_adapter++;
274     if (device_get_unit(sc->amr_dev) == 0)
275 	make_dev_alias(sc->amr_dev_t, "megadev0");
276 
277     /*
278      * Schedule ourselves to bring the controller up once interrupts are
279      * available.
280      */
281     bzero(&sc->amr_ich, sizeof(struct intr_config_hook));
282     sc->amr_ich.ich_func = amr_startup;
283     sc->amr_ich.ich_arg = sc;
284     if (config_intrhook_establish(&sc->amr_ich) != 0) {
285 	device_printf(sc->amr_dev, "can't establish configuration hook\n");
286 	return(ENOMEM);
287     }
288 
289     /*
290      * Print a little information about the controller.
291      */
292     amr_describe_controller(sc);
293 
294     debug(2, "attach complete");
295     return(0);
296 }
297 
298 /********************************************************************************
299  * Locate disk resources and attach children to them.
300  */
301 static void
amr_startup(void * arg)302 amr_startup(void *arg)
303 {
304     struct amr_softc	*sc = (struct amr_softc *)arg;
305     struct amr_logdrive	*dr;
306     int			i, error;
307 
308     debug_called(1);
309 
310     /* pull ourselves off the intrhook chain */
311     if (sc->amr_ich.ich_func)
312 	config_intrhook_disestablish(&sc->amr_ich);
313     sc->amr_ich.ich_func = NULL;
314 
315     /* get up-to-date drive information */
316     if (amr_query_controller(sc)) {
317 	device_printf(sc->amr_dev, "can't scan controller for drives\n");
318 	return;
319     }
320 
321     /* iterate over available drives */
322     for (i = 0, dr = &sc->amr_drive[0]; (i < AMR_MAXLD) && (dr->al_size != 0xffffffff); i++, dr++) {
323 	/* are we already attached to this drive? */
324 	if (dr->al_disk == 0) {
325 	    /* generate geometry information */
326 	    if (dr->al_size > 0x200000) {	/* extended translation? */
327 		dr->al_heads = 255;
328 		dr->al_sectors = 63;
329 	    } else {
330 		dr->al_heads = 64;
331 		dr->al_sectors = 32;
332 	    }
333 	    dr->al_cylinders = dr->al_size / (dr->al_heads * dr->al_sectors);
334 
335 	    dr->al_disk = device_add_child(sc->amr_dev, NULL, -1);
336 	    if (dr->al_disk == 0)
337 		device_printf(sc->amr_dev, "device_add_child failed\n");
338 	    device_set_ivars(dr->al_disk, dr);
339 	}
340     }
341 
342     if ((error = bus_generic_attach(sc->amr_dev)) != 0)
343 	device_printf(sc->amr_dev, "bus_generic_attach returned %d\n", error);
344 
345     /* mark controller back up */
346     sc->amr_state &= ~AMR_STATE_SHUTDOWN;
347 
348     /* interrupts will be enabled before we do anything more */
349     sc->amr_state |= AMR_STATE_INTEN;
350 
351     /*
352      * Start the timeout routine.
353      */
354 /*    sc->amr_timeout = timeout(amr_periodic, sc, hz);*/
355 
356     return;
357 }
358 
359 static void
amr_init_sysctl(struct amr_softc * sc)360 amr_init_sysctl(struct amr_softc *sc)
361 {
362 
363     SYSCTL_ADD_INT(device_get_sysctl_ctx(sc->amr_dev),
364 	SYSCTL_CHILDREN(device_get_sysctl_tree(sc->amr_dev)),
365 	OID_AUTO, "allow_volume_configure", CTLFLAG_RW, &sc->amr_allow_vol_config, 0,
366 	"");
367     SYSCTL_ADD_INT(device_get_sysctl_ctx(sc->amr_dev),
368 	SYSCTL_CHILDREN(device_get_sysctl_tree(sc->amr_dev)),
369 	OID_AUTO, "nextslot", CTLFLAG_RD, &sc->amr_nextslot, 0,
370 	"");
371     SYSCTL_ADD_INT(device_get_sysctl_ctx(sc->amr_dev),
372 	SYSCTL_CHILDREN(device_get_sysctl_tree(sc->amr_dev)),
373 	OID_AUTO, "busyslots", CTLFLAG_RD, &sc->amr_busyslots, 0,
374 	"");
375     SYSCTL_ADD_INT(device_get_sysctl_ctx(sc->amr_dev),
376 	SYSCTL_CHILDREN(device_get_sysctl_tree(sc->amr_dev)),
377 	OID_AUTO, "maxio", CTLFLAG_RD, &sc->amr_maxio, 0,
378 	"");
379 }
380 
381 
382 /*******************************************************************************
383  * Free resources associated with a controller instance
384  */
385 void
amr_free(struct amr_softc * sc)386 amr_free(struct amr_softc *sc)
387 {
388     struct amr_command_cluster	*acc;
389 
390     /* detach from CAM */
391     if (sc->amr_pass != NULL)
392 	device_delete_child(sc->amr_dev, sc->amr_pass);
393 
394     /* cancel status timeout */
395     untimeout(amr_periodic, sc, sc->amr_timeout);
396 
397     /* throw away any command buffers */
398     while ((acc = TAILQ_FIRST(&sc->amr_cmd_clusters)) != NULL) {
399 	TAILQ_REMOVE(&sc->amr_cmd_clusters, acc, acc_link);
400 	amr_freecmd_cluster(acc);
401     }
402 
403     /* destroy control device */
404     if( sc->amr_dev_t != (struct cdev *)NULL)
405 	    destroy_dev(sc->amr_dev_t);
406 
407     if (mtx_initialized(&sc->amr_hw_lock))
408 	mtx_destroy(&sc->amr_hw_lock);
409 
410     if (mtx_initialized(&sc->amr_list_lock))
411 	mtx_destroy(&sc->amr_list_lock);
412 }
413 
414 /*******************************************************************************
415  * Receive a bio structure from a child device and queue it on a particular
416  * disk resource, then poke the disk resource to start as much work as it can.
417  */
418 int
amr_submit_bio(struct amr_softc * sc,struct bio * bio)419 amr_submit_bio(struct amr_softc *sc, struct bio *bio)
420 {
421     debug_called(2);
422 
423     mtx_lock(&sc->amr_list_lock);
424     amr_enqueue_bio(sc, bio);
425     amr_startio(sc);
426     mtx_unlock(&sc->amr_list_lock);
427     return(0);
428 }
429 
430 /********************************************************************************
431  * Accept an open operation on the control device.
432  */
433 static int
amr_open(struct cdev * dev,int flags,int fmt,struct thread * td)434 amr_open(struct cdev *dev, int flags, int fmt, struct thread *td)
435 {
436     int			unit = dev2unit(dev);
437     struct amr_softc	*sc = devclass_get_softc(devclass_find("amr"), unit);
438 
439     debug_called(1);
440 
441     sc->amr_state |= AMR_STATE_OPEN;
442     return(0);
443 }
444 
445 #ifdef LSI
446 static int
amr_del_ld(struct amr_softc * sc,int drv_no,int status)447 amr_del_ld(struct amr_softc *sc, int drv_no, int status)
448 {
449 
450     debug_called(1);
451 
452     sc->amr_state &= ~AMR_STATE_QUEUE_FRZN;
453     sc->amr_state &= ~AMR_STATE_LD_DELETE;
454     sc->amr_state |= AMR_STATE_REMAP_LD;
455     debug(1, "State Set");
456 
457     if (!status) {
458 	debug(1, "disk begin destroyed %d",drv_no);
459 	if (--amr_disks_registered == 0)
460 	    cdevsw_remove(&amrddisk_cdevsw);
461 	debug(1, "disk begin destroyed success");
462     }
463     return 0;
464 }
465 
466 static int
amr_prepare_ld_delete(struct amr_softc * sc)467 amr_prepare_ld_delete(struct amr_softc *sc)
468 {
469 
470     debug_called(1);
471     if (sc->ld_del_supported == 0)
472 	return(ENOIOCTL);
473 
474     sc->amr_state |= AMR_STATE_QUEUE_FRZN;
475     sc->amr_state |= AMR_STATE_LD_DELETE;
476 
477     /* 5 minutes for the all the commands to be flushed.*/
478     tsleep((void *)&sc->ld_del_supported, PCATCH | PRIBIO,"delete_logical_drv",hz * 60 * 1);
479     if ( sc->amr_busyslots )
480 	return(ENOIOCTL);
481 
482     return 0;
483 }
484 #endif
485 
486 /********************************************************************************
487  * Accept the last close on the control device.
488  */
489 static int
amr_close(struct cdev * dev,int flags,int fmt,struct thread * td)490 amr_close(struct cdev *dev, int flags, int fmt, struct thread *td)
491 {
492     int			unit = dev2unit(dev);
493     struct amr_softc	*sc = devclass_get_softc(devclass_find("amr"), unit);
494 
495     debug_called(1);
496 
497     sc->amr_state &= ~AMR_STATE_OPEN;
498     return (0);
499 }
500 
501 /********************************************************************************
502  * Handle controller-specific control operations.
503  */
504 static void
amr_rescan_drives(struct cdev * dev)505 amr_rescan_drives(struct cdev *dev)
506 {
507     struct amr_softc	*sc = (struct amr_softc *)dev->si_drv1;
508     int			i, error = 0;
509 
510     sc->amr_state |= AMR_STATE_REMAP_LD;
511     while (sc->amr_busyslots) {
512 	device_printf(sc->amr_dev, "idle controller\n");
513 	amr_done(sc);
514     }
515 
516     /* mark ourselves as in-shutdown */
517     sc->amr_state |= AMR_STATE_SHUTDOWN;
518 
519     /* flush controller */
520     device_printf(sc->amr_dev, "flushing cache...");
521     printf("%s\n", amr_flush(sc) ? "failed" : "done");
522 
523     /* delete all our child devices */
524     for(i = 0 ; i < AMR_MAXLD; i++) {
525 	if(sc->amr_drive[i].al_disk != 0) {
526 	    if((error = device_delete_child(sc->amr_dev,
527 		sc->amr_drive[i].al_disk)) != 0)
528 		goto shutdown_out;
529 
530 	     sc->amr_drive[i].al_disk = 0;
531 	}
532     }
533 
534 shutdown_out:
535     amr_startup(sc);
536 }
537 
538 /*
539  * Bug-for-bug compatibility with Linux!
540  * Some apps will send commands with inlen and outlen set to 0,
541  * even though they expect data to be transfered to them from the
542  * card.  Linux accidentally allows this by allocating a 4KB
543  * buffer for the transfer anyways, but it then throws it away
544  * without copying it back to the app.
545  *
546  * The amr(4) firmware relies on this feature.  In fact, it assumes
547  * the buffer is always a power of 2 up to a max of 64k.  There is
548  * also at least one case where it assumes a buffer less than 16k is
549  * greater than 16k.  However, forcing all buffers to a size of 32k
550  * causes stalls in the firmware.  Force each command smaller than
551  * 64k up to the next power of two except that commands between 8k
552  * and 16k are rounded up to 32k instead of 16k.
553  */
554 static unsigned long
amr_ioctl_buffer_length(unsigned long len)555 amr_ioctl_buffer_length(unsigned long len)
556 {
557 
558     if (len <= 4 * 1024)
559 	return (4 * 1024);
560     if (len <= 8 * 1024)
561 	return (8 * 1024);
562     if (len <= 32 * 1024)
563 	return (32 * 1024);
564     if (len <= 64 * 1024)
565 	return (64 * 1024);
566     return (len);
567 }
568 
569 int
amr_linux_ioctl_int(struct cdev * dev,u_long cmd,caddr_t addr,int32_t flag,struct thread * td)570 amr_linux_ioctl_int(struct cdev *dev, u_long cmd, caddr_t addr, int32_t flag,
571     struct thread *td)
572 {
573     struct amr_softc		*sc = (struct amr_softc *)dev->si_drv1;
574     struct amr_command		*ac;
575     struct amr_mailbox		*mb;
576     struct amr_linux_ioctl	ali;
577     void			*dp, *temp;
578     int				error;
579     int				adapter, len, ac_flags = 0;
580     int				logical_drives_changed = 0;
581     u_int32_t			linux_version = 0x02100000;
582     u_int8_t			status;
583     struct amr_passthrough	*ap;	/* 60 bytes */
584 
585     error = 0;
586     dp = NULL;
587     ac = NULL;
588     ap = NULL;
589 
590     if ((error = copyin(addr, &ali, sizeof(ali))) != 0)
591 	return (error);
592     switch (ali.ui.fcs.opcode) {
593     case 0x82:
594 	switch(ali.ui.fcs.subopcode) {
595 	case 'e':
596 	    copyout(&linux_version, (void *)(uintptr_t)ali.data,
597 		sizeof(linux_version));
598 	    error = 0;
599 	    break;
600 
601 	case 'm':
602 	    copyout(&linux_no_adapter, (void *)(uintptr_t)ali.data,
603 		sizeof(linux_no_adapter));
604 	    td->td_retval[0] = linux_no_adapter;
605 	    error = 0;
606 	    break;
607 
608 	default:
609 	    printf("Unknown subopcode\n");
610 	    error = ENOIOCTL;
611 	    break;
612 	}
613     break;
614 
615     case 0x80:
616     case 0x81:
617 	if (ali.ui.fcs.opcode == 0x80)
618 	    len = max(ali.outlen, ali.inlen);
619 	else
620 	    len = ali.ui.fcs.length;
621 
622 	adapter = (ali.ui.fcs.adapno) ^ 'm' << 8;
623 
624 	mb = (void *)&ali.mbox[0];
625 
626 	if ((ali.mbox[0] == FC_DEL_LOGDRV  && ali.mbox[2] == OP_DEL_LOGDRV) ||	/* delete */
627 	    (ali.mbox[0] == AMR_CMD_CONFIG && ali.mbox[2] == 0x0d)) {		/* create */
628 	    if (sc->amr_allow_vol_config == 0) {
629 		error = EPERM;
630 		break;
631 	    }
632 	    logical_drives_changed = 1;
633 	}
634 
635 	if (ali.mbox[0] == AMR_CMD_PASS) {
636 	    mtx_lock(&sc->amr_list_lock);
637 	    while ((ac = amr_alloccmd(sc)) == NULL)
638 		msleep(sc, &sc->amr_list_lock, PPAUSE, "amrioc", hz);
639 	    mtx_unlock(&sc->amr_list_lock);
640 	    ap = &ac->ac_ccb->ccb_pthru;
641 
642 	    error = copyin((void *)(uintptr_t)mb->mb_physaddr, ap,
643 		sizeof(struct amr_passthrough));
644 	    if (error)
645 		break;
646 
647 	    if (ap->ap_data_transfer_length)
648 		dp = malloc(ap->ap_data_transfer_length, M_AMR,
649 		    M_WAITOK | M_ZERO);
650 
651 	    if (ali.inlen) {
652 		error = copyin((void *)(uintptr_t)ap->ap_data_transfer_address,
653 		    dp, ap->ap_data_transfer_length);
654 		if (error)
655 		    break;
656 	    }
657 
658 	    ac_flags = AMR_CMD_DATAIN|AMR_CMD_DATAOUT|AMR_CMD_CCB;
659 	    bzero(&ac->ac_mailbox, sizeof(ac->ac_mailbox));
660 	    ac->ac_mailbox.mb_command = AMR_CMD_PASS;
661 	    ac->ac_flags = ac_flags;
662 
663 	    ac->ac_data = dp;
664 	    ac->ac_length = ap->ap_data_transfer_length;
665 	    temp = (void *)(uintptr_t)ap->ap_data_transfer_address;
666 
667 	    mtx_lock(&sc->amr_list_lock);
668 	    error = amr_wait_command(ac);
669 	    mtx_unlock(&sc->amr_list_lock);
670 	    if (error)
671 		break;
672 
673 	    status = ac->ac_status;
674 	    error = copyout(&status, &((struct amr_passthrough *)(uintptr_t)mb->mb_physaddr)->ap_scsi_status, sizeof(status));
675 	    if (error)
676 		break;
677 
678 	    if (ali.outlen) {
679 		error = copyout(dp, temp, ap->ap_data_transfer_length);
680 	        if (error)
681 		    break;
682 	    }
683 	    error = copyout(ap->ap_request_sense_area, ((struct amr_passthrough *)(uintptr_t)mb->mb_physaddr)->ap_request_sense_area, ap->ap_request_sense_length);
684 	    if (error)
685 		break;
686 
687 	    error = 0;
688 	    break;
689 	} else if (ali.mbox[0] == AMR_CMD_PASS_64) {
690 	    printf("No AMR_CMD_PASS_64\n");
691 	    error = ENOIOCTL;
692 	    break;
693 	} else if (ali.mbox[0] == AMR_CMD_EXTPASS) {
694 	    printf("No AMR_CMD_EXTPASS\n");
695 	    error = ENOIOCTL;
696 	    break;
697 	} else {
698 	    len = amr_ioctl_buffer_length(imax(ali.inlen, ali.outlen));
699 
700 	    dp = malloc(len, M_AMR, M_WAITOK | M_ZERO);
701 
702 	    if (ali.inlen) {
703 		error = copyin((void *)(uintptr_t)mb->mb_physaddr, dp, len);
704 		if (error)
705 		    break;
706 	    }
707 
708 	    mtx_lock(&sc->amr_list_lock);
709 	    while ((ac = amr_alloccmd(sc)) == NULL)
710 		msleep(sc, &sc->amr_list_lock, PPAUSE, "amrioc", hz);
711 
712 	    ac_flags = AMR_CMD_DATAIN|AMR_CMD_DATAOUT;
713 	    bzero(&ac->ac_mailbox, sizeof(ac->ac_mailbox));
714 	    bcopy(&ali.mbox[0], &ac->ac_mailbox, sizeof(ali.mbox));
715 
716 	    ac->ac_length = len;
717 	    ac->ac_data = dp;
718 	    ac->ac_flags = ac_flags;
719 
720 	    error = amr_wait_command(ac);
721 	    mtx_unlock(&sc->amr_list_lock);
722 	    if (error)
723 		break;
724 
725 	    status = ac->ac_status;
726 	    error = copyout(&status, &((struct amr_mailbox *)&((struct amr_linux_ioctl *)addr)->mbox[0])->mb_status, sizeof(status));
727 	    if (ali.outlen) {
728 		error = copyout(dp, (void *)(uintptr_t)mb->mb_physaddr, ali.outlen);
729 		if (error)
730 		    break;
731 	    }
732 
733 	    error = 0;
734 	    if (logical_drives_changed)
735 		amr_rescan_drives(dev);
736 	    break;
737 	}
738 	break;
739 
740     default:
741 	debug(1, "unknown linux ioctl 0x%lx", cmd);
742 	printf("unknown linux ioctl 0x%lx\n", cmd);
743 	error = ENOIOCTL;
744 	break;
745     }
746 
747     /*
748      * At this point, we know that there is a lock held and that these
749      * objects have been allocated.
750      */
751     mtx_lock(&sc->amr_list_lock);
752     if (ac != NULL)
753 	amr_releasecmd(ac);
754     mtx_unlock(&sc->amr_list_lock);
755     if (dp != NULL)
756 	free(dp, M_AMR);
757     return(error);
758 }
759 
760 static int
amr_ioctl(struct cdev * dev,u_long cmd,caddr_t addr,int32_t flag,struct thread * td)761 amr_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, int32_t flag, struct thread *td)
762 {
763     struct amr_softc		*sc = (struct amr_softc *)dev->si_drv1;
764     union {
765 	void			*_p;
766 	struct amr_user_ioctl	*au;
767 #ifdef AMR_IO_COMMAND32
768 	struct amr_user_ioctl32	*au32;
769 #endif
770 	int			*result;
771     } arg;
772     struct amr_command		*ac;
773     struct amr_mailbox_ioctl	*mbi;
774     void			*dp, *au_buffer;
775     unsigned long		au_length, real_length;
776     unsigned char		*au_cmd;
777     int				*au_statusp, au_direction;
778     int				error;
779     struct amr_passthrough	*ap;	/* 60 bytes */
780     int				logical_drives_changed = 0;
781 
782     debug_called(1);
783 
784     arg._p = (void *)addr;
785 
786     error = 0;
787     dp = NULL;
788     ac = NULL;
789     ap = NULL;
790 
791     switch(cmd) {
792 
793     case AMR_IO_VERSION:
794 	debug(1, "AMR_IO_VERSION");
795 	*arg.result = AMR_IO_VERSION_NUMBER;
796 	return(0);
797 
798 #ifdef AMR_IO_COMMAND32
799     /*
800      * Accept ioctl-s from 32-bit binaries on non-32-bit
801      * platforms, such as AMD. LSI's MEGAMGR utility is
802      * the only example known today...	-mi
803      */
804     case AMR_IO_COMMAND32:
805 	debug(1, "AMR_IO_COMMAND32 0x%x", arg.au32->au_cmd[0]);
806 	au_cmd = arg.au32->au_cmd;
807 	au_buffer = (void *)(u_int64_t)arg.au32->au_buffer;
808 	au_length = arg.au32->au_length;
809 	au_direction = arg.au32->au_direction;
810 	au_statusp = &arg.au32->au_status;
811 	break;
812 #endif
813 
814     case AMR_IO_COMMAND:
815 	debug(1, "AMR_IO_COMMAND  0x%x", arg.au->au_cmd[0]);
816 	au_cmd = arg.au->au_cmd;
817 	au_buffer = (void *)arg.au->au_buffer;
818 	au_length = arg.au->au_length;
819 	au_direction = arg.au->au_direction;
820 	au_statusp = &arg.au->au_status;
821 	break;
822 
823     case 0xc0046d00:
824     case 0xc06e6d00:	/* Linux emulation */
825 	{
826 	    devclass_t			devclass;
827 	    struct amr_linux_ioctl	ali;
828 	    int				adapter, error;
829 
830 	    devclass = devclass_find("amr");
831 	    if (devclass == NULL)
832 		return (ENOENT);
833 
834 	    error = copyin(addr, &ali, sizeof(ali));
835 	    if (error)
836 		return (error);
837 	    if (ali.ui.fcs.opcode == 0x82)
838 		adapter = 0;
839 	    else
840 		adapter = (ali.ui.fcs.adapno) ^ 'm' << 8;
841 
842 	    sc = devclass_get_softc(devclass, adapter);
843 	    if (sc == NULL)
844 		return (ENOENT);
845 
846 	    return (amr_linux_ioctl_int(sc->amr_dev_t, cmd, addr, 0, td));
847 	}
848     default:
849 	debug(1, "unknown ioctl 0x%lx", cmd);
850 	return(ENOIOCTL);
851     }
852 
853     if ((au_cmd[0] == FC_DEL_LOGDRV && au_cmd[1] == OP_DEL_LOGDRV) ||	/* delete */
854 	(au_cmd[0] == AMR_CMD_CONFIG && au_cmd[1] == 0x0d)) {		/* create */
855 	if (sc->amr_allow_vol_config == 0) {
856 	    error = EPERM;
857 	    goto out;
858 	}
859 	logical_drives_changed = 1;
860 #ifdef LSI
861 	if ((error = amr_prepare_ld_delete(sc)) != 0)
862 	    return (error);
863 #endif
864     }
865 
866     /* handle inbound data buffer */
867     real_length = amr_ioctl_buffer_length(au_length);
868     dp = malloc(real_length, M_AMR, M_WAITOK|M_ZERO);
869     if (au_length != 0 && au_cmd[0] != 0x06) {
870 	if ((error = copyin(au_buffer, dp, au_length)) != 0) {
871 	    free(dp, M_AMR);
872 	    return (error);
873 	}
874 	debug(2, "copyin %ld bytes from %p -> %p", au_length, au_buffer, dp);
875     }
876 
877     /* Allocate this now before the mutex gets held */
878 
879     mtx_lock(&sc->amr_list_lock);
880     while ((ac = amr_alloccmd(sc)) == NULL)
881 	msleep(sc, &sc->amr_list_lock, PPAUSE, "amrioc", hz);
882 
883     /* handle SCSI passthrough command */
884     if (au_cmd[0] == AMR_CMD_PASS) {
885         int len;
886 
887 	ap = &ac->ac_ccb->ccb_pthru;
888 	bzero(ap, sizeof(struct amr_passthrough));
889 
890 	/* copy cdb */
891         len = au_cmd[2];
892 	ap->ap_cdb_length = len;
893 	bcopy(au_cmd + 3, ap->ap_cdb, len);
894 
895 	/* build passthrough */
896 	ap->ap_timeout		= au_cmd[len + 3] & 0x07;
897 	ap->ap_ars		= (au_cmd[len + 3] & 0x08) ? 1 : 0;
898 	ap->ap_islogical		= (au_cmd[len + 3] & 0x80) ? 1 : 0;
899 	ap->ap_logical_drive_no	= au_cmd[len + 4];
900 	ap->ap_channel		= au_cmd[len + 5];
901 	ap->ap_scsi_id 		= au_cmd[len + 6];
902 	ap->ap_request_sense_length	= 14;
903 	ap->ap_data_transfer_length	= au_length;
904 	/* XXX what about the request-sense area? does the caller want it? */
905 
906 	/* build command */
907 	ac->ac_mailbox.mb_command = AMR_CMD_PASS;
908 	ac->ac_flags = AMR_CMD_CCB;
909 
910     } else {
911 	/* direct command to controller */
912 	mbi = (struct amr_mailbox_ioctl *)&ac->ac_mailbox;
913 
914 	/* copy pertinent mailbox items */
915 	mbi->mb_command = au_cmd[0];
916 	mbi->mb_channel = au_cmd[1];
917 	mbi->mb_param = au_cmd[2];
918 	mbi->mb_pad[0] = au_cmd[3];
919 	mbi->mb_drive = au_cmd[4];
920 	ac->ac_flags = 0;
921     }
922 
923     /* build the command */
924     ac->ac_data = dp;
925     ac->ac_length = real_length;
926     ac->ac_flags |= AMR_CMD_DATAIN|AMR_CMD_DATAOUT;
927 
928     /* run the command */
929     error = amr_wait_command(ac);
930     mtx_unlock(&sc->amr_list_lock);
931     if (error)
932 	goto out;
933 
934     /* copy out data and set status */
935     if (au_length != 0) {
936 	error = copyout(dp, au_buffer, au_length);
937     }
938     debug(2, "copyout %ld bytes from %p -> %p", au_length, dp, au_buffer);
939     debug(2, "%p status 0x%x", dp, ac->ac_status);
940     *au_statusp = ac->ac_status;
941 
942 out:
943     /*
944      * At this point, we know that there is a lock held and that these
945      * objects have been allocated.
946      */
947     mtx_lock(&sc->amr_list_lock);
948     if (ac != NULL)
949 	amr_releasecmd(ac);
950     mtx_unlock(&sc->amr_list_lock);
951     if (dp != NULL)
952 	free(dp, M_AMR);
953 
954 #ifndef LSI
955     if (logical_drives_changed)
956 	amr_rescan_drives(dev);
957 #endif
958 
959     return(error);
960 }
961 
962 /********************************************************************************
963  ********************************************************************************
964                                                                 Status Monitoring
965  ********************************************************************************
966  ********************************************************************************/
967 
968 /********************************************************************************
969  * Perform a periodic check of the controller status
970  */
971 static void
amr_periodic(void * data)972 amr_periodic(void *data)
973 {
974     struct amr_softc	*sc = (struct amr_softc *)data;
975 
976     debug_called(2);
977 
978     /* XXX perform periodic status checks here */
979 
980     /* compensate for missed interrupts */
981     amr_done(sc);
982 
983     /* reschedule */
984     sc->amr_timeout = timeout(amr_periodic, sc, hz);
985 }
986 
987 /********************************************************************************
988  ********************************************************************************
989                                                                  Command Wrappers
990  ********************************************************************************
991  ********************************************************************************/
992 
993 /********************************************************************************
994  * Interrogate the controller for the operational parameters we require.
995  */
996 static int
amr_query_controller(struct amr_softc * sc)997 amr_query_controller(struct amr_softc *sc)
998 {
999     struct amr_enquiry3	*aex;
1000     struct amr_prodinfo	*ap;
1001     struct amr_enquiry	*ae;
1002     int			ldrv;
1003     int			status;
1004 
1005     /*
1006      * Greater than 10 byte cdb support
1007      */
1008     sc->support_ext_cdb = amr_support_ext_cdb(sc);
1009 
1010     if(sc->support_ext_cdb) {
1011 	debug(2,"supports extended CDBs.");
1012     }
1013 
1014     /*
1015      * Try to issue an ENQUIRY3 command
1016      */
1017     if ((aex = amr_enquiry(sc, 2048, AMR_CMD_CONFIG, AMR_CONFIG_ENQ3,
1018 			   AMR_CONFIG_ENQ3_SOLICITED_FULL, &status)) != NULL) {
1019 
1020 	/*
1021 	 * Fetch current state of logical drives.
1022 	 */
1023 	for (ldrv = 0; ldrv < aex->ae_numldrives; ldrv++) {
1024 	    sc->amr_drive[ldrv].al_size       = aex->ae_drivesize[ldrv];
1025 	    sc->amr_drive[ldrv].al_state      = aex->ae_drivestate[ldrv];
1026 	    sc->amr_drive[ldrv].al_properties = aex->ae_driveprop[ldrv];
1027 	    debug(2, "  drive %d: %d state %x properties %x\n", ldrv, sc->amr_drive[ldrv].al_size,
1028 		  sc->amr_drive[ldrv].al_state, sc->amr_drive[ldrv].al_properties);
1029 	}
1030 	free(aex, M_AMR);
1031 
1032 	/*
1033 	 * Get product info for channel count.
1034 	 */
1035 	if ((ap = amr_enquiry(sc, 2048, AMR_CMD_CONFIG, AMR_CONFIG_PRODUCT_INFO, 0, &status)) == NULL) {
1036 	    device_printf(sc->amr_dev, "can't obtain product data from controller\n");
1037 	    return(1);
1038 	}
1039 	sc->amr_maxdrives = 40;
1040 	sc->amr_maxchan = ap->ap_nschan;
1041 	sc->amr_maxio = ap->ap_maxio;
1042 	sc->amr_type |= AMR_TYPE_40LD;
1043 	free(ap, M_AMR);
1044 
1045 	ap = amr_enquiry(sc, 0, FC_DEL_LOGDRV, OP_SUP_DEL_LOGDRV, 0, &status);
1046 	if (ap != NULL)
1047 	    free(ap, M_AMR);
1048 	if (!status) {
1049 	    sc->amr_ld_del_supported = 1;
1050 	    device_printf(sc->amr_dev, "delete logical drives supported by controller\n");
1051 	}
1052     } else {
1053 
1054 	/* failed, try the 8LD ENQUIRY commands */
1055 	if ((ae = (struct amr_enquiry *)amr_enquiry(sc, 2048, AMR_CMD_EXT_ENQUIRY2, 0, 0, &status)) == NULL) {
1056 	    if ((ae = (struct amr_enquiry *)amr_enquiry(sc, 2048, AMR_CMD_ENQUIRY, 0, 0, &status)) == NULL) {
1057 		device_printf(sc->amr_dev, "can't obtain configuration data from controller\n");
1058 		return(1);
1059 	    }
1060 	    ae->ae_signature = 0;
1061 	}
1062 
1063 	/*
1064 	 * Fetch current state of logical drives.
1065 	 */
1066 	for (ldrv = 0; ldrv < ae->ae_ldrv.al_numdrives; ldrv++) {
1067 	    sc->amr_drive[ldrv].al_size       = ae->ae_ldrv.al_size[ldrv];
1068 	    sc->amr_drive[ldrv].al_state      = ae->ae_ldrv.al_state[ldrv];
1069 	    sc->amr_drive[ldrv].al_properties = ae->ae_ldrv.al_properties[ldrv];
1070 	    debug(2, "  drive %d: %d state %x properties %x\n", ldrv, sc->amr_drive[ldrv].al_size,
1071 		  sc->amr_drive[ldrv].al_state, sc->amr_drive[ldrv].al_properties);
1072 	}
1073 
1074 	sc->amr_maxdrives = 8;
1075 	sc->amr_maxchan = ae->ae_adapter.aa_channels;
1076 	sc->amr_maxio = ae->ae_adapter.aa_maxio;
1077 	free(ae, M_AMR);
1078     }
1079 
1080     /*
1081      * Mark remaining drives as unused.
1082      */
1083     for (; ldrv < AMR_MAXLD; ldrv++)
1084 	sc->amr_drive[ldrv].al_size = 0xffffffff;
1085 
1086     /*
1087      * Cap the maximum number of outstanding I/Os.  AMI's Linux driver doesn't trust
1088      * the controller's reported value, and lockups have been seen when we do.
1089      */
1090     sc->amr_maxio = imin(sc->amr_maxio, AMR_LIMITCMD);
1091 
1092     return(0);
1093 }
1094 
1095 /********************************************************************************
1096  * Run a generic enquiry-style command.
1097  */
1098 static void *
amr_enquiry(struct amr_softc * sc,size_t bufsize,u_int8_t cmd,u_int8_t cmdsub,u_int8_t cmdqual,int * status)1099 amr_enquiry(struct amr_softc *sc, size_t bufsize, u_int8_t cmd, u_int8_t cmdsub, u_int8_t cmdqual, int *status)
1100 {
1101     struct amr_command	*ac;
1102     void		*result;
1103     u_int8_t		*mbox;
1104     int			error;
1105 
1106     debug_called(1);
1107 
1108     error = 1;
1109     result = NULL;
1110 
1111     /* get ourselves a command buffer */
1112     mtx_lock(&sc->amr_list_lock);
1113     ac = amr_alloccmd(sc);
1114     mtx_unlock(&sc->amr_list_lock);
1115     if (ac == NULL)
1116 	goto out;
1117     /* allocate the response structure */
1118     if ((result = malloc(bufsize, M_AMR, M_ZERO|M_NOWAIT)) == NULL)
1119 	goto out;
1120     /* set command flags */
1121 
1122     ac->ac_flags |= AMR_CMD_PRIORITY | AMR_CMD_DATAIN;
1123 
1124     /* point the command at our data */
1125     ac->ac_data = result;
1126     ac->ac_length = bufsize;
1127 
1128     /* build the command proper */
1129     mbox = (u_int8_t *)&ac->ac_mailbox;		/* XXX want a real structure for this? */
1130     mbox[0] = cmd;
1131     mbox[2] = cmdsub;
1132     mbox[3] = cmdqual;
1133     *status = 0;
1134 
1135     /* can't assume that interrupts are going to work here, so play it safe */
1136     if (sc->amr_poll_command(ac))
1137 	goto out;
1138     error = ac->ac_status;
1139     *status = ac->ac_status;
1140 
1141  out:
1142     mtx_lock(&sc->amr_list_lock);
1143     if (ac != NULL)
1144 	amr_releasecmd(ac);
1145     mtx_unlock(&sc->amr_list_lock);
1146     if ((error != 0) && (result != NULL)) {
1147 	free(result, M_AMR);
1148 	result = NULL;
1149     }
1150     return(result);
1151 }
1152 
1153 /********************************************************************************
1154  * Flush the controller's internal cache, return status.
1155  */
1156 int
amr_flush(struct amr_softc * sc)1157 amr_flush(struct amr_softc *sc)
1158 {
1159     struct amr_command	*ac;
1160     int			error;
1161 
1162     /* get ourselves a command buffer */
1163     error = 1;
1164     mtx_lock(&sc->amr_list_lock);
1165     ac = amr_alloccmd(sc);
1166     mtx_unlock(&sc->amr_list_lock);
1167     if (ac == NULL)
1168 	goto out;
1169     /* set command flags */
1170     ac->ac_flags |= AMR_CMD_PRIORITY | AMR_CMD_DATAOUT;
1171 
1172     /* build the command proper */
1173     ac->ac_mailbox.mb_command = AMR_CMD_FLUSH;
1174 
1175     /* we have to poll, as the system may be going down or otherwise damaged */
1176     if (sc->amr_poll_command(ac))
1177 	goto out;
1178     error = ac->ac_status;
1179 
1180  out:
1181     mtx_lock(&sc->amr_list_lock);
1182     if (ac != NULL)
1183 	amr_releasecmd(ac);
1184     mtx_unlock(&sc->amr_list_lock);
1185     return(error);
1186 }
1187 
1188 /********************************************************************************
1189  * Detect extented cdb >> greater than 10 byte cdb support
1190  * returns '1' means this support exist
1191  * returns '0' means this support doesn't exist
1192  */
1193 static int
amr_support_ext_cdb(struct amr_softc * sc)1194 amr_support_ext_cdb(struct amr_softc *sc)
1195 {
1196     struct amr_command	*ac;
1197     u_int8_t		*mbox;
1198     int			error;
1199 
1200     /* get ourselves a command buffer */
1201     error = 0;
1202     mtx_lock(&sc->amr_list_lock);
1203     ac = amr_alloccmd(sc);
1204     mtx_unlock(&sc->amr_list_lock);
1205     if (ac == NULL)
1206 	goto out;
1207     /* set command flags */
1208     ac->ac_flags |= AMR_CMD_PRIORITY | AMR_CMD_DATAOUT;
1209 
1210     /* build the command proper */
1211     mbox = (u_int8_t *)&ac->ac_mailbox;		/* XXX want a real structure for this? */
1212     mbox[0] = 0xA4;
1213     mbox[2] = 0x16;
1214 
1215 
1216     /* we have to poll, as the system may be going down or otherwise damaged */
1217     if (sc->amr_poll_command(ac))
1218 	goto out;
1219     if( ac->ac_status == AMR_STATUS_SUCCESS ) {
1220 	    error = 1;
1221     }
1222 
1223 out:
1224     mtx_lock(&sc->amr_list_lock);
1225     if (ac != NULL)
1226 	amr_releasecmd(ac);
1227     mtx_unlock(&sc->amr_list_lock);
1228     return(error);
1229 }
1230 
1231 /********************************************************************************
1232  * Try to find I/O work for the controller from one or more of the work queues.
1233  *
1234  * We make the assumption that if the controller is not ready to take a command
1235  * at some given time, it will generate an interrupt at some later time when
1236  * it is.
1237  */
1238 void
amr_startio(struct amr_softc * sc)1239 amr_startio(struct amr_softc *sc)
1240 {
1241     struct amr_command	*ac;
1242 
1243     /* spin until something prevents us from doing any work */
1244     for (;;) {
1245 
1246 	/* Don't bother to queue commands no bounce buffers are available. */
1247 	if (sc->amr_state & AMR_STATE_QUEUE_FRZN)
1248 	    break;
1249 
1250 	/* try to get a ready command */
1251 	ac = amr_dequeue_ready(sc);
1252 
1253 	/* if that failed, build a command from a bio */
1254 	if (ac == NULL)
1255 	    (void)amr_bio_command(sc, &ac);
1256 
1257 	/* if that failed, build a command from a ccb */
1258 	if ((ac == NULL) && (sc->amr_cam_command != NULL))
1259 	    sc->amr_cam_command(sc, &ac);
1260 
1261 	/* if we don't have anything to do, give up */
1262 	if (ac == NULL)
1263 	    break;
1264 
1265 	/* try to give the command to the controller; if this fails save it for later and give up */
1266 	if (amr_start(ac)) {
1267 	    debug(2, "controller busy, command deferred");
1268 	    amr_requeue_ready(ac);	/* XXX schedule retry very soon? */
1269 	    break;
1270 	}
1271     }
1272 }
1273 
1274 /********************************************************************************
1275  * Handle completion of an I/O command.
1276  */
1277 static void
amr_completeio(struct amr_command * ac)1278 amr_completeio(struct amr_command *ac)
1279 {
1280     struct amrd_softc		*sc = ac->ac_bio->bio_disk->d_drv1;
1281     static struct timeval	lastfail;
1282     static int			curfail;
1283 
1284     if (ac->ac_status != AMR_STATUS_SUCCESS) {	/* could be more verbose here? */
1285 	ac->ac_bio->bio_error = EIO;
1286 	ac->ac_bio->bio_flags |= BIO_ERROR;
1287 
1288 	if (ppsratecheck(&lastfail, &curfail, 1))
1289 	    device_printf(sc->amrd_dev, "I/O error - 0x%x\n", ac->ac_status);
1290 /*	amr_printcommand(ac);*/
1291     }
1292     amrd_intr(ac->ac_bio);
1293     mtx_lock(&ac->ac_sc->amr_list_lock);
1294     amr_releasecmd(ac);
1295     mtx_unlock(&ac->ac_sc->amr_list_lock);
1296 }
1297 
1298 /********************************************************************************
1299  ********************************************************************************
1300                                                                Command Processing
1301  ********************************************************************************
1302  ********************************************************************************/
1303 
1304 /********************************************************************************
1305  * Convert a bio off the top of the bio queue into a command.
1306  */
1307 static int
amr_bio_command(struct amr_softc * sc,struct amr_command ** acp)1308 amr_bio_command(struct amr_softc *sc, struct amr_command **acp)
1309 {
1310     struct amr_command	*ac;
1311     struct amrd_softc	*amrd;
1312     struct bio		*bio;
1313     int			error;
1314     int			blkcount;
1315     int			driveno;
1316     int			cmd;
1317 
1318     ac = NULL;
1319     error = 0;
1320 
1321     /* get a command */
1322     if ((ac = amr_alloccmd(sc)) == NULL)
1323 	return (ENOMEM);
1324 
1325     /* get a bio to work on */
1326     if ((bio = amr_dequeue_bio(sc)) == NULL) {
1327 	amr_releasecmd(ac);
1328 	return (0);
1329     }
1330 
1331     /* connect the bio to the command */
1332     ac->ac_complete = amr_completeio;
1333     ac->ac_bio = bio;
1334     ac->ac_data = bio->bio_data;
1335     ac->ac_length = bio->bio_bcount;
1336     cmd = 0;
1337     switch (bio->bio_cmd) {
1338     case BIO_READ:
1339 	ac->ac_flags |= AMR_CMD_DATAIN;
1340 	if (AMR_IS_SG64(sc)) {
1341 	    cmd = AMR_CMD_LREAD64;
1342 	    ac->ac_flags |= AMR_CMD_SG64;
1343 	} else
1344 	    cmd = AMR_CMD_LREAD;
1345 	break;
1346     case BIO_WRITE:
1347 	ac->ac_flags |= AMR_CMD_DATAOUT;
1348 	if (AMR_IS_SG64(sc)) {
1349 	    cmd = AMR_CMD_LWRITE64;
1350 	    ac->ac_flags |= AMR_CMD_SG64;
1351 	} else
1352 	    cmd = AMR_CMD_LWRITE;
1353 	break;
1354     case BIO_FLUSH:
1355 	ac->ac_flags |= AMR_CMD_PRIORITY | AMR_CMD_DATAOUT;
1356 	cmd = AMR_CMD_FLUSH;
1357 	break;
1358     }
1359     amrd = (struct amrd_softc *)bio->bio_disk->d_drv1;
1360     driveno = amrd->amrd_drive - sc->amr_drive;
1361     blkcount = (bio->bio_bcount + AMR_BLKSIZE - 1) / AMR_BLKSIZE;
1362 
1363     ac->ac_mailbox.mb_command = cmd;
1364     if (bio->bio_cmd & (BIO_READ|BIO_WRITE)) {
1365 	ac->ac_mailbox.mb_blkcount = blkcount;
1366 	ac->ac_mailbox.mb_lba = bio->bio_pblkno;
1367 	if ((bio->bio_pblkno + blkcount) > sc->amr_drive[driveno].al_size) {
1368 	    device_printf(sc->amr_dev,
1369 			  "I/O beyond end of unit (%lld,%d > %lu)\n",
1370 			  (long long)bio->bio_pblkno, blkcount,
1371 			  (u_long)sc->amr_drive[driveno].al_size);
1372 	}
1373     }
1374     ac->ac_mailbox.mb_drive = driveno;
1375     if (sc->amr_state & AMR_STATE_REMAP_LD)
1376 	ac->ac_mailbox.mb_drive |= 0x80;
1377 
1378     /* we fill in the s/g related data when the command is mapped */
1379 
1380 
1381     *acp = ac;
1382     return(error);
1383 }
1384 
1385 /********************************************************************************
1386  * Take a command, submit it to the controller and sleep until it completes
1387  * or fails.  Interrupts must be enabled, returns nonzero on error.
1388  */
1389 static int
amr_wait_command(struct amr_command * ac)1390 amr_wait_command(struct amr_command *ac)
1391 {
1392     int			error = 0;
1393     struct amr_softc	*sc = ac->ac_sc;
1394 
1395     debug_called(1);
1396 
1397     ac->ac_complete = NULL;
1398     ac->ac_flags |= AMR_CMD_SLEEP;
1399     if ((error = amr_start(ac)) != 0) {
1400 	return(error);
1401     }
1402 
1403     while ((ac->ac_flags & AMR_CMD_BUSY) && (error != EWOULDBLOCK)) {
1404 	error = msleep(ac,&sc->amr_list_lock, PRIBIO, "amrwcmd", 0);
1405     }
1406 
1407     return(error);
1408 }
1409 
1410 /********************************************************************************
1411  * Take a command, submit it to the controller and busy-wait for it to return.
1412  * Returns nonzero on error.  Can be safely called with interrupts enabled.
1413  */
1414 static int
amr_std_poll_command(struct amr_command * ac)1415 amr_std_poll_command(struct amr_command *ac)
1416 {
1417     struct amr_softc	*sc = ac->ac_sc;
1418     int			error, count;
1419 
1420     debug_called(2);
1421 
1422     ac->ac_complete = NULL;
1423     if ((error = amr_start(ac)) != 0)
1424 	return(error);
1425 
1426     count = 0;
1427     do {
1428 	/*
1429 	 * Poll for completion, although the interrupt handler may beat us to it.
1430 	 * Note that the timeout here is somewhat arbitrary.
1431 	 */
1432 	amr_done(sc);
1433 	DELAY(1000);
1434     } while ((ac->ac_flags & AMR_CMD_BUSY) && (count++ < 1000));
1435     if (!(ac->ac_flags & AMR_CMD_BUSY)) {
1436 	error = 0;
1437     } else {
1438 	/* XXX the slot is now marked permanently busy */
1439 	error = EIO;
1440 	device_printf(sc->amr_dev, "polled command timeout\n");
1441     }
1442     return(error);
1443 }
1444 
1445 static void
amr_setup_polled_dmamap(void * arg,bus_dma_segment_t * segs,int nsegs,int err)1446 amr_setup_polled_dmamap(void *arg, bus_dma_segment_t *segs, int nsegs, int err)
1447 {
1448     struct amr_command *ac = arg;
1449     struct amr_softc *sc = ac->ac_sc;
1450     int mb_channel;
1451 
1452     if (err) {
1453 	device_printf(sc->amr_dev, "error %d in %s", err, __FUNCTION__);
1454 	ac->ac_status = AMR_STATUS_ABORTED;
1455 	return;
1456     }
1457 
1458     amr_setup_sg(arg, segs, nsegs, err);
1459 
1460     /* for AMR_CMD_CONFIG Read/Write the s/g count goes elsewhere */
1461     mb_channel = ((struct amr_mailbox_ioctl *)&ac->ac_mailbox)->mb_channel;
1462     if (ac->ac_mailbox.mb_command == AMR_CMD_CONFIG &&
1463         ((mb_channel == AMR_CONFIG_READ_NVRAM_CONFIG) ||
1464         (mb_channel == AMR_CONFIG_WRITE_NVRAM_CONFIG)))
1465 	((struct amr_mailbox_ioctl *)&ac->ac_mailbox)->mb_param = ac->ac_nsegments;
1466 
1467     ac->ac_mailbox.mb_nsgelem = ac->ac_nsegments;
1468     ac->ac_mailbox.mb_physaddr = ac->ac_mb_physaddr;
1469     if (AC_IS_SG64(ac)) {
1470 	ac->ac_sg64_hi = 0;
1471 	ac->ac_sg64_lo = ac->ac_sgbusaddr;
1472     }
1473 
1474     sc->amr_poll_command1(sc, ac);
1475 }
1476 
1477 /********************************************************************************
1478  * Take a command, submit it to the controller and busy-wait for it to return.
1479  * Returns nonzero on error.  Can be safely called with interrupts enabled.
1480  */
1481 static int
amr_quartz_poll_command(struct amr_command * ac)1482 amr_quartz_poll_command(struct amr_command *ac)
1483 {
1484     struct amr_softc	*sc = ac->ac_sc;
1485     int			error;
1486 
1487     debug_called(2);
1488 
1489     error = 0;
1490 
1491     if (AC_IS_SG64(ac)) {
1492 	ac->ac_tag = sc->amr_buffer64_dmat;
1493 	ac->ac_datamap = ac->ac_dma64map;
1494     } else {
1495 	ac->ac_tag = sc->amr_buffer_dmat;
1496 	ac->ac_datamap = ac->ac_dmamap;
1497     }
1498 
1499     /* now we have a slot, we can map the command (unmapped in amr_complete) */
1500     if (ac->ac_data != 0) {
1501 	if (bus_dmamap_load(ac->ac_tag, ac->ac_datamap, ac->ac_data,
1502 	    ac->ac_length, amr_setup_polled_dmamap, ac, BUS_DMA_NOWAIT) != 0) {
1503 	    error = 1;
1504 	}
1505     } else {
1506 	error = amr_quartz_poll_command1(sc, ac);
1507     }
1508 
1509     return (error);
1510 }
1511 
1512 static int
amr_quartz_poll_command1(struct amr_softc * sc,struct amr_command * ac)1513 amr_quartz_poll_command1(struct amr_softc *sc, struct amr_command *ac)
1514 {
1515     int count, error;
1516 
1517     mtx_lock(&sc->amr_hw_lock);
1518     if ((sc->amr_state & AMR_STATE_INTEN) == 0) {
1519 	count=0;
1520 	while (sc->amr_busyslots) {
1521 	    msleep(sc, &sc->amr_hw_lock, PRIBIO | PCATCH, "amrpoll", hz);
1522 	    if(count++>10) {
1523 		break;
1524 	    }
1525 	}
1526 
1527 	if(sc->amr_busyslots) {
1528 	    device_printf(sc->amr_dev, "adapter is busy\n");
1529 	    mtx_unlock(&sc->amr_hw_lock);
1530 	    if (ac->ac_data != NULL) {
1531 		bus_dmamap_unload(ac->ac_tag, ac->ac_datamap);
1532 	    }
1533     	    ac->ac_status=0;
1534 	    return(1);
1535 	}
1536     }
1537 
1538     bcopy(&ac->ac_mailbox, (void *)(uintptr_t)(volatile void *)sc->amr_mailbox, AMR_MBOX_CMDSIZE);
1539 
1540     /* clear the poll/ack fields in the mailbox */
1541     sc->amr_mailbox->mb_ident = 0xFE;
1542     sc->amr_mailbox->mb_nstatus = 0xFF;
1543     sc->amr_mailbox->mb_status = 0xFF;
1544     sc->amr_mailbox->mb_poll = 0;
1545     sc->amr_mailbox->mb_ack = 0;
1546     sc->amr_mailbox->mb_busy = 1;
1547 
1548     AMR_QPUT_IDB(sc, sc->amr_mailboxphys | AMR_QIDB_SUBMIT);
1549 
1550     while(sc->amr_mailbox->mb_nstatus == 0xFF)
1551 	DELAY(1);
1552     while(sc->amr_mailbox->mb_status == 0xFF)
1553 	DELAY(1);
1554     ac->ac_status=sc->amr_mailbox->mb_status;
1555     error = (ac->ac_status !=AMR_STATUS_SUCCESS) ? 1:0;
1556     while(sc->amr_mailbox->mb_poll != 0x77)
1557 	DELAY(1);
1558     sc->amr_mailbox->mb_poll = 0;
1559     sc->amr_mailbox->mb_ack = 0x77;
1560 
1561     /* acknowledge that we have the commands */
1562     AMR_QPUT_IDB(sc, sc->amr_mailboxphys | AMR_QIDB_ACK);
1563     while(AMR_QGET_IDB(sc) & AMR_QIDB_ACK)
1564 	DELAY(1);
1565     mtx_unlock(&sc->amr_hw_lock);
1566 
1567     /* unmap the command's data buffer */
1568     if (ac->ac_flags & AMR_CMD_DATAIN) {
1569 	bus_dmamap_sync(ac->ac_tag, ac->ac_datamap, BUS_DMASYNC_POSTREAD);
1570     }
1571     if (ac->ac_flags & AMR_CMD_DATAOUT) {
1572 	bus_dmamap_sync(ac->ac_tag, ac->ac_datamap, BUS_DMASYNC_POSTWRITE);
1573     }
1574     bus_dmamap_unload(ac->ac_tag, ac->ac_datamap);
1575 
1576     return(error);
1577 }
1578 
1579 static __inline int
amr_freeslot(struct amr_command * ac)1580 amr_freeslot(struct amr_command *ac)
1581 {
1582     struct amr_softc *sc = ac->ac_sc;
1583     int			slot;
1584 
1585     debug_called(3);
1586 
1587     slot = ac->ac_slot;
1588     if (sc->amr_busycmd[slot] == NULL)
1589 	panic("amr: slot %d not busy?\n", slot);
1590 
1591     sc->amr_busycmd[slot] = NULL;
1592     atomic_subtract_int(&sc->amr_busyslots, 1);
1593 
1594     return (0);
1595 }
1596 
1597 /********************************************************************************
1598  * Map/unmap (ac)'s data in the controller's addressable space as required.
1599  *
1600  * These functions may be safely called multiple times on a given command.
1601  */
1602 static void
amr_setup_sg(void * arg,bus_dma_segment_t * segs,int nsegments,int error)1603 amr_setup_sg(void *arg, bus_dma_segment_t *segs, int nsegments, int error)
1604 {
1605     struct amr_command	*ac = (struct amr_command *)arg;
1606     struct amr_sgentry	*sg;
1607     struct amr_sg64entry *sg64;
1608     int flags, i;
1609 
1610     debug_called(3);
1611 
1612     /* get base address of s/g table */
1613     sg = ac->ac_sg.sg32;
1614     sg64 = ac->ac_sg.sg64;
1615 
1616     if (AC_IS_SG64(ac)) {
1617 	ac->ac_nsegments = nsegments;
1618 	ac->ac_mb_physaddr = 0xffffffff;
1619 	for (i = 0; i < nsegments; i++, sg64++) {
1620 	    sg64->sg_addr = segs[i].ds_addr;
1621 	    sg64->sg_count = segs[i].ds_len;
1622 	}
1623     } else {
1624 	/* decide whether we need to populate the s/g table */
1625 	if (nsegments < 2) {
1626 	    ac->ac_nsegments = 0;
1627 	    ac->ac_mb_physaddr = segs[0].ds_addr;
1628 	} else {
1629             ac->ac_nsegments = nsegments;
1630 	    ac->ac_mb_physaddr = ac->ac_sgbusaddr;
1631 	    for (i = 0; i < nsegments; i++, sg++) {
1632 		sg->sg_addr = segs[i].ds_addr;
1633 		sg->sg_count = segs[i].ds_len;
1634 	    }
1635 	}
1636     }
1637 
1638     flags = 0;
1639     if (ac->ac_flags & AMR_CMD_DATAIN)
1640 	flags |= BUS_DMASYNC_PREREAD;
1641     if (ac->ac_flags & AMR_CMD_DATAOUT)
1642 	flags |= BUS_DMASYNC_PREWRITE;
1643     bus_dmamap_sync(ac->ac_tag, ac->ac_datamap, flags);
1644     ac->ac_flags |= AMR_CMD_MAPPED;
1645 }
1646 
1647 static void
amr_setup_data(void * arg,bus_dma_segment_t * segs,int nsegs,int err)1648 amr_setup_data(void *arg, bus_dma_segment_t *segs, int nsegs, int err)
1649 {
1650     struct amr_command *ac = arg;
1651     struct amr_softc *sc = ac->ac_sc;
1652     int mb_channel;
1653 
1654     if (err) {
1655 	device_printf(sc->amr_dev, "error %d in %s", err, __FUNCTION__);
1656 	amr_abort_load(ac);
1657 	return;
1658     }
1659 
1660     amr_setup_sg(arg, segs, nsegs, err);
1661 
1662     /* for AMR_CMD_CONFIG Read/Write the s/g count goes elsewhere */
1663     mb_channel = ((struct amr_mailbox_ioctl *)&ac->ac_mailbox)->mb_channel;
1664     if (ac->ac_mailbox.mb_command == AMR_CMD_CONFIG &&
1665         ((mb_channel == AMR_CONFIG_READ_NVRAM_CONFIG) ||
1666         (mb_channel == AMR_CONFIG_WRITE_NVRAM_CONFIG)))
1667 	((struct amr_mailbox_ioctl *)&ac->ac_mailbox)->mb_param = ac->ac_nsegments;
1668 
1669     ac->ac_mailbox.mb_nsgelem = ac->ac_nsegments;
1670     ac->ac_mailbox.mb_physaddr = ac->ac_mb_physaddr;
1671     if (AC_IS_SG64(ac)) {
1672 	ac->ac_sg64_hi = 0;
1673 	ac->ac_sg64_lo = ac->ac_sgbusaddr;
1674     }
1675 
1676     if (sc->amr_submit_command(ac) == EBUSY) {
1677 	amr_freeslot(ac);
1678 	amr_requeue_ready(ac);
1679     }
1680 }
1681 
1682 static void
amr_setup_ccb(void * arg,bus_dma_segment_t * segs,int nsegs,int err)1683 amr_setup_ccb(void *arg, bus_dma_segment_t *segs, int nsegs, int err)
1684 {
1685     struct amr_command *ac = arg;
1686     struct amr_softc *sc = ac->ac_sc;
1687     struct amr_passthrough *ap = &ac->ac_ccb->ccb_pthru;
1688     struct amr_ext_passthrough *aep = &ac->ac_ccb->ccb_epthru;
1689 
1690     if (err) {
1691 	device_printf(sc->amr_dev, "error %d in %s", err, __FUNCTION__);
1692 	amr_abort_load(ac);
1693 	return;
1694     }
1695 
1696     /* Set up the mailbox portion of the command to point at the ccb */
1697     ac->ac_mailbox.mb_nsgelem = 0;
1698     ac->ac_mailbox.mb_physaddr = ac->ac_ccb_busaddr;
1699 
1700     amr_setup_sg(arg, segs, nsegs, err);
1701 
1702     switch (ac->ac_mailbox.mb_command) {
1703     case AMR_CMD_EXTPASS:
1704 	aep->ap_no_sg_elements = ac->ac_nsegments;
1705 	aep->ap_data_transfer_address = ac->ac_mb_physaddr;
1706         break;
1707     case AMR_CMD_PASS:
1708 	ap->ap_no_sg_elements = ac->ac_nsegments;
1709 	ap->ap_data_transfer_address = ac->ac_mb_physaddr;
1710 	break;
1711     default:
1712 	panic("Unknown ccb command");
1713     }
1714 
1715     if (sc->amr_submit_command(ac) == EBUSY) {
1716 	amr_freeslot(ac);
1717 	amr_requeue_ready(ac);
1718     }
1719 }
1720 
1721 static int
amr_mapcmd(struct amr_command * ac)1722 amr_mapcmd(struct amr_command *ac)
1723 {
1724     bus_dmamap_callback_t *cb;
1725     struct amr_softc	*sc = ac->ac_sc;
1726 
1727     debug_called(3);
1728 
1729     if (AC_IS_SG64(ac)) {
1730 	ac->ac_tag = sc->amr_buffer64_dmat;
1731 	ac->ac_datamap = ac->ac_dma64map;
1732     } else {
1733 	ac->ac_tag = sc->amr_buffer_dmat;
1734 	ac->ac_datamap = ac->ac_dmamap;
1735     }
1736 
1737     if (ac->ac_flags & AMR_CMD_CCB)
1738 	cb = amr_setup_ccb;
1739     else
1740 	cb = amr_setup_data;
1741 
1742     /* if the command involves data at all, and hasn't been mapped */
1743     if ((ac->ac_flags & AMR_CMD_MAPPED) == 0 && (ac->ac_data != NULL)) {
1744 	/* map the data buffers into bus space and build the s/g list */
1745 	if (bus_dmamap_load(ac->ac_tag, ac->ac_datamap, ac->ac_data,
1746 	     ac->ac_length, cb, ac, 0) == EINPROGRESS) {
1747 	    sc->amr_state |= AMR_STATE_QUEUE_FRZN;
1748 	}
1749    } else {
1750     	if (sc->amr_submit_command(ac) == EBUSY) {
1751 	    amr_freeslot(ac);
1752 	    amr_requeue_ready(ac);
1753 	}
1754    }
1755 
1756     return (0);
1757 }
1758 
1759 static void
amr_unmapcmd(struct amr_command * ac)1760 amr_unmapcmd(struct amr_command *ac)
1761 {
1762     int			flag;
1763 
1764     debug_called(3);
1765 
1766     /* if the command involved data at all and was mapped */
1767     if (ac->ac_flags & AMR_CMD_MAPPED) {
1768 
1769 	if (ac->ac_data != NULL) {
1770 
1771 	    flag = 0;
1772 	    if (ac->ac_flags & AMR_CMD_DATAIN)
1773 		flag |= BUS_DMASYNC_POSTREAD;
1774 	    if (ac->ac_flags & AMR_CMD_DATAOUT)
1775 		flag |= BUS_DMASYNC_POSTWRITE;
1776 
1777 	    bus_dmamap_sync(ac->ac_tag, ac->ac_datamap, flag);
1778 	    bus_dmamap_unload(ac->ac_tag, ac->ac_datamap);
1779 	}
1780 
1781 	ac->ac_flags &= ~AMR_CMD_MAPPED;
1782     }
1783 }
1784 
1785 static void
amr_abort_load(struct amr_command * ac)1786 amr_abort_load(struct amr_command *ac)
1787 {
1788     ac_qhead_t head;
1789     struct amr_softc *sc = ac->ac_sc;
1790 
1791     mtx_assert(&sc->amr_list_lock, MA_OWNED);
1792 
1793     ac->ac_status = AMR_STATUS_ABORTED;
1794     amr_init_qhead(&head);
1795     amr_enqueue_completed(ac, &head);
1796 
1797     mtx_unlock(&sc->amr_list_lock);
1798     amr_complete(sc, &head);
1799     mtx_lock(&sc->amr_list_lock);
1800 }
1801 
1802 /********************************************************************************
1803  * Take a command and give it to the controller, returns 0 if successful, or
1804  * EBUSY if the command should be retried later.
1805  */
1806 static int
amr_start(struct amr_command * ac)1807 amr_start(struct amr_command *ac)
1808 {
1809     struct amr_softc *sc;
1810     int error = 0;
1811     int slot;
1812 
1813     debug_called(3);
1814 
1815     /* mark command as busy so that polling consumer can tell */
1816     sc = ac->ac_sc;
1817     ac->ac_flags |= AMR_CMD_BUSY;
1818 
1819     /* get a command slot (freed in amr_done) */
1820     slot = ac->ac_slot;
1821     if (sc->amr_busycmd[slot] != NULL)
1822 	panic("amr: slot %d busy?\n", slot);
1823     sc->amr_busycmd[slot] = ac;
1824     atomic_add_int(&sc->amr_busyslots, 1);
1825 
1826     /* Now we have a slot, we can map the command (unmapped in amr_complete). */
1827     if ((error = amr_mapcmd(ac)) == ENOMEM) {
1828 	/*
1829 	 * Memroy resources are short, so free the slot and let this be tried
1830 	 * later.
1831 	 */
1832 	amr_freeslot(ac);
1833     }
1834 
1835     return (error);
1836 }
1837 
1838 /********************************************************************************
1839  * Extract one or more completed commands from the controller (sc)
1840  *
1841  * Returns nonzero if any commands on the work queue were marked as completed.
1842  */
1843 
1844 int
amr_done(struct amr_softc * sc)1845 amr_done(struct amr_softc *sc)
1846 {
1847     ac_qhead_t		head;
1848     struct amr_command	*ac;
1849     struct amr_mailbox	mbox;
1850     int			i, idx, result;
1851 
1852     debug_called(3);
1853 
1854     /* See if there's anything for us to do */
1855     result = 0;
1856     amr_init_qhead(&head);
1857 
1858     /* loop collecting completed commands */
1859     for (;;) {
1860 	/* poll for a completed command's identifier and status */
1861 	if (sc->amr_get_work(sc, &mbox)) {
1862 	    result = 1;
1863 
1864 	    /* iterate over completed commands in this result */
1865 	    for (i = 0; i < mbox.mb_nstatus; i++) {
1866 		/* get pointer to busy command */
1867 		idx = mbox.mb_completed[i] - 1;
1868 		ac = sc->amr_busycmd[idx];
1869 
1870 		/* really a busy command? */
1871 		if (ac != NULL) {
1872 
1873 		    /* pull the command from the busy index */
1874 		    amr_freeslot(ac);
1875 
1876 		    /* save status for later use */
1877 		    ac->ac_status = mbox.mb_status;
1878 		    amr_enqueue_completed(ac, &head);
1879 		    debug(3, "completed command with status %x", mbox.mb_status);
1880 		} else {
1881 		    device_printf(sc->amr_dev, "bad slot %d completed\n", idx);
1882 		}
1883 	    }
1884 	} else
1885 	    break;	/* no work */
1886     }
1887 
1888     /* handle completion and timeouts */
1889     amr_complete(sc, &head);
1890 
1891     return(result);
1892 }
1893 
1894 /********************************************************************************
1895  * Do completion processing on done commands on (sc)
1896  */
1897 
1898 static void
amr_complete(void * context,ac_qhead_t * head)1899 amr_complete(void *context, ac_qhead_t *head)
1900 {
1901     struct amr_softc	*sc = (struct amr_softc *)context;
1902     struct amr_command	*ac;
1903 
1904     debug_called(3);
1905 
1906     /* pull completed commands off the queue */
1907     for (;;) {
1908 	ac = amr_dequeue_completed(sc, head);
1909 	if (ac == NULL)
1910 	    break;
1911 
1912 	/* unmap the command's data buffer */
1913 	amr_unmapcmd(ac);
1914 
1915 	/*
1916 	 * Is there a completion handler?
1917 	 */
1918 	if (ac->ac_complete != NULL) {
1919 	    /* unbusy the command */
1920 	    ac->ac_flags &= ~AMR_CMD_BUSY;
1921 	    ac->ac_complete(ac);
1922 
1923 	    /*
1924 	     * Is someone sleeping on this one?
1925 	     */
1926 	} else {
1927 	    mtx_lock(&sc->amr_list_lock);
1928 	    ac->ac_flags &= ~AMR_CMD_BUSY;
1929 	    if (ac->ac_flags & AMR_CMD_SLEEP) {
1930 		/* unbusy the command */
1931 		wakeup(ac);
1932 	    }
1933 	    mtx_unlock(&sc->amr_list_lock);
1934 	}
1935 
1936 	if(!sc->amr_busyslots) {
1937 	    wakeup(sc);
1938 	}
1939     }
1940 
1941     mtx_lock(&sc->amr_list_lock);
1942     sc->amr_state &= ~AMR_STATE_QUEUE_FRZN;
1943     amr_startio(sc);
1944     mtx_unlock(&sc->amr_list_lock);
1945 }
1946 
1947 /********************************************************************************
1948  ********************************************************************************
1949                                                         Command Buffer Management
1950  ********************************************************************************
1951  ********************************************************************************/
1952 
1953 /********************************************************************************
1954  * Get a new command buffer.
1955  *
1956  * This may return NULL in low-memory cases.
1957  *
1958  * If possible, we recycle a command buffer that's been used before.
1959  */
1960 struct amr_command *
amr_alloccmd(struct amr_softc * sc)1961 amr_alloccmd(struct amr_softc *sc)
1962 {
1963     struct amr_command	*ac;
1964 
1965     debug_called(3);
1966 
1967     ac = amr_dequeue_free(sc);
1968     if (ac == NULL) {
1969 	sc->amr_state |= AMR_STATE_QUEUE_FRZN;
1970 	return(NULL);
1971     }
1972 
1973     /* clear out significant fields */
1974     ac->ac_status = 0;
1975     bzero(&ac->ac_mailbox, sizeof(struct amr_mailbox));
1976     ac->ac_flags = 0;
1977     ac->ac_bio = NULL;
1978     ac->ac_data = NULL;
1979     ac->ac_complete = NULL;
1980     ac->ac_retries = 0;
1981     ac->ac_tag = NULL;
1982     ac->ac_datamap = NULL;
1983     return(ac);
1984 }
1985 
1986 /********************************************************************************
1987  * Release a command buffer for recycling.
1988  */
1989 void
amr_releasecmd(struct amr_command * ac)1990 amr_releasecmd(struct amr_command *ac)
1991 {
1992     debug_called(3);
1993 
1994     amr_enqueue_free(ac);
1995 }
1996 
1997 /********************************************************************************
1998  * Allocate a new command cluster and initialise it.
1999  */
2000 static void
amr_alloccmd_cluster(struct amr_softc * sc)2001 amr_alloccmd_cluster(struct amr_softc *sc)
2002 {
2003     struct amr_command_cluster	*acc;
2004     struct amr_command		*ac;
2005     int				i, nextslot;
2006 
2007     /*
2008      * If we haven't found the real limit yet, let us have a couple of
2009      * commands in order to be able to probe.
2010      */
2011     if (sc->amr_maxio == 0)
2012 	sc->amr_maxio = 2;
2013 
2014     if (sc->amr_nextslot > sc->amr_maxio)
2015 	return;
2016     acc = malloc(AMR_CMD_CLUSTERSIZE, M_AMR, M_NOWAIT | M_ZERO);
2017     if (acc != NULL) {
2018 	nextslot = sc->amr_nextslot;
2019 	mtx_lock(&sc->amr_list_lock);
2020 	TAILQ_INSERT_TAIL(&sc->amr_cmd_clusters, acc, acc_link);
2021 	mtx_unlock(&sc->amr_list_lock);
2022 	for (i = 0; i < AMR_CMD_CLUSTERCOUNT; i++) {
2023 	    ac = &acc->acc_command[i];
2024 	    ac->ac_sc = sc;
2025 	    ac->ac_slot = nextslot;
2026 
2027 	    /*
2028 	     * The SG table for each slot is a fixed size and is assumed to
2029 	     * to hold 64-bit s/g objects when the driver is configured to do
2030 	     * 64-bit DMA.  32-bit DMA commands still use the same table, but
2031 	     * cast down to 32-bit objects.
2032 	     */
2033 	    if (AMR_IS_SG64(sc)) {
2034 		ac->ac_sgbusaddr = sc->amr_sgbusaddr +
2035 		    (ac->ac_slot * AMR_NSEG * sizeof(struct amr_sg64entry));
2036 	        ac->ac_sg.sg64 = sc->amr_sg64table + (ac->ac_slot * AMR_NSEG);
2037 	    } else {
2038 		ac->ac_sgbusaddr = sc->amr_sgbusaddr +
2039 		    (ac->ac_slot * AMR_NSEG * sizeof(struct amr_sgentry));
2040 	        ac->ac_sg.sg32 = sc->amr_sgtable + (ac->ac_slot * AMR_NSEG);
2041 	    }
2042 
2043 	    ac->ac_ccb = sc->amr_ccb + ac->ac_slot;
2044 	    ac->ac_ccb_busaddr = sc->amr_ccb_busaddr +
2045 		(ac->ac_slot * sizeof(union amr_ccb));
2046 
2047 	    if (bus_dmamap_create(sc->amr_buffer_dmat, 0, &ac->ac_dmamap))
2048 		break;
2049 	    if (AMR_IS_SG64(sc) &&
2050 		(bus_dmamap_create(sc->amr_buffer64_dmat, 0,&ac->ac_dma64map)))
2051 		break;
2052 	    amr_releasecmd(ac);
2053 	    if (++nextslot > sc->amr_maxio)
2054 		break;
2055 	}
2056 	sc->amr_nextslot = nextslot;
2057     }
2058 }
2059 
2060 /********************************************************************************
2061  * Free a command cluster
2062  */
2063 static void
amr_freecmd_cluster(struct amr_command_cluster * acc)2064 amr_freecmd_cluster(struct amr_command_cluster *acc)
2065 {
2066     struct amr_softc	*sc = acc->acc_command[0].ac_sc;
2067     int			i;
2068 
2069     for (i = 0; i < AMR_CMD_CLUSTERCOUNT; i++) {
2070 	if (acc->acc_command[i].ac_sc == NULL)
2071 	    break;
2072 	bus_dmamap_destroy(sc->amr_buffer_dmat, acc->acc_command[i].ac_dmamap);
2073 	if (AMR_IS_SG64(sc))
2074 		bus_dmamap_destroy(sc->amr_buffer64_dmat, acc->acc_command[i].ac_dma64map);
2075     }
2076     free(acc, M_AMR);
2077 }
2078 
2079 /********************************************************************************
2080  ********************************************************************************
2081                                                          Interface-specific Shims
2082  ********************************************************************************
2083  ********************************************************************************/
2084 
2085 /********************************************************************************
2086  * Tell the controller that the mailbox contains a valid command
2087  */
2088 static int
amr_quartz_submit_command(struct amr_command * ac)2089 amr_quartz_submit_command(struct amr_command *ac)
2090 {
2091     struct amr_softc	*sc = ac->ac_sc;
2092     static struct timeval lastfail;
2093     static int		curfail;
2094     int			i = 0;
2095 
2096     mtx_lock(&sc->amr_hw_lock);
2097     while (sc->amr_mailbox->mb_busy && (i++ < 10)) {
2098         DELAY(1);
2099 	/* This is a no-op read that flushes pending mailbox updates */
2100 	AMR_QGET_ODB(sc);
2101     }
2102     if (sc->amr_mailbox->mb_busy) {
2103 	mtx_unlock(&sc->amr_hw_lock);
2104 	if (ac->ac_retries++ > 1000) {
2105 	    if (ppsratecheck(&lastfail, &curfail, 1))
2106 		device_printf(sc->amr_dev, "Too many retries on command %p.  "
2107 			      "Controller is likely dead\n", ac);
2108 	    ac->ac_retries = 0;
2109 	}
2110 	return (EBUSY);
2111     }
2112 
2113     /*
2114      * Save the slot number so that we can locate this command when complete.
2115      * Note that ident = 0 seems to be special, so we don't use it.
2116      */
2117     ac->ac_mailbox.mb_ident = ac->ac_slot + 1; /* will be coppied into mbox */
2118     bcopy(&ac->ac_mailbox, (void *)(uintptr_t)(volatile void *)sc->amr_mailbox, 14);
2119     sc->amr_mailbox->mb_busy = 1;
2120     sc->amr_mailbox->mb_poll = 0;
2121     sc->amr_mailbox->mb_ack  = 0;
2122     sc->amr_mailbox64->sg64_hi = ac->ac_sg64_hi;
2123     sc->amr_mailbox64->sg64_lo = ac->ac_sg64_lo;
2124 
2125     AMR_QPUT_IDB(sc, sc->amr_mailboxphys | AMR_QIDB_SUBMIT);
2126     mtx_unlock(&sc->amr_hw_lock);
2127     return(0);
2128 }
2129 
2130 static int
amr_std_submit_command(struct amr_command * ac)2131 amr_std_submit_command(struct amr_command *ac)
2132 {
2133     struct amr_softc	*sc = ac->ac_sc;
2134     static struct timeval lastfail;
2135     static int		curfail;
2136 
2137     mtx_lock(&sc->amr_hw_lock);
2138     if (AMR_SGET_MBSTAT(sc) & AMR_SMBOX_BUSYFLAG) {
2139 	mtx_unlock(&sc->amr_hw_lock);
2140 	if (ac->ac_retries++ > 1000) {
2141 	    if (ppsratecheck(&lastfail, &curfail, 1))
2142 		device_printf(sc->amr_dev, "Too many retries on command %p.  "
2143 			      "Controller is likely dead\n", ac);
2144 	    ac->ac_retries = 0;
2145 	}
2146 	return (EBUSY);
2147     }
2148 
2149     /*
2150      * Save the slot number so that we can locate this command when complete.
2151      * Note that ident = 0 seems to be special, so we don't use it.
2152      */
2153     ac->ac_mailbox.mb_ident = ac->ac_slot + 1; /* will be coppied into mbox */
2154     bcopy(&ac->ac_mailbox, (void *)(uintptr_t)(volatile void *)sc->amr_mailbox, 14);
2155     sc->amr_mailbox->mb_busy = 1;
2156     sc->amr_mailbox->mb_poll = 0;
2157     sc->amr_mailbox->mb_ack  = 0;
2158 
2159     AMR_SPOST_COMMAND(sc);
2160     mtx_unlock(&sc->amr_hw_lock);
2161     return(0);
2162 }
2163 
2164 /********************************************************************************
2165  * Claim any work that the controller has completed; acknowledge completion,
2166  * save details of the completion in (mbsave)
2167  */
2168 static int
amr_quartz_get_work(struct amr_softc * sc,struct amr_mailbox * mbsave)2169 amr_quartz_get_work(struct amr_softc *sc, struct amr_mailbox *mbsave)
2170 {
2171     int		worked, i;
2172     u_int32_t	outd;
2173     u_int8_t	nstatus;
2174     u_int8_t	completed[46];
2175 
2176     debug_called(3);
2177 
2178     worked = 0;
2179 
2180     /* work waiting for us? */
2181     if ((outd = AMR_QGET_ODB(sc)) == AMR_QODB_READY) {
2182 
2183 	/* acknowledge interrupt */
2184 	AMR_QPUT_ODB(sc, AMR_QODB_READY);
2185 
2186 	while ((nstatus = sc->amr_mailbox->mb_nstatus) == 0xff)
2187 	    DELAY(1);
2188 	sc->amr_mailbox->mb_nstatus = 0xff;
2189 
2190 	/* wait until fw wrote out all completions */
2191 	for (i = 0; i < nstatus; i++) {
2192 	    while ((completed[i] = sc->amr_mailbox->mb_completed[i]) == 0xff)
2193 		DELAY(1);
2194 	    sc->amr_mailbox->mb_completed[i] = 0xff;
2195 	}
2196 
2197 	/* Save information for later processing */
2198 	mbsave->mb_nstatus = nstatus;
2199 	mbsave->mb_status = sc->amr_mailbox->mb_status;
2200 	sc->amr_mailbox->mb_status = 0xff;
2201 
2202 	for (i = 0; i < nstatus; i++)
2203 	    mbsave->mb_completed[i] = completed[i];
2204 
2205 	/* acknowledge that we have the commands */
2206 	AMR_QPUT_IDB(sc, AMR_QIDB_ACK);
2207 
2208 #if 0
2209 #ifndef AMR_QUARTZ_GOFASTER
2210 	/*
2211 	 * This waits for the controller to notice that we've taken the
2212 	 * command from it.  It's very inefficient, and we shouldn't do it,
2213 	 * but if we remove this code, we stop completing commands under
2214 	 * load.
2215 	 *
2216 	 * Peter J says we shouldn't do this.  The documentation says we
2217 	 * should.  Who is right?
2218 	 */
2219 	while(AMR_QGET_IDB(sc) & AMR_QIDB_ACK)
2220 	    ;				/* XXX aiee! what if it dies? */
2221 #endif
2222 #endif
2223 
2224 	worked = 1;			/* got some work */
2225     }
2226 
2227     return(worked);
2228 }
2229 
2230 static int
amr_std_get_work(struct amr_softc * sc,struct amr_mailbox * mbsave)2231 amr_std_get_work(struct amr_softc *sc, struct amr_mailbox *mbsave)
2232 {
2233     int		worked;
2234     u_int8_t	istat;
2235 
2236     debug_called(3);
2237 
2238     worked = 0;
2239 
2240     /* check for valid interrupt status */
2241     istat = AMR_SGET_ISTAT(sc);
2242     if ((istat & AMR_SINTR_VALID) != 0) {
2243 	AMR_SPUT_ISTAT(sc, istat);	/* ack interrupt status */
2244 
2245 	/* save mailbox, which contains a list of completed commands */
2246 	bcopy((void *)(uintptr_t)(volatile void *)sc->amr_mailbox, mbsave, sizeof(*mbsave));
2247 
2248 	AMR_SACK_INTERRUPT(sc);		/* acknowledge we have the mailbox */
2249 	worked = 1;
2250     }
2251 
2252     return(worked);
2253 }
2254 
2255 /********************************************************************************
2256  * Notify the controller of the mailbox location.
2257  */
2258 static void
amr_std_attach_mailbox(struct amr_softc * sc)2259 amr_std_attach_mailbox(struct amr_softc *sc)
2260 {
2261 
2262     /* program the mailbox physical address */
2263     AMR_SBYTE_SET(sc, AMR_SMBOX_0, sc->amr_mailboxphys         & 0xff);
2264     AMR_SBYTE_SET(sc, AMR_SMBOX_1, (sc->amr_mailboxphys >>  8) & 0xff);
2265     AMR_SBYTE_SET(sc, AMR_SMBOX_2, (sc->amr_mailboxphys >> 16) & 0xff);
2266     AMR_SBYTE_SET(sc, AMR_SMBOX_3, (sc->amr_mailboxphys >> 24) & 0xff);
2267     AMR_SBYTE_SET(sc, AMR_SMBOX_ENABLE, AMR_SMBOX_ADDR);
2268 
2269     /* clear any outstanding interrupt and enable interrupts proper */
2270     AMR_SACK_INTERRUPT(sc);
2271     AMR_SENABLE_INTR(sc);
2272 }
2273 
2274 #ifdef AMR_BOARD_INIT
2275 /********************************************************************************
2276  * Initialise the controller
2277  */
2278 static int
amr_quartz_init(struct amr_softc * sc)2279 amr_quartz_init(struct amr_softc *sc)
2280 {
2281     int		status, ostatus;
2282 
2283     device_printf(sc->amr_dev, "initial init status %x\n", AMR_QGET_INITSTATUS(sc));
2284 
2285     AMR_QRESET(sc);
2286 
2287     ostatus = 0xff;
2288     while ((status = AMR_QGET_INITSTATUS(sc)) != AMR_QINIT_DONE) {
2289 	if (status != ostatus) {
2290 	    device_printf(sc->amr_dev, "(%x) %s\n", status, amr_describe_code(amr_table_qinit, status));
2291 	    ostatus = status;
2292 	}
2293 	switch (status) {
2294 	case AMR_QINIT_NOMEM:
2295 	    return(ENOMEM);
2296 
2297 	case AMR_QINIT_SCAN:
2298 	    /* XXX we could print channel/target here */
2299 	    break;
2300 	}
2301     }
2302     return(0);
2303 }
2304 
2305 static int
amr_std_init(struct amr_softc * sc)2306 amr_std_init(struct amr_softc *sc)
2307 {
2308     int		status, ostatus;
2309 
2310     device_printf(sc->amr_dev, "initial init status %x\n", AMR_SGET_INITSTATUS(sc));
2311 
2312     AMR_SRESET(sc);
2313 
2314     ostatus = 0xff;
2315     while ((status = AMR_SGET_INITSTATUS(sc)) != AMR_SINIT_DONE) {
2316 	if (status != ostatus) {
2317 	    device_printf(sc->amr_dev, "(%x) %s\n", status, amr_describe_code(amr_table_sinit, status));
2318 	    ostatus = status;
2319 	}
2320 	switch (status) {
2321 	case AMR_SINIT_NOMEM:
2322 	    return(ENOMEM);
2323 
2324 	case AMR_SINIT_INPROG:
2325 	    /* XXX we could print channel/target here? */
2326 	    break;
2327 	}
2328     }
2329     return(0);
2330 }
2331 #endif
2332 
2333 /********************************************************************************
2334  ********************************************************************************
2335                                                                         Debugging
2336  ********************************************************************************
2337  ********************************************************************************/
2338 
2339 /********************************************************************************
2340  * Identify the controller and print some information about it.
2341  */
2342 static void
amr_describe_controller(struct amr_softc * sc)2343 amr_describe_controller(struct amr_softc *sc)
2344 {
2345     struct amr_prodinfo	*ap;
2346     struct amr_enquiry	*ae;
2347     char		*prod;
2348     int			status;
2349 
2350     /*
2351      * Try to get 40LD product info, which tells us what the card is labelled as.
2352      */
2353     if ((ap = amr_enquiry(sc, 2048, AMR_CMD_CONFIG, AMR_CONFIG_PRODUCT_INFO, 0, &status)) != NULL) {
2354 	device_printf(sc->amr_dev, "<LSILogic %.80s> Firmware %.16s, BIOS %.16s, %dMB RAM\n",
2355 		      ap->ap_product, ap->ap_firmware, ap->ap_bios,
2356 		      ap->ap_memsize);
2357 
2358 	free(ap, M_AMR);
2359 	return;
2360     }
2361 
2362     /*
2363      * Try 8LD extended ENQUIRY to get controller signature, and use lookup table.
2364      */
2365     if ((ae = (struct amr_enquiry *)amr_enquiry(sc, 2048, AMR_CMD_EXT_ENQUIRY2, 0, 0, &status)) != NULL) {
2366 	prod = amr_describe_code(amr_table_adaptertype, ae->ae_signature);
2367 
2368     } else if ((ae = (struct amr_enquiry *)amr_enquiry(sc, 2048, AMR_CMD_ENQUIRY, 0, 0, &status)) != NULL) {
2369 
2370 	/*
2371 	 * Try to work it out based on the PCI signatures.
2372 	 */
2373 	switch (pci_get_device(sc->amr_dev)) {
2374 	case 0x9010:
2375 	    prod = "Series 428";
2376 	    break;
2377 	case 0x9060:
2378 	    prod = "Series 434";
2379 	    break;
2380 	default:
2381 	    prod = "unknown controller";
2382 	    break;
2383 	}
2384     } else {
2385 	device_printf(sc->amr_dev, "<unsupported controller>\n");
2386 	return;
2387     }
2388 
2389     /*
2390      * HP NetRaid controllers have a special encoding of the firmware and
2391      * BIOS versions. The AMI version seems to have it as strings whereas
2392      * the HP version does it with a leading uppercase character and two
2393      * binary numbers.
2394      */
2395 
2396     if(ae->ae_adapter.aa_firmware[2] >= 'A' &&
2397        ae->ae_adapter.aa_firmware[2] <= 'Z' &&
2398        ae->ae_adapter.aa_firmware[1] <  ' ' &&
2399        ae->ae_adapter.aa_firmware[0] <  ' ' &&
2400        ae->ae_adapter.aa_bios[2] >= 'A'     &&
2401        ae->ae_adapter.aa_bios[2] <= 'Z'     &&
2402        ae->ae_adapter.aa_bios[1] <  ' '     &&
2403        ae->ae_adapter.aa_bios[0] <  ' ') {
2404 
2405 	/* this looks like we have an HP NetRaid version of the MegaRaid */
2406 
2407     	if(ae->ae_signature == AMR_SIG_438) {
2408     		/* the AMI 438 is a NetRaid 3si in HP-land */
2409     		prod = "HP NetRaid 3si";
2410     	}
2411 
2412 	device_printf(sc->amr_dev, "<%s> Firmware %c.%02d.%02d, BIOS %c.%02d.%02d, %dMB RAM\n",
2413 		      prod, ae->ae_adapter.aa_firmware[2],
2414 		      ae->ae_adapter.aa_firmware[1],
2415 		      ae->ae_adapter.aa_firmware[0],
2416 		      ae->ae_adapter.aa_bios[2],
2417 		      ae->ae_adapter.aa_bios[1],
2418 		      ae->ae_adapter.aa_bios[0],
2419 		      ae->ae_adapter.aa_memorysize);
2420     } else {
2421 	device_printf(sc->amr_dev, "<%s> Firmware %.4s, BIOS %.4s, %dMB RAM\n",
2422 		      prod, ae->ae_adapter.aa_firmware, ae->ae_adapter.aa_bios,
2423 		      ae->ae_adapter.aa_memorysize);
2424     }
2425     free(ae, M_AMR);
2426 }
2427 
2428 int
amr_dump_blocks(struct amr_softc * sc,int unit,u_int32_t lba,void * data,int blks)2429 amr_dump_blocks(struct amr_softc *sc, int unit, u_int32_t lba, void *data, int blks)
2430 {
2431     struct amr_command	*ac;
2432     int			error = EIO;
2433 
2434     debug_called(1);
2435 
2436     sc->amr_state |= AMR_STATE_INTEN;
2437 
2438     /* get ourselves a command buffer */
2439     if ((ac = amr_alloccmd(sc)) == NULL)
2440 	goto out;
2441     /* set command flags */
2442     ac->ac_flags |= AMR_CMD_PRIORITY | AMR_CMD_DATAOUT;
2443 
2444     /* point the command at our data */
2445     ac->ac_data = data;
2446     ac->ac_length = blks * AMR_BLKSIZE;
2447 
2448     /* build the command proper */
2449     ac->ac_mailbox.mb_command 	= AMR_CMD_LWRITE;
2450     ac->ac_mailbox.mb_blkcount	= blks;
2451     ac->ac_mailbox.mb_lba	= lba;
2452     ac->ac_mailbox.mb_drive	= unit;
2453 
2454     /* can't assume that interrupts are going to work here, so play it safe */
2455     if (sc->amr_poll_command(ac))
2456 	goto out;
2457     error = ac->ac_status;
2458 
2459  out:
2460     if (ac != NULL)
2461 	amr_releasecmd(ac);
2462 
2463     sc->amr_state &= ~AMR_STATE_INTEN;
2464     return (error);
2465 }
2466 
2467 
2468 
2469 #ifdef AMR_DEBUG
2470 /********************************************************************************
2471  * Print the command (ac) in human-readable format
2472  */
2473 #if 0
2474 static void
2475 amr_printcommand(struct amr_command *ac)
2476 {
2477     struct amr_softc	*sc = ac->ac_sc;
2478     struct amr_sgentry	*sg;
2479     int			i;
2480 
2481     device_printf(sc->amr_dev, "cmd %x  ident %d  drive %d\n",
2482 		  ac->ac_mailbox.mb_command, ac->ac_mailbox.mb_ident, ac->ac_mailbox.mb_drive);
2483     device_printf(sc->amr_dev, "blkcount %d  lba %d\n",
2484 		  ac->ac_mailbox.mb_blkcount, ac->ac_mailbox.mb_lba);
2485     device_printf(sc->amr_dev, "virtaddr %p  length %lu\n", ac->ac_data, (unsigned long)ac->ac_length);
2486     device_printf(sc->amr_dev, "sg physaddr %08x  nsg %d\n",
2487 		  ac->ac_mailbox.mb_physaddr, ac->ac_mailbox.mb_nsgelem);
2488     device_printf(sc->amr_dev, "ccb %p  bio %p\n", ac->ac_ccb_data, ac->ac_bio);
2489 
2490     /* get base address of s/g table */
2491     sg = sc->amr_sgtable + (ac->ac_slot * AMR_NSEG);
2492     for (i = 0; i < ac->ac_mailbox.mb_nsgelem; i++, sg++)
2493 	device_printf(sc->amr_dev, "  %x/%d\n", sg->sg_addr, sg->sg_count);
2494 }
2495 #endif
2496 #endif
2497