1 /*-
2 * Copyright (c) 2011-2012 Semihalf.
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD: releng/11.0/sys/powerpc/booke/machdep_ppc4xx.c 236324 2012-05-30 17:34:40Z raj $");
29
30 #include <sys/types.h>
31 #include <sys/systm.h>
32
33 #include <machine/machdep.h>
34
35 #include <powerpc/booke/dcr.h>
36 #include <powerpc/apm86xxx/apm86xxx.h>
37
38 #include <dev/fdt/fdt_common.h>
39
40 #define OCP_ADDR_WORDLO(addr) ((uint32_t)((uint64_t)(addr) & 0xFFFFFFFF))
41 #define OCP_ADDR_WORDHI(addr) ((uint32_t)((uint64_t)(addr) >> 32))
42
43 extern void tlb_write(u_int, uint32_t, uint32_t, uint32_t, tlbtid_t, uint32_t,
44 uint32_t);
45 extern void tlb_read(u_int, uint32_t *, uint32_t *, uint32_t *, uint32_t *,
46 uint32_t *, uint32_t *);
47
48 unsigned int tlb_static_entries;
49 unsigned int tlb_current_entry = TLB_SIZE;
50 unsigned int tlb_misses = 0;
51 unsigned int tlb_invals = 0;
52
53 void tlb_map(uint32_t, uint32_t, uint32_t, uint32_t, uint32_t);
54 void tlb_map_mem(uint32_t, uint32_t, uint32_t);
55 void tlb_dump(void);
56
57 void
58 booke_init_tlb(vm_paddr_t fdt_immr_pa)
59 {
60
61 /* Map register space */
62 tlb_map(APM86XXX_DEEP_SLEEP_VA,
63 OCP_ADDR_WORDLO(APM86XXX_DEEP_SLEEP_PA),
64 OCP_ADDR_WORDHI(APM86XXX_DEEP_SLEEP_PA), TLB_VALID | TLB_SIZE_16M,
65 TLB_SW | TLB_SR | TLB_I | TLB_G);
66
67 tlb_map(APM86XXX_CSR_VA, OCP_ADDR_WORDLO(APM86XXX_CSR_PA),
68 OCP_ADDR_WORDHI(APM86XXX_CSR_PA), TLB_VALID | TLB_SIZE_16M,
69 TLB_SW | TLB_SR | TLB_I | TLB_G);
70
71 tlb_map(APM86XXX_PRIMARY_FABRIC_VA,
72 OCP_ADDR_WORDLO(APM86XXX_PRIMARY_FABRIC_PA),
73 OCP_ADDR_WORDHI(APM86XXX_PRIMARY_FABRIC_PA),
74 TLB_VALID | TLB_SIZE_16M,
75 TLB_SW | TLB_SR | TLB_I | TLB_G);
76
77 tlb_map(APM86XXX_AHB_VA, OCP_ADDR_WORDLO(APM86XXX_AHB_PA),
78 OCP_ADDR_WORDHI(APM86XXX_AHB_PA),
79 TLB_VALID | TLB_SIZE_16M,
80 TLB_SW | TLB_SR | TLB_I | TLB_G);
81
82 /* Map MailBox space */
83 tlb_map(APM86XXX_MBOX_VA, OCP_ADDR_WORDLO(APM86XXX_MBOX_PA),
84 OCP_ADDR_WORDHI(APM86XXX_MBOX_PA),
85 TLB_VALID | TLB_SIZE_4K,
86 TLB_UX | TLB_UW | TLB_UR |
87 TLB_SX | TLB_SW | TLB_SR |
88 TLB_I | TLB_G);
89
90 tlb_map(APM86XXX_MBOX_VA + 0x1000,
91 OCP_ADDR_WORDLO(APM86XXX_MBOX_PA) + 0x1000,
92 OCP_ADDR_WORDHI(APM86XXX_MBOX_PA),
93 TLB_VALID | TLB_SIZE_4K,
94 TLB_UX | TLB_UW | TLB_UR |
95 TLB_SX | TLB_SW | TLB_SR |
96 TLB_I | TLB_G);
97
98 tlb_map(APM86XXX_MBOX_VA + 0x2000,
99 OCP_ADDR_WORDLO(APM86XXX_MBOX_PA)+ 0x2000,
100 OCP_ADDR_WORDHI(APM86XXX_MBOX_PA),
101 TLB_VALID | TLB_SIZE_4K,
102 TLB_UX | TLB_UW | TLB_UR |
103 TLB_SX | TLB_SW | TLB_SR |
104 TLB_I | TLB_G);
105 }
106
107 void
108 booke_enable_l1_cache(void)
109 {
110 }
111
112 void
113 booke_enable_l2_cache(void)
114 {
115 }
116
117 void
118 booke_enable_l3_cache(void)
119 {
120 }
121
122 void
123 booke_disable_l2_cache(void)
124 {
125 uint32_t ccr1,l2cr0;
126
127 /* Disable L2 cache op broadcast */
128 ccr1 = mfspr(SPR_CCR1);
129 ccr1 &= ~CCR1_L2COBE;
130 mtspr(SPR_CCR1, ccr1);
131
132 /* Set L2 array size to 0 i.e. disable L2 cache */
133 mtdcr(DCR_L2DCDCRAI, DCR_L2CR0);
134 l2cr0 = mfdcr(DCR_L2DCDCRDI);
135 l2cr0 &= ~L2CR0_AS;
136 mtdcr(DCR_L2DCDCRDI, l2cr0);
137 }
138
139 void tlb_map(uint32_t epn, uint32_t rpn, uint32_t erpn, uint32_t flags,
140 uint32_t perms)
141 {
142
143 tlb_write(++tlb_static_entries, epn, rpn, erpn, 0, flags, perms);
144 }
145
146 static void tlb_dump_entry(u_int entry)
147 {
148 uint32_t epn, rpn, erpn, tid, flags, perms;
149 const char *size;
150
151 tlb_read(entry, &epn, &rpn, &erpn, &tid, &flags, &perms);
152
153 switch (flags & TLB_SIZE_MASK) {
154 case TLB_SIZE_1K:
155 size = " 1k";
156 break;
157 case TLB_SIZE_4K:
158 size = " 4k";
159 break;
160 case TLB_SIZE_16K:
161 size = " 16k";
162 break;
163 case TLB_SIZE_256K:
164 size = "256k";
165 break;
166 case TLB_SIZE_1M:
167 size = " 1M";
168 break;
169 case TLB_SIZE_16M:
170 size = " 16M";
171 break;
172 case TLB_SIZE_256M:
173 size = "256M";
174 break;
175 case TLB_SIZE_1G:
176 size = " 1G";
177 break;
178 default:
179 size = "????";
180 break;
181 }
182
183
184 printf("TLB[%02u]: 0x%08X => "
185 "0x%01X_%08X %s %c %c %s %s %s %s %s "
186 "%c%c%c%c%c%c%c%c%c%c%c%c%c%c%c (%u)\n",
187 entry, epn, erpn, rpn, size,
188 (flags & TLB_TS) ? '1' : '',
189 (flags & TLB_VALID) ? 'V' : '.',
190 (perms & TLB_WL1) ? "WL1" : "___",
191 (perms & TLB_IL1I) ? "IL1I" : "____",
192 (perms & TLB_IL1D) ? "IL1D" : "____",
193 (perms & TLB_IL2I) ? "IL2I" : "____",
194 (perms & TLB_IL2D) ? "IL2D" : "____",
195 (perms & TLB_U0) ? '1' : '.',
196 (perms & TLB_U1) ? '2' : '.',
197 (perms & TLB_U2) ? '3' : '.',
198 (perms & TLB_U3) ? '4' : '.',
199 (perms & TLB_W) ? 'W' : '.',
200 (perms & TLB_I) ? 'I' : '.',
201 (perms & TLB_M) ? 'M' : '.',
202 (perms & TLB_G) ? 'G' : '.',
203 (perms & TLB_E) ? 'E' : '.',
204 (perms & TLB_UX) ? 'x' : '.',
205 (perms & TLB_UW) ? 'w' : '.',
206 (perms & TLB_UR) ? 'r' : '.',
207 (perms & TLB_SX) ? 'X' : '.',
208 (perms & TLB_SW) ? 'W' : '.',
209 (perms & TLB_SR) ? 'R' : '.',
210 tid);
211 }
212
213 void tlb_dump(void)
214 {
215 int i;
216
217 for (i = 0; i < TLB_SIZE; i++)
218 tlb_dump_entry(i);
219 }
Cache object: 4127ccf7db720fce01954a70c7f9ea14
|