sound/core/memory.c

   1 /*
   2  *  Copyright (c) by Jaroslav Kysela <perex@suse.cz>
   3  *
   4  *  Memory allocation helpers.
   5  *
   6  *
   7  *   This program is free software; you can redistribute it and/or modify
   8  *   it under the terms of the GNU General Public License as published by
   9  *   the Free Software Foundation; either version 2 of the License, or
  10  *   (at your option) any later version.
  11  *
  12  *   This program is distributed in the hope that it will be useful,
  13  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *   GNU General Public License for more details.
  16  *
  17  *   You should have received a copy of the GNU General Public License
  18  *   along with this program; if not, write to the Free Software
  19  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  20  *
  21  */
  22
  23 #include <sound/driver.h>
  24 #include <asm/io.h>
  25 #include <asm/uaccess.h>
  26 #include <linux/init.h>
  27 #include <linux/slab.h>
  28 #include <linux/time.h>
  29 #include <linux/pci.h>
  30 #include <sound/core.h>
  31 #include <sound/info.h>
  32
  33 /*
  34  *  memory allocation helpers and debug routines
  35  */
  36
  37 #ifdef CONFIG_SND_DEBUG_MEMORY
  38
  39 struct snd_alloc_track {
  40         unsigned long magic;
  41         void *caller;
  42         size_t size;
  43         struct list_head list;
  44         long data[0];
  45 };
  46
  47 #define snd_alloc_track_entry(obj) (struct snd_alloc_track *)((char*)obj - (unsigned long)((struct snd_alloc_track *)0)->data)
  48
  49 static long snd_alloc_kmalloc;
  50 static long snd_alloc_vmalloc;
  51 static LIST_HEAD(snd_alloc_kmalloc_list);
  52 static LIST_HEAD(snd_alloc_vmalloc_list);
  53 static DEFINE_SPINLOCK(snd_alloc_kmalloc_lock);
  54 static DEFINE_SPINLOCK(snd_alloc_vmalloc_lock);
  55 #define KMALLOC_MAGIC 0x87654321
  56 #define VMALLOC_MAGIC 0x87654320
  57 static snd_info_entry_t *snd_memory_info_entry;
  58
  59 void snd_memory_init(void)
  60 {
  61         snd_alloc_kmalloc = 0;
  62         snd_alloc_vmalloc = 0;
  63 }
  64
  65 void snd_memory_done(void)
  66 {
  67         struct list_head *head;
  68         struct snd_alloc_track *t;
  69
  70         if (snd_alloc_kmalloc > 0)
  71                 snd_printk(KERN_ERR "Not freed snd_alloc_kmalloc = %li\n", snd_alloc_kmalloc);
  72         if (snd_alloc_vmalloc > 0)
  73                 snd_printk(KERN_ERR "Not freed snd_alloc_vmalloc = %li\n", snd_alloc_vmalloc);
  74         list_for_each_prev(head, &snd_alloc_kmalloc_list) {
  75                 t = list_entry(head, struct snd_alloc_track, list);
  76                 if (t->magic != KMALLOC_MAGIC) {
  77                         snd_printk(KERN_ERR "Corrupted kmalloc\n");
  78                         break;
  79                 }
  80                 snd_printk(KERN_ERR "kmalloc(%ld) from %p not freed\n", (long) t->size, t->caller);
  81         }
  82         list_for_each_prev(head, &snd_alloc_vmalloc_list) {
  83                 t = list_entry(head, struct snd_alloc_track, list);
  84                 if (t->magic != VMALLOC_MAGIC) {
  85                         snd_printk(KERN_ERR "Corrupted vmalloc\n");
  86                         break;
  87                 }
  88                 snd_printk(KERN_ERR "vmalloc(%ld) from %p not freed\n", (long) t->size, t->caller);
  89         }
  90 }
  91
  92 static void *__snd_kmalloc(size_t size, int flags, void *caller)
  93 {
  94         unsigned long cpu_flags;
  95         struct snd_alloc_track *t;
  96         void *ptr;
  97
  98         ptr = snd_wrapper_kmalloc(size + sizeof(struct snd_alloc_track), flags);
  99         if (ptr != NULL) {
 100                 t = (struct snd_alloc_track *)ptr;
 101                 t->magic = KMALLOC_MAGIC;
 102                 t->caller = caller;
 103                 spin_lock_irqsave(&snd_alloc_kmalloc_lock, cpu_flags);
 104                 list_add_tail(&t->list, &snd_alloc_kmalloc_list);
 105                 spin_unlock_irqrestore(&snd_alloc_kmalloc_lock, cpu_flags);
 106                 t->size = size;
 107                 snd_alloc_kmalloc += size;
 108                 ptr = t->data;
 109         }
 110         return ptr;
 111 }
 112
 113 #define _snd_kmalloc(size, flags) __snd_kmalloc((size), (flags), __builtin_return_address(0));
 114 void *snd_hidden_kmalloc(size_t size, int flags)
 115 {
 116         return _snd_kmalloc(size, flags);
 117 }
 118
 119 void *snd_hidden_kcalloc(size_t n, size_t size, int flags)
 120 {
 121         void *ret = NULL;
 122         if (n != 0 && size > INT_MAX / n)
 123                 return ret;
 124         ret = _snd_kmalloc(n * size, flags);
 125         if (ret)
 126                 memset(ret, 0, n * size);
 127         return ret;
 128 }
 129
 130 void snd_hidden_kfree(const void *obj)
 131 {
 132         unsigned long flags;
 133         struct snd_alloc_track *t;
 134         if (obj == NULL)
 135                 return;
 136         t = snd_alloc_track_entry(obj);
 137         if (t->magic != KMALLOC_MAGIC) {
 138                 snd_printk(KERN_WARNING "bad kfree (called from %p)\n", __builtin_return_address(0));
 139                 return;
 140         }
 141         spin_lock_irqsave(&snd_alloc_kmalloc_lock, flags);
 142         list_del(&t->list);
 143         spin_unlock_irqrestore(&snd_alloc_kmalloc_lock, flags);
 144         t->magic = 0;
 145         snd_alloc_kmalloc -= t->size;
 146         obj = t;
 147         snd_wrapper_kfree(obj);
 148 }
 149
 150 void *snd_hidden_vmalloc(unsigned long size)
 151 {
 152         void *ptr;
 153         ptr = snd_wrapper_vmalloc(size + sizeof(struct snd_alloc_track));
 154         if (ptr) {
 155                 struct snd_alloc_track *t = (struct snd_alloc_track *)ptr;
 156                 t->magic = VMALLOC_MAGIC;
 157                 t->caller = __builtin_return_address(0);
 158                 spin_lock(&snd_alloc_vmalloc_lock);
 159                 list_add_tail(&t->list, &snd_alloc_vmalloc_list);
 160                 spin_unlock(&snd_alloc_vmalloc_lock);
 161                 t->size = size;
 162                 snd_alloc_vmalloc += size;
 163                 ptr = t->data;
 164         }
 165         return ptr;
 166 }
 167
 168 void snd_hidden_vfree(void *obj)
 169 {
 170         struct snd_alloc_track *t;
 171         if (obj == NULL)
 172                 return;
 173         t = snd_alloc_track_entry(obj);
 174         if (t->magic != VMALLOC_MAGIC) {
 175                 snd_printk(KERN_ERR "bad vfree (called from %p)\n", __builtin_return_address(0));
 176                 return;
 177         }
 178         spin_lock(&snd_alloc_vmalloc_lock);
 179         list_del(&t->list);
 180         spin_unlock(&snd_alloc_vmalloc_lock);
 181         t->magic = 0;
 182         snd_alloc_vmalloc -= t->size;
 183         obj = t;
 184         snd_wrapper_vfree(obj);
 185 }
 186
 187 char *snd_hidden_kstrdup(const char *s, int flags)
 188 {
 189         int len;
 190         char *buf;
 191
 192         if (!s) return NULL;
 193
 194         len = strlen(s) + 1;
 195         buf = _snd_kmalloc(len, flags);
 196         if (buf)
 197                 memcpy(buf, s, len);
 198         return buf;
 199 }
 200
 201 static void snd_memory_info_read(snd_info_entry_t *entry, snd_info_buffer_t * buffer)
 202 {
 203         snd_iprintf(buffer, "kmalloc: %li bytes\n", snd_alloc_kmalloc);
 204         snd_iprintf(buffer, "vmalloc: %li bytes\n", snd_alloc_vmalloc);
 205 }
 206
 207 int __init snd_memory_info_init(void)
 208 {
 209         snd_info_entry_t *entry;
 210
 211         entry = snd_info_create_module_entry(THIS_MODULE, "meminfo", NULL);
 212         if (entry) {
 213                 entry->c.text.read_size = 256;
 214                 entry->c.text.read = snd_memory_info_read;
 215                 if (snd_info_register(entry) < 0) {
 216                         snd_info_free_entry(entry);
 217                         entry = NULL;
 218                 }
 219         }
 220         snd_memory_info_entry = entry;
 221         return 0;
 222 }
 223
 224 int __exit snd_memory_info_done(void)
 225 {
 226         if (snd_memory_info_entry)
 227                 snd_info_unregister(snd_memory_info_entry);
 228         return 0;
 229 }
 230
 231 #endif /* CONFIG_SND_DEBUG_MEMORY */
 232
 233 /**
 234  * copy_to_user_fromio - copy data from mmio-space to user-space
 235  * @dst: the destination pointer on user-space
 236  * @src: the source pointer on mmio
 237  * @count: the data size to copy in bytes
 238  *
 239  * Copies the data from mmio-space to user-space.
 240  *
 241  * Returns zero if successful, or non-zero on failure.
 242  */
 243 int copy_to_user_fromio(void __user *dst, const volatile void __iomem *src, size_t count)
 244 {
 245 #if defined(__i386__) || defined(CONFIG_SPARC32)
 246         return copy_to_user(dst, (const void*)src, count) ? -EFAULT : 0;
 247 #else
 248         char buf[256];
 249         while (count) {
 250                 size_t c = count;
 251                 if (c > sizeof(buf))
 252                         c = sizeof(buf);
 253                 memcpy_fromio(buf, (void __iomem *)src, c);
 254                 if (copy_to_user(dst, buf, c))
 255                         return -EFAULT;
 256                 count -= c;
 257                 dst += c;
 258                 src += c;
 259         }
 260         return 0;
 261 #endif
 262 }
 263
 264 /**
 265  * copy_from_user_toio - copy data from user-space to mmio-space
 266  * @dst: the destination pointer on mmio-space
 267  * @src: the source pointer on user-space
 268  * @count: the data size to copy in bytes
 269  *
 270  * Copies the data from user-space to mmio-space.
 271  *
 272  * Returns zero if successful, or non-zero on failure.
 273  */
 274 int copy_from_user_toio(volatile void __iomem *dst, const void __user *src, size_t count)
 275 {
 276 #if defined(__i386__) || defined(CONFIG_SPARC32)
 277         return copy_from_user((void*)dst, src, count) ? -EFAULT : 0;
 278 #else
 279         char buf[256];
 280         while (count) {
 281                 size_t c = count;
 282                 if (c > sizeof(buf))
 283                         c = sizeof(buf);
 284                 if (copy_from_user(buf, src, c))
 285                         return -EFAULT;
 286                 memcpy_toio(dst, buf, c);
 287                 count -= c;
 288                 dst += c;
 289                 src += c;
 290         }
 291         return 0;
 292 #endif
 293 }