1098 lines
25 KiB
C
1098 lines
25 KiB
C
/* $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++)
|
|
kfree (alias_names [i]);
|
|
nodes = NULL;
|
|
}
|
|
|
|
module_init(init_openprom_fs)
|
|
module_exit(exit_openprom_fs)
|
|
MODULE_LICENSE("GPL");
|