Subversion Repositories shark

/*
 *      $Id: proc.c,v 1.1 2004-01-28 18:32:17 giacomo Exp $
 *
 *      Procfs interface for the PCI bus.
 *
 *      Copyright (c) 1997--1999 Martin Mares <mj@ucw.cz>
 */

#include <linux/init.h>
#include <linux/pci.h>
#include <linux/module.h>
#include <linux/proc_fs.h>
#include <linux/seq_file.h>
#include <linux/smp_lock.h>

#include <asm/uaccess.h>
#include <asm/byteorder.h>

#define PCI_CFG_SPACE_SIZE 256

static int proc_initialized;    /* = 0 */

static loff_t
proc_bus_pci_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 = PCI_CFG_SPACE_SIZE + off;
                break;
        }
        unlock_kernel();
        if (new < 0 || new > PCI_CFG_SPACE_SIZE)
                return -EINVAL;
        return (file->f_pos = new);
}

static ssize_t
proc_bus_pci_read(struct file *file, char __user *buf, size_t nbytes, loff_t *ppos)
{
        const struct inode *ino = file->f_dentry->d_inode;
        const struct proc_dir_entry *dp = PDE(ino);
        struct pci_dev *dev = dp->data;
        unsigned int pos = *ppos;
        unsigned int cnt, size;

        /*
         * Normal users can read only the standardized portion of the
         * configuration space as several chips lock up when trying to read
         * undefined locations (think of Intel PIIX4 as a typical example).
         */

        if (capable(CAP_SYS_ADMIN))
                size = PCI_CFG_SPACE_SIZE;
        else if (dev->hdr_type == PCI_HEADER_TYPE_CARDBUS)
                size = 128;
        else
                size = 64;

        if (pos >= size)
                return 0;
        if (nbytes >= size)
                nbytes = size;
        if (pos + nbytes > size)
                nbytes = size - pos;
        cnt = nbytes;

        if (!access_ok(VERIFY_WRITE, buf, cnt))
                return -EINVAL;

        if ((pos & 1) && cnt) {
                unsigned char val;
                pci_read_config_byte(dev, pos, &val);
                __put_user(val, buf);
                buf++;
                pos++;
                cnt--;
        }

        if ((pos & 3) && cnt > 2) {
                unsigned short val;
                pci_read_config_word(dev, pos, &val);
                __put_user(cpu_to_le16(val), (unsigned short *) buf);
                buf += 2;
                pos += 2;
                cnt -= 2;
        }

        while (cnt >= 4) {
                unsigned int val;
                pci_read_config_dword(dev, pos, &val);
                __put_user(cpu_to_le32(val), (unsigned int *) buf);
                buf += 4;
                pos += 4;
                cnt -= 4;
        }

        if (cnt >= 2) {
                unsigned short val;
                pci_read_config_word(dev, pos, &val);
                __put_user(cpu_to_le16(val), (unsigned short *) buf);
                buf += 2;
                pos += 2;
                cnt -= 2;
        }

        if (cnt) {
                unsigned char val;
                pci_read_config_byte(dev, pos, &val);
                __put_user(val, buf);
                buf++;
                pos++;
                cnt--;
        }

        *ppos = pos;
        return nbytes;
}

static ssize_t
proc_bus_pci_write(struct file *file, const char __user *buf, size_t nbytes, loff_t *ppos)
{
        const struct inode *ino = file->f_dentry->d_inode;
        const struct proc_dir_entry *dp = PDE(ino);
        struct pci_dev *dev = dp->data;
        int pos = *ppos;
        int cnt;

        if (pos >= PCI_CFG_SPACE_SIZE)
                return 0;
        if (nbytes >= PCI_CFG_SPACE_SIZE)
                nbytes = PCI_CFG_SPACE_SIZE;
        if (pos + nbytes > PCI_CFG_SPACE_SIZE)
                nbytes = PCI_CFG_SPACE_SIZE - pos;
        cnt = nbytes;

        if (!access_ok(VERIFY_READ, buf, cnt))
                return -EINVAL;

        if ((pos & 1) && cnt) {
                unsigned char val;
                __get_user(val, buf);
                pci_write_config_byte(dev, pos, val);
                buf++;
                pos++;
                cnt--;
        }

        if ((pos & 3) && cnt > 2) {
                unsigned short val;
                __get_user(val, (unsigned short *) buf);
                pci_write_config_word(dev, pos, le16_to_cpu(val));
                buf += 2;
                pos += 2;
                cnt -= 2;
        }

        while (cnt >= 4) {
                unsigned int val;
                __get_user(val, (unsigned int *) buf);
                pci_write_config_dword(dev, pos, le32_to_cpu(val));
                buf += 4;
                pos += 4;
                cnt -= 4;
        }

        if (cnt >= 2) {
                unsigned short val;
                __get_user(val, (unsigned short *) buf);
                pci_write_config_word(dev, pos, le16_to_cpu(val));
                buf += 2;
                pos += 2;
                cnt -= 2;
        }

        if (cnt) {
                unsigned char val;
                __get_user(val, buf);
                pci_write_config_byte(dev, pos, val);
                buf++;
                pos++;
                cnt--;
        }

        *ppos = pos;
        return nbytes;
}

