xref: /freebsd/sys/dev/pst/pst-raid.c (revision 595ecc67ab3818bffe1fd7d45acaf000f2b5e51c)
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