sys/dev/ips/ips_disk.c

   1 /*-
   2  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   3  *
   4  * Written by: David Jeffery
   5  * Copyright (c) 2002 Adaptec Inc.
   6  * All rights reserved.
   7  *
   8  * Redistribution and use in source and binary forms, with or without
   9  * modification, are permitted provided that the following conditions
  10  * are met:
  11  * 1. Redistributions of source code must retain the above copyright
  12  *    notice, this list of conditions and the following disclaimer.
  13  * 2. Redistributions in binary form must reproduce the above copyright
  14  *    notice, this list of conditions and the following disclaimer in the
  15  *    documentation and/or other materials provided with the distribution.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  27  * SUCH DAMAGE.
  28  */
  29
  30 #include <sys/cdefs.h>
  31 __FBSDID("$FreeBSD$");
  32
  33 #include <dev/ips/ipsreg.h>
  34 #include <dev/ips/ips.h>
  35 #include <dev/ips/ips_disk.h>
  36 #include <sys/stat.h>
  37
  38 static int ipsd_probe(device_t dev);
  39 static int ipsd_attach(device_t dev);
  40 static int ipsd_detach(device_t dev);
  41
  42 static int ipsd_dump(void *arg, void *virtual, vm_offset_t physical,
  43                      off_t offset, size_t length);
  44 static void ipsd_dump_map_sg(void *arg, bus_dma_segment_t *segs, int nsegs,
  45                              int error);
  46 static void ipsd_dump_block_complete(ips_command_t *command);
  47
  48 static disk_open_t ipsd_open;
  49 static disk_close_t ipsd_close;
  50 static disk_strategy_t ipsd_strategy;
  51
  52 static device_method_t ipsd_methods[] = {
  53         DEVMETHOD(device_probe,         ipsd_probe),
  54         DEVMETHOD(device_attach,        ipsd_attach),
  55         DEVMETHOD(device_detach,        ipsd_detach),
  56         { 0, 0 }
  57 };
  58
  59 static driver_t ipsd_driver = {
  60         "ipsd",
  61         ipsd_methods,
  62         sizeof(ipsdisk_softc_t)
  63 };
  64
  65 static devclass_t ipsd_devclass;
  66 DRIVER_MODULE(ipsd, ips, ipsd_driver, ipsd_devclass, 0, 0);
  67
  68 /* handle opening of disk device.  It must set up all
  69    information about the geometry and size of the disk */
  70 static int ipsd_open(struct disk *dp)
  71 {
  72         ipsdisk_softc_t *dsc = dp->d_drv1;
  73
  74         dsc->state |= IPS_DEV_OPEN;
  75         DEVICE_PRINTF(2, dsc->dev, "I'm open\n");
  76         return 0;
  77 }
  78
  79 static int ipsd_close(struct disk *dp)
  80 {
  81         ipsdisk_softc_t *dsc = dp->d_drv1;
  82         dsc->state &= ~IPS_DEV_OPEN;
  83         DEVICE_PRINTF(2, dsc->dev, "I'm closed for the day\n");
  84         return 0;
  85 }
  86
  87 /* ipsd_finish is called to clean up and return a completed IO request */
  88 void ipsd_finish(struct bio *iobuf)
  89 {
  90         ipsdisk_softc_t *dsc;
  91         dsc = iobuf->bio_disk->d_drv1;
  92
  93         if (iobuf->bio_flags & BIO_ERROR) {
  94                 ipsdisk_softc_t *dsc;
  95                 dsc = iobuf->bio_disk->d_drv1;
  96                 device_printf(dsc->dev, "iobuf error %d\n", iobuf->bio_error);
  97         } else
  98                 iobuf->bio_resid = 0;
  99
 100         biodone(iobuf);
 101         ips_start_io_request(dsc->sc);
 102 }
 103
 104
 105 static void ipsd_strategy(struct bio *iobuf)
 106 {
 107         ipsdisk_softc_t *dsc;
 108
 109         dsc = iobuf->bio_disk->d_drv1;
 110         DEVICE_PRINTF(8,dsc->dev,"in strategy\n");
 111         iobuf->bio_driver1 = (void *)(uintptr_t)dsc->sc->drives[dsc->disk_number].drivenum;
 112
 113         if ((iobuf->bio_cmd != BIO_READ) &&
 114             (iobuf->bio_cmd != BIO_WRITE)) {
 115                 biofinish(iobuf, NULL, EOPNOTSUPP);
 116                 return;
 117         }
 118
 119         mtx_lock(&dsc->sc->queue_mtx);
 120         bioq_insert_tail(&dsc->sc->queue, iobuf);
 121         ips_start_io_request(dsc->sc);
 122         mtx_unlock(&dsc->sc->queue_mtx);
 123 }
 124
 125 static int ipsd_probe(device_t dev)
 126 {
 127         DEVICE_PRINTF(2,dev, "in probe\n");
 128         device_set_desc(dev, "Logical Drive");
 129         return 0;
 130 }
 131
 132 static int ipsd_attach(device_t dev)
 133 {
 134         device_t adapter;
 135         ipsdisk_softc_t *dsc;
 136         u_int totalsectors;
 137
 138         DEVICE_PRINTF(2,dev, "in attach\n");
 139
 140         dsc = (ipsdisk_softc_t *)device_get_softc(dev);
 141         bzero(dsc, sizeof(ipsdisk_softc_t));
 142         adapter = device_get_parent(dev);
 143         dsc->dev = dev;
 144         dsc->sc = device_get_softc(adapter);
 145         dsc->unit = device_get_unit(dev);
 146         dsc->disk_number = (uintptr_t) device_get_ivars(dev);
 147         dsc->ipsd_disk = disk_alloc();
 148         dsc->ipsd_disk->d_drv1 = dsc;
 149         dsc->ipsd_disk->d_name = "ipsd";
 150         dsc->ipsd_disk->d_maxsize = IPS_MAX_IO_SIZE;
 151         dsc->ipsd_disk->d_open = ipsd_open;
 152         dsc->ipsd_disk->d_close = ipsd_close;
 153         dsc->ipsd_disk->d_strategy = ipsd_strategy;
 154         dsc->ipsd_disk->d_dump = ipsd_dump;
 155
 156         totalsectors = dsc->sc->drives[dsc->disk_number].sector_count;
 157         if ((totalsectors > 0x400000) &&
 158                         ((dsc->sc->adapter_info.miscflags & 0x8) == 0)) {
 159                 dsc->ipsd_disk->d_fwheads = IPS_NORM_HEADS;
 160                 dsc->ipsd_disk->d_fwsectors = IPS_NORM_SECTORS;
 161         } else {
 162                 dsc->ipsd_disk->d_fwheads = IPS_COMP_HEADS;
 163                 dsc->ipsd_disk->d_fwsectors = IPS_COMP_SECTORS;
 164         }
 165         dsc->ipsd_disk->d_sectorsize = IPS_BLKSIZE;
 166         dsc->ipsd_disk->d_mediasize = (off_t)totalsectors * IPS_BLKSIZE;
 167         dsc->ipsd_disk->d_unit = dsc->unit;
 168         dsc->ipsd_disk->d_flags = 0;
 169         disk_create(dsc->ipsd_disk, DISK_VERSION);
 170
 171         device_printf(dev, "Logical Drive  (%dMB)\n",
 172                       dsc->sc->drives[dsc->disk_number].sector_count >> 11);
 173         return 0;
 174 }
 175
 176 static int ipsd_detach(device_t dev)
 177 {
 178         ipsdisk_softc_t *dsc;
 179
 180         DEVICE_PRINTF(2, dev,"in detach\n");
 181         dsc = (ipsdisk_softc_t *)device_get_softc(dev);
 182         if(dsc->state & IPS_DEV_OPEN)
 183                 return (EBUSY);
 184         disk_destroy(dsc->ipsd_disk);
 185         return 0;
 186 }
 187
 188 static int
 189 ipsd_dump(void *arg, void *virtual, vm_offset_t physical, off_t offset,
 190           size_t length)
 191 {
 192         ipsdisk_softc_t *dsc;
 193         ips_softc_t *sc;
 194         ips_command_t *command;
 195         ips_io_cmd *command_struct;
 196         struct disk *dp;
 197         void *va;
 198         off_t off;
 199         size_t len;
 200         int error = 0;
 201
 202         dp = arg;
 203         dsc = dp->d_drv1;
 204
 205         if (dsc == NULL)
 206                 return (EINVAL);
 207         sc = dsc->sc;
 208
 209         if (ips_get_free_cmd(sc, &command, 0) != 0) {
 210                 printf("ipsd: failed to get cmd for dump\n");
 211                 return (ENOMEM);
 212         }
 213
 214         command->data_dmatag = sc->sg_dmatag;
 215         command->callback = ipsd_dump_block_complete;
 216
 217         command_struct = (ips_io_cmd *)command->command_buffer;
 218         command_struct->id = command->id;
 219         command_struct->drivenum= sc->drives[dsc->disk_number].drivenum;
 220
 221         off = offset;
 222         va = virtual;
 223
 224         while (length > 0) {
 225                 len =
 226                     (length > IPS_MAX_IO_SIZE) ? IPS_MAX_IO_SIZE : length;
 227
 228                 command_struct->lba = off / IPS_BLKSIZE;
 229
 230                 if (bus_dmamap_load(command->data_dmatag, command->data_dmamap,
 231                     va, len, ipsd_dump_map_sg, command, BUS_DMA_NOWAIT) != 0) {
 232                         error = EIO;
 233                         break;
 234                 }
 235                 if (COMMAND_ERROR(command)) {
 236                         error = EIO;
 237                         break;
 238                 }
 239
 240                 length -= len;
 241                 off += len;
 242                 va = (uint8_t *)va + len;
 243         }
 244
 245         ips_insert_free_cmd(command->sc, command);
 246         return (error);
 247 }
 248
 249 static void
 250 ipsd_dump_map_sg(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
 251 {
 252         ips_softc_t *sc;
 253         ips_command_t *command;
 254         ips_sg_element_t *sg_list;
 255         ips_io_cmd *command_struct;
 256         int i, length;
 257
 258         command = (ips_command_t *)arg;
 259         sc = command->sc;
 260         length = 0;
 261
 262         if (error) {
 263                 printf("ipsd_dump_map_sg: error %d\n", error);
 264                 ips_set_error(command, error);
 265                 return;
 266         }
 267
 268         command_struct = (ips_io_cmd *)command->command_buffer;
 269
 270         if (nsegs != 1) {
 271                 command_struct->segnum = nsegs;
 272                 sg_list = (ips_sg_element_t *)((uint8_t *)
 273                     command->command_buffer + IPS_COMMAND_LEN);
 274                 for (i = 0; i < nsegs; i++) {
 275                         sg_list[i].addr = segs[i].ds_addr;
 276                         sg_list[i].len = segs[i].ds_len;
 277                         length += segs[i].ds_len;
 278                 }
 279                 command_struct->buffaddr =
 280                     (uint32_t)command->command_phys_addr + IPS_COMMAND_LEN;
 281                 command_struct->command = IPS_SG_WRITE_CMD;
 282         } else {
 283                 command_struct->buffaddr = segs[0].ds_addr;
 284                 length = segs[0].ds_len;
 285                 command_struct->segnum = 0;
 286                 command_struct->command = IPS_WRITE_CMD;
 287         }
 288
 289         length = (length + IPS_BLKSIZE - 1) / IPS_BLKSIZE;
 290         command_struct->length = length;
 291         bus_dmamap_sync(sc->command_dmatag, command->command_dmamap,
 292             BUS_DMASYNC_PREWRITE);
 293         bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
 294             BUS_DMASYNC_PREWRITE);
 295
 296         sc->ips_issue_cmd(command);
 297         sc->ips_poll_cmd(command);
 298         return;
 299 }
 300
 301 static void
 302 ipsd_dump_block_complete(ips_command_t *command)
 303 {
 304
 305         if (COMMAND_ERROR(command))
 306                 printf("ipsd_dump completion error= 0x%x\n",
 307                     command->status.value);
 308
 309         bus_dmamap_sync(command->data_dmatag, command->data_dmamap,
 310             BUS_DMASYNC_POSTWRITE);
 311         bus_dmamap_unload(command->data_dmatag, command->data_dmamap);
 312 }