Commit | Line | Data |
---|---|---|
1da177e4 LT |
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 | ||
267d4d64 | 59 | void __init snd_memory_init(void) |
1da177e4 LT |
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 | ||
dd0fc66f | 92 | static void *__snd_kmalloc(size_t size, gfp_t flags, void *caller) |
1da177e4 LT |
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)); | |
dd0fc66f | 114 | void *snd_hidden_kmalloc(size_t size, gfp_t flags) |
1da177e4 LT |
115 | { |
116 | return _snd_kmalloc(size, flags); | |
117 | } | |
118 | ||
dd0fc66f | 119 | void *snd_hidden_kzalloc(size_t size, gfp_t flags) |
8db08ea7 PE |
120 | { |
121 | void *ret = _snd_kmalloc(size, flags); | |
122 | if (ret) | |
123 | memset(ret, 0, size); | |
124 | return ret; | |
125 | } | |
126 | EXPORT_SYMBOL(snd_hidden_kzalloc); | |
127 | ||
dd0fc66f | 128 | void *snd_hidden_kcalloc(size_t n, size_t size, gfp_t flags) |
1da177e4 LT |
129 | { |
130 | void *ret = NULL; | |
131 | if (n != 0 && size > INT_MAX / n) | |
132 | return ret; | |
8db08ea7 | 133 | return snd_hidden_kzalloc(n * size, flags); |
1da177e4 LT |
134 | } |
135 | ||
136 | void snd_hidden_kfree(const void *obj) | |
137 | { | |
138 | unsigned long flags; | |
139 | struct snd_alloc_track *t; | |
140 | if (obj == NULL) | |
141 | return; | |
142 | t = snd_alloc_track_entry(obj); | |
143 | if (t->magic != KMALLOC_MAGIC) { | |
144 | snd_printk(KERN_WARNING "bad kfree (called from %p)\n", __builtin_return_address(0)); | |
145 | return; | |
146 | } | |
147 | spin_lock_irqsave(&snd_alloc_kmalloc_lock, flags); | |
148 | list_del(&t->list); | |
149 | spin_unlock_irqrestore(&snd_alloc_kmalloc_lock, flags); | |
150 | t->magic = 0; | |
151 | snd_alloc_kmalloc -= t->size; | |
152 | obj = t; | |
153 | snd_wrapper_kfree(obj); | |
154 | } | |
155 | ||
156 | void *snd_hidden_vmalloc(unsigned long size) | |
157 | { | |
158 | void *ptr; | |
159 | ptr = snd_wrapper_vmalloc(size + sizeof(struct snd_alloc_track)); | |
160 | if (ptr) { | |
161 | struct snd_alloc_track *t = (struct snd_alloc_track *)ptr; | |
162 | t->magic = VMALLOC_MAGIC; | |
163 | t->caller = __builtin_return_address(0); | |
164 | spin_lock(&snd_alloc_vmalloc_lock); | |
165 | list_add_tail(&t->list, &snd_alloc_vmalloc_list); | |
166 | spin_unlock(&snd_alloc_vmalloc_lock); | |
167 | t->size = size; | |
168 | snd_alloc_vmalloc += size; | |
169 | ptr = t->data; | |
170 | } | |
171 | return ptr; | |
172 | } | |
173 | ||
174 | void snd_hidden_vfree(void *obj) | |
175 | { | |
176 | struct snd_alloc_track *t; | |
177 | if (obj == NULL) | |
178 | return; | |
179 | t = snd_alloc_track_entry(obj); | |
180 | if (t->magic != VMALLOC_MAGIC) { | |
181 | snd_printk(KERN_ERR "bad vfree (called from %p)\n", __builtin_return_address(0)); | |
182 | return; | |
183 | } | |
184 | spin_lock(&snd_alloc_vmalloc_lock); | |
185 | list_del(&t->list); | |
186 | spin_unlock(&snd_alloc_vmalloc_lock); | |
187 | t->magic = 0; | |
188 | snd_alloc_vmalloc -= t->size; | |
189 | obj = t; | |
190 | snd_wrapper_vfree(obj); | |
191 | } | |
192 | ||
dd0fc66f | 193 | char *snd_hidden_kstrdup(const char *s, gfp_t flags) |
543537bd PM |
194 | { |
195 | int len; | |
196 | char *buf; | |
197 | ||
198 | if (!s) return NULL; | |
199 | ||
200 | len = strlen(s) + 1; | |
201 | buf = _snd_kmalloc(len, flags); | |
202 | if (buf) | |
203 | memcpy(buf, s, len); | |
204 | return buf; | |
205 | } | |
206 | ||
1da177e4 LT |
207 | static void snd_memory_info_read(snd_info_entry_t *entry, snd_info_buffer_t * buffer) |
208 | { | |
209 | snd_iprintf(buffer, "kmalloc: %li bytes\n", snd_alloc_kmalloc); | |
210 | snd_iprintf(buffer, "vmalloc: %li bytes\n", snd_alloc_vmalloc); | |
211 | } | |
212 | ||
213 | int __init snd_memory_info_init(void) | |
214 | { | |
215 | snd_info_entry_t *entry; | |
216 | ||
217 | entry = snd_info_create_module_entry(THIS_MODULE, "meminfo", NULL); | |
218 | if (entry) { | |
219 | entry->c.text.read_size = 256; | |
220 | entry->c.text.read = snd_memory_info_read; | |
221 | if (snd_info_register(entry) < 0) { | |
222 | snd_info_free_entry(entry); | |
223 | entry = NULL; | |
224 | } | |
225 | } | |
226 | snd_memory_info_entry = entry; | |
227 | return 0; | |
228 | } | |
229 | ||
230 | int __exit snd_memory_info_done(void) | |
231 | { | |
232 | if (snd_memory_info_entry) | |
233 | snd_info_unregister(snd_memory_info_entry); | |
234 | return 0; | |
235 | } | |
236 | ||
1da177e4 LT |
237 | #endif /* CONFIG_SND_DEBUG_MEMORY */ |
238 | ||
1da177e4 LT |
239 | /** |
240 | * copy_to_user_fromio - copy data from mmio-space to user-space | |
241 | * @dst: the destination pointer on user-space | |
242 | * @src: the source pointer on mmio | |
243 | * @count: the data size to copy in bytes | |
244 | * | |
245 | * Copies the data from mmio-space to user-space. | |
246 | * | |
247 | * Returns zero if successful, or non-zero on failure. | |
248 | */ | |
249 | int copy_to_user_fromio(void __user *dst, const volatile void __iomem *src, size_t count) | |
250 | { | |
251 | #if defined(__i386__) || defined(CONFIG_SPARC32) | |
4d23359b | 252 | return copy_to_user(dst, (const void __force*)src, count) ? -EFAULT : 0; |
1da177e4 LT |
253 | #else |
254 | char buf[256]; | |
255 | while (count) { | |
256 | size_t c = count; | |
257 | if (c > sizeof(buf)) | |
258 | c = sizeof(buf); | |
259 | memcpy_fromio(buf, (void __iomem *)src, c); | |
260 | if (copy_to_user(dst, buf, c)) | |
261 | return -EFAULT; | |
262 | count -= c; | |
263 | dst += c; | |
264 | src += c; | |
265 | } | |
266 | return 0; | |
267 | #endif | |
268 | } | |
269 | ||
270 | /** | |
271 | * copy_from_user_toio - copy data from user-space to mmio-space | |
272 | * @dst: the destination pointer on mmio-space | |
273 | * @src: the source pointer on user-space | |
274 | * @count: the data size to copy in bytes | |
275 | * | |
276 | * Copies the data from user-space to mmio-space. | |
277 | * | |
278 | * Returns zero if successful, or non-zero on failure. | |
279 | */ | |
280 | int copy_from_user_toio(volatile void __iomem *dst, const void __user *src, size_t count) | |
281 | { | |
282 | #if defined(__i386__) || defined(CONFIG_SPARC32) | |
4d23359b | 283 | return copy_from_user((void __force *)dst, src, count) ? -EFAULT : 0; |
1da177e4 LT |
284 | #else |
285 | char buf[256]; | |
286 | while (count) { | |
287 | size_t c = count; | |
288 | if (c > sizeof(buf)) | |
289 | c = sizeof(buf); | |
290 | if (copy_from_user(buf, src, c)) | |
291 | return -EFAULT; | |
292 | memcpy_toio(dst, buf, c); | |
293 | count -= c; | |
294 | dst += c; | |
295 | src += c; | |
296 | } | |
297 | return 0; | |
298 | #endif | |
299 | } |