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, 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, 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 #define USE_KEXEC_SMP_WAIT_FINAL
  79         .macro  kexec_smp_wait_final
  80         /* s0:prid s1:initfn */
  81         /* a0:base t1:cpuid t2:node t9:count */
  82         mfc0            t1, CP0_EBASE
  83         andi            t1, MIPS_EBASE_CPUNUM
  84         dins            a0, t1, 8, 2       /* insert core id*/
  85         dext            t2, t1, 2, 2
  86         dins            a0, t2, 44, 2      /* insert node id */
  87         mfc0            s0, CP0_PRID
  88         andi            s0, s0, (PRID_IMP_MASK | PRID_REV_MASK)
  89         beq             s0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3B_R1), 1f
  90         beq             s0, (PRID_IMP_LOONGSON_64C | PRID_REV_LOONGSON3B_R2), 1f
  91         b               2f                 /* Loongson-3A1000/3A2000/3A3000/3A4000 */
  92 1:      dins            a0, t2, 14, 2      /* Loongson-3B1000/3B1500 need bit 15~14 */
  93 2:      li              t9, 0x100          /* wait for init loop */
  94 3:      addiu           t9, -1             /* limit mailbox access */
  95         bnez            t9, 3b
  96         lw              s1, 0x20(a0)       /* check PC as an indicator */
  97         beqz            s1, 2b
  98         ld              s1, 0x20(a0)       /* get PC via mailbox reg0 */
  99         ld              sp, 0x28(a0)       /* get SP via mailbox reg1 */
 100         ld              gp, 0x30(a0)       /* get GP via mailbox reg2 */
 101         ld              a1, 0x38(a0)
 102         jr              s1                 /* jump to initial PC */
 103         .endm
 104
 105 #endif /* __ASM_MACH_LOONGSON64_KERNEL_ENTRY_H */