| /* |
| * 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. |
| * |
| * Copyright (C) 2005 Embedded Alley Solutions, Inc |
| * Copyright (C) 2005 Ralf Baechle (ralf@linux-mips.org) |
| * Copyright (C) 2009 Jiajie Chen (chenjiajie@cse.buaa.edu.cn) |
| * Copyright (C) 2012 Huacai Chen (chenhc@lemote.com) |
| */ |
| #ifndef __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H |
| #define __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H |
| |
| #include <asm/cpu.h> |
| |
| /* |
| * Override macros used in arch/mips/kernel/head.S. |
| */ |
| .macro kernel_entry_setup |
| .set push |
| .set mips64 |
| /* Set ELPA on LOONGSON3 pagegrain */ |
| mfc0 t0, CP0_PAGEGRAIN |
| or t0, (0x1 << 29) |
| mtc0 t0, CP0_PAGEGRAIN |
| /* Enable STFill Buffer */ |
| mfc0 t0, CP0_PRID |
| /* Loongson-3A R4+ */ |
| andi t1, t0, PRID_IMP_MASK |
| li t2, PRID_IMP_LOONGSON_64G |
| beq t1, t2, 1f |
| nop |
| /* Loongson-3A R2/R3 */ |
| andi t0, (PRID_IMP_MASK | PRID_REV_MASK) |
| slti t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0) |
| bnez t0, 2f |
| nop |
| 1: |
| mfc0 t0, CP0_CONFIG6 |
| or t0, 0x100 |
| mtc0 t0, CP0_CONFIG6 |
| 2: |
| _ehb |
| .set pop |
| .endm |
| |
| /* |
| * Do SMP slave processor setup. |
| */ |
| .macro smp_slave_setup |
| .set push |
| .set mips64 |
| /* Set ELPA on LOONGSON3 pagegrain */ |
| mfc0 t0, CP0_PAGEGRAIN |
| or t0, (0x1 << 29) |
| mtc0 t0, CP0_PAGEGRAIN |
| /* Enable STFill Buffer */ |
| mfc0 t0, CP0_PRID |
| /* Loongson-3A R4+ */ |
| andi t1, t0, PRID_IMP_MASK |
| li t2, PRID_IMP_LOONGSON_64G |
| beq t1, t2, 1f |
| nop |
| /* Loongson-3A R2/R3 */ |
| andi t0, (PRID_IMP_MASK | PRID_REV_MASK) |
| slti t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0) |
| bnez t0, 2f |
| nop |
| 1: |
| mfc0 t0, CP0_CONFIG6 |
| or t0, 0x100 |
| mtc0 t0, CP0_CONFIG6 |
| 2: |
| _ehb |
| .set pop |
| .endm |
| |
| #define USE_KEXEC_SMP_WAIT_FINAL |
| .macro kexec_smp_wait_final |
| /* s0:prid s1:initfn */ |
| /* a0:base t1:cpuid t2:node t9:count */ |
| mfc0 t1, CP0_EBASE |
| andi t1, MIPS_EBASE_CPUNUM |
| dins a0, t1, 8, 2 /* insert core id*/ |
| dext t2, t1, 2, 2 |
| dins a0, t2, 44, 2 /* insert node id */ |
| mfc0 s0, CP0_PRID |
| andi s0, s0, (PRID_IMP_MASK | PRID_REV_MASK) |
| beq s0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3B_R1), 1f |
| beq s0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3B_R2), 1f |
| b 2f /* Loongson-3A1000/3A2000/3A3000/3A4000 */ |
| 1: dins a0, t2, 14, 2 /* Loongson-3B1000/3B1500 need bit 15~14 */ |
| 2: li t9, 0x100 /* wait for init loop */ |
| 3: addiu t9, -1 /* limit mailbox access */ |
| bnez t9, 3b |
| lw s1, 0x20(a0) /* check PC as an indicator */ |
| beqz s1, 2b |
| ld s1, 0x20(a0) /* get PC via mailbox reg0 */ |
| ld sp, 0x28(a0) /* get SP via mailbox reg1 */ |
| ld gp, 0x30(a0) /* get GP via mailbox reg2 */ |
| ld a1, 0x38(a0) |
| jr s1 /* jump to initial PC */ |
| .endm |
| |
| #endif /* __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H */ |