1 files changed, 139 insertions, 0 deletions

diff --git a/drivers/zorro/proc.c b/drivers/zorro/proc.c
new file mode 100644
index 000000000000..1a409c2c320c
--- /dev/null
+++ b/drivers/zorro/proc.c
@@ -0,0 +1,139 @@
+/*
+ *      $Id: proc.c,v 1.1.2.1 1998/06/07 23:21:01 geert Exp $
+ *
+ *      Procfs interface for the Zorro bus.
+ *
+ *      Copyright (C) 1998-2003 Geert Uytterhoeven
+ *
+ *      Heavily based on the procfs interface for the PCI bus, which is
+ *
+ *      Copyright (C) 1997, 1998 Martin Mares <mj@atrey.karlin.mff.cuni.cz>
+ */
+
+#include <linux/types.h>
+#include <linux/zorro.h>
+#include <linux/proc_fs.h>
+#include <linux/init.h>
+#include <linux/smp_lock.h>
+#include <asm/uaccess.h>
+#include <asm/amigahw.h>
+#include <asm/setup.h>
+
+static loff_t
+proc_bus_zorro_lseek(struct file *file, loff_t off, int whence)
+{
+        loff_t new = -1;
+
+        lock_kernel();
+        switch (whence) {
+        case 0:
+                new = off;
+                break;
+        case 1:
+                new = file->f_pos + off;
+                break;
+        case 2:
+                new = sizeof(struct ConfigDev) + off;
+                break;
+        }
+        if (new < 0 || new > sizeof(struct ConfigDev)) {
+                unlock_kernel();
+                return -EINVAL;
+        }
+        unlock_kernel();
+        return (file->f_pos = new);
+}
+
+static ssize_t
+proc_bus_zorro_read(struct file *file, char *buf, size_t nbytes, loff_t *ppos)
+{
+        struct inode *ino = file->f_dentry->d_inode;
+        struct proc_dir_entry *dp = PDE(ino);
+        struct zorro_dev *z = dp->data;
+        struct ConfigDev cd;
+        loff_t pos = *ppos;
+
+        if (pos >= sizeof(struct ConfigDev))
+                return 0;
+        if (nbytes >= sizeof(struct ConfigDev))
+                nbytes = sizeof(struct ConfigDev);
+        if (pos + nbytes > sizeof(struct ConfigDev))
+                nbytes = sizeof(struct ConfigDev) - pos;
+
+        /* Construct a ConfigDev */
+        memset(&cd, 0, sizeof(cd));
+        cd.cd_Rom = z->rom;
+        cd.cd_SlotAddr = z->slotaddr;
+        cd.cd_SlotSize = z->slotsize;
+        cd.cd_BoardAddr = (void *)zorro_resource_start(z);
+        cd.cd_BoardSize = zorro_resource_len(z);
+
+        if (copy_to_user(buf, &cd, nbytes))
+                return -EFAULT;
+        *ppos += nbytes;
+
+        return nbytes;
+}
+
+static struct file_operations proc_bus_zorro_operations = {
+        .llseek         = proc_bus_zorro_lseek,
+        .read           = proc_bus_zorro_read,
+};
+
+static int
+get_zorro_dev_info(char *buf, char **start, off_t pos, int count)
+{
+        u_int slot;
+        off_t at = 0;
+        int len, cnt;
+
+        for (slot = cnt = 0; slot < zorro_num_autocon && count > cnt; slot++) {
+                struct zorro_dev *z = &zorro_autocon[slot];
+                len = sprintf(buf, "%02x\t%08x\t%08lx\t%08lx\t%02x\n", slot,
+                              z->id, zorro_resource_start(z),
+                              zorro_resource_len(z), z->rom.er_Type);
+                at += len;
+                if (at >= pos) {
+                        if (!*start) {
+                                *start = buf + (pos - (at - len));
+                                cnt = at - pos;
+                        } else
+                                cnt += len;
+                        buf += len;
+                }
+        }
+        return (count > cnt) ? cnt : count;
+}
+
+static struct proc_dir_entry *proc_bus_zorro_dir;
+
+static int __init zorro_proc_attach_device(u_int slot)
+{
+        struct proc_dir_entry *entry;
+        char name[4];
+
+        sprintf(name, "%02x", slot);
+        entry = create_proc_entry(name, 0, proc_bus_zorro_dir);
+        if (!entry)
+                return -ENOMEM;
+        entry->proc_fops = &proc_bus_zorro_operations;
+        entry->data = &zorro_autocon[slot];
+        entry->size = sizeof(struct zorro_dev);
+        return 0;
+}
+
+static int __init zorro_proc_init(void)
+{
+        u_int slot;
+
+        if (MACH_IS_AMIGA && AMIGAHW_PRESENT(ZORRO)) {
+                proc_bus_zorro_dir = proc_mkdir("zorro", proc_bus);
+                create_proc_info_entry("devices", 0, proc_bus_zorro_dir,
+                                       get_zorro_dev_info);
+                for (slot = 0; slot < zorro_num_autocon; slot++)
+                        zorro_proc_attach_device(slot);
+        }
+        return 0;
+}
+
+__initcall(zorro_proc_init);