127da7e6fSSøren Schmidt /*- 227da7e6fSSøren Schmidt * Copyright (c) 2001,2002 S�ren Schmidt <sos@FreeBSD.org> 327da7e6fSSøren Schmidt * All rights reserved. 427da7e6fSSøren Schmidt * 527da7e6fSSøren Schmidt * Redistribution and use in source and binary forms, with or without 627da7e6fSSøren Schmidt * modification, are permitted provided that the following conditions 727da7e6fSSøren Schmidt * are met: 827da7e6fSSøren Schmidt * 1. Redistributions of source code must retain the above copyright 927da7e6fSSøren Schmidt * notice, this list of conditions and the following disclaimer, 1027da7e6fSSøren Schmidt * without modification, immediately at the beginning of the file. 1127da7e6fSSøren Schmidt * 2. Redistributions in binary form must reproduce the above copyright 1227da7e6fSSøren Schmidt * notice, this list of conditions and the following disclaimer in the 1327da7e6fSSøren Schmidt * documentation and/or other materials provided with the distribution. 1427da7e6fSSøren Schmidt * 3. The name of the author may not be used to endorse or promote products 1527da7e6fSSøren Schmidt * derived from this software without specific prior written permission. 1627da7e6fSSøren Schmidt * 1727da7e6fSSøren Schmidt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 1827da7e6fSSøren Schmidt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 1927da7e6fSSøren Schmidt * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 2027da7e6fSSøren Schmidt * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 2127da7e6fSSøren Schmidt * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 2227da7e6fSSøren Schmidt * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 2327da7e6fSSøren Schmidt * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 2427da7e6fSSøren Schmidt * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 2527da7e6fSSøren Schmidt * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 2627da7e6fSSøren Schmidt * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 2727da7e6fSSøren Schmidt * 2827da7e6fSSøren Schmidt * $FreeBSD$ 2927da7e6fSSøren Schmidt */ 3027da7e6fSSøren Schmidt 3127da7e6fSSøren Schmidt #include <sys/param.h> 3227da7e6fSSøren Schmidt #include <sys/systm.h> 3327da7e6fSSøren Schmidt #include <sys/kernel.h> 3427da7e6fSSøren Schmidt #include <sys/module.h> 3527da7e6fSSøren Schmidt #include <sys/bus.h> 3627da7e6fSSøren Schmidt #include <sys/bio.h> 3727da7e6fSSøren Schmidt #include <sys/conf.h> 3827da7e6fSSøren Schmidt #include <sys/disk.h> 3927da7e6fSSøren Schmidt #include <sys/devicestat.h> 4027da7e6fSSøren Schmidt #include <sys/eventhandler.h> 4127da7e6fSSøren Schmidt #include <sys/malloc.h> 4227da7e6fSSøren Schmidt #include <sys/lock.h> 4327da7e6fSSøren Schmidt #include <sys/mutex.h> 4427da7e6fSSøren Schmidt #include <vm/vm.h> 4527da7e6fSSøren Schmidt #include <vm/pmap.h> 4627da7e6fSSøren Schmidt #include <machine/stdarg.h> 4727da7e6fSSøren Schmidt #include <machine/resource.h> 4827da7e6fSSøren Schmidt #include <machine/bus.h> 4927da7e6fSSøren Schmidt #include <sys/rman.h> 5027da7e6fSSøren Schmidt #include <pci/pcivar.h> 5127da7e6fSSøren Schmidt #include <pci/pcireg.h> 5227da7e6fSSøren Schmidt 5327da7e6fSSøren Schmidt #include "dev/pst/pst-iop.h" 5427da7e6fSSøren Schmidt 5527da7e6fSSøren Schmidt /* device structures */ 5627da7e6fSSøren Schmidt static d_strategy_t pststrategy; 5727da7e6fSSøren Schmidt static struct cdevsw pst_cdevsw = { 5827da7e6fSSøren Schmidt /* open */ nullopen, 5927da7e6fSSøren Schmidt /* close */ nullclose, 6027da7e6fSSøren Schmidt /* read */ physread, 6127da7e6fSSøren Schmidt /* write */ physwrite, 6227da7e6fSSøren Schmidt /* ioctl */ noioctl, 6327da7e6fSSøren Schmidt /* poll */ nopoll, 6427da7e6fSSøren Schmidt /* mmap */ nommap, 6527da7e6fSSøren Schmidt /* strat */ pststrategy, 6627da7e6fSSøren Schmidt /* name */ "pst", 6727da7e6fSSøren Schmidt /* maj */ 200, 6827da7e6fSSøren Schmidt /* dump */ nodump, 6927da7e6fSSøren Schmidt /* psize */ nopsize, 7027da7e6fSSøren Schmidt /* flags */ D_DISK, 7127da7e6fSSøren Schmidt }; 7227da7e6fSSøren Schmidt static struct cdevsw pstdisk_cdevsw; 7327da7e6fSSøren Schmidt 7427da7e6fSSøren Schmidt struct pst_softc { 7527da7e6fSSøren Schmidt struct iop_softc *iop; 7627da7e6fSSøren Schmidt struct i2o_lct_entry *lct; 7727da7e6fSSøren Schmidt struct i2o_bsa_device *info; 7827da7e6fSSøren Schmidt dev_t device; 7927da7e6fSSøren Schmidt struct devstat stats; 8027da7e6fSSøren Schmidt struct disk disk; 8127da7e6fSSøren Schmidt struct bio_queue_head queue; 8227da7e6fSSøren Schmidt struct mtx mtx; 8327da7e6fSSøren Schmidt int outstanding; 8427da7e6fSSøren Schmidt }; 8527da7e6fSSøren Schmidt 8627da7e6fSSøren Schmidt struct pst_request { 8727da7e6fSSøren Schmidt struct pst_softc *psc; /* pointer to softc */ 8827da7e6fSSøren Schmidt u_int32_t mfa; /* frame addreess */ 8927da7e6fSSøren Schmidt struct callout_handle timeout_handle; /* handle for untimeout */ 9027da7e6fSSøren Schmidt struct bio *bp; /* associated bio ptr */ 9127da7e6fSSøren Schmidt }; 9227da7e6fSSøren Schmidt 9327da7e6fSSøren Schmidt /* prototypes */ 9427da7e6fSSøren Schmidt static int pst_probe(device_t); 9527da7e6fSSøren Schmidt static int pst_attach(device_t); 9627da7e6fSSøren Schmidt static int pst_shutdown(device_t); 9727da7e6fSSøren Schmidt static void pst_start(struct pst_softc *); 9827da7e6fSSøren Schmidt static void pst_done(struct iop_softc *, u_int32_t, struct i2o_single_reply *); 9927da7e6fSSøren Schmidt static int pst_rw(struct pst_request *); 10027da7e6fSSøren Schmidt static void pst_timeout(struct pst_request *); 10127da7e6fSSøren Schmidt static void bpack(int8_t *, int8_t *, int); 10227da7e6fSSøren Schmidt 10327da7e6fSSøren Schmidt /* local vars */ 10427da7e6fSSøren Schmidt static MALLOC_DEFINE(M_PSTRAID, "pst", "Promise SuperTrak RAID driver"); 10527da7e6fSSøren Schmidt 10627da7e6fSSøren Schmidt int 10727da7e6fSSøren Schmidt pst_add_raid(struct iop_softc *sc, struct i2o_lct_entry *lct) 10827da7e6fSSøren Schmidt { 10927da7e6fSSøren Schmidt struct pst_softc *psc; 11027da7e6fSSøren Schmidt device_t child = device_add_child(sc->dev, "pst", -1); 11127da7e6fSSøren Schmidt 11227da7e6fSSøren Schmidt if (!child) 11327da7e6fSSøren Schmidt return ENOMEM; 11427da7e6fSSøren Schmidt psc = malloc(sizeof(struct pst_softc), M_PSTRAID, M_NOWAIT | M_ZERO); 11527da7e6fSSøren Schmidt psc->iop = sc; 11627da7e6fSSøren Schmidt psc->lct = lct; 11727da7e6fSSøren Schmidt device_set_softc(child, psc); 11827da7e6fSSøren Schmidt return bus_generic_attach(sc->dev); 11927da7e6fSSøren Schmidt } 12027da7e6fSSøren Schmidt 12127da7e6fSSøren Schmidt static int 12227da7e6fSSøren Schmidt pst_probe(device_t dev) 12327da7e6fSSøren Schmidt { 12427da7e6fSSøren Schmidt device_set_desc(dev, "Promise SuperTrak RAID"); 12527da7e6fSSøren Schmidt return 0; 12627da7e6fSSøren Schmidt } 12727da7e6fSSøren Schmidt 12827da7e6fSSøren Schmidt static int 12927da7e6fSSøren Schmidt pst_attach(device_t dev) 13027da7e6fSSøren Schmidt { 13127da7e6fSSøren Schmidt struct pst_softc *psc = device_get_softc(dev); 13227da7e6fSSøren Schmidt struct i2o_get_param_reply *reply; 13327da7e6fSSøren Schmidt struct i2o_device_identity *ident; 13427da7e6fSSøren Schmidt int lun = device_get_unit(dev); 13527da7e6fSSøren Schmidt int8_t name [32]; 13627da7e6fSSøren Schmidt 13727da7e6fSSøren Schmidt if (!(reply = iop_get_util_params(psc->iop, psc->lct->local_tid, 13827da7e6fSSøren Schmidt I2O_PARAMS_OPERATION_FIELD_GET, 13927da7e6fSSøren Schmidt I2O_BSA_DEVICE_INFO_GROUP_NO))) 14027da7e6fSSøren Schmidt return ENODEV; 14127da7e6fSSøren Schmidt 14227da7e6fSSøren Schmidt if (!(psc->info = (struct i2o_bsa_device *) 14327da7e6fSSøren Schmidt malloc(sizeof(struct i2o_bsa_device), M_PSTRAID, M_NOWAIT))) { 14427da7e6fSSøren Schmidt contigfree(reply, PAGE_SIZE, M_PSTRAID); 14527da7e6fSSøren Schmidt return ENOMEM; 14627da7e6fSSøren Schmidt } 14727da7e6fSSøren Schmidt bcopy(reply->result, psc->info, sizeof(struct i2o_bsa_device)); 14827da7e6fSSøren Schmidt contigfree(reply, PAGE_SIZE, M_PSTRAID); 14927da7e6fSSøren Schmidt 15027da7e6fSSøren Schmidt if (!(reply = iop_get_util_params(psc->iop, psc->lct->local_tid, 15127da7e6fSSøren Schmidt I2O_PARAMS_OPERATION_FIELD_GET, 15227da7e6fSSøren Schmidt I2O_UTIL_DEVICE_IDENTITY_GROUP_NO))) 15327da7e6fSSøren Schmidt return ENODEV; 15427da7e6fSSøren Schmidt ident = (struct i2o_device_identity *)reply->result; 15527da7e6fSSøren Schmidt #ifdef PSTDEBUG 15627da7e6fSSøren Schmidt printf("pst: vendor=<%.16s> product=<%.16s>\n", 15727da7e6fSSøren Schmidt ident->vendor, ident->product); 15827da7e6fSSøren Schmidt printf("pst: description=<%.16s> revision=<%.8s>\n", 15927da7e6fSSøren Schmidt ident->description, ident->revision); 16027da7e6fSSøren Schmidt printf("pst: capacity=%lld blocksize=%d\n", 16127da7e6fSSøren Schmidt psc->info->capacity, psc->info->block_size); 16227da7e6fSSøren Schmidt #endif 16327da7e6fSSøren Schmidt bpack(ident->vendor, ident->vendor, 16); 16427da7e6fSSøren Schmidt bpack(ident->product, ident->product, 16); 16527da7e6fSSøren Schmidt sprintf(name, "%s %s", ident->vendor, ident->product); 16627da7e6fSSøren Schmidt contigfree(reply, PAGE_SIZE, M_PSTRAID); 16727da7e6fSSøren Schmidt 16827da7e6fSSøren Schmidt bioq_init(&psc->queue); 16927da7e6fSSøren Schmidt mtx_init(&psc->mtx, "pst lock", MTX_DEF, 0); 17027da7e6fSSøren Schmidt 17127da7e6fSSøren Schmidt psc->device = disk_create(lun, &psc->disk, 0, &pst_cdevsw, &pstdisk_cdevsw); 17227da7e6fSSøren Schmidt psc->device->si_drv1 = psc; 17327da7e6fSSøren Schmidt psc->device->si_iosize_max = 64 * 1024; /*I2O_SGL_MAX_SEGS * PAGE_SIZE;*/ 17427da7e6fSSøren Schmidt 1757812d86fSPoul-Henning Kamp psc->disk.d_sectorsize = psc->info->block_size; 1767812d86fSPoul-Henning Kamp psc->disk.d_mediasize = psc->info->capacity; 177595ecc67SSøren Schmidt psc->disk.d_fwsectors = 63; 178595ecc67SSøren Schmidt psc->disk.d_fwheads = 255; 17927da7e6fSSøren Schmidt 18027da7e6fSSøren Schmidt devstat_add_entry(&psc->stats, "pst", lun, psc->info->block_size, 18127da7e6fSSøren Schmidt DEVSTAT_NO_ORDERED_TAGS, 18227da7e6fSSøren Schmidt DEVSTAT_TYPE_DIRECT | DEVSTAT_TYPE_IF_IDE, 18327da7e6fSSøren Schmidt DEVSTAT_PRIORITY_DISK); 18427da7e6fSSøren Schmidt 185595ecc67SSøren Schmidt printf("pst%d: %lluMB <%.40s> [%lld/%d/%d] on %.16s\n", lun, 186595ecc67SSøren Schmidt (unsigned long long)psc->info->capacity / (1024 * 1024), 187595ecc67SSøren Schmidt name, psc->info->capacity/(512*255*63), 255, 63, 18827da7e6fSSøren Schmidt device_get_nameunit(psc->iop->dev)); 18927da7e6fSSøren Schmidt 19027da7e6fSSøren Schmidt EVENTHANDLER_REGISTER(shutdown_post_sync, pst_shutdown, 19127da7e6fSSøren Schmidt dev, SHUTDOWN_PRI_FIRST); 19227da7e6fSSøren Schmidt return 0; 19327da7e6fSSøren Schmidt } 19427da7e6fSSøren Schmidt 19527da7e6fSSøren Schmidt static int 19627da7e6fSSøren Schmidt pst_shutdown(device_t dev) 19727da7e6fSSøren Schmidt { 19827da7e6fSSøren Schmidt struct pst_softc *psc = device_get_softc(dev); 19927da7e6fSSøren Schmidt struct i2o_bsa_cache_flush_message *msg; 20027da7e6fSSøren Schmidt int mfa; 20127da7e6fSSøren Schmidt 20227da7e6fSSøren Schmidt mfa = iop_get_mfa(psc->iop); 20327da7e6fSSøren Schmidt msg = (struct i2o_bsa_cache_flush_message *)(psc->iop->ibase + mfa); 20427da7e6fSSøren Schmidt bzero(msg, sizeof(struct i2o_bsa_cache_flush_message)); 20527da7e6fSSøren Schmidt msg->version_offset = 0x01; 20627da7e6fSSøren Schmidt msg->message_flags = 0x0; 20727da7e6fSSøren Schmidt msg->message_size = sizeof(struct i2o_bsa_cache_flush_message) >> 2; 20827da7e6fSSøren Schmidt msg->target_address = psc->lct->local_tid; 20927da7e6fSSøren Schmidt msg->initiator_address = I2O_TID_HOST; 21027da7e6fSSøren Schmidt msg->function = I2O_BSA_CACHE_FLUSH; 21127da7e6fSSøren Schmidt msg->control_flags = 0x0; /* 0x80 = post progress reports */ 21227da7e6fSSøren Schmidt if (iop_queue_wait_msg(psc->iop, mfa, (struct i2o_basic_message *)msg)) 21327da7e6fSSøren Schmidt printf("pst: shutdown failed!\n"); 21427da7e6fSSøren Schmidt return 0; 21527da7e6fSSøren Schmidt } 21627da7e6fSSøren Schmidt 21727da7e6fSSøren Schmidt static void 21827da7e6fSSøren Schmidt pststrategy(struct bio *bp) 21927da7e6fSSøren Schmidt { 22027da7e6fSSøren Schmidt struct pst_softc *psc = bp->bio_dev->si_drv1; 22127da7e6fSSøren Schmidt 22227da7e6fSSøren Schmidt mtx_lock(&psc->mtx); 22327da7e6fSSøren Schmidt bioqdisksort(&psc->queue, bp); 22427da7e6fSSøren Schmidt pst_start(psc); 22527da7e6fSSøren Schmidt mtx_unlock(&psc->mtx); 22627da7e6fSSøren Schmidt } 22727da7e6fSSøren Schmidt 22827da7e6fSSøren Schmidt static void 22927da7e6fSSøren Schmidt pst_start(struct pst_softc *psc) 23027da7e6fSSøren Schmidt { 23127da7e6fSSøren Schmidt struct pst_request *request; 23227da7e6fSSøren Schmidt struct bio *bp; 23327da7e6fSSøren Schmidt u_int32_t mfa; 23427da7e6fSSøren Schmidt 23527da7e6fSSøren Schmidt if (psc->outstanding < (I2O_IOP_OUTBOUND_FRAME_COUNT - 1) && 23627da7e6fSSøren Schmidt (bp = bioq_first(&psc->queue))) { 23727da7e6fSSøren Schmidt if ((mfa = iop_get_mfa(psc->iop)) != 0xffffffff) { 23827da7e6fSSøren Schmidt if (!(request = malloc(sizeof(struct pst_request), 23927da7e6fSSøren Schmidt M_PSTRAID, M_NOWAIT | M_ZERO))) { 24027da7e6fSSøren Schmidt printf("pst: out of memory in start\n"); 24127da7e6fSSøren Schmidt iop_free_mfa(psc->iop, mfa); 24227da7e6fSSøren Schmidt return; 24327da7e6fSSøren Schmidt } 24427da7e6fSSøren Schmidt psc->outstanding++; 24527da7e6fSSøren Schmidt request->psc = psc; 24627da7e6fSSøren Schmidt request->mfa = mfa; 24727da7e6fSSøren Schmidt request->bp = bp; 24827da7e6fSSøren Schmidt if (dumping) 24927da7e6fSSøren Schmidt request->timeout_handle.callout = NULL; 25027da7e6fSSøren Schmidt else 25127da7e6fSSøren Schmidt request->timeout_handle = 2521652b7bdSSøren Schmidt timeout((timeout_t*)pst_timeout, request, 10 * hz); 25327da7e6fSSøren Schmidt bioq_remove(&psc->queue, bp); 25427da7e6fSSøren Schmidt devstat_start_transaction(&psc->stats); 25527da7e6fSSøren Schmidt if (pst_rw(request)) { 25627da7e6fSSøren Schmidt biofinish(request->bp, &psc->stats, EIO); 25727da7e6fSSøren Schmidt iop_free_mfa(request->psc->iop, request->mfa); 25827da7e6fSSøren Schmidt psc->outstanding--; 25927da7e6fSSøren Schmidt free(request, M_PSTRAID); 26027da7e6fSSøren Schmidt } 26127da7e6fSSøren Schmidt } 26227da7e6fSSøren Schmidt } 26327da7e6fSSøren Schmidt } 26427da7e6fSSøren Schmidt 26527da7e6fSSøren Schmidt static void 26627da7e6fSSøren Schmidt pst_done(struct iop_softc *sc, u_int32_t mfa, struct i2o_single_reply *reply) 26727da7e6fSSøren Schmidt { 26827da7e6fSSøren Schmidt struct pst_request *request = 26927da7e6fSSøren Schmidt (struct pst_request *)reply->transaction_context; 27027da7e6fSSøren Schmidt struct pst_softc *psc = request->psc; 27127da7e6fSSøren Schmidt 27227da7e6fSSøren Schmidt untimeout((timeout_t *)pst_timeout, request, request->timeout_handle); 27327da7e6fSSøren Schmidt request->bp->bio_resid = request->bp->bio_bcount - reply->donecount; 27427da7e6fSSøren Schmidt biofinish(request->bp, &psc->stats, reply->status ? EIO : 0); 27527da7e6fSSøren Schmidt free(request, M_PSTRAID); 27627da7e6fSSøren Schmidt mtx_lock(&psc->mtx); 27727da7e6fSSøren Schmidt psc->iop->reg->oqueue = mfa; 27827da7e6fSSøren Schmidt psc->outstanding--; 27927da7e6fSSøren Schmidt pst_start(psc); 28027da7e6fSSøren Schmidt mtx_unlock(&psc->mtx); 28127da7e6fSSøren Schmidt } 28227da7e6fSSøren Schmidt 28327da7e6fSSøren Schmidt static void 28427da7e6fSSøren Schmidt pst_timeout(struct pst_request *request) 28527da7e6fSSøren Schmidt { 28627da7e6fSSøren Schmidt printf("pst: timeout mfa=0x%08x cmd=0x%02x\n", 28727da7e6fSSøren Schmidt request->mfa, request->bp->bio_cmd); 28827da7e6fSSøren Schmidt mtx_lock(&request->psc->mtx); 28927da7e6fSSøren Schmidt iop_free_mfa(request->psc->iop, request->mfa); 29027da7e6fSSøren Schmidt if ((request->mfa = iop_get_mfa(request->psc->iop)) == 0xffffffff) { 29127da7e6fSSøren Schmidt printf("pst: timeout no mfa possible\n"); 29227da7e6fSSøren Schmidt biofinish(request->bp, &request->psc->stats, EIO); 29327da7e6fSSøren Schmidt request->psc->outstanding--; 29427da7e6fSSøren Schmidt mtx_unlock(&request->psc->mtx); 29527da7e6fSSøren Schmidt return; 29627da7e6fSSøren Schmidt } 29727da7e6fSSøren Schmidt if (dumping) 29827da7e6fSSøren Schmidt request->timeout_handle.callout = NULL; 29927da7e6fSSøren Schmidt else 30027da7e6fSSøren Schmidt request->timeout_handle = 30127da7e6fSSøren Schmidt timeout((timeout_t*)pst_timeout, request, 10 * hz); 30227da7e6fSSøren Schmidt if (pst_rw(request)) { 30327da7e6fSSøren Schmidt iop_free_mfa(request->psc->iop, request->mfa); 30427da7e6fSSøren Schmidt biofinish(request->bp, &request->psc->stats, EIO); 30527da7e6fSSøren Schmidt request->psc->outstanding--; 30627da7e6fSSøren Schmidt } 30727da7e6fSSøren Schmidt mtx_unlock(&request->psc->mtx); 30827da7e6fSSøren Schmidt } 30927da7e6fSSøren Schmidt 31027da7e6fSSøren Schmidt int 31127da7e6fSSøren Schmidt pst_rw(struct pst_request *request) 31227da7e6fSSøren Schmidt { 31327da7e6fSSøren Schmidt struct i2o_bsa_rw_block_message *msg; 31427da7e6fSSøren Schmidt int sgl_flag; 31527da7e6fSSøren Schmidt 31627da7e6fSSøren Schmidt msg = (struct i2o_bsa_rw_block_message *) 31727da7e6fSSøren Schmidt (request->psc->iop->ibase + request->mfa); 31827da7e6fSSøren Schmidt bzero(msg, sizeof(struct i2o_bsa_rw_block_message)); 31927da7e6fSSøren Schmidt msg->version_offset = 0x81; 32027da7e6fSSøren Schmidt msg->message_flags = 0x0; 32127da7e6fSSøren Schmidt msg->message_size = sizeof(struct i2o_bsa_rw_block_message) >> 2; 32227da7e6fSSøren Schmidt msg->target_address = request->psc->lct->local_tid; 32327da7e6fSSøren Schmidt msg->initiator_address = I2O_TID_HOST; 32427da7e6fSSøren Schmidt switch (request->bp->bio_cmd) { 32527da7e6fSSøren Schmidt case BIO_READ: 32627da7e6fSSøren Schmidt msg->function = I2O_BSA_BLOCK_READ; 32727da7e6fSSøren Schmidt msg->control_flags = 0x0; /* 0x0c = read cache + readahead */ 32827da7e6fSSøren Schmidt msg->fetch_ahead = 0x0; /* 8 Kb */ 32927da7e6fSSøren Schmidt sgl_flag = 0; 33027da7e6fSSøren Schmidt break; 33127da7e6fSSøren Schmidt case BIO_WRITE: 33227da7e6fSSøren Schmidt msg->function = I2O_BSA_BLOCK_WRITE; 33327da7e6fSSøren Schmidt msg->control_flags = 0x0; /* 0x10 = write behind cache */ 33427da7e6fSSøren Schmidt msg->fetch_ahead = 0x0; 33527da7e6fSSøren Schmidt sgl_flag = I2O_SGL_DIR; 33627da7e6fSSøren Schmidt break; 33727da7e6fSSøren Schmidt default: 33827da7e6fSSøren Schmidt printf("pst: unknown command type\n"); 33927da7e6fSSøren Schmidt return -1; 34027da7e6fSSøren Schmidt } 34127da7e6fSSøren Schmidt msg->initiator_context = (u_int32_t)pst_done; 34227da7e6fSSøren Schmidt msg->transaction_context = (u_int32_t)request; 34327da7e6fSSøren Schmidt msg->time_multiplier = 1; 34427da7e6fSSøren Schmidt msg->bytecount = request->bp->bio_bcount; 34527da7e6fSSøren Schmidt msg->lba = ((u_int64_t)request->bp->bio_pblkno) * (DEV_BSIZE * 1LL); 34627da7e6fSSøren Schmidt if (!iop_create_sgl((struct i2o_basic_message *)msg, request->bp->bio_data, 34727da7e6fSSøren Schmidt request->bp->bio_bcount, sgl_flag)) 34827da7e6fSSøren Schmidt return -1; 34927da7e6fSSøren Schmidt request->psc->iop->reg->iqueue = request->mfa; 35027da7e6fSSøren Schmidt return 0; 35127da7e6fSSøren Schmidt } 35227da7e6fSSøren Schmidt 35327da7e6fSSøren Schmidt static void 35427da7e6fSSøren Schmidt bpack(int8_t *src, int8_t *dst, int len) 35527da7e6fSSøren Schmidt { 35627da7e6fSSøren Schmidt int i, j, blank; 35727da7e6fSSøren Schmidt int8_t *ptr, *buf = dst; 35827da7e6fSSøren Schmidt 35927da7e6fSSøren Schmidt for (i = j = blank = 0 ; i < len; i++) { 36027da7e6fSSøren Schmidt if (blank && src[i] == ' ') continue; 36127da7e6fSSøren Schmidt if (blank && src[i] != ' ') { 36227da7e6fSSøren Schmidt dst[j++] = src[i]; 36327da7e6fSSøren Schmidt blank = 0; 36427da7e6fSSøren Schmidt continue; 36527da7e6fSSøren Schmidt } 36627da7e6fSSøren Schmidt if (src[i] == ' ') { 36727da7e6fSSøren Schmidt blank = 1; 36827da7e6fSSøren Schmidt if (i == 0) 36927da7e6fSSøren Schmidt continue; 37027da7e6fSSøren Schmidt } 37127da7e6fSSøren Schmidt dst[j++] = src[i]; 37227da7e6fSSøren Schmidt } 37327da7e6fSSøren Schmidt if (j < len) 37427da7e6fSSøren Schmidt dst[j] = 0x00; 37527da7e6fSSøren Schmidt for (ptr = buf; ptr < buf+len; ++ptr) 37627da7e6fSSøren Schmidt if (!*ptr) 37727da7e6fSSøren Schmidt *ptr = ' '; 37827da7e6fSSøren Schmidt for (ptr = buf + len - 1; ptr >= buf && *ptr == ' '; --ptr) 37927da7e6fSSøren Schmidt *ptr = 0; 38027da7e6fSSøren Schmidt } 38127da7e6fSSøren Schmidt 38227da7e6fSSøren Schmidt static device_method_t pst_methods[] = { 38327da7e6fSSøren Schmidt DEVMETHOD(device_probe, pst_probe), 38427da7e6fSSøren Schmidt DEVMETHOD(device_attach, pst_attach), 38527da7e6fSSøren Schmidt { 0, 0 } 38627da7e6fSSøren Schmidt }; 38727da7e6fSSøren Schmidt 38827da7e6fSSøren Schmidt static driver_t pst_driver = { 38927da7e6fSSøren Schmidt "pst", 39027da7e6fSSøren Schmidt pst_methods, 39127da7e6fSSøren Schmidt sizeof(struct pst_softc), 39227da7e6fSSøren Schmidt }; 39327da7e6fSSøren Schmidt 39427da7e6fSSøren Schmidt static devclass_t pst_devclass; 39527da7e6fSSøren Schmidt 39627da7e6fSSøren Schmidt DRIVER_MODULE(pst, pstpci, pst_driver, pst_devclass, 0, 0); 397