| /* $Id: inode.c,v 1.15 2001/11/12 09:43:39 davem Exp $ | 
 |  * openpromfs.c: /proc/openprom handling routines | 
 |  * | 
 |  * Copyright (C) 1996-1999 Jakub Jelinek  (jakub@redhat.com) | 
 |  * Copyright (C) 1998      Eddie C. Dost  (ecd@skynet.be) | 
 |  */ | 
 |  | 
 | #include <linux/module.h> | 
 | #include <linux/types.h> | 
 | #include <linux/string.h> | 
 | #include <linux/fs.h> | 
 | #include <linux/openprom_fs.h> | 
 | #include <linux/init.h> | 
 | #include <linux/slab.h> | 
 | #include <linux/smp_lock.h> | 
 |  | 
 | #include <asm/openprom.h> | 
 | #include <asm/oplib.h> | 
 | #include <asm/uaccess.h> | 
 |  | 
 | #define ALIASES_NNODES 64 | 
 |  | 
 | typedef struct { | 
 | 	u16	parent; | 
 | 	u16	next; | 
 | 	u16	child; | 
 | 	u16	first_prop; | 
 | 	u32	node; | 
 | } openpromfs_node; | 
 |  | 
 | typedef struct { | 
 | #define OPP_STRING	0x10 | 
 | #define OPP_STRINGLIST	0x20 | 
 | #define OPP_BINARY	0x40 | 
 | #define OPP_HEXSTRING	0x80 | 
 | #define OPP_DIRTY	0x01 | 
 | #define OPP_QUOTED	0x02 | 
 | #define OPP_NOTQUOTED	0x04 | 
 | #define OPP_ASCIIZ	0x08 | 
 | 	u32	flag; | 
 | 	u32	alloclen; | 
 | 	u32	len; | 
 | 	char	*value; | 
 | 	char	name[8]; | 
 | } openprom_property; | 
 |  | 
 | static openpromfs_node *nodes; | 
 | static int alloced; | 
 | static u16 last_node; | 
 | static u16 first_prop; | 
 | static u16 options = 0xffff; | 
 | static u16 aliases = 0xffff; | 
 | static int aliases_nodes; | 
 | static char *alias_names [ALIASES_NNODES]; | 
 |  | 
 | #define OPENPROM_ROOT_INO	16 | 
 | #define OPENPROM_FIRST_INO	OPENPROM_ROOT_INO | 
 | #define NODE(ino) nodes[ino - OPENPROM_FIRST_INO] | 
 | #define NODE2INO(node) (node + OPENPROM_FIRST_INO) | 
 | #define NODEP2INO(no) (no + OPENPROM_FIRST_INO + last_node) | 
 |  | 
 | static int openpromfs_create (struct inode *, struct dentry *, int, struct nameidata *); | 
 | static int openpromfs_readdir(struct file *, void *, filldir_t); | 
 | static struct dentry *openpromfs_lookup(struct inode *, struct dentry *dentry, struct nameidata *nd); | 
 | static int openpromfs_unlink (struct inode *, struct dentry *dentry); | 
 |  | 
 | static ssize_t nodenum_read(struct file *file, char __user *buf, | 
 | 			    size_t count, loff_t *ppos) | 
 | { | 
 | 	struct inode *inode = file->f_dentry->d_inode; | 
 | 	char buffer[10]; | 
 | 	 | 
 | 	if (count < 0 || !inode->u.generic_ip) | 
 | 		return -EINVAL; | 
 | 	sprintf (buffer, "%8.8x\n", (u32)(long)(inode->u.generic_ip)); | 
 | 	if (file->f_pos >= 9) | 
 | 		return 0; | 
 | 	if (count > 9 - file->f_pos) | 
 | 		count = 9 - file->f_pos; | 
 | 	if (copy_to_user(buf, buffer + file->f_pos, count)) | 
 | 		return -EFAULT; | 
 | 	*ppos += count; | 
 | 	return count; | 
 | } | 
 |  | 
 | static ssize_t property_read(struct file *filp, char __user *buf, | 
 | 			     size_t count, loff_t *ppos) | 
 | { | 
 | 	struct inode *inode = filp->f_dentry->d_inode; | 
 | 	int i, j, k; | 
 | 	u32 node; | 
 | 	char *p, *s; | 
 | 	u32 *q; | 
 | 	openprom_property *op; | 
 | 	char buffer[64]; | 
 | 	 | 
 | 	if (!filp->private_data) { | 
 | 		node = nodes[(u16)((long)inode->u.generic_ip)].node; | 
 | 		i = ((u32)(long)inode->u.generic_ip) >> 16; | 
 | 		if ((u16)((long)inode->u.generic_ip) == aliases) { | 
 | 			if (i >= aliases_nodes) | 
 | 				p = NULL; | 
 | 			else | 
 | 				p = alias_names [i]; | 
 | 		} else | 
 | 			for (p = prom_firstprop (node, buffer); | 
 | 			     i && p && *p; | 
 | 			     p = prom_nextprop (node, p, buffer), i--) | 
 | 				/* nothing */ ; | 
 | 		if (!p || !*p) | 
 | 			return -EIO; | 
 | 		i = prom_getproplen (node, p); | 
 | 		if (i < 0) { | 
 | 			if ((u16)((long)inode->u.generic_ip) == aliases) | 
 | 				i = 0; | 
 | 			else | 
 | 				return -EIO; | 
 | 		} | 
 | 		k = i; | 
 | 		if (i < 64) i = 64; | 
 | 		filp->private_data = kmalloc (sizeof (openprom_property) | 
 | 					      + (j = strlen (p)) + 2 * i, | 
 | 					      GFP_KERNEL); | 
 | 		if (!filp->private_data) | 
 | 			return -ENOMEM; | 
 | 		op = (openprom_property *)filp->private_data; | 
 | 		op->flag = 0; | 
 | 		op->alloclen = 2 * i; | 
 | 		strcpy (op->name, p); | 
 | 		op->value = (char *)(((unsigned long)(op->name + j + 4)) & ~3); | 
 | 		op->len = k; | 
 | 		if (k && prom_getproperty (node, p, op->value, i) < 0) | 
 | 			return -EIO; | 
 | 		op->value [k] = 0; | 
 | 		if (k) { | 
 | 			for (s = NULL, p = op->value; p < op->value + k; p++) { | 
 | 				if ((*p >= ' ' && *p <= '~') || *p == '\n') { | 
 | 					op->flag |= OPP_STRING; | 
 | 					s = p; | 
 | 					continue; | 
 | 				} | 
 | 				if (p > op->value && !*p && s == p - 1) { | 
 | 					if (p < op->value + k - 1) | 
 | 						op->flag |= OPP_STRINGLIST; | 
 | 					else | 
 | 						op->flag |= OPP_ASCIIZ; | 
 | 					continue; | 
 | 				} | 
 | 				if (k == 1 && !*p) { | 
 | 					op->flag |= (OPP_STRING|OPP_ASCIIZ); | 
 | 					break; | 
 | 				} | 
 | 				op->flag &= ~(OPP_STRING|OPP_STRINGLIST); | 
 | 				if (k & 3) | 
 | 					op->flag |= OPP_HEXSTRING; | 
 | 				else | 
 | 					op->flag |= OPP_BINARY; | 
 | 				break; | 
 | 			} | 
 | 			if (op->flag & OPP_STRINGLIST) | 
 | 				op->flag &= ~(OPP_STRING); | 
 | 			if (op->flag & OPP_ASCIIZ) | 
 | 				op->len--; | 
 | 		} | 
 | 	} else | 
 | 		op = (openprom_property *)filp->private_data; | 
 | 	if (!count || !(op->len || (op->flag & OPP_ASCIIZ))) | 
 | 		return 0; | 
 | 	if (*ppos >= 0xffffff || count >= 0xffffff) | 
 | 		return -EINVAL; | 
 | 	if (op->flag & OPP_STRINGLIST) { | 
 | 		for (k = 0, p = op->value; p < op->value + op->len; p++) | 
 | 			if (!*p) | 
 | 				k++; | 
 | 		i = op->len + 4 * k + 3; | 
 | 	} else if (op->flag & OPP_STRING) { | 
 | 		i = op->len + 3; | 
 | 	} else if (op->flag & OPP_BINARY) { | 
 | 		i = (op->len * 9) >> 2; | 
 | 	} else { | 
 | 		i = (op->len << 1) + 1; | 
 | 	} | 
 | 	k = *ppos; | 
 | 	if (k >= i) return 0; | 
 | 	if (count > i - k) count = i - k; | 
 | 	if (op->flag & OPP_STRING) { | 
 | 		if (!k) { | 
 | 			if (put_user('\'', buf)) | 
 | 				return -EFAULT; | 
 | 			k++; | 
 | 			count--; | 
 | 		} | 
 |  | 
 | 		if (k + count >= i - 2) | 
 | 			j = i - 2 - k; | 
 | 		else | 
 | 			j = count; | 
 |  | 
 | 		if (j >= 0) { | 
 | 			if (copy_to_user(buf + k - *ppos, | 
 | 					 op->value + k - 1, j)) | 
 | 				return -EFAULT; | 
 | 			count -= j; | 
 | 			k += j; | 
 | 		} | 
 |  | 
 | 		if (count) { | 
 | 			if (put_user('\'', &buf [k++ - *ppos])) | 
 | 				return -EFAULT; | 
 | 		} | 
 | 		if (count > 1) { | 
 | 			if (put_user('\n', &buf [k++ - *ppos])) | 
 | 				return -EFAULT; | 
 | 		} | 
 | 	} else if (op->flag & OPP_STRINGLIST) { | 
 | 		char *tmp; | 
 |  | 
 | 		tmp = kmalloc (i, GFP_KERNEL); | 
 | 		if (!tmp) | 
 | 			return -ENOMEM; | 
 |  | 
 | 		s = tmp; | 
 | 		*s++ = '\''; | 
 | 		for (p = op->value; p < op->value + op->len; p++) { | 
 | 			if (!*p) { | 
 | 				strcpy(s, "' + '"); | 
 | 				s += 5; | 
 | 				continue; | 
 | 			} | 
 | 			*s++ = *p; | 
 | 		} | 
 | 		strcpy(s, "'\n"); | 
 |  | 
 | 		if (copy_to_user(buf, tmp + k, count)) | 
 | 			return -EFAULT; | 
 |  | 
 | 		kfree(tmp); | 
 | 		k += count; | 
 |  | 
 | 	} else if (op->flag & OPP_BINARY) { | 
 | 		char buffer[10]; | 
 | 		u32 *first, *last; | 
 | 		int first_off, last_cnt; | 
 |  | 
 | 		first = ((u32 *)op->value) + k / 9; | 
 | 		first_off = k % 9; | 
 | 		last = ((u32 *)op->value) + (k + count - 1) / 9; | 
 | 		last_cnt = (k + count) % 9; | 
 | 		if (!last_cnt) last_cnt = 9; | 
 |  | 
 | 		if (first == last) { | 
 | 			sprintf (buffer, "%08x.", *first); | 
 | 			if (copy_to_user(buf, buffer + first_off, | 
 | 					 last_cnt - first_off)) | 
 | 				return -EFAULT; | 
 | 			buf += last_cnt - first_off; | 
 | 		} else {		 | 
 | 			for (q = first; q <= last; q++) { | 
 | 				sprintf (buffer, "%08x.", *q); | 
 | 				if (q == first) { | 
 | 					if (copy_to_user(buf, buffer + first_off, | 
 | 							 9 - first_off)) | 
 | 						return -EFAULT; | 
 | 					buf += 9 - first_off; | 
 | 				} else if (q == last) { | 
 | 					if (copy_to_user(buf, buffer, last_cnt)) | 
 | 						return -EFAULT; | 
 | 					buf += last_cnt; | 
 | 				} else { | 
 | 					if (copy_to_user(buf, buffer, 9)) | 
 | 						return -EFAULT; | 
 | 					buf += 9; | 
 | 				} | 
 | 			} | 
 | 		} | 
 |  | 
 | 		if (last == (u32 *)(op->value + op->len - 4) && last_cnt == 9) { | 
 | 			if (put_user('\n', (buf - 1))) | 
 | 				return -EFAULT; | 
 | 		} | 
 |  | 
 | 		k += count; | 
 |  | 
 | 	} else if (op->flag & OPP_HEXSTRING) { | 
 | 		char buffer[3]; | 
 |  | 
 | 		if ((k < i - 1) && (k & 1)) { | 
 | 			sprintf (buffer, "%02x", | 
 | 				 (unsigned char) *(op->value + (k >> 1)) & 0xff); | 
 | 			if (put_user(buffer[1], &buf[k++ - *ppos])) | 
 | 				return -EFAULT; | 
 | 			count--; | 
 | 		} | 
 |  | 
 | 		for (; (count > 1) && (k < i - 1); k += 2) { | 
 | 			sprintf (buffer, "%02x", | 
 | 				 (unsigned char) *(op->value + (k >> 1)) & 0xff); | 
 | 			if (copy_to_user(buf + k - *ppos, buffer, 2)) | 
 | 				return -EFAULT; | 
 | 			count -= 2; | 
 | 		} | 
 |  | 
 | 		if (count && (k < i - 1)) { | 
 | 			sprintf (buffer, "%02x", | 
 | 				 (unsigned char) *(op->value + (k >> 1)) & 0xff); | 
 | 			if (put_user(buffer[0], &buf[k++ - *ppos])) | 
 | 				return -EFAULT; | 
 | 			count--; | 
 | 		} | 
 |  | 
 | 		if (count) { | 
 | 			if (put_user('\n', &buf [k++ - *ppos])) | 
 | 				return -EFAULT; | 
 | 		} | 
 | 	} | 
 | 	count = k - *ppos; | 
 | 	*ppos = k; | 
 | 	return count; | 
 | } | 
 |  | 
 | static ssize_t property_write(struct file *filp, const char __user *buf, | 
 | 			      size_t count, loff_t *ppos) | 
 | { | 
 | 	int i, j, k; | 
 | 	char *p; | 
 | 	u32 *q; | 
 | 	void *b; | 
 | 	openprom_property *op; | 
 | 	 | 
 | 	if (*ppos >= 0xffffff || count >= 0xffffff) | 
 | 		return -EINVAL; | 
 | 	if (!filp->private_data) { | 
 | 		i = property_read (filp, NULL, 0, NULL); | 
 | 		if (i) | 
 | 			return i; | 
 | 	} | 
 | 	k = *ppos; | 
 | 	op = (openprom_property *)filp->private_data; | 
 | 	if (!(op->flag & OPP_STRING)) { | 
 | 		u32 *first, *last; | 
 | 		int first_off, last_cnt; | 
 | 		u32 mask, mask2; | 
 | 		char tmp [9]; | 
 | 		int forcelen = 0; | 
 | 		 | 
 | 		j = k % 9; | 
 | 		for (i = 0; i < count; i++, j++) { | 
 | 			if (j == 9) j = 0; | 
 | 			if (!j) { | 
 | 				char ctmp; | 
 | 				if (get_user(ctmp, &buf[i])) | 
 | 					return -EFAULT; | 
 | 				if (ctmp != '.') { | 
 | 					if (ctmp != '\n') { | 
 | 						if (op->flag & OPP_BINARY) | 
 | 							return -EINVAL; | 
 | 						else | 
 | 							goto write_try_string; | 
 | 					} else { | 
 | 						count = i + 1; | 
 | 						forcelen = 1; | 
 | 						break; | 
 | 					} | 
 | 				} | 
 | 			} else { | 
 | 				char ctmp; | 
 | 				if (get_user(ctmp, &buf[i])) | 
 | 					return -EFAULT; | 
 | 				if (ctmp < '0' ||  | 
 | 				    (ctmp > '9' && ctmp < 'A') || | 
 | 				    (ctmp > 'F' && ctmp < 'a') || | 
 | 				    ctmp > 'f') { | 
 | 					if (op->flag & OPP_BINARY) | 
 | 						return -EINVAL; | 
 | 					else | 
 | 						goto write_try_string; | 
 | 				} | 
 | 			} | 
 | 		} | 
 | 		op->flag |= OPP_BINARY; | 
 | 		tmp [8] = 0; | 
 | 		i = ((count + k + 8) / 9) << 2; | 
 | 		if (op->alloclen <= i) { | 
 | 			b = kmalloc (sizeof (openprom_property) + 2 * i, | 
 | 				     GFP_KERNEL); | 
 | 			if (!b) | 
 | 				return -ENOMEM; | 
 | 			memcpy (b, filp->private_data, | 
 | 				sizeof (openprom_property) | 
 | 				+ strlen (op->name) + op->alloclen); | 
 | 			memset (((char *)b) + sizeof (openprom_property) | 
 | 				+ strlen (op->name) + op->alloclen,  | 
 | 				0, 2 * i - op->alloclen); | 
 | 			op = (openprom_property *)b; | 
 | 			op->alloclen = 2*i; | 
 | 			b = filp->private_data; | 
 | 			filp->private_data = (void *)op; | 
 | 			kfree (b); | 
 | 		} | 
 | 		first = ((u32 *)op->value) + (k / 9); | 
 | 		first_off = k % 9; | 
 | 		last = (u32 *)(op->value + i); | 
 | 		last_cnt = (k + count) % 9; | 
 | 		if (first + 1 == last) { | 
 | 			memset (tmp, '0', 8); | 
 | 			if (copy_from_user(tmp + first_off, buf, | 
 | 					   (count + first_off > 8) ? | 
 | 					   8 - first_off : count)) | 
 | 				return -EFAULT; | 
 | 			mask = 0xffffffff; | 
 | 			mask2 = 0xffffffff; | 
 | 			for (j = 0; j < first_off; j++) | 
 | 				mask >>= 1; | 
 | 			for (j = 8 - count - first_off; j > 0; j--) | 
 | 				mask2 <<= 1; | 
 | 			mask &= mask2; | 
 | 			if (mask) { | 
 | 				*first &= ~mask; | 
 | 				*first |= simple_strtoul (tmp, NULL, 16); | 
 | 				op->flag |= OPP_DIRTY; | 
 | 			} | 
 | 		} else { | 
 | 			op->flag |= OPP_DIRTY; | 
 | 			for (q = first; q < last; q++) { | 
 | 				if (q == first) { | 
 | 					if (first_off < 8) { | 
 | 						memset (tmp, '0', 8); | 
 | 						if (copy_from_user(tmp + first_off, | 
 | 								   buf, | 
 | 								   8 - first_off)) | 
 | 							return -EFAULT; | 
 | 						mask = 0xffffffff; | 
 | 						for (j = 0; j < first_off; j++) | 
 | 							mask >>= 1; | 
 | 						*q &= ~mask; | 
 | 						*q |= simple_strtoul (tmp,NULL,16); | 
 | 					} | 
 | 					buf += 9; | 
 | 				} else if ((q == last - 1) && last_cnt | 
 | 					   && (last_cnt < 8)) { | 
 | 					memset (tmp, '0', 8); | 
 | 					if (copy_from_user(tmp, buf, last_cnt)) | 
 | 						return -EFAULT; | 
 | 					mask = 0xffffffff; | 
 | 					for (j = 0; j < 8 - last_cnt; j++) | 
 | 						mask <<= 1; | 
 | 					*q &= ~mask; | 
 | 					*q |= simple_strtoul (tmp, NULL, 16); | 
 | 					buf += last_cnt; | 
 | 				} else { | 
 | 					char tchars[17]; /* XXX yuck... */ | 
 |  | 
 | 					if (copy_from_user(tchars, buf, 16)) | 
 | 						return -EFAULT; | 
 | 					*q = simple_strtoul (tchars, NULL, 16); | 
 | 					buf += 9; | 
 | 				} | 
 | 			} | 
 | 		} | 
 | 		if (!forcelen) { | 
 | 			if (op->len < i) | 
 | 				op->len = i; | 
 | 		} else | 
 | 			op->len = i; | 
 | 		*ppos += count; | 
 | 	} | 
 | write_try_string: | 
 | 	if (!(op->flag & OPP_BINARY)) { | 
 | 		if (!(op->flag & (OPP_QUOTED | OPP_NOTQUOTED))) { | 
 | 			char ctmp; | 
 |  | 
 | 			/* No way, if somebody starts writing from the middle,  | 
 | 			 * we don't know whether he uses quotes around or not  | 
 | 			 */ | 
 | 			if (k > 0) | 
 | 				return -EINVAL; | 
 | 			if (get_user(ctmp, buf)) | 
 | 				return -EFAULT; | 
 | 			if (ctmp == '\'') { | 
 | 				op->flag |= OPP_QUOTED; | 
 | 				buf++; | 
 | 				count--; | 
 | 				(*ppos)++; | 
 | 				if (!count) { | 
 | 					op->flag |= OPP_STRING; | 
 | 					return 1; | 
 | 				} | 
 | 			} else | 
 | 				op->flag |= OPP_NOTQUOTED; | 
 | 		} | 
 | 		op->flag |= OPP_STRING; | 
 | 		if (op->alloclen <= count + *ppos) { | 
 | 			b = kmalloc (sizeof (openprom_property) | 
 | 				     + 2 * (count + *ppos), GFP_KERNEL); | 
 | 			if (!b) | 
 | 				return -ENOMEM; | 
 | 			memcpy (b, filp->private_data, | 
 | 				sizeof (openprom_property) | 
 | 				+ strlen (op->name) + op->alloclen); | 
 | 			memset (((char *)b) + sizeof (openprom_property) | 
 | 				+ strlen (op->name) + op->alloclen,  | 
 | 				0, 2*(count - *ppos) - op->alloclen); | 
 | 			op = (openprom_property *)b; | 
 | 			op->alloclen = 2*(count + *ppos); | 
 | 			b = filp->private_data; | 
 | 			filp->private_data = (void *)op; | 
 | 			kfree (b); | 
 | 		} | 
 | 		p = op->value + *ppos - ((op->flag & OPP_QUOTED) ? 1 : 0); | 
 | 		if (copy_from_user(p, buf, count)) | 
 | 			return -EFAULT; | 
 | 		op->flag |= OPP_DIRTY; | 
 | 		for (i = 0; i < count; i++, p++) | 
 | 			if (*p == '\n') { | 
 | 				*p = 0; | 
 | 				break; | 
 | 			} | 
 | 		if (i < count) { | 
 | 			op->len = p - op->value; | 
 | 			*ppos += i + 1; | 
 | 			if ((p > op->value) && (op->flag & OPP_QUOTED) | 
 | 			    && (*(p - 1) == '\'')) | 
 | 				op->len--; | 
 | 		} else { | 
 | 			if (p - op->value > op->len) | 
 | 				op->len = p - op->value; | 
 | 			*ppos += count; | 
 | 		} | 
 | 	} | 
 | 	return *ppos - k; | 
 | } | 
 |  | 
 | int property_release (struct inode *inode, struct file *filp) | 
 | { | 
 | 	openprom_property *op = (openprom_property *)filp->private_data; | 
 | 	int error; | 
 | 	u32 node; | 
 | 	 | 
 | 	if (!op) | 
 | 		return 0; | 
 | 	lock_kernel(); | 
 | 	node = nodes[(u16)((long)inode->u.generic_ip)].node; | 
 | 	if ((u16)((long)inode->u.generic_ip) == aliases) { | 
 | 		if ((op->flag & OPP_DIRTY) && (op->flag & OPP_STRING)) { | 
 | 			char *p = op->name; | 
 | 			int i = (op->value - op->name) - strlen (op->name) - 1; | 
 | 			op->value [op->len] = 0; | 
 | 			*(op->value - 1) = ' '; | 
 | 			if (i) { | 
 | 				for (p = op->value - i - 2; p >= op->name; p--) | 
 | 					p[i] = *p; | 
 | 				p = op->name + i; | 
 | 			} | 
 | 			memcpy (p - 8, "nvalias ", 8); | 
 | 			prom_feval (p - 8); | 
 | 		} | 
 | 	} else if (op->flag & OPP_DIRTY) { | 
 | 		if (op->flag & OPP_STRING) { | 
 | 			op->value [op->len] = 0; | 
 | 			error = prom_setprop (node, op->name, | 
 | 					      op->value, op->len + 1); | 
 | 			if (error <= 0) | 
 | 				printk (KERN_WARNING "openpromfs: " | 
 | 					"Couldn't write property %s\n", | 
 | 					op->name); | 
 | 		} else if ((op->flag & OPP_BINARY) || !op->len) { | 
 | 			error = prom_setprop (node, op->name, | 
 | 					      op->value, op->len); | 
 | 			if (error <= 0) | 
 | 				printk (KERN_WARNING "openpromfs: " | 
 | 					"Couldn't write property %s\n", | 
 | 					op->name); | 
 | 		} else { | 
 | 			printk (KERN_WARNING "openpromfs: " | 
 | 				"Unknown property type of %s\n", | 
 | 				op->name); | 
 | 		} | 
 | 	} | 
 | 	unlock_kernel(); | 
 | 	kfree (filp->private_data); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct file_operations openpromfs_prop_ops = { | 
 | 	.read		= property_read, | 
 | 	.write		= property_write, | 
 | 	.release	= property_release, | 
 | }; | 
 |  | 
 | static struct file_operations openpromfs_nodenum_ops = { | 
 | 	.read		= nodenum_read, | 
 | }; | 
 |  | 
 | static struct file_operations openprom_operations = { | 
 | 	.read		= generic_read_dir, | 
 | 	.readdir	= openpromfs_readdir, | 
 | }; | 
 |  | 
 | static struct inode_operations openprom_alias_inode_operations = { | 
 | 	.create		= openpromfs_create, | 
 | 	.lookup		= openpromfs_lookup, | 
 | 	.unlink		= openpromfs_unlink, | 
 | }; | 
 |  | 
 | static struct inode_operations openprom_inode_operations = { | 
 | 	.lookup		= openpromfs_lookup, | 
 | }; | 
 |  | 
 | static int lookup_children(u16 n, const char * name, int len) | 
 | { | 
 | 	int ret; | 
 | 	u16 node; | 
 | 	for (; n != 0xffff; n = nodes[n].next) { | 
 | 		node = nodes[n].child; | 
 | 		if (node != 0xffff) { | 
 | 			char buffer[128]; | 
 | 			int i; | 
 | 			char *p; | 
 | 			 | 
 | 			while (node != 0xffff) { | 
 | 				if (prom_getname (nodes[node].node, | 
 | 						  buffer, 128) >= 0) { | 
 | 					i = strlen (buffer); | 
 | 					if ((len == i) | 
 | 					    && !strncmp (buffer, name, len)) | 
 | 						return NODE2INO(node); | 
 | 					p = strchr (buffer, '@'); | 
 | 					if (p && (len == p - buffer) | 
 | 					    && !strncmp (buffer, name, len)) | 
 | 						return NODE2INO(node); | 
 | 				} | 
 | 				node = nodes[node].next; | 
 | 			} | 
 | 		} else | 
 | 			continue; | 
 | 		ret = lookup_children (nodes[n].child, name, len); | 
 | 		if (ret) return ret; | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct dentry *openpromfs_lookup(struct inode * dir, struct dentry *dentry, struct nameidata *nd) | 
 | { | 
 | 	int ino = 0; | 
 | #define OPFSL_DIR	0 | 
 | #define OPFSL_PROPERTY	1 | 
 | #define OPFSL_NODENUM	2 | 
 | 	int type = 0; | 
 | 	char buffer[128]; | 
 | 	char *p; | 
 | 	const char *name; | 
 | 	u32 n; | 
 | 	u16 dirnode; | 
 | 	unsigned int len; | 
 | 	int i; | 
 | 	struct inode *inode; | 
 | 	char buffer2[64]; | 
 | 	 | 
 | 	inode = NULL; | 
 | 	name = dentry->d_name.name; | 
 | 	len = dentry->d_name.len; | 
 | 	lock_kernel(); | 
 | 	if (name [0] == '.' && len == 5 && !strncmp (name + 1, "node", 4)) { | 
 | 		ino = NODEP2INO(NODE(dir->i_ino).first_prop); | 
 | 		type = OPFSL_NODENUM; | 
 | 	} | 
 | 	if (!ino) { | 
 | 		u16 node = NODE(dir->i_ino).child; | 
 | 		while (node != 0xffff) { | 
 | 			if (prom_getname (nodes[node].node, buffer, 128) >= 0) { | 
 | 				i = strlen (buffer); | 
 | 				if (len == i && !strncmp (buffer, name, len)) { | 
 | 					ino = NODE2INO(node); | 
 | 					type = OPFSL_DIR; | 
 | 					break; | 
 | 				} | 
 | 				p = strchr (buffer, '@'); | 
 | 				if (p && (len == p - buffer) | 
 | 				    && !strncmp (buffer, name, len)) { | 
 | 					ino = NODE2INO(node); | 
 | 					type = OPFSL_DIR; | 
 | 					break; | 
 | 				} | 
 | 			} | 
 | 			node = nodes[node].next; | 
 | 		} | 
 | 	} | 
 | 	n = NODE(dir->i_ino).node; | 
 | 	dirnode = dir->i_ino - OPENPROM_FIRST_INO; | 
 | 	if (!ino) { | 
 | 		int j = NODEP2INO(NODE(dir->i_ino).first_prop); | 
 | 		if (dirnode != aliases) { | 
 | 			for (p = prom_firstprop (n, buffer2); | 
 | 			     p && *p; | 
 | 			     p = prom_nextprop (n, p, buffer2)) { | 
 | 				j++; | 
 | 				if ((len == strlen (p)) | 
 | 				    && !strncmp (p, name, len)) { | 
 | 					ino = j; | 
 | 					type = OPFSL_PROPERTY; | 
 | 					break; | 
 | 				} | 
 | 			} | 
 | 		} else { | 
 | 			int k; | 
 | 			for (k = 0; k < aliases_nodes; k++) { | 
 | 				j++; | 
 | 				if (alias_names [k] | 
 | 				    && (len == strlen (alias_names [k])) | 
 | 				    && !strncmp (alias_names [k], name, len)) { | 
 | 					ino = j; | 
 | 					type = OPFSL_PROPERTY; | 
 | 					break; | 
 | 				} | 
 | 			} | 
 | 		} | 
 | 	} | 
 | 	if (!ino) { | 
 | 		ino = lookup_children (NODE(dir->i_ino).child, name, len); | 
 | 		if (ino) | 
 | 			type = OPFSL_DIR; | 
 | 		else { | 
 | 			unlock_kernel(); | 
 | 			return ERR_PTR(-ENOENT); | 
 | 		} | 
 | 	} | 
 | 	inode = iget (dir->i_sb, ino); | 
 | 	unlock_kernel(); | 
 | 	if (!inode) | 
 | 		return ERR_PTR(-EINVAL); | 
 | 	switch (type) { | 
 | 	case OPFSL_DIR: | 
 | 		inode->i_mode = S_IFDIR | S_IRUGO | S_IXUGO; | 
 | 		if (ino == OPENPROM_FIRST_INO + aliases) { | 
 | 			inode->i_mode |= S_IWUSR; | 
 | 			inode->i_op = &openprom_alias_inode_operations; | 
 | 		} else | 
 | 			inode->i_op = &openprom_inode_operations; | 
 | 		inode->i_fop = &openprom_operations; | 
 | 		inode->i_nlink = 2; | 
 | 		break; | 
 | 	case OPFSL_NODENUM: | 
 | 		inode->i_mode = S_IFREG | S_IRUGO; | 
 | 		inode->i_fop = &openpromfs_nodenum_ops; | 
 | 		inode->i_nlink = 1; | 
 | 		inode->u.generic_ip = (void *)(long)(n); | 
 | 		break; | 
 | 	case OPFSL_PROPERTY: | 
 | 		if ((dirnode == options) && (len == 17) | 
 | 		    && !strncmp (name, "security-password", 17)) | 
 | 			inode->i_mode = S_IFREG | S_IRUSR | S_IWUSR; | 
 | 		else { | 
 | 			inode->i_mode = S_IFREG | S_IRUGO; | 
 | 			if (dirnode == options || dirnode == aliases) { | 
 | 				if (len != 4 || strncmp (name, "name", 4)) | 
 | 					inode->i_mode |= S_IWUSR; | 
 | 			} | 
 | 		} | 
 | 		inode->i_fop = &openpromfs_prop_ops; | 
 | 		inode->i_nlink = 1; | 
 | 		if (inode->i_size < 0) | 
 | 			inode->i_size = 0; | 
 | 		inode->u.generic_ip = (void *)(long)(((u16)dirnode) |  | 
 | 			(((u16)(ino - NODEP2INO(NODE(dir->i_ino).first_prop) - 1)) << 16)); | 
 | 		break; | 
 | 	} | 
 |  | 
 | 	inode->i_gid = 0; | 
 | 	inode->i_uid = 0; | 
 |  | 
 | 	d_add(dentry, inode); | 
 | 	return NULL; | 
 | } | 
 |  | 
 | static int openpromfs_readdir(struct file * filp, void * dirent, filldir_t filldir) | 
 | { | 
 | 	struct inode *inode = filp->f_dentry->d_inode; | 
 | 	unsigned int ino; | 
 | 	u32 n; | 
 | 	int i, j; | 
 | 	char buffer[128]; | 
 | 	u16 node; | 
 | 	char *p; | 
 | 	char buffer2[64]; | 
 |  | 
 | 	lock_kernel(); | 
 | 	 | 
 | 	ino = inode->i_ino; | 
 | 	i = filp->f_pos; | 
 | 	switch (i) { | 
 | 	case 0: | 
 | 		if (filldir(dirent, ".", 1, i, ino, DT_DIR) < 0) goto out; | 
 | 		i++; | 
 | 		filp->f_pos++; | 
 | 		/* fall thru */ | 
 | 	case 1: | 
 | 		if (filldir(dirent, "..", 2, i,  | 
 | 			(NODE(ino).parent == 0xffff) ?  | 
 | 			OPENPROM_ROOT_INO : NODE2INO(NODE(ino).parent), DT_DIR) < 0)  | 
 | 			goto out; | 
 | 		i++; | 
 | 		filp->f_pos++; | 
 | 		/* fall thru */ | 
 | 	default: | 
 | 		i -= 2; | 
 | 		node = NODE(ino).child; | 
 | 		while (i && node != 0xffff) { | 
 | 			node = nodes[node].next; | 
 | 			i--; | 
 | 		} | 
 | 		while (node != 0xffff) { | 
 | 			if (prom_getname (nodes[node].node, buffer, 128) < 0) | 
 | 				goto out; | 
 | 			if (filldir(dirent, buffer, strlen(buffer), | 
 | 				    filp->f_pos, NODE2INO(node), DT_DIR) < 0) | 
 | 				goto out; | 
 | 			filp->f_pos++; | 
 | 			node = nodes[node].next; | 
 | 		} | 
 | 		j = NODEP2INO(NODE(ino).first_prop); | 
 | 		if (!i) { | 
 | 			if (filldir(dirent, ".node", 5, filp->f_pos, j, DT_REG) < 0) | 
 | 				goto out; | 
 | 			filp->f_pos++; | 
 | 		} else | 
 | 			i--; | 
 | 		n = NODE(ino).node; | 
 | 		if (ino == OPENPROM_FIRST_INO + aliases) { | 
 | 			for (j++; i < aliases_nodes; i++, j++) { | 
 | 				if (alias_names [i]) { | 
 | 					if (filldir (dirent, alias_names [i],  | 
 | 						strlen (alias_names [i]),  | 
 | 						filp->f_pos, j, DT_REG) < 0) goto out;  | 
 | 					filp->f_pos++; | 
 | 				} | 
 | 			} | 
 | 		} else { | 
 | 			for (p = prom_firstprop (n, buffer2); | 
 | 			     p && *p; | 
 | 			     p = prom_nextprop (n, p, buffer2)) { | 
 | 				j++; | 
 | 				if (i) i--; | 
 | 				else { | 
 | 					if (filldir(dirent, p, strlen(p), | 
 | 						    filp->f_pos, j, DT_REG) < 0) | 
 | 						goto out; | 
 | 					filp->f_pos++; | 
 | 				} | 
 | 			} | 
 | 		} | 
 | 	} | 
 | out: | 
 | 	unlock_kernel(); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int openpromfs_create (struct inode *dir, struct dentry *dentry, int mode, | 
 | 		struct nameidata *nd) | 
 | { | 
 | 	char *p; | 
 | 	struct inode *inode; | 
 | 	 | 
 | 	if (!dir) | 
 | 		return -ENOENT; | 
 | 	if (dentry->d_name.len > 256) | 
 | 		return -EINVAL; | 
 | 	p = kmalloc (dentry->d_name.len + 1, GFP_KERNEL); | 
 | 	if (!p) | 
 | 		return -ENOMEM; | 
 | 	strncpy (p, dentry->d_name.name, dentry->d_name.len); | 
 | 	p [dentry->d_name.len] = 0; | 
 | 	lock_kernel(); | 
 | 	if (aliases_nodes == ALIASES_NNODES) { | 
 | 		kfree(p); | 
 | 		unlock_kernel(); | 
 | 		return -EIO; | 
 | 	} | 
 | 	alias_names [aliases_nodes++] = p; | 
 | 	inode = iget (dir->i_sb, | 
 | 			NODEP2INO(NODE(dir->i_ino).first_prop) + aliases_nodes); | 
 | 	if (!inode) { | 
 | 		unlock_kernel(); | 
 | 		return -EINVAL; | 
 | 	} | 
 | 	inode->i_mode = S_IFREG | S_IRUGO | S_IWUSR; | 
 | 	inode->i_fop = &openpromfs_prop_ops; | 
 | 	inode->i_nlink = 1; | 
 | 	if (inode->i_size < 0) inode->i_size = 0; | 
 | 	inode->u.generic_ip = (void *)(long)(((u16)aliases) |  | 
 | 			(((u16)(aliases_nodes - 1)) << 16)); | 
 | 	unlock_kernel(); | 
 | 	d_instantiate(dentry, inode); | 
 | 	return 0; | 
 | } | 
 |  | 
 | static int openpromfs_unlink (struct inode *dir, struct dentry *dentry) | 
 | { | 
 | 	unsigned int len; | 
 | 	char *p; | 
 | 	const char *name; | 
 | 	int i; | 
 | 	 | 
 | 	name = dentry->d_name.name; | 
 | 	len = dentry->d_name.len; | 
 | 	lock_kernel(); | 
 | 	for (i = 0; i < aliases_nodes; i++) | 
 | 		if ((strlen (alias_names [i]) == len) | 
 | 		    && !strncmp (name, alias_names[i], len)) { | 
 | 			char buffer[512]; | 
 | 			 | 
 | 			p = alias_names [i]; | 
 | 			alias_names [i] = NULL; | 
 | 			kfree (p); | 
 | 			strcpy (buffer, "nvunalias "); | 
 | 			memcpy (buffer + 10, name, len); | 
 | 			buffer [10 + len] = 0; | 
 | 			prom_feval (buffer); | 
 | 		} | 
 | 	unlock_kernel(); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* {{{ init section */ | 
 | static int __init check_space (u16 n) | 
 | { | 
 | 	unsigned long pages; | 
 |  | 
 | 	if ((1 << alloced) * PAGE_SIZE < (n + 2) * sizeof(openpromfs_node)) { | 
 | 		pages = __get_free_pages (GFP_KERNEL, alloced + 1); | 
 | 		if (!pages) | 
 | 			return -1; | 
 |  | 
 | 		if (nodes) { | 
 | 			memcpy ((char *)pages, (char *)nodes, | 
 | 				(1 << alloced) * PAGE_SIZE); | 
 | 			free_pages ((unsigned long)nodes, alloced); | 
 | 		} | 
 | 		alloced++; | 
 | 		nodes = (openpromfs_node *)pages; | 
 | 	} | 
 | 	return 0; | 
 | } | 
 |  | 
 | static u16 __init get_nodes (u16 parent, u32 node) | 
 | { | 
 | 	char *p; | 
 | 	u16 n = last_node++, i; | 
 | 	char buffer[64]; | 
 |  | 
 | 	if (check_space (n) < 0) | 
 | 		return 0xffff; | 
 | 	nodes[n].parent = parent; | 
 | 	nodes[n].node = node; | 
 | 	nodes[n].next = 0xffff; | 
 | 	nodes[n].child = 0xffff; | 
 | 	nodes[n].first_prop = first_prop++; | 
 | 	if (!parent) { | 
 | 		char buffer[8]; | 
 | 		int j; | 
 | 		 | 
 | 		if ((j = prom_getproperty (node, "name", buffer, 8)) >= 0) { | 
 | 		    buffer[j] = 0; | 
 | 		    if (!strcmp (buffer, "options")) | 
 | 			options = n; | 
 | 		    else if (!strcmp (buffer, "aliases")) | 
 | 		        aliases = n; | 
 | 		} | 
 | 	} | 
 | 	if (n != aliases) | 
 | 		for (p = prom_firstprop (node, buffer); | 
 | 		     p && p != (char *)-1 && *p; | 
 | 		     p = prom_nextprop (node, p, buffer)) | 
 | 			first_prop++; | 
 | 	else { | 
 | 		char *q; | 
 | 		for (p = prom_firstprop (node, buffer); | 
 | 		     p && p != (char *)-1 && *p; | 
 | 		     p = prom_nextprop (node, p, buffer)) { | 
 | 			if (aliases_nodes == ALIASES_NNODES) | 
 | 				break; | 
 | 			for (i = 0; i < aliases_nodes; i++) | 
 | 				if (!strcmp (p, alias_names [i])) | 
 | 					break; | 
 | 			if (i < aliases_nodes) | 
 | 				continue; | 
 | 			q = kmalloc (strlen (p) + 1, GFP_KERNEL); | 
 | 			if (!q) | 
 | 				return 0xffff; | 
 | 			strcpy (q, p); | 
 | 			alias_names [aliases_nodes++] = q; | 
 | 		} | 
 | 		first_prop += ALIASES_NNODES; | 
 | 	} | 
 | 	node = prom_getchild (node); | 
 | 	if (node) { | 
 | 		parent = get_nodes (n, node); | 
 | 		if (parent == 0xffff) | 
 | 			return 0xffff; | 
 | 		nodes[n].child = parent; | 
 | 		while ((node = prom_getsibling (node)) != 0) { | 
 | 			i = get_nodes (n, node); | 
 | 			if (i == 0xffff) | 
 | 				return 0xffff; | 
 | 			nodes[parent].next = i; | 
 | 			parent = i; | 
 | 		} | 
 | 	} | 
 | 	return n; | 
 | } | 
 |  | 
 | static void openprom_read_inode(struct inode * inode) | 
 | { | 
 | 	inode->i_mtime = inode->i_atime = inode->i_ctime = CURRENT_TIME; | 
 | 	if (inode->i_ino == OPENPROM_ROOT_INO) { | 
 | 		inode->i_op = &openprom_inode_operations; | 
 | 		inode->i_fop = &openprom_operations; | 
 | 		inode->i_mode = S_IFDIR | S_IRUGO | S_IXUGO; | 
 | 	} | 
 | } | 
 |  | 
 | static int openprom_remount(struct super_block *sb, int *flags, char *data) | 
 | { | 
 | 	*flags |= MS_NOATIME; | 
 | 	return 0; | 
 | } | 
 |  | 
 | static struct super_operations openprom_sops = {  | 
 | 	.read_inode	= openprom_read_inode, | 
 | 	.statfs		= simple_statfs, | 
 | 	.remount_fs	= openprom_remount, | 
 | }; | 
 |  | 
 | static int openprom_fill_super(struct super_block *s, void *data, int silent) | 
 | { | 
 | 	struct inode * root_inode; | 
 |  | 
 | 	s->s_flags |= MS_NOATIME; | 
 | 	s->s_blocksize = 1024; | 
 | 	s->s_blocksize_bits = 10; | 
 | 	s->s_magic = OPENPROM_SUPER_MAGIC; | 
 | 	s->s_op = &openprom_sops; | 
 | 	s->s_time_gran = 1; | 
 | 	root_inode = iget(s, OPENPROM_ROOT_INO); | 
 | 	if (!root_inode) | 
 | 		goto out_no_root; | 
 | 	s->s_root = d_alloc_root(root_inode); | 
 | 	if (!s->s_root) | 
 | 		goto out_no_root; | 
 | 	return 0; | 
 |  | 
 | out_no_root: | 
 | 	printk("openprom_fill_super: get root inode failed\n"); | 
 | 	iput(root_inode); | 
 | 	return -ENOMEM; | 
 | } | 
 |  | 
 | static struct super_block *openprom_get_sb(struct file_system_type *fs_type, | 
 | 	int flags, const char *dev_name, void *data) | 
 | { | 
 | 	return get_sb_single(fs_type, flags, data, openprom_fill_super); | 
 | } | 
 |  | 
 | static struct file_system_type openprom_fs_type = { | 
 | 	.owner		= THIS_MODULE, | 
 | 	.name		= "openpromfs", | 
 | 	.get_sb		= openprom_get_sb, | 
 | 	.kill_sb	= kill_anon_super, | 
 | }; | 
 |  | 
 | static int __init init_openprom_fs(void) | 
 | { | 
 | 	nodes = (openpromfs_node *)__get_free_pages(GFP_KERNEL, 0); | 
 | 	if (!nodes) { | 
 | 		printk (KERN_WARNING "openpromfs: can't get free page\n"); | 
 | 		return -EIO; | 
 | 	} | 
 | 	if (get_nodes (0xffff, prom_root_node) == 0xffff) { | 
 | 		printk (KERN_WARNING "openpromfs: couldn't setup tree\n"); | 
 | 		return -EIO; | 
 | 	} | 
 | 	nodes[last_node].first_prop = first_prop; | 
 | 	return register_filesystem(&openprom_fs_type); | 
 | } | 
 |  | 
 | static void __exit exit_openprom_fs(void) | 
 | { | 
 | 	int i; | 
 | 	unregister_filesystem(&openprom_fs_type); | 
 | 	free_pages ((unsigned long)nodes, alloced); | 
 | 	for (i = 0; i < aliases_nodes; i++) | 
 | 		if (alias_names [i]) | 
 | 			kfree (alias_names [i]); | 
 | 	nodes = NULL; | 
 | } | 
 |  | 
 | module_init(init_openprom_fs) | 
 | module_exit(exit_openprom_fs) | 
 | MODULE_LICENSE("GPL"); |