arch/mips/include/asm/mach-loongson64/kernel-entry-init.h

   1 /*
   2  * This file is subject to the terms and conditions of the GNU General Public
   3  * License.  See the file "COPYING" in the main directory of this archive
   4  * for more details.
   5  *
   6  * Copyright (C) 2005 Embedded Alley Solutions, Inc
   7  * Copyright (C) 2005 Ralf Baechle (ralf@linux-mips.org)
   8  * Copyright (C) 2009 Jiajie Chen (chenjiajie@cse.buaa.edu.cn)
   9  * Copyright (C) 2012 Huacai Chen (chenhc@lemote.com)
  10  */
  11 #ifndef __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H
  12 #define __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H
  13
  14 #include <asm/cpu.h>
  15
  16 /*
  17  * Override macros used in arch/mips/kernel/head.S.
  18  */
  19         .macro  kernel_entry_setup
  20         .set    push
  21         .set    mips64
  22         /* Set ELPA on LOONGSON3 pagegrain */
  23         mfc0    t0, CP0_PAGEGRAIN
  24         or      t0, (0x1 << 29)
  25         mtc0    t0, CP0_PAGEGRAIN
  26         /* Enable STFill Buffer */
  27         mfc0    t0, CP0_PRID
  28         /* Loongson-3A R4+ */
  29         andi    t1, t0, PRID_IMP_MASK
  30         li      t2, PRID_IMP_LOONGSON_64G
  31         beq     t1, t2, 1f
  32         nop
  33         /* Loongson-3A R2/R3 */
  34         andi    t0, (PRID_IMP_MASK | PRID_REV_MASK)
  35         slti    t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0)
  36         bnez    t0, 2f
  37         nop
  38 1:
  39         mfc0    t0, CP0_CONFIG6
  40         or      t0, 0x100
  41         mtc0    t0, CP0_CONFIG6
  42 2:
  43         _ehb
  44         .set    pop
  45         .endm
  46
  47 /*
  48  * Do SMP slave processor setup.
  49  */
  50         .macro  smp_slave_setup
  51         .set    push
  52         .set    mips64
  53         /* Set ELPA on LOONGSON3 pagegrain */
  54         mfc0    t0, CP0_PAGEGRAIN
  55         or      t0, (0x1 << 29)
  56         mtc0    t0, CP0_PAGEGRAIN
  57         /* Enable STFill Buffer */
  58         mfc0    t0, CP0_PRID
  59         /* Loongson-3A R4+ */
  60         andi    t1, t0, PRID_IMP_MASK
  61         li      t2, PRID_IMP_LOONGSON_64G
  62         beq     t1, t2, 1f
  63         nop
  64         /* Loongson-3A R2/R3 */
  65         andi    t0, (PRID_IMP_MASK | PRID_REV_MASK)
  66         slti    t0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3A_R2_0)
  67         bnez    t0, 2f
  68         nop
  69 1:
  70         mfc0    t0, CP0_CONFIG6
  71         or      t0, 0x100
  72         mtc0    t0, CP0_CONFIG6
  73 2:
  74         _ehb
  75         .set    pop
  76         .endm
  77
  78 #endif /* __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H */