Home | History | Annotate | Line # | Download | only in ofwboot
ofdev.c revision 1.19
      1  1.19       mrg /*	$NetBSD: ofdev.c,v 1.19 2006/05/24 21:24:25 mrg 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.14   aymeric #include "ofdev.h"
     38  1.17       uwe #include "openfirm.h"
     39  1.14   aymeric 
     40   1.1    tsubai #include <sys/param.h>
     41   1.1    tsubai #include <sys/disklabel.h>
     42  1.13     lukem #include <sys/bootblock.h>
     43   1.1    tsubai 
     44   1.1    tsubai #include <netinet/in.h>
     45   1.1    tsubai 
     46  1.18       uwe #include <lib/libkern/libkern.h>
     47  1.18       uwe 
     48   1.1    tsubai #include <lib/libsa/stand.h>
     49  1.18       uwe #include <lib/libsa/byteorder.h>
     50   1.1    tsubai #include <lib/libsa/cd9660.h>
     51   1.1    tsubai #include <lib/libsa/nfs.h>
     52   1.7    tsubai #include <lib/libsa/ufs.h>
     53   1.9   tsutsui #include <lib/libsa/ustarfs.h>
     54   1.1    tsubai 
     55   1.7    tsubai #include "hfs.h"
     56  1.17       uwe #include "net.h"
     57   1.1    tsubai 
     58   1.1    tsubai extern char bootdev[];
     59   1.1    tsubai 
     60   1.1    tsubai static char *
     61  1.14   aymeric filename(char *str, char *ppart)
     62   1.1    tsubai {
     63   1.1    tsubai 	char *cp, *lp;
     64   1.1    tsubai 	char savec;
     65   1.1    tsubai 	int dhandle;
     66   1.1    tsubai 	char devtype[16];
     67   1.8   tsutsui 
     68   1.1    tsubai 	lp = str;
     69   1.1    tsubai 	devtype[0] = 0;
     70   1.1    tsubai 	*ppart = 0;
     71   1.1    tsubai 	for (cp = str; *cp; lp = cp) {
     72   1.1    tsubai 		/* For each component of the path name... */
     73   1.8   tsutsui 		while (*++cp && *cp != '/')
     74  1.17       uwe 			continue;
     75   1.1    tsubai 		savec = *cp;
     76   1.1    tsubai 		*cp = 0;
     77   1.1    tsubai 		/* ...look whether there is a device with this name */
     78   1.1    tsubai 		dhandle = OF_finddevice(str);
     79   1.1    tsubai 		*cp = savec;
     80   1.1    tsubai 		if (dhandle == -1) {
     81   1.8   tsutsui 			/*
     82   1.8   tsutsui 			 * if not, lp is the delimiter between device and path
     83   1.8   tsutsui 			 */
     84   1.1    tsubai 			/* if the last component was a block device... */
     85   1.1    tsubai 			if (!strcmp(devtype, "block")) {
     86   1.1    tsubai 				/* search for arguments */
     87   1.1    tsubai 				for (cp = lp;
     88   1.8   tsutsui 				    --cp >= str && *cp != '/' && *cp != ':';)
     89  1.17       uwe 					continue;
     90   1.1    tsubai 				if (cp >= str && *cp == ':') {
     91   1.4    tsubai 					/* found arguments */
     92   1.8   tsutsui 					for (cp = lp;
     93   1.8   tsutsui 					    *--cp != ':' && *cp != ',';)
     94  1.17       uwe 						continue;
     95   1.8   tsutsui 					if (*++cp >= 'a' &&
     96   1.8   tsutsui 					    *cp <= 'a' + MAXPARTITIONS)
     97   1.1    tsubai 						*ppart = *cp;
     98   1.1    tsubai 				}
     99   1.1    tsubai 			}
    100   1.1    tsubai 			return lp;
    101   1.8   tsutsui 		} else if (OF_getprop(dhandle, "device_type", devtype,
    102   1.8   tsutsui 		    sizeof devtype) < 0)
    103   1.1    tsubai 			devtype[0] = 0;
    104   1.1    tsubai 	}
    105   1.1    tsubai 	return 0;
    106   1.1    tsubai }
    107   1.1    tsubai 
    108   1.1    tsubai static int
    109  1.12   aymeric strategy(void *devdata, int rw, daddr_t blk, size_t size, void *buf,
    110  1.12   aymeric 	 size_t *rsize)
    111   1.1    tsubai {
    112   1.1    tsubai 	struct of_dev *dev = devdata;
    113   1.1    tsubai 	u_quad_t pos;
    114   1.1    tsubai 	int n;
    115   1.8   tsutsui 
    116   1.1    tsubai 	if (rw != F_READ)
    117   1.1    tsubai 		return EPERM;
    118   1.1    tsubai 	if (dev->type != OFDEV_DISK)
    119   1.1    tsubai 		panic("strategy");
    120   1.8   tsutsui 
    121   1.1    tsubai 	pos = (u_quad_t)(blk + dev->partoff) * dev->bsize;
    122   1.8   tsutsui 
    123   1.1    tsubai 	for (;;) {
    124   1.1    tsubai 		if (OF_seek(dev->handle, pos) < 0)
    125   1.1    tsubai 			break;
    126   1.1    tsubai 		n = OF_read(dev->handle, buf, size);
    127   1.1    tsubai 		if (n == -2)
    128   1.1    tsubai 			continue;
    129   1.1    tsubai 		if (n < 0)
    130   1.1    tsubai 			break;
    131   1.1    tsubai 		*rsize = n;
    132   1.1    tsubai 		return 0;
    133   1.1    tsubai 	}
    134   1.1    tsubai 	return EIO;
    135   1.1    tsubai }
    136   1.1    tsubai 
    137   1.1    tsubai static int
    138  1.14   aymeric devopen_dummy(struct open_file *of, ...) {
    139  1.14   aymeric 	return -1;
    140  1.14   aymeric }
    141  1.14   aymeric 
    142  1.14   aymeric static int
    143  1.14   aymeric devclose(struct open_file *of)
    144   1.1    tsubai {
    145   1.1    tsubai 	struct of_dev *op = of->f_devdata;
    146   1.8   tsutsui 
    147   1.1    tsubai 	if (op->type == OFDEV_NET)
    148   1.1    tsubai 		net_close(op);
    149   1.3    tsubai 	OF_call_method("dma-free", op->handle, 2, 0, op->dmabuf, MAXPHYS);
    150   1.1    tsubai 	OF_close(op->handle);
    151   1.1    tsubai 	op->handle = -1;
    152  1.17       uwe 	return 0;
    153   1.1    tsubai }
    154   1.1    tsubai 
    155  1.19       mrg static struct devsw of_devsw[1] = {
    156  1.17       uwe 	{ "OpenFirmware", strategy, devopen_dummy, devclose, noioctl }
    157   1.1    tsubai };
    158  1.19       mrg int ndevs = sizeof of_devsw / sizeof of_devsw[0];
    159   1.1    tsubai 
    160  1.15  junyoung static struct fs_ops file_system_ufs = FS_OPS(ufs);
    161  1.15  junyoung static struct fs_ops file_system_hfs = FS_OPS(hfs);
    162  1.15  junyoung static struct fs_ops file_system_ustarfs = FS_OPS(ustarfs);
    163  1.15  junyoung static struct fs_ops file_system_cd9660 = FS_OPS(cd9660);
    164  1.15  junyoung static struct fs_ops file_system_nfs = FS_OPS(nfs);
    165   1.1    tsubai 
    166   1.9   tsutsui struct fs_ops file_system[4];
    167   1.1    tsubai int nfsys;
    168   1.1    tsubai 
    169   1.1    tsubai static struct of_dev ofdev = {
    170   1.1    tsubai 	-1,
    171   1.1    tsubai };
    172   1.1    tsubai 
    173   1.1    tsubai char opened_name[256];
    174   1.1    tsubai int floppyboot;
    175   1.1    tsubai 
    176   1.1    tsubai static u_long
    177  1.14   aymeric get_long(const void *p)
    178   1.1    tsubai {
    179   1.1    tsubai 	const unsigned char *cp = p;
    180   1.8   tsutsui 
    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.14   aymeric search_label(struct of_dev *devp, u_long off, u_char *buf, struct disklabel *lp,
    189  1.14   aymeric 	     u_long off0)
    190   1.1    tsubai {
    191  1.17       uwe 	size_t nread;
    192   1.1    tsubai 	struct mbr_partition *p;
    193   1.1    tsubai 	int i;
    194   1.1    tsubai 	u_long poff;
    195   1.1    tsubai 	static int recursion;
    196   1.8   tsutsui 
    197  1.17       uwe 	if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &nread)
    198  1.17       uwe 	    || nread != DEV_BSIZE)
    199   1.1    tsubai 		return ERDLAB;
    200   1.8   tsutsui 
    201  1.13     lukem 	if (*(u_int16_t *)&buf[MBR_MAGIC_OFFSET] != sa_htole16(MBR_MAGIC))
    202   1.1    tsubai 		return ERDLAB;
    203   1.1    tsubai 
    204   1.1    tsubai 	if (recursion++ <= 1)
    205   1.1    tsubai 		off0 += off;
    206  1.13     lukem 	for (p = (struct mbr_partition *)(buf + MBR_PART_OFFSET), i = 4;
    207   1.1    tsubai 	     --i >= 0; p++) {
    208  1.13     lukem 		if (p->mbrp_type == MBR_PTYPE_NETBSD
    209   1.1    tsubai #ifdef COMPAT_386BSD_MBRPART
    210  1.13     lukem 		    || (p->mbrp_type == MBR_PTYPE_386BSD &&
    211   1.1    tsubai 			(printf("WARNING: old BSD partition ID!\n"), 1)
    212   1.1    tsubai 			/* XXX XXX - libsa printf() is void */ )
    213   1.1    tsubai #endif
    214   1.1    tsubai 		    ) {
    215   1.2    tsubai 			poff = get_long(&p->mbrp_start) + off0;
    216  1.10    itojun 			if (strategy(devp, F_READ, poff + 1,
    217  1.17       uwe 				     DEV_BSIZE, buf, &nread) == 0
    218  1.17       uwe 			    && nread == DEV_BSIZE) {
    219   1.1    tsubai 				if (!getdisklabel(buf, lp)) {
    220   1.1    tsubai 					recursion--;
    221   1.1    tsubai 					return 0;
    222   1.1    tsubai 				}
    223   1.1    tsubai 			}
    224  1.17       uwe 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &nread)
    225  1.17       uwe 			    || nread != DEV_BSIZE) {
    226   1.1    tsubai 				recursion--;
    227   1.1    tsubai 				return ERDLAB;
    228   1.1    tsubai 			}
    229  1.13     lukem 		} else if (p->mbrp_type == MBR_PTYPE_EXT) {
    230   1.2    tsubai 			poff = get_long(&p->mbrp_start);
    231   1.1    tsubai 			if (!search_label(devp, poff, buf, lp, off0)) {
    232   1.1    tsubai 				recursion--;
    233   1.1    tsubai 				return 0;
    234   1.1    tsubai 			}
    235  1.17       uwe 			if (strategy(devp, F_READ, off, DEV_BSIZE, buf, &nread)
    236  1.17       uwe 			    || nread != DEV_BSIZE) {
    237   1.1    tsubai 				recursion--;
    238   1.1    tsubai 				return ERDLAB;
    239   1.1    tsubai 			}
    240   1.1    tsubai 		}
    241   1.1    tsubai 	}
    242   1.1    tsubai 	recursion--;
    243   1.1    tsubai 	return ERDLAB;
    244   1.1    tsubai }
    245   1.1    tsubai 
    246   1.1    tsubai int
    247  1.14   aymeric devopen(struct open_file *of, const char *name, char **file)
    248   1.1    tsubai {
    249   1.1    tsubai 	char *cp;
    250   1.1    tsubai 	char partition;
    251   1.1    tsubai 	char fname[256];
    252   1.1    tsubai 	char buf[DEV_BSIZE];
    253   1.1    tsubai 	struct disklabel label;
    254   1.1    tsubai 	int handle, part;
    255  1.17       uwe 	size_t nread;
    256   1.1    tsubai 	int error = 0;
    257   1.1    tsubai 
    258   1.1    tsubai 	if (ofdev.handle != -1)
    259   1.1    tsubai 		panic("devopen");
    260   1.1    tsubai 	if (of->f_flags != F_READ)
    261   1.1    tsubai 		return EPERM;
    262   1.1    tsubai 	strcpy(fname, name);
    263   1.1    tsubai 	cp = filename(fname, &partition);
    264   1.1    tsubai 	if (cp) {
    265   1.1    tsubai 		strcpy(buf, cp);
    266   1.1    tsubai 		*cp = 0;
    267   1.1    tsubai 	}
    268   1.1    tsubai 	if (!cp || !*buf)
    269   1.7    tsubai 		return ENOENT;
    270   1.1    tsubai 	if (!*fname)
    271   1.1    tsubai 		strcpy(fname, bootdev);
    272   1.1    tsubai 	strcpy(opened_name, fname);
    273   1.1    tsubai 	if (partition) {
    274   1.1    tsubai 		cp = opened_name + strlen(opened_name);
    275   1.1    tsubai 		*cp++ = ':';
    276   1.1    tsubai 		*cp++ = partition;
    277   1.1    tsubai 		*cp = 0;
    278   1.1    tsubai 	}
    279   1.1    tsubai 	if (*buf != '/')
    280   1.1    tsubai 		strcat(opened_name, "/");
    281   1.1    tsubai 	strcat(opened_name, buf);
    282   1.1    tsubai 	*file = opened_name + strlen(fname) + 1;
    283   1.1    tsubai 	if ((handle = OF_finddevice(fname)) == -1)
    284   1.1    tsubai 		return ENOENT;
    285   1.1    tsubai 	if (OF_getprop(handle, "name", buf, sizeof buf) < 0)
    286   1.1    tsubai 		return ENXIO;
    287   1.1    tsubai 	floppyboot = !strcmp(buf, "floppy");
    288   1.1    tsubai 	if (OF_getprop(handle, "device_type", buf, sizeof buf) < 0)
    289   1.1    tsubai 		return ENXIO;
    290   1.1    tsubai #if 0
    291   1.1    tsubai 	if (!strcmp(buf, "block"))
    292   1.8   tsutsui 		/*
    293   1.8   tsutsui 		 * For block devices, indicate raw partition
    294   1.8   tsutsui 		 * (:0 in OpenFirmware)
    295   1.8   tsutsui 		 */
    296   1.1    tsubai 		strcat(fname, ":0");
    297   1.1    tsubai #endif
    298   1.1    tsubai 	if ((handle = OF_open(fname)) == -1)
    299   1.1    tsubai 		return ENXIO;
    300   1.6       wiz 	memset(&ofdev, 0, sizeof ofdev);
    301   1.1    tsubai 	ofdev.handle = handle;
    302   1.3    tsubai 	ofdev.dmabuf = NULL;
    303   1.3    tsubai 	OF_call_method("dma-alloc", handle, 1, 1, MAXPHYS, &ofdev.dmabuf);
    304   1.1    tsubai 	if (!strcmp(buf, "block")) {
    305   1.1    tsubai 		ofdev.type = OFDEV_DISK;
    306   1.1    tsubai 		ofdev.bsize = DEV_BSIZE;
    307   1.1    tsubai 		/* First try to find a disklabel without MBR partitions */
    308   1.1    tsubai 		if (strategy(&ofdev, F_READ,
    309  1.17       uwe 			     LABELSECTOR, DEV_BSIZE, buf, &nread) != 0
    310  1.17       uwe 		    || nread != DEV_BSIZE
    311   1.1    tsubai 		    || getdisklabel(buf, &label)) {
    312   1.1    tsubai 			/* Else try MBR partitions */
    313   1.1    tsubai 			error = search_label(&ofdev, 0, buf, &label, 0);
    314   1.1    tsubai 			if (error && error != ERDLAB)
    315   1.1    tsubai 				goto bad;
    316   1.1    tsubai 		}
    317   1.1    tsubai 
    318   1.1    tsubai 		if (error == ERDLAB) {
    319   1.1    tsubai 			if (partition)
    320   1.8   tsutsui 				/*
    321   1.8   tsutsui 				 * User specified a parititon,
    322   1.8   tsutsui 				 * but there is none
    323   1.8   tsutsui 				 */
    324   1.1    tsubai 				goto bad;
    325   1.1    tsubai 			/* No, label, just use complete disk */
    326   1.1    tsubai 			ofdev.partoff = 0;
    327   1.1    tsubai 		} else {
    328   1.1    tsubai 			part = partition ? partition - 'a' : 0;
    329   1.1    tsubai 			ofdev.partoff = label.d_partitions[part].p_offset;
    330   1.1    tsubai 		}
    331   1.8   tsutsui 
    332  1.19       mrg 		of->f_dev = of_devsw;
    333   1.1    tsubai 		of->f_devdata = &ofdev;
    334   1.5    tsubai 		file_system[0] = file_system_ufs;
    335   1.9   tsutsui 		file_system[1] = file_system_ustarfs;
    336   1.9   tsutsui 		file_system[2] = file_system_cd9660;
    337   1.9   tsutsui 		file_system[3] = file_system_hfs;
    338   1.9   tsutsui 		nfsys = 4;
    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.19       mrg 		of->f_dev = of_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.17       uwe 		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