NetBSD/sys/arch/mvme68k/stand/libsa/bugdev.c

273 lines
7.2 KiB
C

/* $NetBSD: bugdev.c,v 1.5 1998/09/05 15:20:48 pk Exp $ */
/*-
* Copyright (c) 1998 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Paul Kranenburg.
*
* 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.
*/
#include <sys/param.h>
#include <sys/disklabel.h>
#include <machine/prom.h>
#include "stand.h"
#include "libsa.h"
void cputobsdlabel __P((struct disklabel *lp, struct cpu_disklabel *clp));
int errno;
struct bugsc_softc {
int fd; /* Prom file descriptor */
int poff; /* Partition offset */
int psize; /* Partition size */
short ctrl;
short dev;
} bugsc_softc[1];
int
devopen(f, fname, file)
struct open_file *f;
const char *fname;
char **file;
{
struct bugsc_softc *pp = &bugsc_softc[0];
int error, pn = 0;
char *dev, *cp;
size_t nrd;
static int iobuf[DEV_BSIZE / sizeof(int)];
struct disklabel sdlabel;
dev = bugargs.arg_start;
/*
* Extract partition # from boot device string.
* The Bug command line format of this is:
*
* 147-Bug> bo [drive],,[<d>:][kernel_name] [options]
*
* Where:
* [drive] The bug LUN number, eg. 0
* [<d>:] <d> is partition # ('a' to 'h')
* [kernel_name] Eg. netbsd or /netbsd
* [options] Eg. -s
*
* At this time, all we need do is scan for a ':', and assume the
* preceding letter is a partition id.
*/
for (cp = dev + 1; *cp && cp <= bugargs.arg_end; cp++) {
if ( *cp == ':' ) {
pn = *(cp - 1) - 'a';
break;
}
}
if ( pn < 0 || pn >= MAXPARTITIONS ) {
printf("Invalid partition number; defaulting to 'a'\n");
pn = 0;
}
pp->fd = bugscopen(f);
if (pp->fd < 0) {
printf("Can't open device `%s'\n", dev);
return (ENXIO);
}
error = bugscstrategy(pp, F_READ, LABELSECTOR, DEV_BSIZE, iobuf, &nrd);
if (error)
return (error);
if (nrd != DEV_BSIZE)
return (EINVAL);
/*LINTED*/
cputobsdlabel(&sdlabel, (struct cpu_disklabel *)&(iobuf[0]));
pp->poff = sdlabel.d_partitions[pn].p_offset;
pp->psize = sdlabel.d_partitions[pn].p_size;
f->f_dev = devsw;
f->f_devdata = (void *)pp;
/*LINTED*/
*file = (char *)fname;
return (0);
}
/* silly block scale factor */
#define BUG_BLOCK_SIZE 256
#define BUG_SCALE (512/BUG_BLOCK_SIZE)
/*ARGSUSED*/
int
bugscstrategy(devdata, func, dblk, size, buf, rsize)
void *devdata;
int func;
daddr_t dblk;
size_t size;
void *buf;
size_t *rsize;
{
struct mvmeprom_dskio dio;
struct bugsc_softc *pp = (struct bugsc_softc *)devdata;
daddr_t blk = dblk + pp->poff;
twiddle();
dio.ctrl_lun = pp->ctrl;
dio.dev_lun = pp->dev;
dio.status = 0;
dio.pbuffer = buf;
dio.blk_num = blk * BUG_SCALE;
dio.blk_cnt = size / BUG_BLOCK_SIZE; /* assumed size in bytes */
dio.flag = 0;
dio.addr_mod = 0;
#ifdef DEBUG
printf("bugscstrategy: size=%d blk=%d buf=%x\n", size, blk, buf);
printf("ctrl %d dev %d\n", dio.ctrl_lun, dio.dev_lun);
#endif
mvmeprom_diskrd(&dio);
*rsize = dio.blk_cnt * BUG_BLOCK_SIZE;
#ifdef DEBUG
printf("rsize %d status %x\n", *rsize, dio.status);
#endif
if (dio.status)
return (EIO);
return (0);
}
int
bugscopen(f)
struct open_file *f;
{
#ifdef DEBUG
printf("bugscopen:\n");
#endif
f->f_devdata = (void *)bugsc_softc;
bugsc_softc[0].ctrl = (short)bugargs.ctrl_lun;
bugsc_softc[0].dev = (short)bugargs.dev_lun;
#ifdef DEBUG
printf("using mvmebug ctrl %d dev %d\n",
bugsc_softc[0].ctrl, bugsc_softc[0].dev);
#endif
return (0);
}
/*ARGSUSED*/
int
bugscclose(f)
struct open_file *f;
{
return (EIO);
}
/*ARGSUSED*/
int
bugscioctl(f, cmd, data)
struct open_file *f;
u_long cmd;
void *data;
{
return (EIO);
}
void
cputobsdlabel(lp, clp)
struct disklabel *lp;
struct cpu_disklabel *clp;
{
int i;
lp->d_magic = (u_int32_t)clp->magic1;
lp->d_type = (u_int16_t)clp->type;
lp->d_subtype = (u_int16_t)clp->subtype;
bcopy(clp->vid_vd, lp->d_typename, 16);
bcopy(clp->packname, lp->d_packname, 16);
lp->d_secsize = (u_int32_t)clp->cfg_psm;
lp->d_nsectors = (u_int32_t)clp->cfg_spt;
lp->d_ncylinders = (u_int32_t)clp->cfg_trk; /* trk is num of cyl! */
lp->d_ntracks = (u_int32_t)clp->cfg_hds;
lp->d_secpercyl = (u_int32_t)clp->secpercyl;
lp->d_secperunit = (u_int32_t)clp->secperunit;
lp->d_sparespertrack = (u_int16_t)clp->sparespertrack;
lp->d_sparespercyl = (u_int16_t)clp->sparespercyl;
lp->d_acylinders = (u_int32_t)clp->acylinders;
lp->d_rpm = (u_int16_t)clp->rpm;
lp->d_interleave = (u_int16_t)clp->cfg_ilv;
lp->d_trackskew = (u_int16_t)clp->cfg_sof;
lp->d_cylskew = (u_int16_t)clp->cylskew;
lp->d_headswitch = (u_int32_t)clp->headswitch;
/* this silly table is for winchester drives */
switch (clp->cfg_ssr) {
case 0:
lp->d_trkseek = 0;
break;
case 1:
lp->d_trkseek = 6;
break;
case 2:
lp->d_trkseek = 10;
break;
case 3:
lp->d_trkseek = 15;
break;
case 4:
lp->d_trkseek = 20;
break;
default:
lp->d_trkseek = 0;
break;
}
lp->d_flags = (u_int32_t)clp->flags;
for (i = 0; i < NDDATA; i++)
lp->d_drivedata[i] = (u_int32_t)clp->drivedata[i];
for (i = 0; i < NSPARE; i++)
lp->d_spare[i] = (u_int32_t)clp->spare[i];
lp->d_magic2 = (u_int32_t)clp->magic2;
lp->d_checksum = (u_int16_t)clp->checksum;
lp->d_npartitions = (u_int16_t)clp->partitions;
lp->d_bbsize = (u_int32_t)clp->bbsize;
lp->d_sbsize = (u_int32_t)clp->sbsize;
bcopy(clp->vid_4, &(lp->d_partitions[0]),sizeof (struct partition) * 4);
/* CONSTCOND */
bcopy(clp->cfg_4, &(lp->d_partitions[4]), sizeof (struct partition)
* ((MAXPARTITIONS < 16) ? (MAXPARTITIONS - 4) : 12));
}