| /* |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file "COPYING" in the main directory of this archive |
| * for more details. |
| * |
| * Chris Dearman (chris@mips.com) |
| * Copyright (C) 2007 Mips Technologies, Inc. |
| * Copyright (C) 2014 Imagination Technologies Ltd. |
| */ |
| #ifndef __ASM_MACH_MIPS_KERNEL_ENTRY_INIT_H |
| #define __ASM_MACH_MIPS_KERNEL_ENTRY_INIT_H |
| |
| #include <asm/regdef.h> |
| #include <asm/mipsregs.h> |
| |
| /* |
| * Prepare segments for EVA boot: |
| * |
| * This is in case the processor boots in legacy configuration |
| * (SI_EVAReset is de-asserted and CONFIG5.K == 0) |
| * |
| * ========================= Mappings ============================= |
| * Virtual memory Physical memory Mapping |
| * 0x00000000 - 0x7fffffff 0x80000000 - 0xfffffffff MUSUK (kuseg) |
| * Flat 2GB physical memory |
| * |
| * 0x80000000 - 0x9fffffff 0x00000000 - 0x1ffffffff MUSUK (kseg0) |
| * 0xa0000000 - 0xbf000000 0x00000000 - 0x1ffffffff MUSUK (kseg1) |
| * 0xc0000000 - 0xdfffffff - MK (kseg2) |
| * 0xe0000000 - 0xffffffff - MK (kseg3) |
| * |
| * |
| * Lowmem is expanded to 2GB |
| * |
| * The following code uses the t0, t1, t2 and ra registers without |
| * previously preserving them. |
| * |
| */ |
| .macro platform_eva_init |
| |
| .set push |
| .set reorder |
| /* |
| * Get Config.K0 value and use it to program |
| * the segmentation registers |
| */ |
| mfc0 t1, CP0_CONFIG |
| andi t1, 0x7 /* CCA */ |
| move t2, t1 |
| ins t2, t1, 16, 3 |
| /* SegCtl0 */ |
| li t0, ((MIPS_SEGCFG_MK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (0 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) | \ |
| (((MIPS_SEGCFG_MK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (0 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) << 16) |
| or t0, t2 |
| mtc0 t0, $5, 2 |
| |
| /* SegCtl1 */ |
| li t0, ((MIPS_SEGCFG_MUSUK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (0 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (2 << MIPS_SEGCFG_C_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) | \ |
| (((MIPS_SEGCFG_MUSUK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (0 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) << 16) |
| ins t0, t1, 16, 3 |
| mtc0 t0, $5, 3 |
| |
| /* SegCtl2 */ |
| li t0, ((MIPS_SEGCFG_MUSUK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (6 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) | \ |
| (((MIPS_SEGCFG_MUSUK << MIPS_SEGCFG_AM_SHIFT) | \ |
| (4 << MIPS_SEGCFG_PA_SHIFT) | \ |
| (1 << MIPS_SEGCFG_EU_SHIFT)) << 16) |
| or t0, t2 |
| mtc0 t0, $5, 4 |
| |
| jal mips_ihb |
| mfc0 t0, $16, 5 |
| li t2, 0x40000000 /* K bit */ |
| or t0, t0, t2 |
| mtc0 t0, $16, 5 |
| sync |
| jal mips_ihb |
| |
| .set pop |
| .endm |
| |
| .macro kernel_entry_setup |
| |
| #ifdef CONFIG_EVA |
| sync |
| ehb |
| |
| mfc0 t1, CP0_CONFIG |
| bgez t1, 9f |
| mfc0 t0, CP0_CONFIG, 1 |
| bgez t0, 9f |
| mfc0 t0, CP0_CONFIG, 2 |
| bgez t0, 9f |
| mfc0 t0, CP0_CONFIG, 3 |
| sll t0, t0, 6 /* SC bit */ |
| bgez t0, 9f |
| |
| platform_eva_init |
| b 0f |
| 9: |
| /* Assume we came from YAMON... */ |
| PTR_LA v0, 0x9fc00534 /* YAMON print */ |
| lw v0, (v0) |
| move a0, zero |
| PTR_LA a1, nonsc_processor |
| jal v0 |
| |
| PTR_LA v0, 0x9fc00520 /* YAMON exit */ |
| lw v0, (v0) |
| li a0, 1 |
| jal v0 |
| |
| 1: b 1b |
| nop |
| __INITDATA |
| nonsc_processor: |
| .asciz "EVA kernel requires a MIPS core with Segment Control implemented\n" |
| __FINIT |
| #endif /* CONFIG_EVA */ |
| 0: |
| .endm |
| |
| /* |
| * Do SMP slave processor setup necessary before we can safely execute C code. |
| */ |
| .macro smp_slave_setup |
| #ifdef CONFIG_EVA |
| sync |
| ehb |
| platform_eva_init |
| #endif |
| .endm |
| |
| #endif /* __ASM_MACH_MIPS_KERNEL_ENTRY_INIT_H */ |