From 8c2f0bb041ffb417d03309e280ad4421052a031c Mon Sep 17 00:00:00 2001 From: Renaud Barbier Date: Fri, 28 Feb 2014 12:58:53 +0000 Subject: ppc: add support for memtest with cache disabled Add support to enable caching on a memory region during the memory test. Tested on P2020RDB and DA923RC. Signed-off-by: Renaud Barbier Signed-off-by: Sascha Hauer --- arch/ppc/cpu-85xx/Makefile | 1 + arch/ppc/cpu-85xx/mmu.c | 54 ++++++++++++++++++++++++++++++++ arch/ppc/cpu-85xx/tlb.c | 17 +++++++++- arch/ppc/include/asm/mmu.h | 6 ++++ arch/ppc/mach-mpc85xx/include/mach/mmu.h | 5 +++ 5 files changed, 82 insertions(+), 1 deletion(-) create mode 100644 arch/ppc/cpu-85xx/mmu.c (limited to 'arch/ppc') diff --git a/arch/ppc/cpu-85xx/Makefile b/arch/ppc/cpu-85xx/Makefile index 3ee039778c..c649c4ec25 100644 --- a/arch/ppc/cpu-85xx/Makefile +++ b/arch/ppc/cpu-85xx/Makefile @@ -1,4 +1,5 @@ obj-y += traps.o obj-y += tlb.o +obj-$(CONFIG_MMU) += mmu.o extra-y += start.o extra-y += resetvec.o diff --git a/arch/ppc/cpu-85xx/mmu.c b/arch/ppc/cpu-85xx/mmu.c new file mode 100644 index 0000000000..7e86e6b2b6 --- /dev/null +++ b/arch/ppc/cpu-85xx/mmu.c @@ -0,0 +1,54 @@ +/* + * Copyright 2014 GE Intelligent Platforms, Inc. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License as + * published by the Free Software Foundation; either version 2 of + * the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#include +#include +#include + +void remap_range(void *_start, size_t size, uint32_t flags) +{ + uint32_t ptr, start, tsize, valid, wimge; + unsigned long epn; + phys_addr_t rpn = 0; + int esel = 0; + + ptr = start = (uint32_t)_start; + wimge = flags | MAS2_M; + + while (ptr < (start + size)) { + esel = e500_find_tlb_idx((void *)ptr, 1); + if (esel != -1) + break; + e500_read_tlbcam_entry(esel, &valid, &tsize, &epn, + &rpn); + if (flags & MAS2_I) { + flush_dcache(); + invalidate_icache(); + } + e500_set_tlb(1, epn, rpn, MAS3_SX|MAS3_SW|MAS3_SR, + (u8)wimge, 0, esel, tsize, 1); + /* convert tsize to bytes to increment address. */ + ptr += (1ULL << ((tsize) + 10)); + } +} + +uint32_t mmu_get_pte_cached_flags(void) +{ + return 0; +} + +uint32_t mmu_get_pte_uncached_flags(void) +{ + return MAS2_I; +} diff --git a/arch/ppc/cpu-85xx/tlb.c b/arch/ppc/cpu-85xx/tlb.c index a2739d000c..3a5b413627 100644 --- a/arch/ppc/cpu-85xx/tlb.c +++ b/arch/ppc/cpu-85xx/tlb.c @@ -50,7 +50,22 @@ void e500_init_tlbs(void) return ; } -static int e500_find_free_tlbcam(void) +void e500_read_tlbcam_entry(int idx, u32 *valid, u32 *tsize, + unsigned long *epn, phys_addr_t *rpn) +{ + u32 _mas1; + + mtspr(MAS0, FSL_BOOKE_MAS0(1, idx, 0)); + asm volatile("tlbre;isync"); + _mas1 = mfspr(MAS1); + + *valid = (_mas1 & MAS1_VALID); + *tsize = (_mas1 >> 7) & 0x1f; + *epn = mfspr(MAS2) & MAS2_EPN; + *rpn = mfspr(MAS3) & MAS3_RPN; +} + +int e500_find_free_tlbcam(void) { int ix; u32 _mas1; diff --git a/arch/ppc/include/asm/mmu.h b/arch/ppc/include/asm/mmu.h index 72233b4175..6e15975545 100644 --- a/arch/ppc/include/asm/mmu.h +++ b/arch/ppc/include/asm/mmu.h @@ -557,6 +557,11 @@ extern int write_bat(ppc_bat_t bat, unsigned long upper, unsigned long lower); #ifndef __ASSEMBLY__ +#ifdef CONFIG_MMU +void remap_range(void *_start, size_t size, uint32_t flags); +uint32_t mmu_get_pte_cached_flags(void); +uint32_t mmu_get_pte_uncached_flags(void); +#else static inline void remap_range(void *_start, size_t size, uint32_t flags) { } @@ -570,6 +575,7 @@ static inline uint32_t mmu_get_pte_uncached_flags(void) { return 0; } +#endif /* CONFIG_MMU */ #endif #endif /* _PPC_MMU_H_ */ diff --git a/arch/ppc/mach-mpc85xx/include/mach/mmu.h b/arch/ppc/mach-mpc85xx/include/mach/mmu.h index 00459e2d29..e2ecc62ef0 100644 --- a/arch/ppc/mach-mpc85xx/include/mach/mmu.h +++ b/arch/ppc/mach-mpc85xx/include/mach/mmu.h @@ -13,6 +13,11 @@ #include #ifndef __ASSEMBLY__ +extern int e500_find_free_tlbcam(void); +extern void e500_read_tlbcam_entry(int idx, u32 *valid, u32 *tsize, + unsigned long *epn, phys_addr_t *rpn); +extern void e500_read_tlbcam_entry(int idx, u32 *valid, u32 *tsize, + unsigned long *epn, phys_addr_t *rpn); extern void e500_set_tlb(u8 tlb, u32 epn, u64 rpn, u8 perms, u8 wimge, u8 ts, u8 esel, u8 tsize, u8 iprot); extern void e500_disable_tlb(u8 esel); -- cgit v1.2.3