git.oblomov.eu Git - linux-2.6/blob - arch/arm/mm/blockops.c

   1 #include <linux/kernel.h>
   2 #include <linux/init.h>
   3 #include <linux/errno.h>
   4 #include <linux/mm.h>
   5
   6 #include <asm/memory.h>
   7 #include <asm/ptrace.h>
   8 #include <asm/cacheflush.h>
   9 #include <asm/traps.h>
  10
  11 extern struct cpu_cache_fns blk_cache_fns;
  12
  13 #define HARVARD_CACHE
  14
  15 /*
  16  *      blk_flush_kern_dcache_page(kaddr)
  17  *
  18  *      Ensure that the data held in the page kaddr is written back
  19  *      to the page in question.
  20  *
  21  *      - kaddr   - kernel address (guaranteed to be page aligned)
  22  */
  23 static void __attribute__((naked))
  24 blk_flush_kern_dcache_page(void *kaddr)
  25 {
  26         asm(
  27         "add    r1, r0, %0                                                      \n\
  28         sub     r1, r1, %1                                                      \n\
  29 1:      .word   0xec401f0e      @ mcrr  p15, 0, r0, r1, c14, 0  @ blocking      \n\
  30         mov     r0, #0                                                          \n\
  31         mcr     p15, 0, r0, c7, c5, 0                                           \n\
  32         mcr     p15, 0, r0, c7, c10, 4                                          \n\
  33         mov     pc, lr"
  34         :
  35         : "I" (PAGE_SIZE), "I" (L1_CACHE_BYTES));
  36 }
  37
  38 /*
  39  *      blk_dma_inv_range(start,end)
  40  *
  41  *      Invalidate the data cache within the specified region; we will
  42  *      be performing a DMA operation in this region and we want to
  43  *      purge old data in the cache.
  44  *
  45  *      - start   - virtual start address of region
  46  *      - end     - virtual end address of region
  47  */
  48 static void __attribute__((naked))
  49 blk_dma_inv_range_unified(unsigned long start, unsigned long end)
  50 {
  51         asm(
  52         "tst    r0, %0                                                          \n\
  53         mcrne   p15, 0, r0, c7, c11, 1          @ clean unified line            \n\
  54         tst     r1, %0                                                          \n\
  55         mcrne   p15, 0, r1, c7, c15, 1          @ clean & invalidate unified line\n\
  56         .word   0xec401f06      @ mcrr  p15, 0, r1, r0, c6, 0   @ blocking      \n\
  57         mov     r0, #0                                                          \n\
  58         mcr     p15, 0, r0, c7, c10, 4          @ drain write buffer            \n\
  59         mov     pc, lr"
  60         :
  61         : "I" (L1_CACHE_BYTES - 1));
  62 }
  63
  64 static void __attribute__((naked))
  65 blk_dma_inv_range_harvard(unsigned long start, unsigned long end)
  66 {
  67         asm(
  68         "tst    r0, %0                                                          \n\
  69         mcrne   p15, 0, r0, c7, c10, 1          @ clean D line                  \n\
  70         tst     r1, %0                                                          \n\
  71         mcrne   p15, 0, r1, c7, c14, 1          @ clean & invalidate D line     \n\
  72         .word   0xec401f06      @ mcrr  p15, 0, r1, r0, c6, 0   @ blocking      \n\
  73         mov     r0, #0                                                          \n\
  74         mcr     p15, 0, r0, c7, c10, 4          @ drain write buffer            \n\
  75         mov     pc, lr"
  76         :
  77         : "I" (L1_CACHE_BYTES - 1));
  78 }
  79
  80 /*
  81  *      blk_dma_clean_range(start,end)
  82  *      - start   - virtual start address of region
  83  *      - end     - virtual end address of region
  84  */
  85 static void __attribute__((naked))
  86 blk_dma_clean_range(unsigned long start, unsigned long end)
  87 {
  88         asm(
  89         ".word  0xec401f0c      @ mcrr  p15, 0, r1, r0, c12, 0  @ blocking      \n\
  90         mov     r0, #0                                                          \n\
  91         mcr     p15, 0, r0, c7, c10, 4          @ drain write buffer            \n\
  92         mov     pc, lr");
  93 }
  94
  95 /*
  96  *      blk_dma_flush_range(start,end)
  97  *      - start   - virtual start address of region
  98  *      - end     - virtual end address of region
  99  */
 100 static void __attribute__((naked))
 101 blk_dma_flush_range(unsigned long start, unsigned long end)
 102 {
 103         asm(
 104         ".word  0xec401f0e      @ mcrr  p15, 0, r1, r0, c14, 0  @ blocking      \n\
 105         mov     pc, lr");
 106 }
 107
 108 static int blockops_trap(struct pt_regs *regs, unsigned int instr)
 109 {
 110         regs->ARM_r4 |= regs->ARM_r2;
 111         regs->ARM_pc += 4;
 112         return 0;
 113 }
 114
 115 static char *func[] = {
 116         "Prefetch data range",
 117         "Clean+Invalidate data range",
 118         "Clean data range",
 119         "Invalidate data range",
 120         "Invalidate instr range"
 121 };
 122
 123 static struct undef_hook blockops_hook __initdata = {
 124         .instr_mask     = 0x0fffffd0,
 125         .instr_val      = 0x0c401f00,
 126         .cpsr_mask      = PSR_T_BIT,
 127         .cpsr_val       = 0,
 128         .fn             = blockops_trap,
 129 };
 130
 131 static int __init blockops_check(void)
 132 {
 133         register unsigned int err asm("r4") = 0;
 134         unsigned int err_pos = 1;
 135         unsigned int cache_type;
 136         int i;
 137
 138         asm("mrc p15, 0, %0, c0, c0, 1" : "=r" (cache_type));
 139
 140         printk("Checking V6 block cache operations:\n");
 141         register_undef_hook(&blockops_hook);
 142
 143         __asm__ ("mov   r0, %0\n\t"
 144                 "mov    r1, %1\n\t"
 145                 "mov    r2, #1\n\t"
 146                 ".word  0xec401f2c @ mcrr p15, 0, r1, r0, c12, 2\n\t"
 147                 "mov    r2, #2\n\t"
 148                 ".word  0xec401f0e @ mcrr p15, 0, r1, r0, c14, 0\n\t"
 149                 "mov    r2, #4\n\t"
 150                 ".word  0xec401f0c @ mcrr p15, 0, r1, r0, c12, 0\n\t"
 151                 "mov    r2, #8\n\t"
 152                 ".word  0xec401f06 @ mcrr p15, 0, r1, r0, c6, 0\n\t"
 153                 "mov    r2, #16\n\t"
 154                 ".word  0xec401f05 @ mcrr p15, 0, r1, r0, c5, 0\n\t"
 155                 :
 156                 : "r" (PAGE_OFFSET), "r" (PAGE_OFFSET + 128)
 157                 : "r0", "r1", "r2");
 158
 159         unregister_undef_hook(&blockops_hook);
 160
 161         for (i = 0; i < ARRAY_SIZE(func); i++, err_pos <<= 1)
 162                 printk("%30s: %ssupported\n", func[i], err & err_pos ? "not " : "");
 163
 164         if ((err & 8) == 0) {
 165                 printk(" --> Using %s block cache invalidate\n",
 166                         cache_type & (1 << 24) ? "harvard" : "unified");
 167                 if (cache_type & (1 << 24))
 168                         cpu_cache.dma_inv_range = blk_dma_inv_range_harvard;
 169                 else
 170                         cpu_cache.dma_inv_range = blk_dma_inv_range_unified;
 171         }
 172         if ((err & 4) == 0) {
 173                 printk(" --> Using block cache clean\n");
 174                 cpu_cache.dma_clean_range        = blk_dma_clean_range;
 175         }
 176         if ((err & 2) == 0) {
 177                 printk(" --> Using block cache clean+invalidate\n");
 178                 cpu_cache.dma_flush_range        = blk_dma_flush_range;
 179                 cpu_cache.flush_kern_dcache_page = blk_flush_kern_dcache_page;
 180         }
 181
 182         return 0;
 183 }
 184
 185 __initcall(blockops_check);