]>
Commit | Line | Data |
---|---|---|
9318c51a CD |
1 | /* |
2 | * Copyright (C) 2006 Chris Dearman (chris@mips.com), | |
3 | */ | |
4 | #include <linux/init.h> | |
5 | #include <linux/kernel.h> | |
6 | #include <linux/sched.h> | |
7 | #include <linux/mm.h> | |
8 | ||
9 | #include <asm/mipsregs.h> | |
10 | #include <asm/bcache.h> | |
11 | #include <asm/cacheops.h> | |
12 | #include <asm/page.h> | |
13 | #include <asm/pgtable.h> | |
14 | #include <asm/system.h> | |
15 | #include <asm/mmu_context.h> | |
16 | #include <asm/r4kcache.h> | |
17 | ||
18 | /* | |
19 | * MIPS32/MIPS64 L2 cache handling | |
20 | */ | |
21 | ||
22 | /* | |
23 | * Writeback and invalidate the secondary cache before DMA. | |
24 | */ | |
25 | static void mips_sc_wback_inv(unsigned long addr, unsigned long size) | |
26 | { | |
a2c2bc4b | 27 | blast_scache_range(addr, addr + size); |
9318c51a CD |
28 | } |
29 | ||
30 | /* | |
31 | * Invalidate the secondary cache before DMA. | |
32 | */ | |
33 | static void mips_sc_inv(unsigned long addr, unsigned long size) | |
34 | { | |
96983ffe KC |
35 | unsigned long lsize = cpu_scache_line_size(); |
36 | unsigned long almask = ~(lsize - 1); | |
37 | ||
38 | cache_op(Hit_Writeback_Inv_SD, addr & almask); | |
39 | cache_op(Hit_Writeback_Inv_SD, (addr + size - 1) & almask); | |
a2c2bc4b | 40 | blast_inv_scache_range(addr, addr + size); |
9318c51a CD |
41 | } |
42 | ||
43 | static void mips_sc_enable(void) | |
44 | { | |
45 | /* L2 cache is permanently enabled */ | |
46 | } | |
47 | ||
48 | static void mips_sc_disable(void) | |
49 | { | |
50 | /* L2 cache is permanently enabled */ | |
51 | } | |
52 | ||
53 | static struct bcache_ops mips_sc_ops = { | |
54 | .bc_enable = mips_sc_enable, | |
55 | .bc_disable = mips_sc_disable, | |
56 | .bc_wback_inv = mips_sc_wback_inv, | |
57 | .bc_inv = mips_sc_inv | |
58 | }; | |
59 | ||
ea31a6b2 KC |
60 | /* |
61 | * Check if the L2 cache controller is activated on a particular platform. | |
62 | * MTI's L2 controller and the L2 cache controller of Broadcom's BMIPS | |
63 | * cores both use c0_config2's bit 12 as "L2 Bypass" bit, that is the | |
64 | * cache being disabled. However there is no guarantee for this to be | |
65 | * true on all platforms. In an act of stupidity the spec defined bits | |
66 | * 12..15 as implementation defined so below function will eventually have | |
67 | * to be replaced by a platform specific probe. | |
68 | */ | |
69 | static inline int mips_sc_is_activated(struct cpuinfo_mips *c) | |
70 | { | |
71 | /* Check the bypass bit (L2B) */ | |
72 | switch (c->cputype) { | |
73 | case CPU_34K: | |
74 | case CPU_74K: | |
75 | case CPU_1004K: | |
76 | case CPU_BMIPS5000: | |
77 | if (config2 & (1 << 12)) | |
78 | return 0; | |
79 | } | |
80 | ||
81 | tmp = (config2 >> 4) & 0x0f; | |
82 | if (0 < tmp && tmp <= 7) | |
83 | c->scache.linesz = 2 << tmp; | |
84 | else | |
85 | return 0; | |
86 | } | |
87 | ||
9318c51a CD |
88 | static inline int __init mips_sc_probe(void) |
89 | { | |
90 | struct cpuinfo_mips *c = ¤t_cpu_data; | |
91 | unsigned int config1, config2; | |
92 | unsigned int tmp; | |
93 | ||
94 | /* Mark as not present until probe completed */ | |
95 | c->scache.flags |= MIPS_CACHE_NOT_PRESENT; | |
96 | ||
97 | /* Ignore anything but MIPSxx processors */ | |
98 | if (c->isa_level != MIPS_CPU_ISA_M32R1 && | |
99 | c->isa_level != MIPS_CPU_ISA_M32R2 && | |
100 | c->isa_level != MIPS_CPU_ISA_M64R1 && | |
101 | c->isa_level != MIPS_CPU_ISA_M64R2) | |
102 | return 0; | |
103 | ||
104 | /* Does this MIPS32/MIPS64 CPU have a config2 register? */ | |
105 | config1 = read_c0_config1(); | |
106 | if (!(config1 & MIPS_CONF_M)) | |
107 | return 0; | |
108 | ||
109 | config2 = read_c0_config2(); | |
ea31a6b2 KC |
110 | |
111 | if (!mips_sc_is_activated(c)) | |
9318c51a CD |
112 | return 0; |
113 | ||
114 | tmp = (config2 >> 8) & 0x0f; | |
115 | if (0 <= tmp && tmp <= 7) | |
116 | c->scache.sets = 64 << tmp; | |
117 | else | |
118 | return 0; | |
119 | ||
120 | tmp = (config2 >> 0) & 0x0f; | |
121 | if (0 <= tmp && tmp <= 7) | |
122 | c->scache.ways = tmp + 1; | |
123 | else | |
124 | return 0; | |
125 | ||
126 | c->scache.waysize = c->scache.sets * c->scache.linesz; | |
a2c2bc4b | 127 | c->scache.waybit = __ffs(c->scache.waysize); |
9318c51a CD |
128 | |
129 | c->scache.flags &= ~MIPS_CACHE_NOT_PRESENT; | |
130 | ||
131 | return 1; | |
132 | } | |
133 | ||
234fcd14 | 134 | int __cpuinit mips_sc_init(void) |
9318c51a | 135 | { |
49a89efb | 136 | int found = mips_sc_probe(); |
9318c51a CD |
137 | if (found) { |
138 | mips_sc_enable(); | |
139 | bcops = &mips_sc_ops; | |
140 | } | |
141 | return found; | |
142 | } |