| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135 |
- --- a/arch/mips/include/asm/r4kcache.h
- +++ b/arch/mips/include/asm/r4kcache.h
- @@ -20,10 +20,25 @@
- #ifdef CONFIG_BCM47XX
- #include <asm/paccess.h>
- #include <linux/ssb/ssb.h>
- -#define BCM4710_DUMMY_RREG() ((void) *((u8 *) KSEG1ADDR(SSB_ENUM_BASE + SSB_IMSTATE)))
- +#define BCM4710_DUMMY_RREG() bcm4710_dummy_rreg()
- +
- +static inline unsigned long bcm4710_dummy_rreg(void) {
- + return (*(volatile unsigned long *)(KSEG1ADDR(SSB_ENUM_BASE + SSB_IMSTATE)));
- +}
- +
- +#define BCM4710_FILL_TLB(addr) bcm4710_fill_tlb((void*)(addr))
- +
- +static inline unsigned long bcm4710_fill_tlb(void *addr) {
- + return (*(unsigned long *)addr);
- +}
- +
- +#define BCM4710_PROTECTED_FILL_TLB(addr) bcm4710_protected_fill_tlb((void*)(addr))
- +
- +static inline void bcm4710_protected_fill_tlb(void *addr) {
- + unsigned long x;
- + get_dbe(x, (unsigned long *)addr);;
- +}
-
- -#define BCM4710_FILL_TLB(addr) (*(volatile unsigned long *)(addr))
- -#define BCM4710_PROTECTED_FILL_TLB(addr) ({ unsigned long x; get_dbe(x, (volatile unsigned long *)(addr)); })
- #else
- #define BCM4710_DUMMY_RREG()
-
- --- a/arch/mips/mm/tlbex.c
- +++ b/arch/mips/mm/tlbex.c
- @@ -548,6 +548,9 @@ build_get_pgde32(u32 **p, unsigned int t
- #endif
- uasm_i_addu(p, ptr, tmp, ptr);
- #else
- +#ifdef CONFIG_BCM47XX
- + uasm_i_nop(p);
- +#endif
- UASM_i_LA_mostly(p, ptr, pgdc);
- #endif
- uasm_i_mfc0(p, tmp, C0_BADVADDR); /* get faulting address */
- @@ -678,12 +681,12 @@ static void __cpuinit build_r4000_tlb_re
- /* No need for uasm_i_nop */
- }
-
- -#ifdef CONFIG_BCM47XX
- - uasm_i_nop(&p);
- -#endif
- #ifdef CONFIG_64BIT
- build_get_pmde64(&p, &l, &r, K0, K1); /* get pmd in K1 */
- #else
- +# ifdef CONFIG_BCM47XX
- + uasm_i_nop(&p);
- +# endif
- build_get_pgde32(&p, K0, K1); /* get pgd in K1 */
- #endif
-
- @@ -691,6 +694,9 @@ static void __cpuinit build_r4000_tlb_re
- build_update_entries(&p, K0, K1);
- build_tlb_write_entry(&p, &l, &r, tlb_random);
- uasm_l_leave(&l, p);
- +#ifdef CONFIG_BCM47XX
- + uasm_i_nop(&p);
- +#endif
- uasm_i_eret(&p); /* return from trap */
-
- #ifdef CONFIG_64BIT
- @@ -1088,12 +1094,12 @@ build_r4000_tlbchange_handler_head(u32 *
- struct uasm_reloc **r, unsigned int pte,
- unsigned int ptr)
- {
- -#ifdef CONFIG_BCM47XX
- - uasm_i_nop(p);
- -#endif
- #ifdef CONFIG_64BIT
- build_get_pmde64(p, l, r, pte, ptr); /* get pmd in ptr */
- #else
- +# ifdef CONFIG_BCM47XX
- + uasm_i_nop(p);
- +# endif
- build_get_pgde32(p, pte, ptr); /* get pgd in ptr */
- #endif
-
- @@ -1121,6 +1127,9 @@ build_r4000_tlbchange_handler_tail(u32 *
- build_update_entries(p, tmp, ptr);
- build_tlb_write_entry(p, l, r, tlb_indexed);
- uasm_l_leave(l, *p);
- +#ifdef CONFIG_BCM47XX
- + uasm_i_nop(p);
- +#endif
- uasm_i_eret(p); /* return from trap */
-
- #ifdef CONFIG_64BIT
- --- a/arch/mips/kernel/genex.S
- +++ b/arch/mips/kernel/genex.S
- @@ -22,6 +22,19 @@
- #include <asm/page.h>
- #include <asm/thread_info.h>
-
- +#ifdef CONFIG_BCM47XX
- +# ifdef eret
- +# undef eret
- +# endif
- +# define eret \
- + .set push; \
- + .set noreorder; \
- + nop; \
- + nop; \
- + eret; \
- + .set pop;
- +#endif
- +
- #define PANIC_PIC(msg) \
- .set push; \
- .set reorder; \
- @@ -54,7 +67,6 @@ NESTED(except_vec3_generic, 0, sp)
- .set noat
- #ifdef CONFIG_BCM47XX
- nop
- - nop
- #endif
- #if R5432_CP0_INTERRUPT_WAR
- mfc0 k0, CP0_INDEX
- @@ -79,6 +91,9 @@ NESTED(except_vec3_r4000, 0, sp)
- .set push
- .set mips3
- .set noat
- +#ifdef CONFIG_BCM47XX
- + nop
- +#endif
- mfc0 k1, CP0_CAUSE
- li k0, 31<<2
- andi k1, k1, 0x7c
|
