#include <lib/libsa/stand.h>
#include <lib/libkern/libkern.h>
#include <machine/prom.h>
#include <sys/param.h>
#include <sys/disklabel.h>
#include "common.h"
#include "saio.h"
struct saio_softc {
int sc_fd;
int sc_ctlr;
int sc_unit;
int sc_part;
struct disklabel sc_label;
};
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;
int (*dt_init) (int);
int (*dt_open)(int);
int (*dt_strategy)(int);
int (*dt_close)(int);
int (*dt_ioctl)(int);
int dt_type;
int dt_fs;
char *dt_desc;
};
struct sa_iob {
char i_buf[IOB_BUFSZ];
char i_ino_dir[IOB_INODESZ];
int i_flgs;
int i_ctlr;
int i_unit;
int i_part;
char *i_ma;
int i_cc;
int32_t i_offset;
int32_t i_bn;
int i_fstype;
int i_errno;
unsigned int i_devaddr;
struct device_table *i_dp;
char *i_bufp;
}__attribute__((__packed__));
extern struct sa_iob *saiob[];
int
saiostrategy(void *devdata, int rw, daddr_t bn, size_t reqcnt, void *addr, size_t *cnt)
{
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;
char *adr;
offset = bn * DEV_BSIZE;
*cnt = 0;
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
adr = (char *)addr;
while (*cnt < reqcnt) {
s = prom_read(sc->sc_fd, iob->i_buf, 512);
if (s < 0) {
return (EIO);
}
memcpy(adr, iob->i_buf, s);
*cnt += s;
adr += 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];
size_t 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;
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:
dealloc(sc, sizeof(struct saio_softc));
return (ENXIO);
}
return (0);
}
#ifndef LIBSA_NO_DEV_CLOSE
int
saioclose(struct open_file *f)
{
prom_close(((struct saio_softc *)f->f_devdata)->sc_fd);
dealloc(f->f_devdata, sizeof(struct saio_softc));
f->f_devdata = (void *)0;
return (0);
}
#endif