4c99916337
Make sure that each va_start has one and only one matching va_end, especially in error cases. If the va_list is used multiple times, do multiple va_starts/va_ends. If a function gets va_list as argument, don't let it use va_end (since it's the callers responsibility). Improved by comments from enami and christos -- thanks! Heimdal/krb4/KAME changes already fed back, rest to follow. Inspired by, but not not based on, OpenBSD.
233 lines
6.2 KiB
C
233 lines
6.2 KiB
C
/* $NetBSD: saio.c,v 1.3 2001/09/24 13:22:33 wiz Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1992, 1993
|
|
* The Regents of the University of California. All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to Berkeley by
|
|
* Van Jacobson of Lawrence Berkeley Laboratory and Ralph Campbell.
|
|
*
|
|
* 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 University of
|
|
* California, Berkeley and its contributors.
|
|
* 4. Neither the name of the University 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 REGENTS 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 REGENTS 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.
|
|
*
|
|
* @(#)rz.c 8.1 (Berkeley) 6/10/93
|
|
*/
|
|
|
|
#include <lib/libsa/stand.h>
|
|
#include <machine/prom.h>
|
|
#include <machine/stdarg.h>
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/disklabel.h>
|
|
|
|
#include "common.h"
|
|
#include "saio.h"
|
|
|
|
struct saio_softc {
|
|
int sc_fd; /* PROM file id */
|
|
int sc_ctlr; /* controller number */
|
|
int sc_unit; /* disk unit number */
|
|
int sc_part; /* disk partition number */
|
|
struct disklabel sc_label; /* disk label for this disk */
|
|
};
|
|
|
|
struct io_arg {
|
|
int retval;
|
|
unsigned long sectst;
|
|
unsigned long memaddr;
|
|
unsigned long datasz;
|
|
};
|
|
|
|
#define IOB_BUFSZ 512
|
|
#define IOB_INODESZ 316
|
|
|
|
struct device_table {
|
|
char *dt_string; /* device name */
|
|
int (*dt_init) (int); /* device init routine */
|
|
int (*dt_open) __P((int)); /* device open routine */
|
|
int (*dt_strategy) __P((int)); /* device strategy routine, returns cnt */
|
|
int (*dt_close) __P((int)); /* device close routine */
|
|
int (*dt_ioctl) __P((int)); /* device ioctl routine */
|
|
int dt_type; /* device "type" */
|
|
int dt_fs; /* file system type */
|
|
char *dt_desc; /* device description */
|
|
};
|
|
|
|
struct sa_iob {
|
|
char i_buf[IOB_BUFSZ]; /* file system or tape header */
|
|
char i_ino_dir[IOB_INODESZ]; /* inode or disk/tape directory */
|
|
|
|
int i_flgs; /* see F_ below */
|
|
int i_ctlr; /* controller board */
|
|
int i_unit; /* pseudo device unit */
|
|
int i_part; /* disk partition */
|
|
char *i_ma; /* memory address of i/o buffer */
|
|
int i_cc; /* character count of transfer */
|
|
int32_t i_offset; /* seek offset in file */
|
|
daddr_t i_bn; /* 1st block # of next read */
|
|
int i_fstype; /* file system type */
|
|
int i_errno; /* error # return */
|
|
unsigned int i_devaddr; /* csr address */
|
|
struct device_table *i_dp; /* pointer into device_table */
|
|
char *i_bufp; /* i/o buffer for blk devs */
|
|
}__attribute__((__packed__));
|
|
|
|
extern struct sa_iob *saiob[];
|
|
|
|
int
|
|
saiostrategy(devdata, rw, bn, reqcnt, addr, cnt)
|
|
void *devdata;
|
|
int rw;
|
|
daddr_t bn;
|
|
size_t reqcnt;
|
|
void *addr;
|
|
size_t *cnt; /* out: number of bytes transfered */
|
|
{
|
|
struct saio_softc *sc = (struct saio_softc *)devdata;
|
|
int part = sc->sc_part;
|
|
struct partition *pp = &sc->sc_label.d_partitions[part];
|
|
int s;
|
|
long offset;
|
|
struct sa_iob *iob;
|
|
|
|
offset = bn * DEV_BSIZE;
|
|
*cnt = 0;
|
|
|
|
/*
|
|
* Partial-block transfers not handled.
|
|
*/
|
|
if (reqcnt & (DEV_BSIZE - 1)) {
|
|
return (EINVAL);
|
|
}
|
|
offset += pp->p_offset * DEV_BSIZE;
|
|
|
|
iob = saiob[sc->sc_fd];
|
|
iob->i_offset = offset;
|
|
|
|
#if notyet
|
|
if (prom_lseek(sc->sc_fd, offset, 0) < 0)
|
|
return (EIO);
|
|
#endif
|
|
|
|
while (*cnt < reqcnt) {
|
|
s = prom_read(sc->sc_fd, iob->i_buf, 512);
|
|
if (s < 0) {
|
|
return (EIO);
|
|
}
|
|
memcpy(addr, iob->i_buf, s);
|
|
*cnt += s;
|
|
(char *)addr += s;
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
int
|
|
saioopen(struct open_file *f, ...)
|
|
{
|
|
int ctlr, unit, part;
|
|
|
|
struct saio_softc *sc;
|
|
struct disklabel *lp;
|
|
int i;
|
|
char *msg;
|
|
char buf[DEV_BSIZE];
|
|
int cnt;
|
|
static char device[] = "dksd(0,0,10)";
|
|
|
|
va_list ap;
|
|
|
|
va_start(ap, f);
|
|
|
|
ctlr = va_arg(ap, int);
|
|
unit = va_arg(ap, int);
|
|
part = va_arg(ap, int);
|
|
|
|
va_end(ap);
|
|
|
|
device[5] = '0' + ctlr;
|
|
device[7] = '0' + unit;
|
|
|
|
i = prom_open(device, 0);
|
|
if (i < 0) {
|
|
printf("open failed\n");
|
|
return (ENXIO);
|
|
}
|
|
|
|
sc = alloc(sizeof(struct saio_softc));
|
|
memset(sc, 0, sizeof(struct saio_softc));
|
|
f->f_devdata = (void *)sc;
|
|
|
|
sc->sc_fd = i;
|
|
sc->sc_ctlr = ctlr;
|
|
sc->sc_unit = unit;
|
|
sc->sc_part = part;
|
|
|
|
/* try to read disk label and partition table information */
|
|
lp = &sc->sc_label;
|
|
lp->d_secsize = DEV_BSIZE;
|
|
lp->d_secpercyl = 1;
|
|
lp->d_npartitions = MAXPARTITIONS;
|
|
lp->d_partitions[part].p_offset = 0;
|
|
lp->d_partitions[part].p_size = 0x7fffffff;
|
|
|
|
i = saiostrategy(sc, F_READ, (daddr_t)LABELSECTOR, DEV_BSIZE, buf, &cnt);
|
|
if (i || cnt != DEV_BSIZE) {
|
|
printf("%s: error reading disk label\n", device);
|
|
goto bad;
|
|
}
|
|
|
|
msg = getdisklabel(buf, lp);
|
|
if (msg) {
|
|
#ifdef LIBSA_NO_DISKLABEL_MSGS
|
|
printf("%s: no disklabel\n", device);
|
|
#else
|
|
printf("getlabel: %s\n", msg);
|
|
#endif
|
|
return (0);
|
|
}
|
|
if (part >= lp->d_npartitions || lp->d_partitions[part].p_size == 0) {
|
|
bad:
|
|
free(sc, sizeof(struct saio_softc));
|
|
return (ENXIO);
|
|
}
|
|
return (0);
|
|
}
|
|
|
|
#ifndef LIBSA_NO_DEV_CLOSE
|
|
int
|
|
saioclose(f)
|
|
struct open_file *f;
|
|
{
|
|
|
|
prom_close(((struct saio_softc *)f->f_devdata)->sc_fd);
|
|
free(f->f_devdata, sizeof(struct saio_softc));
|
|
f->f_devdata = (void *)0;
|
|
return (0);
|
|
}
|
|
#endif
|