MIPS: RM7000: Make use of cache_op() instead of inline asm
[sfrench/cifs-2.6.git] / arch / mips / mm / sc-rm7k.c
1 /*
2  * sc-rm7k.c: RM7000 cache management functions.
3  *
4  * Copyright (C) 1997, 2001, 2003, 2004 Ralf Baechle (ralf@linux-mips.org)
5  */
6
7 #undef DEBUG
8
9 #include <linux/init.h>
10 #include <linux/kernel.h>
11 #include <linux/mm.h>
12 #include <linux/bitops.h>
13
14 #include <asm/addrspace.h>
15 #include <asm/bcache.h>
16 #include <asm/cacheops.h>
17 #include <asm/mipsregs.h>
18 #include <asm/processor.h>
19 #include <asm/cacheflush.h> /* for run_uncached() */
20
21 /* Primary cache parameters. */
22 #define sc_lsize        32
23 #define tc_pagesize     (32*128)
24
25 /* Secondary cache parameters. */
26 #define scache_size     (256*1024)      /* Fixed to 256KiB on RM7000 */
27
28 extern unsigned long icache_way_size, dcache_way_size;
29
30 #include <asm/r4kcache.h>
31
32 static int rm7k_tcache_enabled;
33
34 /*
35  * Writeback and invalidate the primary cache dcache before DMA.
36  * (XXX These need to be fixed ...)
37  */
38 static void rm7k_sc_wback_inv(unsigned long addr, unsigned long size)
39 {
40         unsigned long end, a;
41
42         pr_debug("rm7k_sc_wback_inv[%08lx,%08lx]", addr, size);
43
44         /* Catch bad driver code */
45         BUG_ON(size == 0);
46
47         blast_scache_range(addr, addr + size);
48
49         if (!rm7k_tcache_enabled)
50                 return;
51
52         a = addr & ~(tc_pagesize - 1);
53         end = (addr + size - 1) & ~(tc_pagesize - 1);
54         while(1) {
55                 invalidate_tcache_page(a);      /* Page_Invalidate_T */
56                 if (a == end)
57                         break;
58                 a += tc_pagesize;
59         }
60 }
61
62 static void rm7k_sc_inv(unsigned long addr, unsigned long size)
63 {
64         unsigned long end, a;
65
66         pr_debug("rm7k_sc_inv[%08lx,%08lx]", addr, size);
67
68         /* Catch bad driver code */
69         BUG_ON(size == 0);
70
71         blast_inv_scache_range(addr, addr + size);
72
73         if (!rm7k_tcache_enabled)
74                 return;
75
76         a = addr & ~(tc_pagesize - 1);
77         end = (addr + size - 1) & ~(tc_pagesize - 1);
78         while(1) {
79                 invalidate_tcache_page(a);      /* Page_Invalidate_T */
80                 if (a == end)
81                         break;
82                 a += tc_pagesize;
83         }
84 }
85
86 /*
87  * This function is executed in uncached address space.
88  */
89 static __cpuinit void __rm7k_sc_enable(void)
90 {
91         int i;
92
93         set_c0_config(RM7K_CONF_SE);
94
95         write_c0_taglo(0);
96         write_c0_taghi(0);
97
98         for (i = 0; i < scache_size; i += sc_lsize)
99                 cache_op(Index_Store_Tag_SD, CKSEG0ADDR(i));
100 }
101
102 static __cpuinit void rm7k_sc_enable(void)
103 {
104         if (read_c0_config() & RM7K_CONF_SE)
105                 return;
106
107         printk(KERN_INFO "Enabling secondary cache...\n");
108         run_uncached(__rm7k_sc_enable);
109 }
110
111 static void rm7k_sc_disable(void)
112 {
113         clear_c0_config(RM7K_CONF_SE);
114 }
115
116 static struct bcache_ops rm7k_sc_ops = {
117         .bc_enable = rm7k_sc_enable,
118         .bc_disable = rm7k_sc_disable,
119         .bc_wback_inv = rm7k_sc_wback_inv,
120         .bc_inv = rm7k_sc_inv
121 };
122
123 void __cpuinit rm7k_sc_init(void)
124 {
125         struct cpuinfo_mips *c = &current_cpu_data;
126         unsigned int config = read_c0_config();
127
128         if ((config & RM7K_CONF_SC))
129                 return;
130
131         c->scache.linesz = sc_lsize;
132         c->scache.ways = 4;
133         c->scache.waybit= __ffs(scache_size / c->scache.ways);
134         c->scache.waysize = scache_size / c->scache.ways;
135         c->scache.sets = scache_size / (c->scache.linesz * c->scache.ways);
136         printk(KERN_INFO "Secondary cache size %dK, linesize %d bytes.\n",
137                (scache_size >> 10), sc_lsize);
138
139         if (!(config & RM7K_CONF_SE))
140                 rm7k_sc_enable();
141
142         /*
143          * While we're at it let's deal with the tertiary cache.
144          */
145         if (!(config & RM7K_CONF_TC)) {
146
147                 /*
148                  * We can't enable the L3 cache yet. There may be board-specific
149                  * magic necessary to turn it on, and blindly asking the CPU to
150                  * start using it would may give cache errors.
151                  *
152                  * Also, board-specific knowledge may allow us to use the
153                  * CACHE Flash_Invalidate_T instruction if the tag RAM supports
154                  * it, and may specify the size of the L3 cache so we don't have
155                  * to probe it.
156                  */
157                 printk(KERN_INFO "Tertiary cache present, %s enabled\n",
158                        (config & RM7K_CONF_TE) ? "already" : "not (yet)");
159
160                 if ((config & RM7K_CONF_TE))
161                         rm7k_tcache_enabled = 1;
162         }
163
164         bcops = &rm7k_sc_ops;
165 }