Home | History | Annotate | Line # | Download | only in ofwboot
ofdev.c revision 1.5
      1  1.5  tsubai /*	$NetBSD: ofdev.c,v 1.5 2000/11/14 11:25:35 tsubai Exp $	*/
      2  1.1  tsubai 
      3  1.1  tsubai /*
      4  1.1  tsubai  * Copyright (C) 1995, 1996 Wolfgang Solfrank.
      5  1.1  tsubai  * Copyright (C) 1995, 1996 TooLs GmbH.
      6  1.1  tsubai  * All rights reserved.
      7  1.1  tsubai  *
      8  1.1  tsubai  * Redistribution and use in source and binary forms, with or without
      9  1.1  tsubai  * modification, are permitted provided that the following conditions
     10  1.1  tsubai  * are met:
     11  1.1  tsubai  * 1. Redistributions of source code must retain the above copyright
     12  1.1  tsubai  *    notice, this list of conditions and the following disclaimer.
     13  1.1  tsubai  * 2. Redistributions in binary form must reproduce the above copyright
     14  1.1  tsubai  *    notice, this list of conditions and the following disclaimer in the
     15  1.1  tsubai  *    documentation and/or other materials provided with the distribution.
     16  1.1  tsubai  * 3. All advertising materials mentioning features or use of this software
     17  1.1  tsubai  *    must display the following acknowledgement:
     18  1.1  tsubai  *	This product includes software developed by TooLs GmbH.
     19  1.1  tsubai  * 4. The name of TooLs GmbH may not be used to endorse or promote products
     20  1.1  tsubai  *    derived from this software without specific prior written permission.
     21  1.1  tsubai  *
     22  1.1  tsubai  * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR
     23  1.1  tsubai  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     24  1.1  tsubai  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     25  1.1  tsubai  * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
     26  1.1  tsubai  * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
     27  1.1  tsubai  * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
     28  1.1  tsubai  * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
     29  1.1  tsubai  * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
     30  1.1  tsubai  * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
     31  1.1  tsubai  * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     32  1.1  tsubai  */
     33  1.1  tsubai /*
     34  1.1  tsubai  * Device I/O routines using Open Firmware
     35  1.1  tsubai  */
     36  1.1  tsubai 
     37  1.1  tsubai #include <sys/param.h>
     38  1.1  tsubai #include <sys/disklabel.h>
     39  1.2  tsubai #include <sys/disklabel_mbr.h>
     40  1.1  tsubai 
     41  1.1  tsubai #include <netinet/in.h>
     42  1.1  tsubai 
     43  1.1  tsubai #include <lib/libsa/stand.h>
     44  1.1  tsubai #include <lib/libsa/ufs.h>
     45  1.1  tsubai #include <lib/libsa/cd9660.h>
     46  1.1  tsubai #include <lib/libsa/nfs.h>
     47  1.5  tsubai #include <hfs.h>
     48  1.1  tsubai 
     49  1.1  tsubai #include "ofdev.h"
     50  1.1  tsubai 
     51  1.1  tsubai extern char bootdev[];
     52  1.1  tsubai 
     53  1.1  tsubai static char *
     54  1.1  tsubai filename(str, ppart)
     55  1.1  tsubai 	char *str;
     56  1.1  tsubai 	char *ppart;
     57  1.1  tsubai {
     58  1.1  tsubai 	char *cp, *lp;
     59  1.1  tsubai 	char savec;
     60  1.1  tsubai 	int dhandle;
     61  1.1  tsubai 	char devtype[16];
     62  1.1  tsubai 
     63  1.1  tsubai 	lp = str;
     64  1.1  tsubai 	devtype[0] = 0;
     65  1.1  tsubai 	*ppart = 0;
     66  1.1  tsubai 	for (cp = str; *cp; lp = cp) {
     67  1.1  tsubai 		/* For each component of the path name... */
     68  1.1  tsubai 		while (*++cp && *cp != '/');
     69  1.1  tsubai 		savec = *cp;
     70  1.1  tsubai 		*cp = 0;
     71  1.1  tsubai 		/* ...look whether there is a device with this name */
     72  1.1  tsubai 		dhandle = OF_finddevice(str);
     73  1.1  tsubai 		*cp = savec;
     74  1.1  tsubai 		if (dhandle == -1) {
     75  1.1  tsubai 			/* if not, lp is the delimiter between device and path */
     76  1.1  tsubai 			/* if the last component was a block device... */
     77  1.1  tsubai 			if (!strcmp(devtype, "block")) {
     78  1.1  tsubai 				/* search for arguments */
     79  1.1  tsubai 				for (cp = lp;
     80  1.1  tsubai 				     --cp >= str && *cp != '/' && *cp != ':';);
     81  1.1  tsubai 				if (cp >= str && *cp == ':') {
     82  1.4  tsubai 					/* found arguments */
     83  1.4  tsubai 					for (cp = lp; *--cp != ':' && *cp != ',';);
     84  1.1  tsubai 					if (*++cp >= 'a' && *cp <= 'a' + MAXPARTITIONS)
     85  1.1  tsubai 						*ppart = *cp;
     86  1.1  tsubai 				}
     87  1.1  tsubai 			}
     88  1.1  tsubai 			return lp;
     89  1.1  tsubai 		} else if (OF_getprop(dhandle, "device_type", devtype, sizeof devtype) < 0)
     90  1.1  tsubai 			devtype[0] = 0;
     91  1.1  tsubai 	}
     92  1.1  tsubai 	return 0;
     93  1.1  tsubai }
     94  1.1  tsubai 
     95  1.1  tsubai static int
     96  1.1  tsubai strategy(devdata, rw, blk, size, buf, rsize)
     97  1.1  tsubai 	void *devdata;
     98  1.1  tsubai 	int rw;
     99  1.1  tsubai 	daddr_t blk;
    100  1.1  tsubai 	size_t size;
    101  1.1  tsubai 	void *buf;
    102  1.1  tsubai 	size_t *rsize;
    103  1.1  tsubai {
    104  1.1  tsubai 	struct of_dev *dev = devdata;
    105  1.1  tsubai 	u_quad_t pos;
    106  1.1  tsubai 	int n;
    107  1.1  tsubai 
    108  1.1  tsubai 	if (rw != F_READ)
    109  1.1  tsubai 		return EPERM;
    110  1.1  tsubai 	if (dev->type != OFDEV_DISK)
    111  1.1  tsubai 		panic("strategy");
    112  1.1  tsubai 
    113  1.1  tsubai 	pos = (u_quad_t)(blk + dev->partoff) * dev->bsize;
    114  1.1  tsubai 
    115  1.1  tsubai 	for (;;) {
    116  1.1  tsubai 		if (OF_seek(dev->handle, pos) < 0)
    117  1.1  tsubai 			break;
    118  1.1  tsubai 		n = OF_read(dev->handle, buf, size);
    119  1.1  tsubai 		if (n == -2)
    120  1.1  tsubai 			continue;
    121  1.1  tsubai 		if (n < 0)
    122  1.1  tsubai 			break;
    123  1.1  tsubai 		*rsize = n;
    124  1.1  tsubai 		return 0;
    125  1.1  tsubai 	}
    126  1.1  tsubai 	return EIO;
    127  1.1  tsubai }
    128  1.1  tsubai 
    129  1.1  tsubai static int
    130  1.1  tsubai devclose(of)
    131  1.1  tsubai 	struct open_file *of;
    132  1.1  tsubai {
    133  1.1  tsubai 	struct of_dev *op = of->f_devdata;
    134  1.1  tsubai 
    135  1.1  tsubai 	if (op->type == OFDEV_NET)
    136  1.1  tsubai 		net_close(op);
    137  1.3  tsubai 	OF_call_method("dma-free", op->handle, 2, 0, op->dmabuf, MAXPHYS);
    138  1.1  tsubai 	OF_close(op->handle);
    139  1.1  tsubai 	op->handle = -1;
    140  1.1  tsubai }
    141  1.1  tsubai 
    142  1.1  tsubai static struct devsw devsw[1] = {
    143  1.1  tsubai 	"OpenFirmware",
    144  1.1  tsubai 	strategy,
    145  1.1  tsubai 	(int (*)__P((struct open_file *, ...)))nodev,
    146  1.1  tsubai 	devclose,
    147  1.1  tsubai 	noioctl
    148  1.1  tsubai };
    149  1.1  tsubai int ndevs = sizeof devsw / sizeof devsw[0];
    150  1.1  tsubai 
    151  1.1  tsubai static struct fs_ops file_system_ufs = {
    152  1.1  tsubai 	ufs_open, ufs_close, ufs_read, ufs_write, ufs_seek, ufs_stat
    153  1.1  tsubai };
    154  1.5  tsubai static struct fs_ops file_system_hfs = {
    155  1.5  tsubai 	hfs_open, hfs_close, hfs_read, hfs_write, hfs_seek, hfs_stat
    156  1.5  tsubai };
    157  1.1  tsubai static struct fs_ops file_system_cd9660 = {
    158  1.1  tsubai 	cd9660_open, cd9660_close, cd9660_read, cd9660_write, cd9660_seek,
    159  1.1  tsubai 	    cd9660_stat
    160  1.1  tsubai };
    161  1.1  tsubai static struct fs_ops file_system_nfs = {
    162  1.1  tsubai 	nfs_open, nfs_close, nfs_read, nfs_write, nfs_seek, nfs_stat
    163  1.1  tsubai };
    164  1.1  tsubai 
    165  1.1  tsubai struct fs_ops file_system[3];
    166  1.1  tsubai int nfsys;
    167  1.1  tsubai 
    168  1.1  tsubai static struct of_dev ofdev = {
    169  1.1  tsubai 	-1,
    170  1.1  tsubai };
    171  1.1  tsubai 
    172  1.1  tsubai char opened_name[256];
    173  1.1  tsubai int floppyboot;
    174  1.1  tsubai 
    175  1.1  tsubai static u_long
    176  1.1  tsubai get_long(p)
    177  1.1  tsubai 	const void *p;
    178  1.1  tsubai {
    179  1.1  tsubai 	const unsigned char *cp = p;
    180  1.1  tsubai 
    181  1.1  tsubai 	return cp[0] | (cp[1] << 8) | (cp[2] << 16) | (cp[3] << 24);
    182  1.1  tsubai }
    183  1.1  tsubai 
    184  1.1  tsubai /*
    185  1.1  tsubai  * Find a valid disklabel.
    186  1.1  tsubai  */
    187  1.1  tsubai static int
    188  1.1  tsubai search_label(devp, off, buf, lp, off0)
    189  1.1  tsubai 	struct of_dev *devp;
    190  1.1  tsubai 	u_long off;
    191  1.1  tsubai 	u_char *buf;
    192  1.1  tsubai 	struct disklabel *lp;
    193  1.1  tsubai 	u_long off0;
    194  1.1  tsubai {
    195  1.1  tsubai 	size_t read;
    196  1.1  tsubai 	struct mbr_partition *p;
    197  1.1  tsubai 	int i;
    198  1.1  tsubai 	u_long poff;
    199  1.1  tsubai 	static int recursion;
    200  1.1  tsubai 
    201  1.1  tsubai 	if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    202  1.1  tsubai 	    || read != DEV_BSIZE)
    203  1.1  tsubai 		return ERDLAB;
    204  1.1  tsubai 
    205  1.1  tsubai 	if (buf[510] != 0x55 || buf[511] != 0xaa)
    206  1.1  tsubai 		return ERDLAB;
    207  1.1  tsubai 
    208  1.1  tsubai 	if (recursion++ <= 1)
    209  1.1  tsubai 		off0 += off;
    210  1.2  tsubai 	for (p = (struct mbr_partition *)(buf + MBR_PARTOFF), i = 4;
    211  1.1  tsubai 	     --i >= 0; p++) {
    212  1.2  tsubai 		if (p->mbrp_typ == MBR_PTYPE_NETBSD
    213  1.1  tsubai #ifdef COMPAT_386BSD_MBRPART
    214  1.2  tsubai 		    || (p->mbrp_typ == MBR_PTYPE_386BSD &&
    215  1.1  tsubai 			(printf("WARNING: old BSD partition ID!\n"), 1)
    216  1.1  tsubai 			/* XXX XXX - libsa printf() is void */ )
    217  1.1  tsubai #endif
    218  1.1  tsubai 		    ) {
    219  1.2  tsubai 			poff = get_long(&p->mbrp_start) + off0;
    220  1.1  tsubai 			if (strategy(devp, F_READ, poff + LABELSECTOR,
    221  1.1  tsubai 				     DEV_BSIZE, buf, &read) == 0
    222  1.1  tsubai 			    && read == DEV_BSIZE) {
    223  1.1  tsubai 				if (!getdisklabel(buf, lp)) {
    224  1.1  tsubai 					recursion--;
    225  1.1  tsubai 					return 0;
    226  1.1  tsubai 				}
    227  1.1  tsubai 			}
    228  1.1  tsubai 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    229  1.1  tsubai 			    || read != DEV_BSIZE) {
    230  1.1  tsubai 				recursion--;
    231  1.1  tsubai 				return ERDLAB;
    232  1.1  tsubai 			}
    233  1.2  tsubai 		} else if (p->mbrp_typ == MBR_PTYPE_EXT) {
    234  1.2  tsubai 			poff = get_long(&p->mbrp_start);
    235  1.1  tsubai 			if (!search_label(devp, poff, buf, lp, off0)) {
    236  1.1  tsubai 				recursion--;
    237  1.1  tsubai 				return 0;
    238  1.1  tsubai 			}
    239  1.1  tsubai 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    240  1.1  tsubai 			    || read != DEV_BSIZE) {
    241  1.1  tsubai 				recursion--;
    242  1.1  tsubai 				return ERDLAB;
    243  1.1  tsubai 			}
    244  1.1  tsubai 		}
    245  1.1  tsubai 	}
    246  1.1  tsubai 	recursion--;
    247  1.1  tsubai 	return ERDLAB;
    248  1.1  tsubai }
    249  1.1  tsubai 
    250  1.1  tsubai int
    251  1.1  tsubai devopen(of, name, file)
    252  1.1  tsubai 	struct open_file *of;
    253  1.1  tsubai 	const char *name;
    254  1.1  tsubai 	char **file;
    255  1.1  tsubai {
    256  1.1  tsubai 	char *cp;
    257  1.1  tsubai 	char partition;
    258  1.1  tsubai 	char fname[256];
    259  1.1  tsubai 	char buf[DEV_BSIZE];
    260  1.1  tsubai 	struct disklabel label;
    261  1.1  tsubai 	int handle, part;
    262  1.1  tsubai 	size_t read;
    263  1.1  tsubai 	int error = 0;
    264  1.1  tsubai 
    265  1.1  tsubai 	if (ofdev.handle != -1)
    266  1.1  tsubai 		panic("devopen");
    267  1.1  tsubai 	if (of->f_flags != F_READ)
    268  1.1  tsubai 		return EPERM;
    269  1.1  tsubai 	strcpy(fname, name);
    270  1.1  tsubai 	cp = filename(fname, &partition);
    271  1.1  tsubai 	if (cp) {
    272  1.1  tsubai 		strcpy(buf, cp);
    273  1.1  tsubai 		*cp = 0;
    274  1.1  tsubai 	}
    275  1.1  tsubai 	if (!cp || !*buf)
    276  1.1  tsubai 		strcpy(buf, DEFAULT_KERNEL);
    277  1.1  tsubai 	if (!*fname)
    278  1.1  tsubai 		strcpy(fname, bootdev);
    279  1.1  tsubai 	strcpy(opened_name, fname);
    280  1.1  tsubai 	if (partition) {
    281  1.1  tsubai 		cp = opened_name + strlen(opened_name);
    282  1.1  tsubai 		*cp++ = ':';
    283  1.1  tsubai 		*cp++ = partition;
    284  1.1  tsubai 		*cp = 0;
    285  1.1  tsubai 	}
    286  1.1  tsubai 	if (*buf != '/')
    287  1.1  tsubai 		strcat(opened_name, "/");
    288  1.1  tsubai 	strcat(opened_name, buf);
    289  1.1  tsubai 	*file = opened_name + strlen(fname) + 1;
    290  1.1  tsubai 	if ((handle = OF_finddevice(fname)) == -1)
    291  1.1  tsubai 		return ENOENT;
    292  1.1  tsubai 	if (OF_getprop(handle, "name", buf, sizeof buf) < 0)
    293  1.1  tsubai 		return ENXIO;
    294  1.1  tsubai 	floppyboot = !strcmp(buf, "floppy");
    295  1.1  tsubai 	if (OF_getprop(handle, "device_type", buf, sizeof buf) < 0)
    296  1.1  tsubai 		return ENXIO;
    297  1.1  tsubai #if 0
    298  1.1  tsubai 	if (!strcmp(buf, "block"))
    299  1.1  tsubai 		/* For block devices, indicate raw partition (:0 in OpenFirmware) */
    300  1.1  tsubai 		strcat(fname, ":0");
    301  1.1  tsubai #endif
    302  1.1  tsubai 	if ((handle = OF_open(fname)) == -1)
    303  1.1  tsubai 		return ENXIO;
    304  1.1  tsubai 	bzero(&ofdev, sizeof ofdev);
    305  1.1  tsubai 	ofdev.handle = handle;
    306  1.3  tsubai 	ofdev.dmabuf = NULL;
    307  1.3  tsubai 	OF_call_method("dma-alloc", handle, 1, 1, MAXPHYS, &ofdev.dmabuf);
    308  1.1  tsubai 	if (!strcmp(buf, "block")) {
    309  1.1  tsubai 		ofdev.type = OFDEV_DISK;
    310  1.1  tsubai 		ofdev.bsize = DEV_BSIZE;
    311  1.1  tsubai 		/* First try to find a disklabel without MBR partitions */
    312  1.1  tsubai 		if (strategy(&ofdev, F_READ,
    313  1.1  tsubai 			     LABELSECTOR, DEV_BSIZE, buf, &read) != 0
    314  1.1  tsubai 		    || read != DEV_BSIZE
    315  1.1  tsubai 		    || getdisklabel(buf, &label)) {
    316  1.1  tsubai 			/* Else try MBR partitions */
    317  1.1  tsubai 			error = search_label(&ofdev, 0, buf, &label, 0);
    318  1.1  tsubai 			if (error && error != ERDLAB)
    319  1.1  tsubai 				goto bad;
    320  1.1  tsubai 		}
    321  1.1  tsubai 
    322  1.1  tsubai 		if (error == ERDLAB) {
    323  1.1  tsubai 			if (partition)
    324  1.1  tsubai 				/* User specified a parititon, but there is none */
    325  1.1  tsubai 				goto bad;
    326  1.1  tsubai 			/* No, label, just use complete disk */
    327  1.1  tsubai 			ofdev.partoff = 0;
    328  1.1  tsubai 		} else {
    329  1.1  tsubai 			part = partition ? partition - 'a' : 0;
    330  1.1  tsubai 			ofdev.partoff = label.d_partitions[part].p_offset;
    331  1.1  tsubai 		}
    332  1.1  tsubai 
    333  1.1  tsubai 		of->f_dev = devsw;
    334  1.1  tsubai 		of->f_devdata = &ofdev;
    335  1.5  tsubai 		file_system[0] = file_system_ufs;
    336  1.5  tsubai 		file_system[1] = file_system_cd9660;
    337  1.5  tsubai 		file_system[2] = file_system_hfs;
    338  1.5  tsubai 		nfsys = 3;
    339  1.1  tsubai 		return 0;
    340  1.1  tsubai 	}
    341  1.1  tsubai 	if (!strcmp(buf, "network")) {
    342  1.1  tsubai 		ofdev.type = OFDEV_NET;
    343  1.1  tsubai 		of->f_dev = devsw;
    344  1.1  tsubai 		of->f_devdata = &ofdev;
    345  1.5  tsubai 		file_system[0] = file_system_nfs;
    346  1.1  tsubai 		nfsys = 1;
    347  1.1  tsubai 		if (error = net_open(&ofdev))
    348  1.1  tsubai 			goto bad;
    349  1.1  tsubai 		return 0;
    350  1.1  tsubai 	}
    351  1.1  tsubai 	error = EFTYPE;
    352  1.1  tsubai bad:
    353  1.1  tsubai 	OF_close(handle);
    354  1.1  tsubai 	ofdev.handle = -1;
    355  1.1  tsubai 	return error;
    356  1.1  tsubai }
    357