android_kernel_xiaomi_sm8350/fs/openpromfs/inode.c

1098 lines
25 KiB
C
Raw Normal View History

/* $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");