Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/*

 *      $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 __user *buf, size_t nbytes, loff_t *ppos)

{

        struct inode *ino = file->f_path.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 const 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, (unsigned long)zorro_resource_start(z),

                              (unsigned long)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);