/* $NetBSD: cac.c,v 1.29 2005/02/27 00:27:01 perry Exp $ */ /*- * Copyright (c) 2000 The NetBSD Foundation, Inc. * All rights reserved. * * This code is derived from software contributed to The NetBSD Foundation * by Andrew Doran. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in the * documentation and/or other materials provided with the distribution. * 3. All advertising materials mentioning features or use of this software * must display the following acknowledgement: * This product includes software developed by the NetBSD * Foundation, Inc. and its contributors. * 4. Neither the name of The NetBSD Foundation nor the names of its * contributors may be used to endorse or promote products derived * from this software without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. */ /* * Driver for Compaq array controllers. */ #include __KERNEL_RCSID(0, "$NetBSD: cac.c,v 1.29 2005/02/27 00:27:01 perry Exp $"); #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "locators.h" static struct cac_ccb *cac_ccb_alloc(struct cac_softc *, int); static void cac_ccb_done(struct cac_softc *, struct cac_ccb *); static void cac_ccb_free(struct cac_softc *, struct cac_ccb *); static int cac_ccb_poll(struct cac_softc *, struct cac_ccb *, int); static int cac_ccb_start(struct cac_softc *, struct cac_ccb *); static int cac_print(void *, const char *); static void cac_shutdown(void *); static int cac_submatch(struct device *, struct cfdata *, const locdesc_t *, void *); static struct cac_ccb *cac_l0_completed(struct cac_softc *); static int cac_l0_fifo_full(struct cac_softc *); static void cac_l0_intr_enable(struct cac_softc *, int); static int cac_l0_intr_pending(struct cac_softc *); static void cac_l0_submit(struct cac_softc *, struct cac_ccb *); static void *cac_sdh; /* shutdown hook */ const struct cac_linkage cac_l0 = { cac_l0_completed, cac_l0_fifo_full, cac_l0_intr_enable, cac_l0_intr_pending, cac_l0_submit }; /* * Initialise our interface to the controller. */ int cac_init(struct cac_softc *sc, const char *intrstr, int startfw) { struct cac_controller_info cinfo; struct cac_attach_args caca; int error, rseg, size, i; bus_dma_segment_t seg; struct cac_ccb *ccb; int help[2]; locdesc_t *ldesc = (void *)help; /* XXX */ if (intrstr != NULL) aprint_normal("%s: interrupting at %s\n", sc->sc_dv.dv_xname, intrstr); SIMPLEQ_INIT(&sc->sc_ccb_free); SIMPLEQ_INIT(&sc->sc_ccb_queue); size = sizeof(struct cac_ccb) * CAC_MAX_CCBS; if ((error = bus_dmamem_alloc(sc->sc_dmat, size, PAGE_SIZE, 0, &seg, 1, &rseg, BUS_DMA_NOWAIT)) != 0) { aprint_error("%s: unable to allocate CCBs, error = %d\n", sc->sc_dv.dv_xname, error); return (-1); } if ((error = bus_dmamem_map(sc->sc_dmat, &seg, rseg, size, (caddr_t *)&sc->sc_ccbs, BUS_DMA_NOWAIT | BUS_DMA_COHERENT)) != 0) { aprint_error("%s: unable to map CCBs, error = %d\n", sc->sc_dv.dv_xname, error); return (-1); } if ((error = bus_dmamap_create(sc->sc_dmat, size, 1, size, 0, BUS_DMA_NOWAIT, &sc->sc_dmamap)) != 0) { aprint_error("%s: unable to create CCB DMA map, error = %d\n", sc->sc_dv.dv_xname, error); return (-1); } if ((error = bus_dmamap_load(sc->sc_dmat, sc->sc_dmamap, sc->sc_ccbs, size, NULL, BUS_DMA_NOWAIT)) != 0) { aprint_error("%s: unable to load CCB DMA map, error = %d\n", sc->sc_dv.dv_xname, error); return (-1); } sc->sc_ccbs_paddr = sc->sc_dmamap->dm_segs[0].ds_addr; memset(sc->sc_ccbs, 0, size); ccb = (struct cac_ccb *)sc->sc_ccbs; for (i = 0; i < CAC_MAX_CCBS; i++, ccb++) { /* Create the DMA map for this CCB's data */ error = bus_dmamap_create(sc->sc_dmat, CAC_MAX_XFER, CAC_SG_SIZE, CAC_MAX_XFER, 0, BUS_DMA_NOWAIT | BUS_DMA_ALLOCNOW, &ccb->ccb_dmamap_xfer); if (error) { aprint_error("%s: can't create ccb dmamap (%d)\n", sc->sc_dv.dv_xname, error); break; } ccb->ccb_flags = 0; ccb->ccb_paddr = sc->sc_ccbs_paddr + i * sizeof(struct cac_ccb); SIMPLEQ_INSERT_TAIL(&sc->sc_ccb_free, ccb, ccb_chain); } /* Start firmware background tasks, if needed. */ if (startfw) { if (cac_cmd(sc, CAC_CMD_START_FIRMWARE, &cinfo, sizeof(cinfo), 0, 0, CAC_CCB_DATA_IN, NULL)) { aprint_error("%s: CAC_CMD_START_FIRMWARE failed\n", sc->sc_dv.dv_xname); return (-1); } } if (cac_cmd(sc, CAC_CMD_GET_CTRL_INFO, &cinfo, sizeof(cinfo), 0, 0, CAC_CCB_DATA_IN, NULL)) { aprint_error("%s: CAC_CMD_GET_CTRL_INFO failed\n", sc->sc_dv.dv_xname); return (-1); } sc->sc_nunits = cinfo.num_drvs; for (i = 0; i < cinfo.num_drvs; i++) { caca.caca_unit = i; ldesc->len = 1; ldesc->locs[CACCF_UNIT] = i; config_found_sm_loc(&sc->sc_dv, "cac", ldesc, &caca, cac_print, cac_submatch); } /* Set our `shutdownhook' before we start any device activity. */ if (cac_sdh == NULL) cac_sdh = shutdownhook_establish(cac_shutdown, NULL); (*sc->sc_cl.cl_intr_enable)(sc, CAC_INTR_ENABLE); return (0); } /* * Shut down all `cac' controllers. */ static void cac_shutdown(void *cookie) { extern struct cfdriver cac_cd; struct cac_softc *sc; u_int8_t buf[512]; int i; for (i = 0; i < cac_cd.cd_ndevs; i++) { if ((sc = device_lookup(&cac_cd, i)) == NULL) continue; memset(buf, 0, sizeof(buf)); buf[0] = 1; cac_cmd(sc, CAC_CMD_FLUSH_CACHE, buf, sizeof(buf), 0, 0, CAC_CCB_DATA_OUT, NULL); } } /* * Print autoconfiguration message for a sub-device. */ static int cac_print(void *aux, const char *pnp) { struct cac_attach_args *caca; caca = (struct cac_attach_args *)aux; if (pnp != NULL) aprint_normal("block device at %s", pnp); aprint_normal(" unit %d", caca->caca_unit); return (UNCONF); } /* * Match a sub-device. */ static int cac_submatch(struct device *parent, struct cfdata *cf, const locdesc_t *ldesc, void *aux) { if (cf->cf_loc[CACCF_UNIT] != CACCF_UNIT_DEFAULT && cf->cf_loc[CACCF_UNIT] != ldesc->locs[CACCF_UNIT]) return (0); return (config_match(parent, cf, aux)); } /* * Handle an interrupt from the controller: process finished CCBs and * dequeue any waiting CCBs. */ int cac_intr(void *cookie) { struct cac_softc *sc; struct cac_ccb *ccb; sc = (struct cac_softc *)cookie; if (!(*sc->sc_cl.cl_intr_pending)(sc)) { #ifdef DEBUG printf("%s: spurious intr\n", sc->sc_dv.dv_xname); #endif return (0); } while ((ccb = (*sc->sc_cl.cl_completed)(sc)) != NULL) { cac_ccb_done(sc, ccb); cac_ccb_start(sc, NULL); } return (1); } /* * Execute a [polled] command. */ int cac_cmd(struct cac_softc *sc, int command, void *data, int datasize, int drive, int blkno, int flags, struct cac_context *context) { struct cac_ccb *ccb; struct cac_sgb *sgb; int s, i, rv, size, nsegs; size = 0; if ((ccb = cac_ccb_alloc(sc, 1)) == NULL) { printf("%s: unable to alloc CCB", sc->sc_dv.dv_xname); return (EAGAIN); } if ((flags & (CAC_CCB_DATA_IN | CAC_CCB_DATA_OUT)) != 0) { bus_dmamap_load(sc->sc_dmat, ccb->ccb_dmamap_xfer, (void *)data, datasize, NULL, BUS_DMA_NOWAIT | BUS_DMA_STREAMING | ((flags & CAC_CCB_DATA_IN) ? BUS_DMA_READ : BUS_DMA_WRITE)); bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0, datasize, (flags & CAC_CCB_DATA_IN) != 0 ? BUS_DMASYNC_PREREAD : BUS_DMASYNC_PREWRITE); sgb = ccb->ccb_seg; nsegs = min(ccb->ccb_dmamap_xfer->dm_nsegs, CAC_SG_SIZE); for (i = 0; i < nsegs; i++, sgb++) { size += ccb->ccb_dmamap_xfer->dm_segs[i].ds_len; sgb->length = htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_len); sgb->addr = htole32(ccb->ccb_dmamap_xfer->dm_segs[i].ds_addr); } } else { size = datasize; nsegs = 0; } ccb->ccb_hdr.drive = drive; ccb->ccb_hdr.size = htole16((sizeof(struct cac_req) + sizeof(struct cac_sgb) * CAC_SG_SIZE) >> 2); ccb->ccb_req.bcount = htole16(howmany(size, DEV_BSIZE)); ccb->ccb_req.command = command; ccb->ccb_req.sgcount = nsegs; ccb->ccb_req.blkno = htole32(blkno); ccb->ccb_flags = flags; ccb->ccb_datasize = size; if (context == NULL) { memset(&ccb->ccb_context, 0, sizeof(struct cac_context)); s = splbio(); /* Synchronous commands musn't wait. */ if ((*sc->sc_cl.cl_fifo_full)(sc)) { cac_ccb_free(sc, ccb); rv = EAGAIN; } else { #ifdef DIAGNOSTIC ccb->ccb_flags |= CAC_CCB_ACTIVE; #endif (*sc->sc_cl.cl_submit)(sc, ccb); rv = cac_ccb_poll(sc, ccb, 2000); cac_ccb_free(sc, ccb); } } else { memcpy(&ccb->ccb_context, context, sizeof(struct cac_context)); s = splbio(); (void)cac_ccb_start(sc, ccb); rv = 0; } splx(s); return (rv); } /* * Wait for the specified CCB to complete. Must be called at splbio. */ static int cac_ccb_poll(struct cac_softc *sc, struct cac_ccb *wantccb, int timo) { struct cac_ccb *ccb; timo *= 10; do { for (; timo != 0; timo--) { ccb = (*sc->sc_cl.cl_completed)(sc); if (ccb != NULL) break; DELAY(100); } if (timo == 0) { printf("%s: timeout\n", sc->sc_dv.dv_xname); return (EBUSY); } cac_ccb_done(sc, ccb); } while (ccb != wantccb); return (0); } /* * Enqueue the specified command (if any) and attempt to start all enqueued * commands. Must be called at splbio. */ static int cac_ccb_start(struct cac_softc *sc, struct cac_ccb *ccb) { if (ccb != NULL) SIMPLEQ_INSERT_TAIL(&sc->sc_ccb_queue, ccb, ccb_chain); while ((ccb = SIMPLEQ_FIRST(&sc->sc_ccb_queue)) != NULL) { if ((*sc->sc_cl.cl_fifo_full)(sc)) return (EAGAIN); SIMPLEQ_REMOVE_HEAD(&sc->sc_ccb_queue, ccb_chain); #ifdef DIAGNOSTIC ccb->ccb_flags |= CAC_CCB_ACTIVE; #endif (*sc->sc_cl.cl_submit)(sc, ccb); } return (0); } /* * Process a finished CCB. */ static void cac_ccb_done(struct cac_softc *sc, struct cac_ccb *ccb) { struct device *dv; void *context; int error; error = 0; #ifdef DIAGNOSTIC if ((ccb->ccb_flags & CAC_CCB_ACTIVE) == 0) panic("cac_ccb_done: CCB not active"); ccb->ccb_flags &= ~CAC_CCB_ACTIVE; #endif if ((ccb->ccb_flags & (CAC_CCB_DATA_IN | CAC_CCB_DATA_OUT)) != 0) { bus_dmamap_sync(sc->sc_dmat, ccb->ccb_dmamap_xfer, 0, ccb->ccb_datasize, ccb->ccb_flags & CAC_CCB_DATA_IN ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE); bus_dmamap_unload(sc->sc_dmat, ccb->ccb_dmamap_xfer); } error = ccb->ccb_req.error; if (ccb->ccb_context.cc_handler != NULL) { dv = ccb->ccb_context.cc_dv; context = ccb->ccb_context.cc_context; cac_ccb_free(sc, ccb); (*ccb->ccb_context.cc_handler)(dv, context, error); } else { if ((error & CAC_RET_SOFT_ERROR) != 0) printf("%s: soft error; array may be degraded\n", sc->sc_dv.dv_xname); if ((error & CAC_RET_HARD_ERROR) != 0) printf("%s: hard error\n", sc->sc_dv.dv_xname); if ((error & CAC_RET_CMD_REJECTED) != 0) { error = 1; printf("%s: invalid request\n", sc->sc_dv.dv_xname); } } } /* * Allocate a CCB. */ static struct cac_ccb * cac_ccb_alloc(struct cac_softc *sc, int nosleep) { struct cac_ccb *ccb; int s; s = splbio(); for (;;) { if ((ccb = SIMPLEQ_FIRST(&sc->sc_ccb_free)) != NULL) { SIMPLEQ_REMOVE_HEAD(&sc->sc_ccb_free, ccb_chain); break; } if (nosleep) { ccb = NULL; break; } tsleep(&sc->sc_ccb_free, PRIBIO, "cacccb", 0); } splx(s); return (ccb); } /* * Put a CCB onto the freelist. */ static void cac_ccb_free(struct cac_softc *sc, struct cac_ccb *ccb) { int s; ccb->ccb_flags = 0; s = splbio(); SIMPLEQ_INSERT_HEAD(&sc->sc_ccb_free, ccb, ccb_chain); if (SIMPLEQ_NEXT(ccb, ccb_chain) == NULL) wakeup_one(&sc->sc_ccb_free); splx(s); } /* * Board specific linkage shared between multiple bus types. */ static int cac_l0_fifo_full(struct cac_softc *sc) { return (cac_inl(sc, CAC_REG_CMD_FIFO) == 0); } static void cac_l0_submit(struct cac_softc *sc, struct cac_ccb *ccb) { bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap, (caddr_t)ccb - sc->sc_ccbs, sizeof(struct cac_ccb), BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD); cac_outl(sc, CAC_REG_CMD_FIFO, ccb->ccb_paddr); } static struct cac_ccb * cac_l0_completed(struct cac_softc *sc) { struct cac_ccb *ccb; paddr_t off; if ((off = cac_inl(sc, CAC_REG_DONE_FIFO)) == 0) return (NULL); if ((off & 3) != 0) printf("%s: failed command list returned: %lx\n", sc->sc_dv.dv_xname, (long)off); off = (off & ~3) - sc->sc_ccbs_paddr; ccb = (struct cac_ccb *)(sc->sc_ccbs + off); bus_dmamap_sync(sc->sc_dmat, sc->sc_dmamap, off, sizeof(struct cac_ccb), BUS_DMASYNC_POSTWRITE | BUS_DMASYNC_POSTREAD); return (ccb); } static int cac_l0_intr_pending(struct cac_softc *sc) { return (cac_inl(sc, CAC_REG_INTR_PENDING) & CAC_INTR_ENABLE); } static void cac_l0_intr_enable(struct cac_softc *sc, int state) { cac_outl(sc, CAC_REG_INTR_MASK, state ? CAC_INTR_ENABLE : CAC_INTR_DISABLE); }