wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 1 | /* |
| 2 | * (C) Copyright 2004 Texas Insturments |
| 3 | * |
| 4 | * (C) Copyright 2002 |
| 5 | * Sysgo Real-Time Solutions, GmbH <www.elinos.com> |
| 6 | * Marius Groeger <mgroeger@sysgo.de> |
| 7 | * |
| 8 | * (C) Copyright 2002 |
Detlev Zundel | f1b3f2b | 2009-05-13 10:54:10 +0200 | [diff] [blame] | 9 | * Gary Jennejohn, DENX Software Engineering, <garyj@denx.de> |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 10 | * |
Wolfgang Denk | d79de1d | 2013-07-08 09:37:19 +0200 | [diff] [blame] | 11 | * SPDX-License-Identifier: GPL-2.0+ |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 12 | */ |
| 13 | |
| 14 | /* |
| 15 | * CPU specific code |
| 16 | */ |
| 17 | |
| 18 | #include <common.h> |
| 19 | #include <command.h> |
Jean-Christophe PLAGNIOL-VILLARD | 9053b5a | 2009-04-05 13:02:43 +0200 | [diff] [blame] | 20 | #include <asm/system.h> |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 21 | |
Jean-Christophe PLAGNIOL-VILLARD | e6b5f1b | 2009-04-05 13:06:31 +0200 | [diff] [blame] | 22 | static void cache_flush(void); |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 23 | |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 24 | int cleanup_before_linux (void) |
| 25 | { |
| 26 | /* |
| 27 | * this function is called just before we call linux |
| 28 | * it prepares the processor for linux |
| 29 | * |
| 30 | * we turn off caches etc ... |
| 31 | */ |
| 32 | |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 33 | disable_interrupts (); |
| 34 | |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 35 | /* turn off I/D-cache */ |
Jean-Christophe PLAGNIOL-VILLARD | e6b5f1b | 2009-04-05 13:06:31 +0200 | [diff] [blame] | 36 | icache_disable(); |
| 37 | dcache_disable(); |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 38 | /* flush I/D-cache */ |
Jean-Christophe PLAGNIOL-VILLARD | e6b5f1b | 2009-04-05 13:06:31 +0200 | [diff] [blame] | 39 | cache_flush(); |
| 40 | |
| 41 | return 0; |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 42 | } |
| 43 | |
Jean-Christophe PLAGNIOL-VILLARD | e6b5f1b | 2009-04-05 13:06:31 +0200 | [diff] [blame] | 44 | static void cache_flush(void) |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 45 | { |
Jean-Christophe PLAGNIOL-VILLARD | e6b5f1b | 2009-04-05 13:06:31 +0200 | [diff] [blame] | 46 | unsigned long i = 0; |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 47 | /* clean entire data cache */ |
| 48 | asm volatile("mcr p15, 0, %0, c7, c10, 0" : : "r" (i)); |
| 49 | /* invalidate both caches and flush btb */ |
| 50 | asm volatile("mcr p15, 0, %0, c7, c7, 0" : : "r" (i)); |
| 51 | /* mem barrier to sync things */ |
| 52 | asm volatile("mcr p15, 0, %0, c7, c10, 4" : : "r" (i)); |
wdenk | f806271 | 2005-01-09 23:16:25 +0000 | [diff] [blame] | 53 | } |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 54 | |
| 55 | #ifndef CONFIG_SYS_DCACHE_OFF |
| 56 | |
| 57 | #ifndef CONFIG_SYS_CACHELINE_SIZE |
| 58 | #define CONFIG_SYS_CACHELINE_SIZE 32 |
| 59 | #endif |
| 60 | |
| 61 | void invalidate_dcache_all(void) |
| 62 | { |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 63 | asm volatile("mcr p15, 0, %0, c7, c6, 0" : : "r" (0)); |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 64 | } |
| 65 | |
| 66 | void flush_dcache_all(void) |
| 67 | { |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 68 | asm volatile("mcr p15, 0, %0, c7, c10, 0" : : "r" (0)); |
| 69 | asm volatile("mcr p15, 0, %0, c7, c10, 4" : : "r" (0)); |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 70 | } |
| 71 | |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 72 | void invalidate_dcache_range(unsigned long start, unsigned long stop) |
| 73 | { |
Benoît Thébaudeau | 1053bd2 | 2012-07-19 01:35:32 +0000 | [diff] [blame] | 74 | if (!check_cache_range(start, stop)) |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 75 | return; |
| 76 | |
| 77 | while (start < stop) { |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 78 | asm volatile("mcr p15, 0, %0, c7, c6, 1" : : "r" (start)); |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 79 | start += CONFIG_SYS_CACHELINE_SIZE; |
| 80 | } |
| 81 | } |
| 82 | |
| 83 | void flush_dcache_range(unsigned long start, unsigned long stop) |
| 84 | { |
Benoît Thébaudeau | 1053bd2 | 2012-07-19 01:35:32 +0000 | [diff] [blame] | 85 | if (!check_cache_range(start, stop)) |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 86 | return; |
| 87 | |
| 88 | while (start < stop) { |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 89 | asm volatile("mcr p15, 0, %0, c7, c14, 1" : : "r" (start)); |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 90 | start += CONFIG_SYS_CACHELINE_SIZE; |
| 91 | } |
| 92 | |
Stefano Babic | 9e39793 | 2012-04-09 13:33:04 +0200 | [diff] [blame] | 93 | asm volatile("mcr p15, 0, %0, c7, c10, 4" : : "r" (0)); |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 94 | } |
| 95 | |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 96 | #else /* #ifndef CONFIG_SYS_DCACHE_OFF */ |
| 97 | void invalidate_dcache_all(void) |
| 98 | { |
| 99 | } |
| 100 | |
| 101 | void flush_dcache_all(void) |
| 102 | { |
| 103 | } |
Anatolij Gustschin | 02966ca | 2012-04-02 06:18:00 +0000 | [diff] [blame] | 104 | #endif /* #ifndef CONFIG_SYS_DCACHE_OFF */ |
Benoît Thébaudeau | dbbd845 | 2012-10-04 10:04:02 +0000 | [diff] [blame] | 105 | |
| 106 | #if !defined(CONFIG_SYS_ICACHE_OFF) || !defined(CONFIG_SYS_DCACHE_OFF) |
| 107 | void enable_caches(void) |
| 108 | { |
| 109 | #ifndef CONFIG_SYS_ICACHE_OFF |
| 110 | icache_enable(); |
| 111 | #endif |
| 112 | #ifndef CONFIG_SYS_DCACHE_OFF |
| 113 | dcache_enable(); |
| 114 | #endif |
| 115 | } |
| 116 | #endif |