struct pci_filp_private {
        enum pci_mmap_state mmap_state;
        int write_combine;
};

static int proc_bus_pci_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
        const struct proc_dir_entry *dp = PDE(inode);
        struct pci_dev *dev = dp->data;
#ifdef HAVE_PCI_MMAP
        struct pci_filp_private *fpriv = file->private_data;
#endif /* HAVE_PCI_MMAP */
        int ret = 0;

        switch (cmd) {
        case PCIIOC_CONTROLLER:
                ret = pci_domain_nr(dev->bus);
                break;

#ifdef HAVE_PCI_MMAP
        case PCIIOC_MMAP_IS_IO:
                fpriv->mmap_state = pci_mmap_io;
                break;

        case PCIIOC_MMAP_IS_MEM:
                fpriv->mmap_state = pci_mmap_mem;
                break;

        case PCIIOC_WRITE_COMBINE:
                if (arg)
                        fpriv->write_combine = 1;
                else
                        fpriv->write_combine = 0;
                break;

#endif /* HAVE_PCI_MMAP */

        default:
                ret = -EINVAL;
                break;
        };

        return ret;
}

#ifdef HAVE_PCI_MMAP
static int proc_bus_pci_mmap(struct file *file, struct vm_area_struct *vma)
{
        struct inode *inode = file->f_dentry->d_inode;
        const struct proc_dir_entry *dp = PDE(inode);
        struct pci_dev *dev = dp->data;
        struct pci_filp_private *fpriv = file->private_data;
        int ret;

        if (!capable(CAP_SYS_RAWIO))
                return -EPERM;

        ret = pci_mmap_page_range(dev, vma,
                                  fpriv->mmap_state,
                                  fpriv->write_combine);
        if (ret < 0)
                return ret;

        return 0;
}

static int proc_bus_pci_open(struct inode *inode, struct file *file)
{
        struct pci_filp_private *fpriv = kmalloc(sizeof(*fpriv), GFP_KERNEL);

        if (!fpriv)
                return -ENOMEM;

        fpriv->mmap_state = pci_mmap_io;
        fpriv->write_combine = 0;

        file->private_data = fpriv;

        return 0;
}

static int proc_bus_pci_release(struct inode *inode, struct file *file)
{
        kfree(file->private_data);
        file->private_data = NULL;

        return 0;
}
#endif /* HAVE_PCI_MMAP */

static struct file_operations proc_bus_pci_operations = {
        .llseek         = proc_bus_pci_lseek,
        .read           = proc_bus_pci_read,
        .write          = proc_bus_pci_write,
        .ioctl          = proc_bus_pci_ioctl,
#ifdef HAVE_PCI_MMAP
        .open           = proc_bus_pci_open,
        .release        = proc_bus_pci_release,
        .mmap           = proc_bus_pci_mmap,
#ifdef HAVE_ARCH_PCI_GET_UNMAPPED_AREA
        .get_unmapped_area = get_pci_unmapped_area,
#endif /* HAVE_ARCH_PCI_GET_UNMAPPED_AREA */
#endif /* HAVE_PCI_MMAP */
};

#if BITS_PER_LONG == 32
#define LONG_FORMAT "\t%08lx"
#else
#define LONG_FORMAT "\t%16lx"
#endif

/* iterator */
static void *pci_seq_start(struct seq_file *m, loff_t *pos)
{
        struct pci_dev *dev = NULL;
        loff_t n = *pos;

        dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev);
        while (n--) {
                dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev);
                if (dev == NULL)
                        goto exit;
        }
exit:
        return dev;
}

static void *pci_seq_next(struct seq_file *m, void *v, loff_t *pos)
{
        struct pci_dev *dev = v;

        (*pos)++;
        dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev);
        return dev;
}

