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