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