| /* | 
 |  * (C) Copyright 2007 | 
 |  * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | 
 |  * | 
 |  * Author: Igor Lisitsin <igor@emcraft.com> | 
 |  * | 
 |  * SPDX-License-Identifier:	GPL-2.0+ | 
 |  */ | 
 |  | 
 | #include <common.h> | 
 |  | 
 | /* Cache test | 
 |  * | 
 |  * This test verifies the CPU data and instruction cache using | 
 |  * several test scenarios. | 
 |  */ | 
 |  | 
 | #include <post.h> | 
 |  | 
 | #if CONFIG_POST & CONFIG_SYS_POST_CACHE | 
 |  | 
 | #include <asm/mmu.h> | 
 | #include <watchdog.h> | 
 |  | 
 | #define CACHE_POST_SIZE	1024 | 
 |  | 
 | int cache_post_test1 (int tlb, void *p, int size); | 
 | int cache_post_test2 (int tlb, void *p, int size); | 
 | int cache_post_test3 (int tlb, void *p, int size); | 
 | int cache_post_test4 (int tlb, void *p, int size); | 
 | int cache_post_test5 (int tlb, void *p, int size); | 
 | int cache_post_test6 (int tlb, void *p, int size); | 
 |  | 
 | #ifdef CONFIG_440 | 
 | static unsigned char testarea[CACHE_POST_SIZE] | 
 | __attribute__((__aligned__(CACHE_POST_SIZE))); | 
 | #endif | 
 |  | 
 | int cache_post_test (int flags) | 
 | { | 
 | 	void *virt = (void *)CONFIG_SYS_POST_CACHE_ADDR; | 
 | 	int ints; | 
 | 	int res = 0; | 
 | 	int tlb = -1;		/* index to the victim TLB entry */ | 
 |  | 
 | 	/* | 
 | 	 * All 44x variants deal with cache management differently | 
 | 	 * because they have the address translation always enabled. | 
 | 	 * The 40x ppc's don't use address translation in U-Boot at all, | 
 | 	 * so we have to distinguish here between 40x and 44x. | 
 | 	 */ | 
 | #ifdef CONFIG_440 | 
 | 	int word0, i; | 
 |  | 
 | 	/* | 
 | 	 * Allocate a new TLB entry, since we are going to modify | 
 | 	 * the write-through and caching inhibited storage attributes. | 
 | 	 */ | 
 | 	program_tlb((u32)testarea, (u32)virt, CACHE_POST_SIZE, | 
 | 		    TLB_WORD2_I_ENABLE); | 
 |  | 
 | 	/* Find the TLB entry */ | 
 | 	for (i = 0;; i++) { | 
 | 		if (i >= PPC4XX_TLB_SIZE) { | 
 | 			printf ("Failed to program tlb entry\n"); | 
 | 			return -1; | 
 | 		} | 
 | 		word0 = mftlb1(i); | 
 | 		if (TLB_WORD0_EPN_DECODE(word0) == (u32)virt) { | 
 | 			tlb = i; | 
 | 			break; | 
 | 		} | 
 | 	} | 
 | #endif | 
 | 	ints = disable_interrupts (); | 
 |  | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test1 (tlb, virt, CACHE_POST_SIZE); | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test2 (tlb, virt, CACHE_POST_SIZE); | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test3 (tlb, virt, CACHE_POST_SIZE); | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test4 (tlb, virt, CACHE_POST_SIZE); | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test5 (tlb, virt, CACHE_POST_SIZE); | 
 | 	WATCHDOG_RESET (); | 
 | 	if (res == 0) | 
 | 		res = cache_post_test6 (tlb, virt, CACHE_POST_SIZE); | 
 |  | 
 | 	if (ints) | 
 | 		enable_interrupts (); | 
 |  | 
 | #ifdef CONFIG_440 | 
 | 	remove_tlb((u32)virt, CACHE_POST_SIZE); | 
 | #endif | 
 |  | 
 | 	return res; | 
 | } | 
 |  | 
 | #endif /* CONFIG_POST & CONFIG_SYS_POST_CACHE */ |