The Design and Implementation of the FreeBSD Operating System, Second Edition
Now available: The Design and Implementation of the FreeBSD Operating System (Second Edition)


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]

FreeBSD/Linux Kernel Cross Reference
sys/dev/ida/ida.c

Version: -  FREEBSD  -  FREEBSD-13-STABLE  -  FREEBSD-13-0  -  FREEBSD-12-STABLE  -  FREEBSD-12-0  -  FREEBSD-11-STABLE  -  FREEBSD-11-0  -  FREEBSD-10-STABLE  -  FREEBSD-10-0  -  FREEBSD-9-STABLE  -  FREEBSD-9-0  -  FREEBSD-8-STABLE  -  FREEBSD-8-0  -  FREEBSD-7-STABLE  -  FREEBSD-7-0  -  FREEBSD-6-STABLE  -  FREEBSD-6-0  -  FREEBSD-5-STABLE  -  FREEBSD-5-0  -  FREEBSD-4-STABLE  -  FREEBSD-3-STABLE  -  FREEBSD22  -  l41  -  OPENBSD  -  linux-2.6  -  MK84  -  PLAN9  -  xnu-8792 
SearchContext: -  none  -  3  -  10 

    1 /*-
    2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
    3  *
    4  * Copyright (c) 1999,2000 Jonathan Lemon
    5  * All rights reserved.
    6  *
    7  # Derived from the original IDA Compaq RAID driver, which is
    8  * Copyright (c) 1996, 1997, 1998, 1999
    9  *    Mark Dawson and David James. All rights reserved.
   10  *
   11  * Redistribution and use in source and binary forms, with or without
   12  * modification, are permitted provided that the following conditions
   13  * are met:
   14  * 1. Redistributions of source code must retain the above copyright
   15  *    notice, this list of conditions and the following disclaimer.
   16  * 2. Redistributions in binary form must reproduce the above copyright
   17  *    notice, this list of conditions and the following disclaimer in the
   18  *    documentation and/or other materials provided with the distribution.
   19  *
   20  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
   21  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
   22  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
   23  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
   24  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
   25  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
   26  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
   27  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
   28  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
   29  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
   30  * SUCH DAMAGE.
   31  */
   32 
   33 #include <sys/cdefs.h>
   34 __FBSDID("$FreeBSD$");
   35 
   36 /*
   37  * Generic driver for Compaq SMART RAID adapters.
   38  */
   39 
   40 #include <sys/param.h>
   41 #include <sys/kernel.h>
   42 #include <sys/systm.h>
   43 #include <sys/lock.h>
   44 #include <sys/malloc.h>
   45 #include <sys/mutex.h>
   46 #include <sys/stat.h>
   47 
   48 #include <sys/bio.h>
   49 #include <sys/bus.h>
   50 #include <sys/conf.h>
   51 #include <sys/endian.h>
   52 
   53 #include <machine/bus.h>
   54 #include <sys/rman.h>
   55 
   56 #include <geom/geom_disk.h>
   57 
   58 #include <dev/ida/idareg.h>
   59 #include <dev/ida/idavar.h>
   60 #include <dev/ida/idaio.h>
   61 
   62 /* prototypes */
   63 static int ida_alloc_qcbs(struct ida_softc *ida);
   64 static void ida_done(struct ida_softc *ida, struct ida_qcb *qcb);
   65 static void ida_start(struct ida_softc *ida);
   66 static void ida_startio(struct ida_softc *ida);
   67 static void ida_startup(void *arg);
   68 static void ida_timeout(void *arg);
   69 static int ida_wait(struct ida_softc *ida, struct ida_qcb *qcb);
   70 
   71 static d_ioctl_t ida_ioctl;
   72 static struct cdevsw ida_cdevsw = {
   73         .d_version =    D_VERSION,
   74         .d_ioctl =      ida_ioctl,
   75         .d_name =       "ida",
   76 };
   77 
   78 void
   79 ida_free(struct ida_softc *ida)
   80 {
   81         int i;
   82 
   83         if (ida->ih != NULL)
   84                 bus_teardown_intr(ida->dev, ida->irq, ida->ih);
   85 
   86         mtx_lock(&ida->lock);
   87         callout_stop(&ida->ch);
   88         mtx_unlock(&ida->lock);
   89         callout_drain(&ida->ch);
   90 
   91         if (ida->buffer_dmat) {
   92                 for (i = 0; i < IDA_QCB_MAX; i++)
   93                         bus_dmamap_destroy(ida->buffer_dmat, ida->qcbs[i].dmamap);
   94                 bus_dma_tag_destroy(ida->buffer_dmat);
   95         }
   96 
   97         if (ida->hwqcb_dmat) {
   98                 if (ida->hwqcb_busaddr)
   99                         bus_dmamap_unload(ida->hwqcb_dmat, ida->hwqcb_dmamap);
  100                 if (ida->hwqcbs)
  101                         bus_dmamem_free(ida->hwqcb_dmat, ida->hwqcbs,
  102                             ida->hwqcb_dmamap);
  103                 bus_dma_tag_destroy(ida->hwqcb_dmat);
  104         }
  105 
  106         if (ida->qcbs != NULL)
  107                 free(ida->qcbs, M_DEVBUF);
  108 
  109         if (ida->irq != NULL)
  110                 bus_release_resource(ida->dev, ida->irq_res_type,
  111                     0, ida->irq);
  112 
  113         if (ida->parent_dmat != NULL)
  114                 bus_dma_tag_destroy(ida->parent_dmat);
  115 
  116         if (ida->regs != NULL)
  117                 bus_release_resource(ida->dev, ida->regs_res_type,
  118                     ida->regs_res_id, ida->regs);
  119 
  120         mtx_destroy(&ida->lock);
  121 }
  122 
  123 /*
  124  * record bus address from bus_dmamap_load
  125  */
  126 static void
  127 ida_dma_map_cb(void *arg, bus_dma_segment_t *segs, int nseg, int error)
  128 {
  129         bus_addr_t *baddr;
  130 
  131         baddr = (bus_addr_t *)arg;
  132         *baddr = segs->ds_addr;
  133 }
  134 
  135 static __inline struct ida_qcb *
  136 ida_get_qcb(struct ida_softc *ida)
  137 {
  138         struct ida_qcb *qcb;
  139 
  140         if ((qcb = SLIST_FIRST(&ida->free_qcbs)) != NULL) {
  141                 SLIST_REMOVE_HEAD(&ida->free_qcbs, link.sle);
  142                 bzero(qcb->hwqcb, sizeof(struct ida_hdr) + sizeof(struct ida_req));
  143         }
  144         return (qcb);
  145 }
  146 
  147 static __inline void
  148 ida_free_qcb(struct ida_softc *ida, struct ida_qcb *qcb)
  149 {
  150 
  151         qcb->state = QCB_FREE;
  152         qcb->buf = NULL;
  153         qcb->error = 0;
  154         SLIST_INSERT_HEAD(&ida->free_qcbs, qcb, link.sle);
  155 }
  156 
  157 static __inline bus_addr_t
  158 idahwqcbvtop(struct ida_softc *ida, struct ida_hardware_qcb *hwqcb)
  159 {
  160         return (ida->hwqcb_busaddr +
  161             ((bus_addr_t)hwqcb - (bus_addr_t)ida->hwqcbs));
  162 }
  163 
  164 static __inline struct ida_qcb *
  165 idahwqcbptov(struct ida_softc *ida, bus_addr_t hwqcb_addr)
  166 {
  167         struct ida_hardware_qcb *hwqcb;
  168 
  169         hwqcb = (struct ida_hardware_qcb *)
  170             ((bus_addr_t)ida->hwqcbs + (hwqcb_addr - ida->hwqcb_busaddr));
  171         return (hwqcb->qcb);
  172 }
  173 
  174 static int
  175 ida_alloc_qcbs(struct ida_softc *ida)
  176 {
  177         struct ida_qcb *qcb;
  178         int error, i;
  179 
  180         for (i = 0; i < IDA_QCB_MAX; i++) {
  181                 qcb = &ida->qcbs[i];
  182 
  183                 error = bus_dmamap_create(ida->buffer_dmat, /*flags*/0, &qcb->dmamap);
  184                 if (error != 0)
  185                         return (error);
  186 
  187                 qcb->ida = ida;
  188                 qcb->flags = QCB_FREE;
  189                 qcb->hwqcb = &ida->hwqcbs[i];
  190                 qcb->hwqcb->qcb = qcb;
  191                 qcb->hwqcb_busaddr = idahwqcbvtop(ida, qcb->hwqcb);
  192                 SLIST_INSERT_HEAD(&ida->free_qcbs, qcb, link.sle);
  193         }
  194         return (0);
  195 }
  196 
  197 int
  198 ida_setup(struct ida_softc *ida)
  199 {
  200         struct ida_controller_info cinfo;
  201         device_t child;
  202         int error, i, unit;
  203 
  204         SLIST_INIT(&ida->free_qcbs);
  205         STAILQ_INIT(&ida->qcb_queue);
  206         bioq_init(&ida->bio_queue);
  207 
  208         ida->qcbs = (struct ida_qcb *)
  209             malloc(IDA_QCB_MAX * sizeof(struct ida_qcb), M_DEVBUF,
  210                 M_NOWAIT | M_ZERO);
  211         if (ida->qcbs == NULL)
  212                 return (ENOMEM);
  213 
  214         /*
  215          * Create our DMA tags
  216          */
  217 
  218         /* DMA tag for our hardware QCB structures */
  219         error = bus_dma_tag_create(
  220                 /* parent       */ ida->parent_dmat,
  221                 /* alignment    */ 1,
  222                 /* boundary     */ 0,
  223                 /* lowaddr      */ BUS_SPACE_MAXADDR,
  224                 /* highaddr     */ BUS_SPACE_MAXADDR,
  225                 /* filter       */ NULL,
  226                 /* filterarg    */ NULL,
  227                 /* maxsize      */ IDA_QCB_MAX * sizeof(struct ida_hardware_qcb),
  228                 /* nsegments    */ 1,
  229                 /* maxsegsz     */ BUS_SPACE_MAXSIZE_32BIT,
  230                 /* flags        */ 0,
  231                 /* lockfunc     */ NULL,
  232                 /* lockarg      */ NULL,
  233                 &ida->hwqcb_dmat);
  234         if (error)
  235                 return (ENOMEM);
  236 
  237         /* DMA tag for mapping buffers into device space */
  238         error = bus_dma_tag_create(
  239                 /* parent       */ ida->parent_dmat,
  240                 /* alignment    */ 1,
  241                 /* boundary     */ 0,
  242                 /* lowaddr      */ BUS_SPACE_MAXADDR,
  243                 /* highaddr     */ BUS_SPACE_MAXADDR,
  244                 /* filter       */ NULL,
  245                 /* filterarg    */ NULL,
  246                 /* maxsize      */ DFLTPHYS,
  247                 /* nsegments    */ IDA_NSEG,
  248                 /* maxsegsz     */ BUS_SPACE_MAXSIZE_32BIT,
  249                 /* flags        */ 0,
  250                 /* lockfunc     */ busdma_lock_mutex,
  251                 /* lockarg      */ &ida->lock,
  252                 &ida->buffer_dmat);
  253         if (error)
  254                 return (ENOMEM);
  255 
  256         /* Allocation of hardware QCBs */
  257         /* XXX allocation is rounded to hardware page size */
  258         error = bus_dmamem_alloc(ida->hwqcb_dmat,
  259             (void **)&ida->hwqcbs, BUS_DMA_NOWAIT, &ida->hwqcb_dmamap);
  260         if (error)
  261                 return (ENOMEM);
  262 
  263         /* And permanently map them in */
  264         bus_dmamap_load(ida->hwqcb_dmat, ida->hwqcb_dmamap,
  265             ida->hwqcbs, IDA_QCB_MAX * sizeof(struct ida_hardware_qcb),
  266             ida_dma_map_cb, &ida->hwqcb_busaddr, /*flags*/0);
  267 
  268         bzero(ida->hwqcbs, IDA_QCB_MAX * sizeof(struct ida_hardware_qcb));
  269 
  270         error = ida_alloc_qcbs(ida);
  271         if (error)
  272                 return (error);
  273 
  274         mtx_lock(&ida->lock);
  275         ida->cmd.int_enable(ida, 0);
  276 
  277         error = ida_command(ida, CMD_GET_CTRL_INFO, &cinfo, sizeof(cinfo),
  278             IDA_CONTROLLER, 0, DMA_DATA_IN);
  279         if (error) {
  280                 mtx_unlock(&ida->lock);
  281                 device_printf(ida->dev, "CMD_GET_CTRL_INFO failed.\n");
  282                 return (error);
  283         }
  284 
  285         device_printf(ida->dev, "drives=%d firm_rev=%c%c%c%c\n",
  286             cinfo.num_drvs, cinfo.firm_rev[0], cinfo.firm_rev[1],
  287             cinfo.firm_rev[2], cinfo.firm_rev[3]);
  288 
  289         if (ida->flags & IDA_FIRMWARE) {
  290                 int data;
  291 
  292                 error = ida_command(ida, CMD_START_FIRMWARE,
  293                     &data, sizeof(data), IDA_CONTROLLER, 0, DMA_DATA_IN);
  294                 if (error) {
  295                         mtx_unlock(&ida->lock);
  296                         device_printf(ida->dev, "CMD_START_FIRMWARE failed.\n");
  297                         return (error);
  298                 }
  299         }
  300         
  301         ida->cmd.int_enable(ida, 1);
  302         ida->flags |= IDA_ATTACHED;
  303         mtx_unlock(&ida->lock);
  304 
  305         for (i = 0; i < cinfo.num_drvs; i++) {
  306                 child = device_add_child(ida->dev, /*"idad"*/NULL, -1);
  307                 if (child != NULL)
  308                         device_set_ivars(child, (void *)(intptr_t)i);
  309         }
  310 
  311         ida->ich.ich_func = ida_startup;
  312         ida->ich.ich_arg = ida;
  313         if (config_intrhook_establish(&ida->ich) != 0) {
  314                 device_delete_children(ida->dev);
  315                 device_printf(ida->dev, "Cannot establish configuration hook\n");
  316                 return (error);
  317         }
  318 
  319         unit = device_get_unit(ida->dev);
  320         ida->ida_dev_t = make_dev(&ida_cdevsw, unit,
  321                                  UID_ROOT, GID_OPERATOR, S_IRUSR | S_IWUSR,
  322                                  "ida%d", unit);
  323         ida->ida_dev_t->si_drv1 = ida;
  324 
  325         return (0);
  326 }
  327 
  328 static void
  329 ida_startup(void *arg)
  330 {
  331         struct ida_softc *ida;
  332 
  333         ida = arg;
  334 
  335         config_intrhook_disestablish(&ida->ich);
  336 
  337         bus_topo_lock();
  338         bus_generic_attach(ida->dev);
  339         bus_topo_unlock();
  340 }
  341 
  342 int
  343 ida_detach(device_t dev)
  344 {
  345         struct ida_softc *ida;
  346         int error;
  347 
  348         ida = (struct ida_softc *)device_get_softc(dev);
  349 
  350         error = bus_generic_detach(dev);
  351         if (error)
  352                 return (error);
  353         error = device_delete_children(dev);
  354         if (error)
  355                 return (error);
  356 
  357         /*
  358          * XXX
  359          * before detaching, we must make sure that the system is
  360          * quiescent; nothing mounted, no pending activity.
  361          */
  362 
  363         /*
  364          * XXX
  365          * now, how are we supposed to maintain a list of our drives?
  366          * iterate over our "child devices"?
  367          */
  368 
  369         destroy_dev(ida->ida_dev_t);
  370         ida_free(ida);
  371         return (error);
  372 }
  373 
  374 static void
  375 ida_data_cb(void *arg, bus_dma_segment_t *segs, int nsegments, int error)
  376 {
  377         struct ida_hardware_qcb *hwqcb;
  378         struct ida_softc *ida;
  379         struct ida_qcb *qcb;
  380         bus_dmasync_op_t op;
  381         int i;
  382 
  383         qcb = arg;
  384         ida = qcb->ida;
  385         if (!dumping)
  386                 mtx_assert(&ida->lock, MA_OWNED);
  387         if (error) {
  388                 qcb->error = error;
  389                 ida_done(ida, qcb);
  390                 return;
  391         }
  392 
  393         hwqcb = qcb->hwqcb;
  394         hwqcb->hdr.size = htole16((sizeof(struct ida_req) +
  395             sizeof(struct ida_sgb) * IDA_NSEG) >> 2);
  396 
  397         for (i = 0; i < nsegments; i++) {
  398                 hwqcb->seg[i].addr = htole32(segs[i].ds_addr);
  399                 hwqcb->seg[i].length = htole32(segs[i].ds_len);
  400         }
  401         hwqcb->req.sgcount = nsegments;
  402         if (qcb->flags & DMA_DATA_TRANSFER) {
  403                 switch (qcb->flags & DMA_DATA_TRANSFER) {
  404                 case DMA_DATA_TRANSFER:
  405                         op = BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE;
  406                         break;
  407                 case DMA_DATA_IN:
  408                         op = BUS_DMASYNC_PREREAD;
  409                         break;
  410                 default:
  411                         KASSERT((qcb->flags & DMA_DATA_TRANSFER) ==
  412                             DMA_DATA_OUT, ("bad DMA data flags"));
  413                         op = BUS_DMASYNC_PREWRITE;
  414                         break;
  415                 }
  416                 bus_dmamap_sync(ida->buffer_dmat, qcb->dmamap, op);
  417         }
  418         bus_dmamap_sync(ida->hwqcb_dmat, ida->hwqcb_dmamap,
  419             BUS_DMASYNC_PREWRITE | BUS_DMASYNC_PREREAD);
  420 
  421         STAILQ_INSERT_TAIL(&ida->qcb_queue, qcb, link.stqe);
  422         ida_start(ida);
  423         ida->flags &= ~IDA_QFROZEN;
  424 }
  425 
  426 static int
  427 ida_map_qcb(struct ida_softc *ida, struct ida_qcb *qcb, void *data,
  428     bus_size_t datasize)
  429 {
  430         int error, flags;
  431 
  432         if (ida->flags & IDA_INTERRUPTS)
  433                 flags = BUS_DMA_WAITOK;
  434         else
  435                 flags = BUS_DMA_NOWAIT;
  436         error = bus_dmamap_load(ida->buffer_dmat, qcb->dmamap, data, datasize,
  437             ida_data_cb, qcb, flags);
  438         if (error == EINPROGRESS) {
  439                 ida->flags |= IDA_QFROZEN;
  440                 error = 0;
  441         }
  442         return (error);
  443 }
  444 
  445 int
  446 ida_command(struct ida_softc *ida, int command, void *data, int datasize,
  447         int drive, u_int32_t pblkno, int flags)
  448 {
  449         struct ida_hardware_qcb *hwqcb;
  450         struct ida_qcb *qcb;
  451         int error;
  452 
  453         if (!dumping)
  454                 mtx_assert(&ida->lock, MA_OWNED);
  455         qcb = ida_get_qcb(ida);
  456 
  457         if (qcb == NULL) {
  458                 device_printf(ida->dev, "out of QCBs\n");
  459                 return (EAGAIN);
  460         }
  461 
  462         qcb->flags = flags | IDA_COMMAND;
  463         hwqcb = qcb->hwqcb;
  464         hwqcb->hdr.drive = drive;
  465         hwqcb->req.blkno = htole32(pblkno);
  466         hwqcb->req.bcount = htole16(howmany(datasize, DEV_BSIZE));
  467         hwqcb->req.command = command;
  468 
  469         error = ida_map_qcb(ida, qcb, data, datasize);
  470         if (error == 0) {
  471                 error = ida_wait(ida, qcb);
  472                 /* Don't free QCB on a timeout in case it later completes. */
  473                 if (error)
  474                         return (error);
  475                 error = qcb->error;
  476         }
  477 
  478         /* XXX should have status returned here? */
  479         /* XXX have "status pointer" area in QCB? */
  480 
  481         ida_free_qcb(ida, qcb);
  482         return (error);
  483 }
  484 
  485 void
  486 ida_submit_buf(struct ida_softc *ida, struct bio *bp)
  487 {
  488         mtx_lock(&ida->lock);
  489         bioq_insert_tail(&ida->bio_queue, bp);
  490         ida_startio(ida);
  491         mtx_unlock(&ida->lock);
  492 }
  493 
  494 static void
  495 ida_startio(struct ida_softc *ida)
  496 {
  497         struct ida_hardware_qcb *hwqcb;
  498         struct ida_qcb *qcb;
  499         struct idad_softc *drv;
  500         struct bio *bp;
  501         int error;
  502 
  503         mtx_assert(&ida->lock, MA_OWNED);
  504         for (;;) {
  505                 if (ida->flags & IDA_QFROZEN)
  506                         return;
  507                 bp = bioq_first(&ida->bio_queue);
  508                 if (bp == NULL)
  509                         return;                         /* no more buffers */
  510 
  511                 qcb = ida_get_qcb(ida);
  512                 if (qcb == NULL)
  513                         return;                         /* out of resources */
  514 
  515                 bioq_remove(&ida->bio_queue, bp);
  516                 qcb->buf = bp;
  517                 qcb->flags = bp->bio_cmd == BIO_READ ? DMA_DATA_IN : DMA_DATA_OUT;
  518 
  519                 hwqcb = qcb->hwqcb;
  520                 drv = bp->bio_driver1;
  521                 hwqcb->hdr.drive = drv->drive;
  522                 hwqcb->req.blkno = bp->bio_pblkno;
  523                 hwqcb->req.bcount = howmany(bp->bio_bcount, DEV_BSIZE);
  524                 hwqcb->req.command = bp->bio_cmd == BIO_READ ? CMD_READ : CMD_WRITE;
  525 
  526                 error = ida_map_qcb(ida, qcb, bp->bio_data, bp->bio_bcount);
  527                 if (error) {
  528                         qcb->error = error;
  529                         ida_done(ida, qcb);
  530                 }
  531         }
  532 }
  533 
  534 static void
  535 ida_start(struct ida_softc *ida)
  536 {
  537         struct ida_qcb *qcb;
  538 
  539         if (!dumping)
  540                 mtx_assert(&ida->lock, MA_OWNED);
  541         while ((qcb = STAILQ_FIRST(&ida->qcb_queue)) != NULL) {
  542                 if (ida->cmd.fifo_full(ida))
  543                         break;
  544                 STAILQ_REMOVE_HEAD(&ida->qcb_queue, link.stqe);
  545                 /*
  546                  * XXX
  547                  * place the qcb on an active list?
  548                  */
  549 
  550                 /* Set a timeout. */
  551                 if (!ida->qactive && !dumping)
  552                         callout_reset(&ida->ch, hz * 5, ida_timeout, ida);
  553                 ida->qactive++;
  554 
  555                 qcb->state = QCB_ACTIVE;
  556                 ida->cmd.submit(ida, qcb);
  557         }
  558 }
  559 
  560 static int
  561 ida_wait(struct ida_softc *ida, struct ida_qcb *qcb)
  562 {
  563         struct ida_qcb *qcb_done = NULL;
  564         bus_addr_t completed;
  565         int delay;
  566 
  567         if (!dumping)
  568                 mtx_assert(&ida->lock, MA_OWNED);
  569         if (ida->flags & IDA_INTERRUPTS) {
  570                 if (mtx_sleep(qcb, &ida->lock, PRIBIO, "idacmd", 5 * hz)) {
  571                         qcb->state = QCB_TIMEDOUT;
  572                         return (ETIMEDOUT);
  573                 }
  574                 return (0);
  575         }
  576 
  577 again:
  578         delay = 5 * 1000 * 100;                 /* 5 sec delay */
  579         while ((completed = ida->cmd.done(ida)) == 0) {
  580                 if (delay-- == 0) {
  581                         qcb->state = QCB_TIMEDOUT;
  582                         return (ETIMEDOUT);
  583                 }
  584                 DELAY(10);
  585         }
  586 
  587         qcb_done = idahwqcbptov(ida, completed & ~3);
  588         if (qcb_done != qcb)
  589                 goto again;
  590         ida_done(ida, qcb);
  591         return (0);
  592 }
  593 
  594 void
  595 ida_intr(void *data)
  596 {
  597         struct ida_softc *ida;
  598         struct ida_qcb *qcb;
  599         bus_addr_t completed;
  600 
  601         ida = (struct ida_softc *)data;
  602 
  603         mtx_lock(&ida->lock);
  604         if (ida->cmd.int_pending(ida) == 0) {
  605                 mtx_unlock(&ida->lock);
  606                 return;                         /* not our interrupt */
  607         }
  608 
  609         while ((completed = ida->cmd.done(ida)) != 0) {
  610                 qcb = idahwqcbptov(ida, completed & ~3);
  611 
  612                 if (qcb == NULL || qcb->state != QCB_ACTIVE) {
  613                         device_printf(ida->dev,
  614                             "ignoring completion %jx\n", (intmax_t)completed);
  615                         continue;
  616                 }
  617                 /* Handle "Bad Command List" errors. */
  618                 if ((completed & 3) && (qcb->hwqcb->req.error == 0))
  619                         qcb->hwqcb->req.error = CMD_REJECTED;
  620                 ida_done(ida, qcb);
  621         }
  622         ida_startio(ida);
  623         mtx_unlock(&ida->lock);
  624 }
  625 
  626 /*
  627  * should switch out command type; may be status, not just I/O.
  628  */
  629 static void
  630 ida_done(struct ida_softc *ida, struct ida_qcb *qcb)
  631 {
  632         bus_dmasync_op_t op;
  633         int active, error = 0;
  634 
  635         /*
  636          * finish up command
  637          */
  638         if (!dumping)
  639                 mtx_assert(&ida->lock, MA_OWNED);
  640         active = (qcb->state != QCB_FREE);
  641         if (qcb->flags & DMA_DATA_TRANSFER && active) {
  642                 switch (qcb->flags & DMA_DATA_TRANSFER) {
  643                 case DMA_DATA_TRANSFER:
  644                         op = BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE;
  645                         break;
  646                 case DMA_DATA_IN:
  647                         op = BUS_DMASYNC_POSTREAD;
  648                         break;
  649                 default:
  650                         KASSERT((qcb->flags & DMA_DATA_TRANSFER) ==
  651                             DMA_DATA_OUT, ("bad DMA data flags"));
  652                         op = BUS_DMASYNC_POSTWRITE;
  653                         break;
  654                 }
  655                 bus_dmamap_sync(ida->buffer_dmat, qcb->dmamap, op);
  656                 bus_dmamap_unload(ida->buffer_dmat, qcb->dmamap);
  657         }
  658         if (active)
  659                 bus_dmamap_sync(ida->hwqcb_dmat, ida->hwqcb_dmamap,
  660                     BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
  661 
  662         if (qcb->hwqcb->req.error & SOFT_ERROR) {
  663                 if (qcb->buf)
  664                         device_printf(ida->dev, "soft %s error\n",
  665                                 qcb->buf->bio_cmd == BIO_READ ?
  666                                         "read" : "write");
  667                 else
  668                         device_printf(ida->dev, "soft error\n");
  669         }
  670         if (qcb->hwqcb->req.error & HARD_ERROR) {
  671                 error = 1;
  672                 if (qcb->buf)
  673                         device_printf(ida->dev, "hard %s error\n",
  674                                 qcb->buf->bio_cmd == BIO_READ ?
  675                                         "read" : "write");
  676                 else
  677                         device_printf(ida->dev, "hard error\n");
  678         }
  679         if (qcb->hwqcb->req.error & CMD_REJECTED) {
  680                 error = 1;
  681                 device_printf(ida->dev, "invalid request\n");
  682         }
  683         if (qcb->error) {
  684                 error = 1;
  685                 device_printf(ida->dev, "request failed to map: %d\n", qcb->error);
  686         }
  687 
  688         if (qcb->flags & IDA_COMMAND) {
  689                 if (ida->flags & IDA_INTERRUPTS)
  690                         wakeup(qcb);
  691                 if (qcb->state == QCB_TIMEDOUT)
  692                         ida_free_qcb(ida, qcb);
  693         } else {
  694                 KASSERT(qcb->buf != NULL, ("ida_done(): qcb->buf is NULL!"));
  695                 if (error)
  696                         qcb->buf->bio_flags |= BIO_ERROR;
  697                 idad_intr(qcb->buf);
  698                 ida_free_qcb(ida, qcb);
  699         }
  700 
  701         if (!active)
  702                 return;
  703 
  704         ida->qactive--;
  705         /* Reschedule or cancel timeout */
  706         if (ida->qactive)
  707                 callout_reset(&ida->ch, hz * 5, ida_timeout, ida);
  708         else
  709                 callout_stop(&ida->ch);
  710 }
  711 
  712 static void
  713 ida_timeout(void *arg)
  714 {
  715         struct ida_softc *ida;
  716 
  717         ida = (struct ida_softc *)arg;
  718         device_printf(ida->dev, "%s() qactive %d\n", __func__, ida->qactive);
  719 
  720         if (ida->flags & IDA_INTERRUPTS)
  721                 device_printf(ida->dev, "IDA_INTERRUPTS\n");
  722 
  723         device_printf(ida->dev, "\t   R_CMD_FIFO: %08x\n"
  724                                 "\t  R_DONE_FIFO: %08x\n"
  725                                 "\t   R_INT_MASK: %08x\n"
  726                                 "\t     R_STATUS: %08x\n"
  727                                 "\tR_INT_PENDING: %08x\n",
  728                                         ida_inl(ida, R_CMD_FIFO),
  729                                         ida_inl(ida, R_DONE_FIFO),
  730                                         ida_inl(ida, R_INT_MASK),
  731                                         ida_inl(ida, R_STATUS),
  732                                         ida_inl(ida, R_INT_PENDING));
  733 
  734         return;
  735 }
  736 
  737 /*
  738  * IOCTL stuff follows.
  739  */
  740 struct cmd_info {
  741         int     cmd;
  742         int     len;
  743         int     flags;
  744 };
  745 static struct cmd_info *ida_cmd_lookup(int);
  746 
  747 static int
  748 ida_ioctl (struct cdev *dev, u_long cmd, caddr_t addr, int32_t flag, struct thread *td)
  749 {
  750         struct ida_softc *sc;
  751         struct ida_user_command *uc;
  752         struct cmd_info *ci;
  753         int len;
  754         int flags;
  755         int error;
  756         int data;
  757         void *daddr;
  758 
  759         sc = (struct ida_softc *)dev->si_drv1;
  760         uc = (struct ida_user_command *)addr;
  761         error = 0;
  762 
  763         switch (cmd) {
  764         case IDAIO_COMMAND:
  765                 ci = ida_cmd_lookup(uc->command);
  766                 if (ci == NULL) {
  767                         error = EINVAL;
  768                         break;
  769                 }
  770                 len = ci->len;
  771                 flags = ci->flags;
  772                 if (len)
  773                         daddr = &uc->d.buf;
  774                 else {
  775                         daddr = &data;
  776                         len = sizeof(data);
  777                 }
  778                 mtx_lock(&sc->lock);
  779                 error = ida_command(sc, uc->command, daddr, len,
  780                                     uc->drive, uc->blkno, flags);
  781                 mtx_unlock(&sc->lock);
  782                 break;
  783         default:
  784                 error = ENOIOCTL;
  785                 break;
  786         }
  787         return (error);
  788 }
  789 
  790 static struct cmd_info ci_list[] = {
  791         { CMD_GET_LOG_DRV_INFO,
  792                         sizeof(struct ida_drive_info), DMA_DATA_IN },
  793         { CMD_GET_CTRL_INFO,
  794                         sizeof(struct ida_controller_info), DMA_DATA_IN },
  795         { CMD_SENSE_DRV_STATUS,
  796                         sizeof(struct ida_drive_status), DMA_DATA_IN },
  797         { CMD_START_RECOVERY,           0, 0 },
  798         { CMD_GET_PHYS_DRV_INFO,
  799                         sizeof(struct ida_phys_drv_info), DMA_DATA_TRANSFER },
  800         { CMD_BLINK_DRV_LEDS,
  801                         sizeof(struct ida_blink_drv_leds), DMA_DATA_OUT },
  802         { CMD_SENSE_DRV_LEDS,
  803                         sizeof(struct ida_blink_drv_leds), DMA_DATA_IN },
  804         { CMD_GET_LOG_DRV_EXT,
  805                         sizeof(struct ida_drive_info_ext), DMA_DATA_IN },
  806         { CMD_RESET_CTRL,               0, 0 },
  807         { CMD_GET_CONFIG,               0, 0 },
  808         { CMD_SET_CONFIG,               0, 0 },
  809         { CMD_LABEL_LOG_DRV,
  810                         sizeof(struct ida_label_logical), DMA_DATA_OUT },
  811         { CMD_SET_SURFACE_DELAY,        0, 0 },
  812         { CMD_SENSE_BUS_PARAMS,         0, 0 },
  813         { CMD_SENSE_SUBSYS_INFO,        0, 0 },
  814         { CMD_SENSE_SURFACE_ATS,        0, 0 },
  815         { CMD_PASSTHROUGH,              0, 0 },
  816         { CMD_RESET_SCSI_DEV,           0, 0 },
  817         { CMD_PAUSE_BG_ACT,             0, 0 },
  818         { CMD_RESUME_BG_ACT,            0, 0 },
  819         { CMD_START_FIRMWARE,           0, 0 },
  820         { CMD_SENSE_DRV_ERR_LOG,        0, 0 },
  821         { CMD_START_CPM,                0, 0 },
  822         { CMD_SENSE_CP,                 0, 0 },
  823         { CMD_STOP_CPM,                 0, 0 },
  824         { CMD_FLUSH_CACHE,              0, 0 },
  825         { CMD_ACCEPT_MEDIA_EXCH,        0, 0 },
  826         { 0, 0, 0 }
  827 };
  828 
  829 static struct cmd_info *
  830 ida_cmd_lookup (int command)
  831 {
  832         struct cmd_info *ci;
  833 
  834         ci = ci_list;
  835         while (ci->cmd) {
  836                 if (ci->cmd == command)
  837                         return (ci);
  838                 ci++;
  839         }
  840         return (NULL);
  841 }

Cache object: 8523e3cc652dbad73d50c36d3e48232b


[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ] [ list types ] [ track identifier ]


This page is part of the FreeBSD/Linux Linux Kernel Cross-Reference, and was automatically generated using a modified version of the LXR engine.