Home | History | Annotate | Line # | Download | only in ofwboot
ofdev.c revision 1.3
      1  1.3  tsubai /*	$NetBSD: ofdev.c,v 1.3 1999/02/04 15:41:15 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.1  tsubai 
     48  1.1  tsubai #include "ofdev.h"
     49  1.1  tsubai 
     50  1.1  tsubai extern char bootdev[];
     51  1.1  tsubai 
     52  1.1  tsubai static char *
     53  1.1  tsubai filename(str, ppart)
     54  1.1  tsubai 	char *str;
     55  1.1  tsubai 	char *ppart;
     56  1.1  tsubai {
     57  1.1  tsubai 	char *cp, *lp;
     58  1.1  tsubai 	char savec;
     59  1.1  tsubai 	int dhandle;
     60  1.1  tsubai 	char devtype[16];
     61  1.1  tsubai 
     62  1.1  tsubai 	lp = str;
     63  1.1  tsubai 	devtype[0] = 0;
     64  1.1  tsubai 	*ppart = 0;
     65  1.1  tsubai 	for (cp = str; *cp; lp = cp) {
     66  1.1  tsubai 		/* For each component of the path name... */
     67  1.1  tsubai 		while (*++cp && *cp != '/');
     68  1.1  tsubai 		savec = *cp;
     69  1.1  tsubai 		*cp = 0;
     70  1.1  tsubai 		/* ...look whether there is a device with this name */
     71  1.1  tsubai 		dhandle = OF_finddevice(str);
     72  1.1  tsubai 		*cp = savec;
     73  1.1  tsubai 		if (dhandle == -1) {
     74  1.1  tsubai 			/* if not, lp is the delimiter between device and path */
     75  1.1  tsubai 			/* if the last component was a block device... */
     76  1.1  tsubai 			if (!strcmp(devtype, "block")) {
     77  1.1  tsubai 				/* search for arguments */
     78  1.1  tsubai 				for (cp = lp;
     79  1.1  tsubai 				     --cp >= str && *cp != '/' && *cp != ':';);
     80  1.1  tsubai 				if (cp >= str && *cp == ':') {
     81  1.1  tsubai 					/* found arguments, make firmware ignore them */
     82  1.1  tsubai 					*cp = 0;
     83  1.1  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.1  tsubai static struct fs_ops file_system_cd9660 = {
    155  1.1  tsubai 	cd9660_open, cd9660_close, cd9660_read, cd9660_write, cd9660_seek,
    156  1.1  tsubai 	    cd9660_stat
    157  1.1  tsubai };
    158  1.1  tsubai static struct fs_ops file_system_nfs = {
    159  1.1  tsubai 	nfs_open, nfs_close, nfs_read, nfs_write, nfs_seek, nfs_stat
    160  1.1  tsubai };
    161  1.1  tsubai 
    162  1.1  tsubai struct fs_ops file_system[3];
    163  1.1  tsubai int nfsys;
    164  1.1  tsubai 
    165  1.1  tsubai static struct of_dev ofdev = {
    166  1.1  tsubai 	-1,
    167  1.1  tsubai };
    168  1.1  tsubai 
    169  1.1  tsubai char opened_name[256];
    170  1.1  tsubai int floppyboot;
    171  1.1  tsubai 
    172  1.1  tsubai static u_long
    173  1.1  tsubai get_long(p)
    174  1.1  tsubai 	const void *p;
    175  1.1  tsubai {
    176  1.1  tsubai 	const unsigned char *cp = p;
    177  1.1  tsubai 
    178  1.1  tsubai 	return cp[0] | (cp[1] << 8) | (cp[2] << 16) | (cp[3] << 24);
    179  1.1  tsubai }
    180  1.1  tsubai 
    181  1.1  tsubai /*
    182  1.1  tsubai  * Find a valid disklabel.
    183  1.1  tsubai  */
    184  1.1  tsubai static int
    185  1.1  tsubai search_label(devp, off, buf, lp, off0)
    186  1.1  tsubai 	struct of_dev *devp;
    187  1.1  tsubai 	u_long off;
    188  1.1  tsubai 	u_char *buf;
    189  1.1  tsubai 	struct disklabel *lp;
    190  1.1  tsubai 	u_long off0;
    191  1.1  tsubai {
    192  1.1  tsubai 	size_t read;
    193  1.1  tsubai 	struct mbr_partition *p;
    194  1.1  tsubai 	int i;
    195  1.1  tsubai 	u_long poff;
    196  1.1  tsubai 	static int recursion;
    197  1.1  tsubai 
    198  1.1  tsubai 	if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    199  1.1  tsubai 	    || read != DEV_BSIZE)
    200  1.1  tsubai 		return ERDLAB;
    201  1.1  tsubai 
    202  1.1  tsubai 	if (buf[510] != 0x55 || buf[511] != 0xaa)
    203  1.1  tsubai 		return ERDLAB;
    204  1.1  tsubai 
    205  1.1  tsubai 	if (recursion++ <= 1)
    206  1.1  tsubai 		off0 += off;
    207  1.2  tsubai 	for (p = (struct mbr_partition *)(buf + MBR_PARTOFF), i = 4;
    208  1.1  tsubai 	     --i >= 0; p++) {
    209  1.2  tsubai 		if (p->mbrp_typ == MBR_PTYPE_NETBSD
    210  1.1  tsubai #ifdef COMPAT_386BSD_MBRPART
    211  1.2  tsubai 		    || (p->mbrp_typ == MBR_PTYPE_386BSD &&
    212  1.1  tsubai 			(printf("WARNING: old BSD partition ID!\n"), 1)
    213  1.1  tsubai 			/* XXX XXX - libsa printf() is void */ )
    214  1.1  tsubai #endif
    215  1.1  tsubai 		    ) {
    216  1.2  tsubai 			poff = get_long(&p->mbrp_start) + off0;
    217  1.1  tsubai 			if (strategy(devp, F_READ, poff + LABELSECTOR,
    218  1.1  tsubai 				     DEV_BSIZE, buf, &read) == 0
    219  1.1  tsubai 			    && read == DEV_BSIZE) {
    220  1.1  tsubai 				if (!getdisklabel(buf, lp)) {
    221  1.1  tsubai 					recursion--;
    222  1.1  tsubai 					return 0;
    223  1.1  tsubai 				}
    224  1.1  tsubai 			}
    225  1.1  tsubai 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    226  1.1  tsubai 			    || read != DEV_BSIZE) {
    227  1.1  tsubai 				recursion--;
    228  1.1  tsubai 				return ERDLAB;
    229  1.1  tsubai 			}
    230  1.2  tsubai 		} else if (p->mbrp_typ == MBR_PTYPE_EXT) {
    231  1.2  tsubai 			poff = get_long(&p->mbrp_start);
    232  1.1  tsubai 			if (!search_label(devp, poff, buf, lp, off0)) {
    233  1.1  tsubai 				recursion--;
    234  1.1  tsubai 				return 0;
    235  1.1  tsubai 			}
    236  1.1  tsubai 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &read)
    237  1.1  tsubai 			    || read != DEV_BSIZE) {
    238  1.1  tsubai 				recursion--;
    239  1.1  tsubai 				return ERDLAB;
    240  1.1  tsubai 			}
    241  1.1  tsubai 		}
    242  1.1  tsubai 	}
    243  1.1  tsubai 	recursion--;
    244  1.1  tsubai 	return ERDLAB;
    245  1.1  tsubai }
    246  1.1  tsubai 
    247  1.1  tsubai int
    248  1.1  tsubai devopen(of, name, file)
    249  1.1  tsubai 	struct open_file *of;
    250  1.1  tsubai 	const char *name;
    251  1.1  tsubai 	char **file;
    252  1.1  tsubai {
    253  1.1  tsubai 	char *cp;
    254  1.1  tsubai 	char partition;
    255  1.1  tsubai 	char fname[256];
    256  1.1  tsubai 	char buf[DEV_BSIZE];
    257  1.1  tsubai 	struct disklabel label;
    258  1.1  tsubai 	int handle, part;
    259  1.1  tsubai 	size_t read;
    260  1.1  tsubai 	int error = 0;
    261  1.1  tsubai 
    262  1.1  tsubai 	if (ofdev.handle != -1)
    263  1.1  tsubai 		panic("devopen");
    264  1.1  tsubai 	if (of->f_flags != F_READ)
    265  1.1  tsubai 		return EPERM;
    266  1.1  tsubai 	strcpy(fname, name);
    267  1.1  tsubai 	cp = filename(fname, &partition);
    268  1.1  tsubai 	if (cp) {
    269  1.1  tsubai 		strcpy(buf, cp);
    270  1.1  tsubai 		*cp = 0;
    271  1.1  tsubai 	}
    272  1.1  tsubai 	if (!cp || !*buf)
    273  1.1  tsubai 		strcpy(buf, DEFAULT_KERNEL);
    274  1.1  tsubai 	if (!*fname)
    275  1.1  tsubai 		strcpy(fname, bootdev);
    276  1.1  tsubai 	strcpy(opened_name, fname);
    277  1.1  tsubai 	if (partition) {
    278  1.1  tsubai 		cp = opened_name + strlen(opened_name);
    279  1.1  tsubai 		*cp++ = ':';
    280  1.1  tsubai 		*cp++ = partition;
    281  1.1  tsubai 		*cp = 0;
    282  1.1  tsubai 	}
    283  1.1  tsubai 	if (*buf != '/')
    284  1.1  tsubai 		strcat(opened_name, "/");
    285  1.1  tsubai 	strcat(opened_name, buf);
    286  1.1  tsubai 	*file = opened_name + strlen(fname) + 1;
    287  1.1  tsubai 	if ((handle = OF_finddevice(fname)) == -1)
    288  1.1  tsubai 		return ENOENT;
    289  1.1  tsubai 	if (OF_getprop(handle, "name", buf, sizeof buf) < 0)
    290  1.1  tsubai 		return ENXIO;
    291  1.1  tsubai 	floppyboot = !strcmp(buf, "floppy");
    292  1.1  tsubai 	if (OF_getprop(handle, "device_type", buf, sizeof buf) < 0)
    293  1.1  tsubai 		return ENXIO;
    294  1.1  tsubai #if 0
    295  1.1  tsubai 	if (!strcmp(buf, "block"))
    296  1.1  tsubai 		/* For block devices, indicate raw partition (:0 in OpenFirmware) */
    297  1.1  tsubai 		strcat(fname, ":0");
    298  1.1  tsubai #endif
    299  1.1  tsubai 	if ((handle = OF_open(fname)) == -1)
    300  1.1  tsubai 		return ENXIO;
    301  1.1  tsubai 	bzero(&ofdev, sizeof ofdev);
    302  1.1  tsubai 	ofdev.handle = handle;
    303  1.3  tsubai 	ofdev.dmabuf = NULL;
    304  1.3  tsubai 	OF_call_method("dma-alloc", handle, 1, 1, MAXPHYS, &ofdev.dmabuf);
    305  1.1  tsubai 	if (!strcmp(buf, "block")) {
    306  1.1  tsubai 		ofdev.type = OFDEV_DISK;
    307  1.1  tsubai 		ofdev.bsize = DEV_BSIZE;
    308  1.1  tsubai 		/* First try to find a disklabel without MBR partitions */
    309  1.1  tsubai 		if (strategy(&ofdev, F_READ,
    310  1.1  tsubai 			     LABELSECTOR, DEV_BSIZE, buf, &read) != 0
    311  1.1  tsubai 		    || read != DEV_BSIZE
    312  1.1  tsubai 		    || getdisklabel(buf, &label)) {
    313  1.1  tsubai 			/* Else try MBR partitions */
    314  1.1  tsubai 			error = search_label(&ofdev, 0, buf, &label, 0);
    315  1.1  tsubai 			if (error && error != ERDLAB)
    316  1.1  tsubai 				goto bad;
    317  1.1  tsubai 		}
    318  1.1  tsubai 
    319  1.1  tsubai 		if (error == ERDLAB) {
    320  1.1  tsubai 			if (partition)
    321  1.1  tsubai 				/* User specified a parititon, but there is none */
    322  1.1  tsubai 				goto bad;
    323  1.1  tsubai 			/* No, label, just use complete disk */
    324  1.1  tsubai 			ofdev.partoff = 0;
    325  1.1  tsubai 		} else {
    326  1.1  tsubai 			part = partition ? partition - 'a' : 0;
    327  1.1  tsubai 			ofdev.partoff = label.d_partitions[part].p_offset;
    328  1.1  tsubai 		}
    329  1.1  tsubai 
    330  1.1  tsubai 		of->f_dev = devsw;
    331  1.1  tsubai 		of->f_devdata = &ofdev;
    332  1.1  tsubai 		bcopy(&file_system_ufs, file_system, sizeof file_system[0]);
    333  1.1  tsubai 		bcopy(&file_system_cd9660, file_system + 1,
    334  1.1  tsubai 		    sizeof file_system[0]);
    335  1.1  tsubai 		nfsys = 2;
    336  1.1  tsubai 		return 0;
    337  1.1  tsubai 	}
    338  1.1  tsubai 	if (!strcmp(buf, "network")) {
    339  1.1  tsubai 		ofdev.type = OFDEV_NET;
    340  1.1  tsubai 		of->f_dev = devsw;
    341  1.1  tsubai 		of->f_devdata = &ofdev;
    342  1.1  tsubai 		bcopy(&file_system_nfs, file_system, sizeof file_system[0]);
    343  1.1  tsubai 		nfsys = 1;
    344  1.1  tsubai 		if (error = net_open(&ofdev))
    345  1.1  tsubai 			goto bad;
    346  1.1  tsubai 		return 0;
    347  1.1  tsubai 	}
    348  1.1  tsubai 	error = EFTYPE;
    349  1.1  tsubai bad:
    350  1.1  tsubai 	OF_close(handle);
    351  1.1  tsubai 	ofdev.handle = -1;
    352  1.1  tsubai 	return error;
    353  1.1  tsubai }
    354