blob: c4c5c2d45138ab532151d5414840bcd8de397515 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -04001// SPDX-License-Identifier: GPL-2.0+
wdenkaffae2b2002-08-17 09:36:01 +00002/*
3 * (C) Copyright 2002
4 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
wdenkaffae2b2002-08-17 09:36:01 +00005 */
6
7#include <common.h>
Simon Glass1eb69ae2019-11-14 12:57:39 -07008#include <cpu_func.h>
Stefan Roese9b94ac62007-10-31 17:55:58 +01009#include <asm/cache.h>
Yuri Tikhonov138105e2008-04-29 13:32:45 +020010#include <watchdog.h>
wdenk0db5bca2003-03-31 17:27:09 +000011
Rasmus Villemoes729c1fe2021-04-21 11:16:03 +020012static ulong maybe_watchdog_reset(ulong flushed)
13{
14 flushed += CONFIG_SYS_CACHELINE_SIZE;
15 if (flushed >= CONFIG_CACHE_FLUSH_WATCHDOG_THRESHOLD) {
Stefan Roese29caf932022-09-02 14:10:46 +020016 schedule();
Rasmus Villemoes729c1fe2021-04-21 11:16:03 +020017 flushed = 0;
18 }
19 return flushed;
20}
21
Dave Liue39cd812008-12-05 15:36:14 +080022void flush_cache(ulong start_addr, ulong size)
wdenkaffae2b2002-08-17 09:36:01 +000023{
Dave Liue39cd812008-12-05 15:36:14 +080024 ulong addr, start, end;
Rasmus Villemoes729c1fe2021-04-21 11:16:03 +020025 ulong flushed = 0;
wdenkaffae2b2002-08-17 09:36:01 +000026
Dave Liue39cd812008-12-05 15:36:14 +080027 start = start_addr & ~(CONFIG_SYS_CACHELINE_SIZE - 1);
28 end = start_addr + size - 1;
wdenkaffae2b2002-08-17 09:36:01 +000029
Kumar Galabced7cc2009-02-06 08:08:06 -060030 for (addr = start; (addr <= end) && (addr >= start);
31 addr += CONFIG_SYS_CACHELINE_SIZE) {
Dave Liue39cd812008-12-05 15:36:14 +080032 asm volatile("dcbst 0,%0" : : "r" (addr) : "memory");
Rasmus Villemoes729c1fe2021-04-21 11:16:03 +020033 flushed = maybe_watchdog_reset(flushed);
wdenkaffae2b2002-08-17 09:36:01 +000034 }
Dave Liue39cd812008-12-05 15:36:14 +080035 /* wait for all dcbst to complete on bus */
36 asm volatile("sync" : : : "memory");
37
Kumar Galabced7cc2009-02-06 08:08:06 -060038 for (addr = start; (addr <= end) && (addr >= start);
39 addr += CONFIG_SYS_CACHELINE_SIZE) {
Dave Liue39cd812008-12-05 15:36:14 +080040 asm volatile("icbi 0,%0" : : "r" (addr) : "memory");
Rasmus Villemoes729c1fe2021-04-21 11:16:03 +020041 flushed = maybe_watchdog_reset(flushed);
Dave Liue39cd812008-12-05 15:36:14 +080042 }
43 asm volatile("sync" : : : "memory");
44 /* flush prefetch queue */
45 asm volatile("isync" : : : "memory");
wdenkaffae2b2002-08-17 09:36:01 +000046}