Merge git://www.denx.de/git/u-boot
[platform/kernel/u-boot.git] / post / cpu / ppc4xx / cache.c
1 /*
2  * (C) Copyright 2007
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * Author: Igor Lisitsin <igor@emcraft.com>
6  *
7  * See file CREDITS for list of people who contributed to this
8  * project.
9  *
10  * This program is free software; you can redistribute it and/or
11  * modify it under the terms of the GNU General Public License as
12  * published by the Free Software Foundation; either version 2 of
13  * the License, or (at your option) any later version.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
23  * MA 02111-1307 USA
24  */
25
26 #include <common.h>
27
28 /* Cache test
29  *
30  * This test verifies the CPU data and instruction cache using
31  * several test scenarios.
32  */
33
34 #ifdef CONFIG_POST
35
36 #include <post.h>
37
38 #if CONFIG_POST & CFG_POST_CACHE
39
40 #include <asm/mmu.h>
41 #include <watchdog.h>
42
43 #define CACHE_POST_SIZE 1024
44
45 void program_tlb(u32 phys_addr, u32 virt_addr, u32 size, u32 tlb_word2_i_value);
46
47 int cache_post_test1 (int tlb, void *p, int size);
48 int cache_post_test2 (int tlb, void *p, int size);
49 int cache_post_test3 (int tlb, void *p, int size);
50 int cache_post_test4 (int tlb, void *p, int size);
51 int cache_post_test5 (int tlb, void *p, int size);
52 int cache_post_test6 (int tlb, void *p, int size);
53
54 #ifdef CONFIG_440
55 static unsigned char testarea[CACHE_POST_SIZE]
56 __attribute__((__aligned__(CACHE_POST_SIZE)));
57 #endif
58
59 int cache_post_test (int flags)
60 {
61         void *virt = (void *)CFG_POST_CACHE_ADDR;
62         int ints;
63         int res = 0;
64         int tlb = -1;           /* index to the victim TLB entry */
65
66         /*
67          * All 44x variants deal with cache management differently
68          * because they have the address translation always enabled.
69          * The 40x ppc's don't use address translation in U-Boot at all,
70          * so we have to distinguish here between 40x and 44x.
71          */
72 #ifdef CONFIG_440
73         int word0, i;
74
75         /*
76          * Allocate a new TLB entry, since we are going to modify
77          * the write-through and caching inhibited storage attributes.
78          */
79         program_tlb((u32)testarea, (u32)virt, CACHE_POST_SIZE,
80                     TLB_WORD2_I_ENABLE);
81
82         /* Find the TLB entry */
83         for (i = 0;; i++) {
84                 if (i >= PPC4XX_TLB_SIZE) {
85                         printf ("Failed to program tlb entry\n");
86                         return -1;
87                 }
88                 word0 = mftlb1(i);
89                 if (TLB_WORD0_EPN_DECODE(word0) == (u32)virt) {
90                         tlb = i;
91                         break;
92                 }
93         }
94 #endif
95         ints = disable_interrupts ();
96
97         WATCHDOG_RESET ();
98         if (res == 0)
99                 res = cache_post_test1 (tlb, virt, CACHE_POST_SIZE);
100         WATCHDOG_RESET ();
101         if (res == 0)
102                 res = cache_post_test2 (tlb, virt, CACHE_POST_SIZE);
103         WATCHDOG_RESET ();
104         if (res == 0)
105                 res = cache_post_test3 (tlb, virt, CACHE_POST_SIZE);
106         WATCHDOG_RESET ();
107         if (res == 0)
108                 res = cache_post_test4 (tlb, virt, CACHE_POST_SIZE);
109         WATCHDOG_RESET ();
110         if (res == 0)
111                 res = cache_post_test5 (tlb, virt, CACHE_POST_SIZE);
112         WATCHDOG_RESET ();
113         if (res == 0)
114                 res = cache_post_test6 (tlb, virt, CACHE_POST_SIZE);
115
116         if (ints)
117                 enable_interrupts ();
118
119 #ifdef CONFIG_440
120         remove_tlb((u32)virt, CACHE_POST_SIZE);
121 #endif
122
123         return res;
124 }
125
126 #endif /* CONFIG_POST & CFG_POST_CACHE */
127 #endif /* CONFIG_POST */