static void pci_seq_stop(struct seq_file *m, void *v)
{
        if (v) {
                struct pci_dev *dev = v;
                pci_dev_put(dev);
        }
}

static int show_device(struct seq_file *m, void *v)
{
        const struct pci_dev *dev = v;
        const struct pci_driver *drv;
        int i;

        if (dev == NULL)
                return 0;

        drv = pci_dev_driver(dev);
        seq_printf(m, "%02x%02x\t%04x%04x\t%x",
                        dev->bus->number,
                        dev->devfn,
                        dev->vendor,
                        dev->device,
                        dev->irq);
        /* Here should be 7 and not PCI_NUM_RESOURCES as we need to preserve compatibility */
        for(i=0; i<7; i++)
                seq_printf(m, LONG_FORMAT,
                        dev->resource[i].start |
                        (dev->resource[i].flags & PCI_REGION_FLAG_MASK));
        for(i=0; i<7; i++)
                seq_printf(m, LONG_FORMAT,
                        dev->resource[i].start < dev->resource[i].end ?
                        dev->resource[i].end - dev->resource[i].start + 1 : 0);
        seq_putc(m, '\t');
        if (drv)
                seq_printf(m, "%s", drv->name);
        seq_putc(m, '\n');
        return 0;
}

static struct seq_operations proc_bus_pci_devices_op = {
        .start  = pci_seq_start,
        .next   = pci_seq_next,
        .stop   = pci_seq_stop,
        .show   = show_device
};

struct proc_dir_entry *proc_bus_pci_dir;

int pci_proc_attach_device(struct pci_dev *dev)
{
        struct pci_bus *bus = dev->bus;
        struct proc_dir_entry *de, *e;
        char name[16];

        if (!proc_initialized)
                return -EACCES;

        if (!(de = bus->procdir)) {
                if (pci_name_bus(name, bus))
                        return -EEXIST;
                de = bus->procdir = proc_mkdir(name, proc_bus_pci_dir);
                if (!de)
                        return -ENOMEM;
        }
        sprintf(name, "%02x.%x", PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn));
        e = dev->procent = create_proc_entry(name, S_IFREG | S_IRUGO | S_IWUSR, de);
        if (!e)
                return -ENOMEM;
        e->proc_fops = &proc_bus_pci_operations;
        e->data = dev;
        e->size = PCI_CFG_SPACE_SIZE;

        return 0;
}

int pci_proc_detach_device(struct pci_dev *dev)
{
        struct proc_dir_entry *e;

        if ((e = dev->procent)) {
                if (atomic_read(&e->count))
                        return -EBUSY;
                remove_proc_entry(e->name, dev->bus->procdir);
                dev->procent = NULL;
        }
        return 0;
}

int pci_proc_attach_bus(struct pci_bus* bus)
{
        struct proc_dir_entry *de = bus->procdir;

        if (!proc_initialized)
                return -EACCES;

        if (!de) {
                char name[16];
                sprintf(name, "%02x", bus->number);
                de = bus->procdir = proc_mkdir(name, proc_bus_pci_dir);
                if (!de)
                        return -ENOMEM;
        }
        return 0;
}

int pci_proc_detach_bus(struct pci_bus* bus)
{
        struct proc_dir_entry *de = bus->procdir;
        if (de)
                remove_proc_entry(de->name, proc_bus_pci_dir);
        return 0;
}

#ifdef CONFIG_PCI_LEGACY_PROC

/*
 *  Backward compatible /proc/pci interface.
 */

/*
 * Convert some of the configuration space registers of the device at
 * address (bus,devfn) into a string (possibly several lines each).
 * The configuration string is stored starting at buf[len].  If the
 * string would exceed the size of the buffer (SIZE), 0 is returned.
 */
static int show_dev_config(struct seq_file *m, void *v)
{
        struct pci_dev *dev = v;
        struct pci_dev *first_dev;
        struct pci_driver *drv;
        u32 class_rev;
        unsigned char latency, min_gnt, max_lat, *class;
        int reg;

        first_dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, NULL);
        if (dev == first_dev)
                seq_puts(m, "PCI devices found:\n");
        pci_dev_put(first_dev);

        drv = pci_dev_driver(dev);

        pci_read_config_dword(dev, PCI_CLASS_REVISION, &class_rev);
        pci_read_config_byte (dev, PCI_LATENCY_TIMER, &latency);
        pci_read_config_byte (dev, PCI_MIN_GNT, &min_gnt);
        pci_read_config_byte (dev, PCI_MAX_LAT, &max_lat);
        seq_printf(m, "  Bus %2d, device %3d, function %2d:\n",
               dev->bus->number, PCI_SLOT(dev->devfn), PCI_FUNC(dev->devfn));
        class = pci_class_name(class_rev >> 16);
        if (class)
                seq_printf(m, "    %s", class);
        else
                seq_printf(m, "    Class %04x", class_rev >> 16);
