freebsd-dev/sys/boot/ofw/libofw/ofw_disk.c

241 lines
5.2 KiB
C
Raw Normal View History

/*
* Copyright (C) 2000 Benno Rice.
* All rights reserved.
*
* 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.
*
* THIS SOFTWARE IS PROVIDED BY Benno Rice ``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 TOOLS GMBH 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.
*
* $FreeBSD$
*/
/*
* Disk I/O routines using Open Firmware
*/
#include <sys/param.h>
#include <sys/disklabel.h>
#include <netinet/in.h>
#include <machine/stdarg.h>
#include <stand.h>
#include "bootstrap.h"
#include "libofw.h"
#define DISKSECSZ 512
#define DISKLABELSEC 0
#define DISKLABELOFF 128
static int ofwd_init(void);
static int ofwd_strategy(void *devdata, int flag, daddr_t dblk,
size_t size, char *buf, size_t *rsize);
static int ofwd_open(struct open_file *f, ...);
static int ofwd_close(struct open_file *f);
static void ofwd_print(int verbose);
static char * ofwd_getdevpath(int unit);
int readdisklabel(struct ofw_devdesc *);
struct devsw ofwdisk = {
"disk",
DEVT_DISK,
ofwd_init,
ofwd_strategy,
ofwd_open,
ofwd_close,
noioctl,
ofwd_print
};
static struct ofwdinfo {
int ofwd_unit;
char ofwd_path[255];
} ofwdinfo[MAXDEV];
static int nofwdinfo = 0;
static int
ofwd_init(void)
{
int ret;
char devpath[255];
ihandle_t instance;
printf("ofwd_init: searching for block devices\n");
ofw_devsearch_init();
while ((ret = ofw_devsearch("block", devpath)) != 0) {
devpath[sizeof devpath - 1] = 0;
printf("ofwd_init: devpath=%s\n", devpath);
if (ret == -1) {
printf("ofwd_init: ret=%d\n", ret);
return (1);
}
#ifdef DEBUG
printf("devpath=\"%s\" ret=%d\n", devpath, ret);
#endif
if (strcmp(devpath, "/pci@1f,0/pci@1,1/ide@3/cdrom") == 0)
continue;
instance = OF_open(devpath);
if (instance != -1) {
ofwdinfo[nofwdinfo].ofwd_unit = nofwdinfo;
strncpy(ofwdinfo[nofwdinfo].ofwd_path, devpath, 255);
printf("disk%d is %s\n", nofwdinfo, ofwdinfo[nofwdinfo].ofwd_path);
nofwdinfo++;
OF_close(instance);
}
if (nofwdinfo > MAXDEV) {
printf("Hit MAXDEV probing disks.\n");
return (1);
}
}
printf("ofwd_init: return (0)\n");
return (0);
}
static int
ofwd_strategy(void *devdata, int flag, daddr_t dblk, size_t size, char *buf,
size_t *rsize)
{
struct ofw_devdesc *dp = (struct ofw_devdesc *)devdata;
unsigned long pos;
int n;
int i, j;
pos = (dp->d_kind.ofwdisk.partoff + dblk) * dp->d_kind.ofwdisk.bsize;
do {
if (OF_seek(dp->d_kind.ofwdisk.handle, pos) < 0) {
return EIO;
}
n = OF_read(dp->d_kind.ofwdisk.handle, buf, size);
if (n < 0 && n != -2) {
return EIO;
}
} while (n == -2);
*rsize = size;
return 0;
}
static int
ofwd_open(struct open_file *f, ...)
{
va_list vl;
struct ofw_devdesc *dp;
char *devpath;
phandle_t diskh;
char buf[8192];
int i, j;
va_start(vl, f);
dp = va_arg(vl, struct ofw_devdesc *);
va_end(vl);
devpath = ofwd_getdevpath(dp->d_kind.ofwdisk.unit);
if ((diskh = OF_open(devpath)) == -1) {
printf("ofwd_open: Could not open %s\n", devpath);
return 1;
}
dp->d_kind.ofwdisk.bsize = DISKSECSZ;
dp->d_kind.ofwdisk.handle = diskh;
readdisklabel(dp);
return 0;
}
/* XXX This is a NetBSD header! */
#include "disklabel.h"
int
readdisklabel(struct ofw_devdesc *dp)
{
char buf[DISKSECSZ];
struct partition *p;
struct disklabel *lp;
size_t size;
int i;
dp->d_kind.ofwdisk.partoff = 0;
dp->d_dev->dv_strategy(dp, 0, DISKLABELSEC, sizeof(buf), buf, &size);
lp = (struct disklabel *)(buf + DISKLABELOFF);
p = lp->d_partitions;
for (i = 0; i < MAXPARTITIONS; i++) {
if (i == dp->d_kind.ofwdisk.partition) {
dp->d_kind.ofwdisk.partoff = p->p_offset;
return 0;
}
p++;
}
return 1;
}
static int
ofwd_close(struct open_file *f)
{
struct ofw_devdesc *dev = f->f_devdata;
OF_close(dev->d_kind.ofwdisk.handle);
return 0;
}
static void
ofwd_print(int verbose)
{
int i;
char line[80];
for (i = 0; i < nofwdinfo; i++) {
sprintf(line, " disk%d: %s", i, ofwdinfo[i].ofwd_path);
pager_output(line);
pager_output("\n");
}
return;
}
int
ofwd_getunit(const char *path)
{
int i;
for (i = 0; i < nofwdinfo; i++) {
if (strcmp(path, ofwdinfo[i].ofwd_path) == 0)
return i;
}
return -1;
}
static char *
ofwd_getdevpath(int unit)
{
int i;
for (i = 0; i < nofwdinfo; i++) {
if (ofwdinfo[i].ofwd_unit == unit)
return ofwdinfo[i].ofwd_path;
}
return 0;
}