123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338 |
- /**
- *
- * @file sysfs.c
- * @brief This file contains the functions providing the SysFS-interface.
- * @author Guillermo Marcus
- * @date 2010-03-01
- *
- */
- #include <linux/version.h>
- #include <linux/string.h>
- #include <linux/types.h>
- #include <linux/list.h>
- #include <linux/interrupt.h>
- #include <linux/pci.h>
- #include <linux/cdev.h>
- #include <linux/wait.h>
- #include <linux/mm.h>
- #include <linux/pagemap.h>
- #include <linux/kernel.h>
- #include "base.h"
- #define SYSFS_GET_PRIVDATA dev_get_drvdata(dev)
- #define SYSFS_GET_FUNCTION(name) ssize_t name(struct device *dev, struct device_attribute *attr, char *buf)
- #define SYSFS_SET_FUNCTION(name) ssize_t name(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
- #define SYSFS_ATTR_NAME(name) (dev_attr_##name)
- #define SYSFS_ATTR_CREATE(name) do { \
- int err = device_create_file(privdata->class_dev, &SYSFS_ATTR_NAME(name)); \
- if (err != 0) return err; \
- } while (0)
- #define SYSFS_ATTR_REMOVE(name) do { \
- device_remove_file(privdata->class_dev, &SYSFS_ATTR_NAME(name)); \
- } while (0)
- #ifdef ENABLE_IRQ
- static SYSFS_GET_FUNCTION(pcidriver_show_irq_count)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- return snprintf(buf, PAGE_SIZE, "%d\n", privdata->irq_count);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_irq_queues)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- int i, offset;
- /* output will be truncated to PAGE_SIZE */
- offset = snprintf(buf, PAGE_SIZE, "Queue\tOutstanding IRQs\n");
- for (i = 0; i < PCIDRIVER_INT_MAXSOURCES; i++)
- offset += snprintf(buf+offset, PAGE_SIZE-offset, "%d\t%d\n", i, atomic_read(&(privdata->irq_outstanding[i])) );
- return (offset > PAGE_SIZE ? PAGE_SIZE : offset+1);
- }
- #endif
- static SYSFS_GET_FUNCTION(pcidriver_show_mmap_mode)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- return snprintf(buf, PAGE_SIZE, "%d\n", privdata->mmap_mode);
- }
- static SYSFS_SET_FUNCTION(pcidriver_store_mmap_mode)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- int mode = -1;
- /* Set the mmap-mode if it is either PCIDRIVER_MMAP_PCI or PCIDRIVER_MMAP_KMEM */
- if (sscanf(buf, "%d", &mode) == 1 &&
- (mode == PCIDRIVER_MMAP_PCI || mode == PCIDRIVER_MMAP_KMEM))
- privdata->mmap_mode = mode;
- return strlen(buf);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_mmap_area)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- return snprintf(buf, PAGE_SIZE, "%d\n", privdata->mmap_area);
- }
- static SYSFS_SET_FUNCTION(pcidriver_store_mmap_area)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- int temp = -1;
- sscanf(buf, "%d", &temp);
- if ((temp >= PCIDRIVER_BAR0) && (temp <= PCIDRIVER_BAR5))
- privdata->mmap_area = temp;
- return strlen(buf);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_kmem_count)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- return snprintf(buf, PAGE_SIZE, "%d\n", atomic_read(&(privdata->kmem_count)));
- }
- static SYSFS_SET_FUNCTION(pcidriver_store_kmem_alloc)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- kmem_handle_t kmem_handle;
- /* FIXME: guillermo: is validation of parsing an unsigned int enough? */
- if (sscanf(buf, "%lu", &kmem_handle.size) == 1)
- pcidriver_kmem_alloc(privdata, &kmem_handle);
- return strlen(buf);
- }
- static SYSFS_SET_FUNCTION(pcidriver_store_kmem_free)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- unsigned int id;
- pcidriver_kmem_entry_t *kmem_entry;
- /* Parse the ID of the kernel memory to be freed, check bounds */
- if (sscanf(buf, "%u", &id) != 1 ||
- (id >= atomic_read(&(privdata->kmem_count))))
- goto err;
- if ((kmem_entry = pcidriver_kmem_find_entry_id(privdata,id)) == NULL)
- goto err;
- pcidriver_kmem_free_entry(privdata, kmem_entry );
- err:
- return strlen(buf);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_kbuffers)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- int offset = 0;
- struct list_head *ptr;
- pcidriver_kmem_entry_t *entry;
- /* print the header */
- offset += snprintf(buf, PAGE_SIZE, "kbuf#\tcpu addr\tsize\n");
- spin_lock(&(privdata->kmemlist_lock));
- list_for_each(ptr, &(privdata->kmem_list)) {
- entry = list_entry(ptr, pcidriver_kmem_entry_t, list);
- /* print entry info */
- if (offset > PAGE_SIZE) {
- spin_unlock( &(privdata->kmemlist_lock) );
- return PAGE_SIZE;
- }
- offset += snprintf(buf+offset, PAGE_SIZE-offset, "%3d\t%08lx\t%lu\n", entry->id, (unsigned long)(entry->dma_handle), entry->size );
- }
- spin_unlock(&(privdata->kmemlist_lock));
- /* output will be truncated to PAGE_SIZE */
- return (offset > PAGE_SIZE ? PAGE_SIZE : offset+1);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_umappings)
- {
- int offset = 0;
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- struct list_head *ptr;
- pcidriver_umem_entry_t *entry;
- /* print the header */
- offset += snprintf(buf, PAGE_SIZE, "umap#\tn_pages\tsg_ents\n");
- spin_lock( &(privdata->umemlist_lock) );
- list_for_each( ptr, &(privdata->umem_list) ) {
- entry = list_entry(ptr, pcidriver_umem_entry_t, list );
- /* print entry info */
- if (offset > PAGE_SIZE) {
- spin_unlock( &(privdata->umemlist_lock) );
- return PAGE_SIZE;
- }
- offset += snprintf(buf+offset, PAGE_SIZE-offset, "%3d\t%lu\t%lu\n", entry->id,
- (unsigned long)(entry->nr_pages), (unsigned long)(entry->nents));
- }
- spin_unlock( &(privdata->umemlist_lock) );
- /* output will be truncated to PAGE_SIZE */
- return (offset > PAGE_SIZE ? PAGE_SIZE : offset+1);
- }
- static SYSFS_SET_FUNCTION(pcidriver_store_umem_unmap)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- pcidriver_umem_entry_t *umem_entry;
- unsigned int id;
- if (sscanf(buf, "%u", &id) != 1 ||
- (id >= atomic_read(&(privdata->umem_count))))
- goto err;
- if ((umem_entry = pcidriver_umem_find_entry_id(privdata, id)) == NULL)
- goto err;
- pcidriver_umem_sgunmap(privdata, umem_entry);
- err:
- return strlen(buf);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_kmem_entry)
- {
- pcidriver_privdata_t *privdata = SYSFS_GET_PRIVDATA;
- /* As we can be sure that attr.name contains a filename which we
- * created (see _pcidriver_sysfs_initialize), we do not need to have
- * sanity checks but can directly call simple_strtol() */
- int id = simple_strtol(attr->attr.name + strlen("kbuf"), NULL, 10);
- pcidriver_kmem_entry_t *entry = pcidriver_kmem_find_entry_id(privdata, id);
- if (entry) {
- unsigned long addr = entry->cpua;
- unsigned long dma_addr = entry->dma_handle;
- if (entry->size >= 16) {
- pcidriver_kmem_sync_entry(privdata, entry, PCILIB_KMEM_SYNC_FROMDEVICE);
- return snprintf(buf, PAGE_SIZE, "buffer: %d\naddr: %lx\nhw addr: %llx\nbus addr: %lx\ntype: %lx\nuse: 0x%lx\nitem: %lu\nsize: %lu\nrefs: %lu\nhw ref: %i\nmode: 0x%lx\ndata: %8x %8x %8x %8x\n", id, addr, virt_to_phys((void*)addr), dma_addr, entry->type, entry->use, entry->item, entry->size, entry->refs&KMEM_REF_COUNT, (entry->refs&KMEM_REF_HW)?1:0, entry->mode, *(u32*)(entry->cpua), *(u32*)(entry->cpua + 4), *(u32*)(entry->cpua + 8), *(u32*)(entry->cpua + 12));
- } else
- return snprintf(buf, PAGE_SIZE, "buffer: %d\naddr: %lx\nhw addr: %llx\nbus addr: %lx\ntype: %lx\nuse: 0x%lx\nitem: %lu\nsize: %lu\nrefs: %lu\nhw ref: %i\nmode: 0x%lx\n", id, addr, virt_to_phys((void*)addr), dma_addr, entry->type, entry->use, entry->item, entry->size, entry->refs&KMEM_REF_COUNT, (entry->refs&KMEM_REF_HW)?1:0, entry->mode);
- } else
- return snprintf(buf, PAGE_SIZE, "I am in the kmem_entry show function for buffer %d\n", id);
- }
- static SYSFS_GET_FUNCTION(pcidriver_show_umem_entry)
- {
- return 0;
- }
- #ifdef ENABLE_IRQ
- static DEVICE_ATTR(irq_count, S_IRUGO, pcidriver_show_irq_count, NULL);
- static DEVICE_ATTR(irq_queues, S_IRUGO, pcidriver_show_irq_queues, NULL);
- #endif
- static DEVICE_ATTR(mmap_mode, 0664, pcidriver_show_mmap_mode, pcidriver_store_mmap_mode);
- static DEVICE_ATTR(mmap_area, 0664, pcidriver_show_mmap_area, pcidriver_store_mmap_area);
- static DEVICE_ATTR(kmem_count, 0444, pcidriver_show_kmem_count, NULL);
- static DEVICE_ATTR(kbuffers, 0444, pcidriver_show_kbuffers, NULL);
- static DEVICE_ATTR(kmem_alloc, 0220, NULL, pcidriver_store_kmem_alloc);
- static DEVICE_ATTR(kmem_free, 0220, NULL, pcidriver_store_kmem_free);
- static DEVICE_ATTR(umappings, 0444, pcidriver_show_umappings, NULL);
- static DEVICE_ATTR(umem_unmap, 0220, NULL, pcidriver_store_umem_unmap);
- int pcidriver_create_sysfs_attributes(pcidriver_privdata_t *privdata) {
- #ifdef ENABLE_IRQ
- SYSFS_ATTR_CREATE(irq_count);
- SYSFS_ATTR_CREATE(irq_queues);
- #endif
- SYSFS_ATTR_CREATE(mmap_mode);
- SYSFS_ATTR_CREATE(mmap_area);
- SYSFS_ATTR_CREATE(kmem_count);
- SYSFS_ATTR_CREATE(kmem_alloc);
- SYSFS_ATTR_CREATE(kmem_free);
- SYSFS_ATTR_CREATE(kbuffers);
- SYSFS_ATTR_CREATE(umappings);
- SYSFS_ATTR_CREATE(umem_unmap);
- return 0;
- }
- void pcidriver_remove_sysfs_attributes(pcidriver_privdata_t *privdata) {
- #ifdef ENABLE_IRQ
- SYSFS_ATTR_REMOVE(irq_count);
- SYSFS_ATTR_REMOVE(irq_queues);
- #endif
- SYSFS_ATTR_REMOVE(mmap_mode);
- SYSFS_ATTR_REMOVE(mmap_area);
- SYSFS_ATTR_REMOVE(kmem_count);
- SYSFS_ATTR_REMOVE(kmem_alloc);
- SYSFS_ATTR_REMOVE(kmem_free);
- SYSFS_ATTR_REMOVE(kbuffers);
- SYSFS_ATTR_REMOVE(umappings);
- SYSFS_ATTR_REMOVE(umem_unmap);
- }
- /**
- *
- * Removes the file from sysfs and frees the allocated (kstrdup()) memory.
- *
- */
- void pcidriver_sysfs_remove(pcidriver_privdata_t *privdata, struct device_attribute *sysfs_attr)
- {
- device_remove_file(privdata->class_dev, sysfs_attr);
- kfree(sysfs_attr->attr.name);
- }
- /**
- *
- * Initializes the sysfs attributes for an kmem/umem-entry
- *
- */
- static int _pcidriver_sysfs_initialize(pcidriver_privdata_t *privdata, int id, struct device_attribute *sysfs_attr, const char *fmtstring, SYSFS_GET_FUNCTION((*callback)))
- {
- /* sysfs attributes for kmem buffers don’t make sense before 2.6.13, as
- we have no mmap support before */
- char namebuffer[16];
- /* allocate space for the name of the attribute */
- snprintf(namebuffer, sizeof(namebuffer), fmtstring, id);
- if ((sysfs_attr->attr.name = kstrdup(namebuffer, GFP_KERNEL)) == NULL)
- return -ENOMEM;
- sysfs_attr->attr.mode = S_IRUGO;
- sysfs_attr->show = callback;
- sysfs_attr->store = NULL;
- /* name and add attribute */
- if (device_create_file(privdata->class_dev, sysfs_attr) != 0)
- return -ENXIO; /* Device not configured. Not the really best choice, but hm. */
- return 0;
- }
- int pcidriver_sysfs_initialize_kmem(pcidriver_privdata_t *privdata, int id, struct device_attribute *sysfs_attr)
- {
- return _pcidriver_sysfs_initialize(privdata, id, sysfs_attr, "kbuf%d", pcidriver_show_kmem_entry);
- }
- int pcidriver_sysfs_initialize_umem(pcidriver_privdata_t *privdata, int id, struct device_attribute *sysfs_attr)
- {
- return _pcidriver_sysfs_initialize(privdata, id, sysfs_attr, "umem%d", pcidriver_show_umem_entry);
- }
|