#ifdef CONFIG_PCI_NAMES
        seq_printf(m, ": %s", dev->pretty_name);
#else
        seq_printf(m, ": PCI device %04x:%04x", dev->vendor, dev->device);
#endif
        seq_printf(m, " (rev %d).\n", class_rev & 0xff);

        if (dev->irq)
                seq_printf(m, "      IRQ %d.\n", dev->irq);

        if (latency || min_gnt || max_lat) {
                seq_printf(m, "      Master Capable.  ");
                if (latency)
                        seq_printf(m, "Latency=%d.  ", latency);
                else
                        seq_puts(m, "No bursts.  ");
                if (min_gnt)
                        seq_printf(m, "Min Gnt=%d.", min_gnt);
                if (max_lat)
                        seq_printf(m, "Max Lat=%d.", max_lat);
                seq_putc(m, '\n');
        }

        for (reg = 0; reg < 6; reg++) {
                struct resource *res = dev->resource + reg;
                unsigned long base, end, flags;

                base = res->start;
                end = res->end;
                flags = res->flags;
                if (!end)
                        continue;

                if (flags & PCI_BASE_ADDRESS_SPACE_IO) {
                        seq_printf(m, "      I/O at 0x%lx [0x%lx].\n",
                                base, end);
                } else {
                        const char *pref, *type = "unknown";

                        if (flags & PCI_BASE_ADDRESS_MEM_PREFETCH)
                                pref = "P";
                        else
                                pref = "Non-p";
                        switch (flags & PCI_BASE_ADDRESS_MEM_TYPE_MASK) {
                              case PCI_BASE_ADDRESS_MEM_TYPE_32:
                                type = "32 bit"; break;
                              case PCI_BASE_ADDRESS_MEM_TYPE_1M:
                                type = "20 bit"; break;
                              case PCI_BASE_ADDRESS_MEM_TYPE_64:
                                type = "64 bit"; break;
                        }
                        seq_printf(m, "      %srefetchable %s memory at "
                                       "0x%lx [0x%lx].\n", pref, type,
                                       base,
                                       end);
                }
        }
        return 0;
}

static struct seq_operations proc_pci_op = {
        .start  = pci_seq_start,
        .next   = pci_seq_next,
        .stop   = pci_seq_stop,
        .show   = show_dev_config
};

static int proc_pci_open(struct inode *inode, struct file *file)
{
        return seq_open(file, &proc_pci_op);
}
static struct file_operations proc_pci_operations = {
        .open           = proc_pci_open,
        .read           = seq_read,
        .llseek         = seq_lseek,
        .release        = seq_release,
};

static void legacy_proc_init(void)
{
        struct proc_dir_entry * entry = create_proc_entry("pci", 0, NULL);
        if (entry)
                entry->proc_fops = &proc_pci_operations;
}

#else

static void legacy_proc_init(void)
{

}

#endif /* CONFIG_PCI_LEGACY_PROC */

static int proc_bus_pci_dev_open(struct inode *inode, struct file *file)
{
        return seq_open(file, &proc_bus_pci_devices_op);
}
static struct file_operations proc_bus_pci_dev_operations = {
        .open           = proc_bus_pci_dev_open,
        .read           = seq_read,
        .llseek         = seq_lseek,
        .release        = seq_release,
};

static int __init pci_proc_init(void)
{
        struct proc_dir_entry *entry;
        struct pci_dev *dev = NULL;
        proc_bus_pci_dir = proc_mkdir("pci", proc_bus);
        entry = create_proc_entry("devices", 0, proc_bus_pci_dir);
        if (entry)
                entry->proc_fops = &proc_bus_pci_dev_operations;
        proc_initialized = 1;
        while ((dev = pci_find_device(PCI_ANY_ID, PCI_ANY_ID, dev)) != NULL) {
                pci_proc_attach_device(dev);
        }
        legacy_proc_init();
        return 0;
}

__initcall(pci_proc_init);

#ifdef CONFIG_HOTPLUG
EXPORT_SYMBOL(pci_proc_attach_device);
EXPORT_SYMBOL(pci_proc_attach_bus);
EXPORT_SYMBOL(pci_proc_detach_bus);
EXPORT_SYMBOL(proc_bus_pci_dir);
#endif