blob: 377005cd4d32aa4bea01016d7480bcc369acae60 [file] [log] [blame]
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +09001/*
2 * (C) Copyright 2007
3 * Nobuhiro Iwamatsu <iwamatsu@nigauri.org>
4 *
5 * See file CREDITS for list of people who contributed to this
6 * project.
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21 * MA 02111-1307 USA
22 */
23
24#include <common.h>
25#include <command.h>
26#include <asm/processor.h>
27#include <asm/io.h>
28
29/*
30 * Jump to P2 area.
31 * When handling TLB or caches, we need to do it from P2 area.
32 */
Wolfgang Denk61fb15c52007-12-27 01:52:50 +010033#define jump_to_P2() \
34 do { \
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090035 unsigned long __dummy; \
Wolfgang Denk61fb15c52007-12-27 01:52:50 +010036 __asm__ __volatile__( \
37 "mov.l 1f, %0\n\t" \
38 "or %1, %0\n\t" \
39 "jmp @%0\n\t" \
40 " nop\n\t" \
41 ".balign 4\n" \
42 "1: .long 2f\n" \
43 "2:" \
44 : "=&r" (__dummy) \
45 : "r" (0x20000000)); \
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090046 } while (0)
47
48/*
49 * Back to P1 area.
50 */
Wolfgang Denk61fb15c52007-12-27 01:52:50 +010051#define back_to_P1() \
52 do { \
53 unsigned long __dummy; \
54 __asm__ __volatile__( \
55 "nop;nop;nop;nop;nop;nop;nop\n\t" \
56 "mov.l 1f, %0\n\t" \
57 "jmp @%0\n\t" \
58 " nop\n\t" \
59 ".balign 4\n" \
60 "1: .long 2f\n" \
61 "2:" \
62 : "=&r" (__dummy)); \
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090063 } while (0)
64
65#define CACHE_VALID 1
66#define CACHE_UPDATED 2
67
68static inline void cache_wback_all(void)
69{
70 unsigned long addr, data, i, j;
71
72 jump_to_P2();
73 for (i = 0; i < CACHE_OC_NUM_ENTRIES; i++){
74 for (j = 0; j < CACHE_OC_NUM_WAYS; j++) {
Wolfgang Denk53677ef2008-05-20 16:00:29 +020075 addr = CACHE_OC_ADDRESS_ARRAY | (j << CACHE_OC_WAY_SHIFT)
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090076 | (i << CACHE_OC_ENTRY_SHIFT);
Wolfgang Denk53677ef2008-05-20 16:00:29 +020077 data = inl(addr);
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090078 if (data & CACHE_UPDATED) {
79 data &= ~CACHE_UPDATED;
80 outl(data, addr);
81 }
82 }
83 }
84 back_to_P1();
85}
86
87
88#define CACHE_ENABLE 0
89#define CACHE_DISABLE 1
90
91int cache_control(unsigned int cmd)
92{
93 unsigned long ccr;
94
95 jump_to_P2();
96 ccr = inl(CCR);
97
98 if (ccr & CCR_CACHE_ENABLE)
99 cache_wback_all();
100
101 if (cmd == CACHE_DISABLE)
102 outl(CCR_CACHE_STOP, CCR);
103 else
104 outl(CCR_CACHE_INIT, CCR);
105 back_to_P1();
106
107 return 0;
108}