2 * File: arch/blackfin/mm/sram-alloc.c
7 * Description: SRAM allocator for Blackfin L1 and L2 memory
10 * Copyright 2004-2008 Analog Devices Inc.
12 * Bugs: Enter bugs at http://blackfin.uclinux.org/
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License as published by
16 * the Free Software Foundation; either version 2 of the License, or
17 * (at your option) any later version.
19 * This program is distributed in the hope that it will be useful,
20 * but WITHOUT ANY WARRANTY; without even the implied warranty of
21 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
22 * GNU General Public License for more details.
24 * You should have received a copy of the GNU General Public License
25 * along with this program; if not, see the file COPYING, or write
26 * to the Free Software Foundation, Inc.,
27 * 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
30 #include <linux/module.h>
31 #include <linux/kernel.h>
32 #include <linux/types.h>
33 #include <linux/miscdevice.h>
34 #include <linux/ioport.h>
35 #include <linux/fcntl.h>
36 #include <linux/init.h>
37 #include <linux/poll.h>
38 #include <linux/proc_fs.h>
39 #include <linux/spinlock.h>
40 #include <linux/rtc.h>
41 #include <asm/blackfin.h>
42 #include "blackfin_sram.h"
44 static spinlock_t l1sram_lock, l1_data_sram_lock, l1_inst_sram_lock;
45 static spinlock_t l2_sram_lock;
47 /* the data structure for L1 scratchpad and DATA SRAM */
52 struct sram_piece *next;
55 static struct sram_piece free_l1_ssram_head, used_l1_ssram_head;
57 #if L1_DATA_A_LENGTH != 0
58 static struct sram_piece free_l1_data_A_sram_head, used_l1_data_A_sram_head;
61 #if L1_DATA_B_LENGTH != 0
62 static struct sram_piece free_l1_data_B_sram_head, used_l1_data_B_sram_head;
65 #if L1_CODE_LENGTH != 0
66 static struct sram_piece free_l1_inst_sram_head, used_l1_inst_sram_head;
70 static struct sram_piece free_l2_sram_head, used_l2_sram_head;
73 static struct kmem_cache *sram_piece_cache;
75 /* L1 Scratchpad SRAM initialization function */
76 static void __init l1sram_init(void)
78 free_l1_ssram_head.next =
79 kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
80 if (!free_l1_ssram_head.next) {
81 printk(KERN_INFO "Failed to initialize Scratchpad data SRAM\n");
85 free_l1_ssram_head.next->paddr = (void *)L1_SCRATCH_START;
86 free_l1_ssram_head.next->size = L1_SCRATCH_LENGTH;
87 free_l1_ssram_head.next->pid = 0;
88 free_l1_ssram_head.next->next = NULL;
90 used_l1_ssram_head.next = NULL;
92 /* mutex initialize */
93 spin_lock_init(&l1sram_lock);
95 printk(KERN_INFO "Blackfin Scratchpad data SRAM: %d KB\n",
96 L1_SCRATCH_LENGTH >> 10);
99 static void __init l1_data_sram_init(void)
101 #if L1_DATA_A_LENGTH != 0
102 free_l1_data_A_sram_head.next =
103 kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
104 if (!free_l1_data_A_sram_head.next) {
105 printk(KERN_INFO "Failed to initialize L1 Data A SRAM\n");
109 free_l1_data_A_sram_head.next->paddr =
110 (void *)L1_DATA_A_START + (_ebss_l1 - _sdata_l1);
111 free_l1_data_A_sram_head.next->size =
112 L1_DATA_A_LENGTH - (_ebss_l1 - _sdata_l1);
113 free_l1_data_A_sram_head.next->pid = 0;
114 free_l1_data_A_sram_head.next->next = NULL;
116 used_l1_data_A_sram_head.next = NULL;
118 printk(KERN_INFO "Blackfin L1 Data A SRAM: %d KB (%d KB free)\n",
119 L1_DATA_A_LENGTH >> 10,
120 free_l1_data_A_sram_head.next->size >> 10);
122 #if L1_DATA_B_LENGTH != 0
123 free_l1_data_B_sram_head.next =
124 kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
125 if (!free_l1_data_B_sram_head.next) {
126 printk(KERN_INFO "Failed to initialize L1 Data B SRAM\n");
130 free_l1_data_B_sram_head.next->paddr =
131 (void *)L1_DATA_B_START + (_ebss_b_l1 - _sdata_b_l1);
132 free_l1_data_B_sram_head.next->size =
133 L1_DATA_B_LENGTH - (_ebss_b_l1 - _sdata_b_l1);
134 free_l1_data_B_sram_head.next->pid = 0;
135 free_l1_data_B_sram_head.next->next = NULL;
137 used_l1_data_B_sram_head.next = NULL;
139 printk(KERN_INFO "Blackfin L1 Data B SRAM: %d KB (%d KB free)\n",
140 L1_DATA_B_LENGTH >> 10,
141 free_l1_data_B_sram_head.next->size >> 10);
144 /* mutex initialize */
145 spin_lock_init(&l1_data_sram_lock);
148 static void __init l1_inst_sram_init(void)
150 #if L1_CODE_LENGTH != 0
151 free_l1_inst_sram_head.next =
152 kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
153 if (!free_l1_inst_sram_head.next) {
154 printk(KERN_INFO "Failed to initialize L1 Instruction SRAM\n");
158 free_l1_inst_sram_head.next->paddr =
159 (void *)L1_CODE_START + (_etext_l1 - _stext_l1);
160 free_l1_inst_sram_head.next->size =
161 L1_CODE_LENGTH - (_etext_l1 - _stext_l1);
162 free_l1_inst_sram_head.next->pid = 0;
163 free_l1_inst_sram_head.next->next = NULL;
165 used_l1_inst_sram_head.next = NULL;
167 printk(KERN_INFO "Blackfin L1 Instruction SRAM: %d KB (%d KB free)\n",
168 L1_CODE_LENGTH >> 10,
169 free_l1_inst_sram_head.next->size >> 10);
172 /* mutex initialize */
173 spin_lock_init(&l1_inst_sram_lock);
176 static void __init l2_sram_init(void)
179 free_l2_sram_head.next =
180 kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
181 if (!free_l2_sram_head.next) {
182 printk(KERN_INFO "Failed to initialize L2 SRAM\n");
186 free_l2_sram_head.next->paddr =
187 (void *)L2_START + (_ebss_l2 - _stext_l2);
188 free_l2_sram_head.next->size =
189 L2_LENGTH - (_ebss_l2 - _stext_l2);
190 free_l2_sram_head.next->pid = 0;
191 free_l2_sram_head.next->next = NULL;
193 used_l2_sram_head.next = NULL;
195 printk(KERN_INFO "Blackfin L2 SRAM: %d KB (%d KB free)\n",
197 free_l2_sram_head.next->size >> 10);
200 /* mutex initialize */
201 spin_lock_init(&l2_sram_lock);
203 void __init bfin_sram_init(void)
205 sram_piece_cache = kmem_cache_create("sram_piece_cache",
206 sizeof(struct sram_piece),
207 0, SLAB_PANIC, NULL);
215 /* SRAM allocate function */
216 static void *_sram_alloc(size_t size, struct sram_piece *pfree_head,
217 struct sram_piece *pused_head)
219 struct sram_piece *pslot, *plast, *pavail;
221 if (size <= 0 || !pfree_head || !pused_head)
225 size = (size + 3) & ~3;
227 pslot = pfree_head->next;
230 /* search an available piece slot */
231 while (pslot != NULL && size > pslot->size) {
239 if (pslot->size == size) {
240 plast->next = pslot->next;
243 pavail = kmem_cache_alloc(sram_piece_cache, GFP_KERNEL);
248 pavail->paddr = pslot->paddr;
250 pslot->paddr += size;
254 pavail->pid = current->pid;
256 pslot = pused_head->next;
259 /* insert new piece into used piece list !!! */
260 while (pslot != NULL && pavail->paddr < pslot->paddr) {
265 pavail->next = pslot;
266 plast->next = pavail;
268 return pavail->paddr;
271 /* Allocate the largest available block. */
272 static void *_sram_alloc_max(struct sram_piece *pfree_head,
273 struct sram_piece *pused_head,
274 unsigned long *psize)
276 struct sram_piece *pslot, *pmax;
278 if (!pfree_head || !pused_head)
281 pmax = pslot = pfree_head->next;
283 /* search an available piece slot */
284 while (pslot != NULL) {
285 if (pslot->size > pmax->size)
295 return _sram_alloc(*psize, pfree_head, pused_head);
298 /* SRAM free function */
299 static int _sram_free(const void *addr,
300 struct sram_piece *pfree_head,
301 struct sram_piece *pused_head)
303 struct sram_piece *pslot, *plast, *pavail;
305 if (!pfree_head || !pused_head)
308 /* search the relevant memory slot */
309 pslot = pused_head->next;
312 /* search an available piece slot */
313 while (pslot != NULL && pslot->paddr != addr) {
321 plast->next = pslot->next;
325 /* insert free pieces back to the free list */
326 pslot = pfree_head->next;
329 while (pslot != NULL && addr > pslot->paddr) {
334 if (plast != pfree_head && plast->paddr + plast->size == pavail->paddr) {
335 plast->size += pavail->size;
336 kmem_cache_free(sram_piece_cache, pavail);
338 pavail->next = plast->next;
339 plast->next = pavail;
343 if (pslot && plast->paddr + plast->size == pslot->paddr) {
344 plast->size += pslot->size;
345 plast->next = pslot->next;
346 kmem_cache_free(sram_piece_cache, pslot);
352 int sram_free(const void *addr)
355 #if L1_CODE_LENGTH != 0
356 if (addr >= (void *)L1_CODE_START
357 && addr < (void *)(L1_CODE_START + L1_CODE_LENGTH))
358 return l1_inst_sram_free(addr);
361 #if L1_DATA_A_LENGTH != 0
362 if (addr >= (void *)L1_DATA_A_START
363 && addr < (void *)(L1_DATA_A_START + L1_DATA_A_LENGTH))
364 return l1_data_A_sram_free(addr);
367 #if L1_DATA_B_LENGTH != 0
368 if (addr >= (void *)L1_DATA_B_START
369 && addr < (void *)(L1_DATA_B_START + L1_DATA_B_LENGTH))
370 return l1_data_B_sram_free(addr);
374 if (addr >= (void *)L2_START
375 && addr < (void *)(L2_START + L2_LENGTH))
376 return l2_sram_free(addr);
381 EXPORT_SYMBOL(sram_free);
383 void *l1_data_A_sram_alloc(size_t size)
388 /* add mutex operation */
389 spin_lock_irqsave(&l1_data_sram_lock, flags);
391 #if L1_DATA_A_LENGTH != 0
392 addr = _sram_alloc(size, &free_l1_data_A_sram_head,
393 &used_l1_data_A_sram_head);
396 /* add mutex operation */
397 spin_unlock_irqrestore(&l1_data_sram_lock, flags);
399 pr_debug("Allocated address in l1_data_A_sram_alloc is 0x%lx+0x%lx\n",
400 (long unsigned int)addr, size);
404 EXPORT_SYMBOL(l1_data_A_sram_alloc);
406 int l1_data_A_sram_free(const void *addr)
411 /* add mutex operation */
412 spin_lock_irqsave(&l1_data_sram_lock, flags);
414 #if L1_DATA_A_LENGTH != 0
415 ret = _sram_free(addr, &free_l1_data_A_sram_head,
416 &used_l1_data_A_sram_head);
421 /* add mutex operation */
422 spin_unlock_irqrestore(&l1_data_sram_lock, flags);
426 EXPORT_SYMBOL(l1_data_A_sram_free);
428 void *l1_data_B_sram_alloc(size_t size)
430 #if L1_DATA_B_LENGTH != 0
434 /* add mutex operation */
435 spin_lock_irqsave(&l1_data_sram_lock, flags);
437 addr = _sram_alloc(size, &free_l1_data_B_sram_head,
438 &used_l1_data_B_sram_head);
440 /* add mutex operation */
441 spin_unlock_irqrestore(&l1_data_sram_lock, flags);
443 pr_debug("Allocated address in l1_data_B_sram_alloc is 0x%lx+0x%lx\n",
444 (long unsigned int)addr, size);
451 EXPORT_SYMBOL(l1_data_B_sram_alloc);
453 int l1_data_B_sram_free(const void *addr)
455 #if L1_DATA_B_LENGTH != 0
459 /* add mutex operation */
460 spin_lock_irqsave(&l1_data_sram_lock, flags);
462 ret = _sram_free(addr, &free_l1_data_B_sram_head,
463 &used_l1_data_B_sram_head);
465 /* add mutex operation */
466 spin_unlock_irqrestore(&l1_data_sram_lock, flags);
473 EXPORT_SYMBOL(l1_data_B_sram_free);
475 void *l1_data_sram_alloc(size_t size)
477 void *addr = l1_data_A_sram_alloc(size);
480 addr = l1_data_B_sram_alloc(size);
484 EXPORT_SYMBOL(l1_data_sram_alloc);
486 void *l1_data_sram_zalloc(size_t size)
488 void *addr = l1_data_sram_alloc(size);
491 memset(addr, 0x00, size);
495 EXPORT_SYMBOL(l1_data_sram_zalloc);
497 int l1_data_sram_free(const void *addr)
500 ret = l1_data_A_sram_free(addr);
502 ret = l1_data_B_sram_free(addr);
505 EXPORT_SYMBOL(l1_data_sram_free);
507 void *l1_inst_sram_alloc(size_t size)
509 #if L1_CODE_LENGTH != 0
513 /* add mutex operation */
514 spin_lock_irqsave(&l1_inst_sram_lock, flags);
516 addr = _sram_alloc(size, &free_l1_inst_sram_head,
517 &used_l1_inst_sram_head);
519 /* add mutex operation */
520 spin_unlock_irqrestore(&l1_inst_sram_lock, flags);
522 pr_debug("Allocated address in l1_inst_sram_alloc is 0x%lx+0x%lx\n",
523 (long unsigned int)addr, size);
530 EXPORT_SYMBOL(l1_inst_sram_alloc);
532 int l1_inst_sram_free(const void *addr)
534 #if L1_CODE_LENGTH != 0
538 /* add mutex operation */
539 spin_lock_irqsave(&l1_inst_sram_lock, flags);
541 ret = _sram_free(addr, &free_l1_inst_sram_head,
542 &used_l1_inst_sram_head);
544 /* add mutex operation */
545 spin_unlock_irqrestore(&l1_inst_sram_lock, flags);
552 EXPORT_SYMBOL(l1_inst_sram_free);
554 /* L1 Scratchpad memory allocate function */
555 void *l1sram_alloc(size_t size)
560 /* add mutex operation */
561 spin_lock_irqsave(&l1sram_lock, flags);
563 addr = _sram_alloc(size, &free_l1_ssram_head,
564 &used_l1_ssram_head);
566 /* add mutex operation */
567 spin_unlock_irqrestore(&l1sram_lock, flags);
572 /* L1 Scratchpad memory allocate function */
573 void *l1sram_alloc_max(size_t *psize)
578 /* add mutex operation */
579 spin_lock_irqsave(&l1sram_lock, flags);
581 addr = _sram_alloc_max(&free_l1_ssram_head,
582 &used_l1_ssram_head, psize);
584 /* add mutex operation */
585 spin_unlock_irqrestore(&l1sram_lock, flags);
590 /* L1 Scratchpad memory free function */
591 int l1sram_free(const void *addr)
596 /* add mutex operation */
597 spin_lock_irqsave(&l1sram_lock, flags);
599 ret = _sram_free(addr, &free_l1_ssram_head,
600 &used_l1_ssram_head);
602 /* add mutex operation */
603 spin_unlock_irqrestore(&l1sram_lock, flags);
608 void *l2_sram_alloc(size_t size)
614 /* add mutex operation */
615 spin_lock_irqsave(&l2_sram_lock, flags);
617 addr = _sram_alloc(size, &free_l2_sram_head,
620 /* add mutex operation */
621 spin_unlock_irqrestore(&l2_sram_lock, flags);
623 pr_debug("Allocated address in l2_sram_alloc is 0x%lx+0x%lx\n",
624 (long unsigned int)addr, size);
631 EXPORT_SYMBOL(l2_sram_alloc);
633 void *l2_sram_zalloc(size_t size)
635 void *addr = l2_sram_alloc(size);
638 memset(addr, 0x00, size);
642 EXPORT_SYMBOL(l2_sram_zalloc);
644 int l2_sram_free(const void *addr)
650 /* add mutex operation */
651 spin_lock_irqsave(&l2_sram_lock, flags);
653 ret = _sram_free(addr, &free_l2_sram_head,
656 /* add mutex operation */
657 spin_unlock_irqrestore(&l2_sram_lock, flags);
664 EXPORT_SYMBOL(l2_sram_free);
666 int sram_free_with_lsl(const void *addr)
668 struct sram_list_struct *lsl, **tmp;
669 struct mm_struct *mm = current->mm;
671 for (tmp = &mm->context.sram_list; *tmp; tmp = &(*tmp)->next)
672 if ((*tmp)->addr == addr)
683 EXPORT_SYMBOL(sram_free_with_lsl);
685 void *sram_alloc_with_lsl(size_t size, unsigned long flags)
688 struct sram_list_struct *lsl = NULL;
689 struct mm_struct *mm = current->mm;
691 lsl = kzalloc(sizeof(struct sram_list_struct), GFP_KERNEL);
695 if (flags & L1_INST_SRAM)
696 addr = l1_inst_sram_alloc(size);
698 if (addr == NULL && (flags & L1_DATA_A_SRAM))
699 addr = l1_data_A_sram_alloc(size);
701 if (addr == NULL && (flags & L1_DATA_B_SRAM))
702 addr = l1_data_B_sram_alloc(size);
704 if (addr == NULL && (flags & L2_SRAM))
705 addr = l2_sram_alloc(size);
713 lsl->next = mm->context.sram_list;
714 mm->context.sram_list = lsl;
717 EXPORT_SYMBOL(sram_alloc_with_lsl);
719 #ifdef CONFIG_PROC_FS
720 /* Once we get a real allocator, we'll throw all of this away.
721 * Until then, we need some sort of visibility into the L1 alloc.
723 /* Need to keep line of output the same. Currently, that is 44 bytes
724 * (including newline).
726 static int _sram_proc_read(char *buf, int *len, int count, const char *desc,
727 struct sram_piece *pfree_head,
728 struct sram_piece *pused_head)
730 struct sram_piece *pslot;
732 if (!pfree_head || !pused_head)
735 *len += sprintf(&buf[*len], "--- SRAM %-14s Size PID State \n", desc);
737 /* search the relevant memory slot */
738 pslot = pused_head->next;
740 while (pslot != NULL) {
741 *len += sprintf(&buf[*len], "%p-%p %10i %5i %-10s\n",
742 pslot->paddr, pslot->paddr + pslot->size,
743 pslot->size, pslot->pid, "ALLOCATED");
748 pslot = pfree_head->next;
750 while (pslot != NULL) {
751 *len += sprintf(&buf[*len], "%p-%p %10i %5i %-10s\n",
752 pslot->paddr, pslot->paddr + pslot->size,
753 pslot->size, pslot->pid, "FREE");
760 static int sram_proc_read(char *buf, char **start, off_t offset, int count,
761 int *eof, void *data)
765 if (_sram_proc_read(buf, &len, count, "Scratchpad",
766 &free_l1_ssram_head, &used_l1_ssram_head))
768 #if L1_DATA_A_LENGTH != 0
769 if (_sram_proc_read(buf, &len, count, "L1 Data A",
770 &free_l1_data_A_sram_head,
771 &used_l1_data_A_sram_head))
774 #if L1_DATA_B_LENGTH != 0
775 if (_sram_proc_read(buf, &len, count, "L1 Data B",
776 &free_l1_data_B_sram_head,
777 &used_l1_data_B_sram_head))
780 #if L1_CODE_LENGTH != 0
781 if (_sram_proc_read(buf, &len, count, "L1 Instruction",
782 &free_l1_inst_sram_head, &used_l1_inst_sram_head))
786 if (_sram_proc_read(buf, &len, count, "L2",
787 &free_l2_sram_head, &used_l2_sram_head))
796 static int __init sram_proc_init(void)
798 struct proc_dir_entry *ptr;
799 ptr = create_proc_entry("sram", S_IFREG | S_IRUGO, NULL);
801 printk(KERN_WARNING "unable to create /proc/sram\n");
804 ptr->owner = THIS_MODULE;
805 ptr->read_proc = sram_proc_read;
808 late_initcall(sram_proc_init);