blob: 50490904249330a1f2f779aeac4cb4040db5a4f3 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +09002/*
Vladimir Zapolskiyb33718c2016-11-28 00:15:18 +02003 * (C) Copyright 2016 Vladimir Zapolskiy <vz@mleia.com>
4 * (C) Copyright 2007 Nobuhiro Iwamatsu <iwamatsu@nigauri.org>
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +09005 */
6
7#include <common.h>
8#include <command.h>
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +09009#include <asm/io.h>
Vladimir Zapolskiyc230a372016-11-28 00:15:16 +020010#include <asm/processor.h>
11#include <asm/system.h>
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090012
13#define CACHE_VALID 1
14#define CACHE_UPDATED 2
15
16static inline void cache_wback_all(void)
17{
18 unsigned long addr, data, i, j;
19
Vladimir Zapolskiy6ab8b962016-11-28 00:15:17 +020020 for (i = 0; i < CACHE_OC_NUM_ENTRIES; i++) {
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090021 for (j = 0; j < CACHE_OC_NUM_WAYS; j++) {
Vladimir Zapolskiy6ab8b962016-11-28 00:15:17 +020022 addr = CACHE_OC_ADDRESS_ARRAY
23 | (j << CACHE_OC_WAY_SHIFT)
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090024 | (i << CACHE_OC_ENTRY_SHIFT);
Wolfgang Denk53677ef2008-05-20 16:00:29 +020025 data = inl(addr);
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090026 if (data & CACHE_UPDATED) {
27 data &= ~CACHE_UPDATED;
28 outl(data, addr);
29 }
30 }
31 }
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090032}
33
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090034#define CACHE_ENABLE 0
35#define CACHE_DISABLE 1
36
Vladimir Zapolskiyb33718c2016-11-28 00:15:18 +020037static int cache_control(unsigned int cmd)
Nobuhiro Iwamatsub02bad12007-09-23 02:12:30 +090038{
39 unsigned long ccr;
40
41 jump_to_P2();
42 ccr = inl(CCR);
43
44 if (ccr & CCR_CACHE_ENABLE)
45 cache_wback_all();
46
47 if (cmd == CACHE_DISABLE)
48 outl(CCR_CACHE_STOP, CCR);
49 else
50 outl(CCR_CACHE_INIT, CCR);
51 back_to_P1();
52
53 return 0;
54}
Mike Frysinger17210642011-10-27 04:59:59 -040055
Nobuhiro Iwamatsua633a182013-08-22 08:43:47 +090056void flush_dcache_range(unsigned long start, unsigned long end)
Mike Frysinger17210642011-10-27 04:59:59 -040057{
58 u32 v;
59
60 start &= ~(L1_CACHE_BYTES - 1);
61 for (v = start; v < end; v += L1_CACHE_BYTES) {
Vladimir Zapolskiyee47c4c2016-11-28 00:15:13 +020062 asm volatile ("ocbp %0" : /* no output */
Mike Frysinger17210642011-10-27 04:59:59 -040063 : "m" (__m(v)));
64 }
65}
66
Nobuhiro Iwamatsua633a182013-08-22 08:43:47 +090067void invalidate_dcache_range(unsigned long start, unsigned long end)
Mike Frysinger17210642011-10-27 04:59:59 -040068{
69 u32 v;
70
71 start &= ~(L1_CACHE_BYTES - 1);
72 for (v = start; v < end; v += L1_CACHE_BYTES) {
73 asm volatile ("ocbi %0" : /* no output */
74 : "m" (__m(v)));
75 }
76}
Vladimir Zapolskiyb33718c2016-11-28 00:15:18 +020077
78void flush_cache(unsigned long addr, unsigned long size)
79{
80 flush_dcache_range(addr , addr + size);
81}
82
83void icache_enable(void)
84{
85 cache_control(CACHE_ENABLE);
86}
87
88void icache_disable(void)
89{
90 cache_control(CACHE_DISABLE);
91}
92
93int icache_status(void)
94{
95 return 0;
96}
97
98void dcache_enable(void)
99{
100}
101
102void dcache_disable(void)
103{
104}
105
106int dcache_status(void)
107{
108 return 0;
109}