Quelle  entry.h   Sprache: C

/* SPDX-License-Identifier: GPL-2.0 */

#ifndef __ASM_CSKY_ENTRY_H
#define __ASM_CSKY_ENTRY_H

#include <asm/setup.h>
#include <abi/regdef.h>

#define LSAVE_PC 8
#define LSAVE_PSR 12
#define LSAVE_A0 24
#define LSAVE_A1 28
#define LSAVE_A2 32
#define LSAVE_A3 36
#define LSAVE_A4 40
#define LSAVE_A5 44

#define KSPTOUSP
#define USPTOKSP

#define usp cr<14, 1>

.macro SAVE_ALL epc_inc
 subi    sp, 152
 stw tls, (sp, 0)
 stw lr, (sp, 4)

 RD_MEH lr
 WR_MEH lr

 mfcr lr, epc
 movi tls, \epc_inc
 add lr, tls
 stw lr, (sp, 8)

 mfcr lr, epsr
 stw lr, (sp, 12)
 btsti   lr, 31
 bf      1f
 addi    lr, sp, 152
 br 2f
1:
 mfcr lr, usp
2:
 stw lr, (sp, 16)

 stw     a0, (sp, 20)
 stw     a0, (sp, 24)
 stw     a1, (sp, 28)
 stw     a2, (sp, 32)
 stw     a3, (sp, 36)

 addi sp, 40
 stm r4-r13, (sp)

 addi    sp, 40
 stm     r16-r30, (sp)
#ifdef CONFIG_CPU_HAS_HILO
 mfhi lr
 stw lr, (sp, 60)
 mflo lr
 stw lr, (sp, 64)
 mfcr lr, cr14
 stw lr, (sp, 68)
#endif
 subi sp, 80
.endm

.macro RESTORE_ALL
 ldw tls, (sp, 0)
 ldw lr, (sp, 4)
 ldw a0, (sp, 8)
 mtcr a0, epc
 ldw a0, (sp, 12)
 mtcr a0, epsr
 btsti   a0, 31
 ldw a0, (sp, 16)
 mtcr a0, usp
 mtcr a0, ss0

#ifdef CONFIG_CPU_HAS_HILO
 ldw a0, (sp, 140)
 mthi a0
 ldw a0, (sp, 144)
 mtlo a0
 ldw a0, (sp, 148)
 mtcr a0, cr14
#endif

 ldw     a0, (sp, 24)
 ldw     a1, (sp, 28)
 ldw     a2, (sp, 32)
 ldw     a3, (sp, 36)

 addi sp, 40
 ldm r4-r13, (sp)
 addi    sp, 40
 ldm     r16-r30, (sp)
 addi    sp, 72
 bf 1f
 mfcr sp, ss0
1:
 rte
.endm

.macro SAVE_REGS_FTRACE
 subi    sp, 152
 stw tls, (sp, 0)
 stw lr, (sp, 4)

 mfcr lr, psr
 stw lr, (sp, 12)

 addi    lr, sp, 152
 stw lr, (sp, 16)

 stw     a0, (sp, 20)
 stw     a0, (sp, 24)
 stw     a1, (sp, 28)
 stw     a2, (sp, 32)
 stw     a3, (sp, 36)

 addi sp, 40
 stm r4-r13, (sp)

 addi    sp, 40
 stm     r16-r30, (sp)
#ifdef CONFIG_CPU_HAS_HILO
 mfhi lr
 stw lr, (sp, 60)
 mflo lr
 stw lr, (sp, 64)
 mfcr lr, cr14
 stw lr, (sp, 68)
#endif
 subi sp, 80
.endm

.macro RESTORE_REGS_FTRACE
 ldw tls, (sp, 0)

#ifdef CONFIG_CPU_HAS_HILO
 ldw a0, (sp, 140)
 mthi a0
 ldw a0, (sp, 144)
 mtlo a0
 ldw a0, (sp, 148)
 mtcr a0, cr14
#endif

 ldw     a0, (sp, 24)
 ldw     a1, (sp, 28)
 ldw     a2, (sp, 32)
 ldw     a3, (sp, 36)

 addi sp, 40
 ldm r4-r13, (sp)
 addi    sp, 40
 ldm     r16-r30, (sp)
 addi    sp, 72
.endm

.macro SAVE_SWITCH_STACK
 subi    sp, 64
 stm r4-r11, (sp)
 stw lr,  (sp, 32)
 stw r16, (sp, 36)
 stw r17, (sp, 40)
 stw r26, (sp, 44)
 stw r27, (sp, 48)
 stw r28, (sp, 52)
 stw r29, (sp, 56)
 stw r30, (sp, 60)
#ifdef CONFIG_CPU_HAS_HILO
 subi sp, 16
 mfhi lr
 stw lr, (sp, 0)
 mflo lr
 stw lr, (sp, 4)
 mfcr lr, cr14
 stw lr, (sp, 8)
#endif
.endm

.macro RESTORE_SWITCH_STACK
#ifdef CONFIG_CPU_HAS_HILO
 ldw lr, (sp, 0)
 mthi lr
 ldw lr, (sp, 4)
 mtlo lr
 ldw lr, (sp, 8)
 mtcr lr, cr14
 addi sp, 16
#endif
 ldm r4-r11, (sp)
 ldw lr,  (sp, 32)
 ldw r16, (sp, 36)
 ldw r17, (sp, 40)
 ldw r26, (sp, 44)
 ldw r27, (sp, 48)
 ldw r28, (sp, 52)
 ldw r29, (sp, 56)
 ldw r30, (sp, 60)
 addi sp, 64
.endm

/* MMU registers operators. */
.macro RD_MIR rx
 mfcr \rx, cr<0, 15>
.endm

.macro RD_MEH rx
 mfcr \rx, cr<4, 15>
.endm

.macro RD_MCIR rx
 mfcr \rx, cr<8, 15>
.endm

.macro RD_PGDR rx
 mfcr \rx, cr<29, 15>
.endm

.macro RD_PGDR_K rx
 mfcr \rx, cr<28, 15>
.endm

.macro WR_MEH rx
 mtcr \rx, cr<4, 15>
.endm

.macro WR_MCIR rx
 mtcr \rx, cr<8, 15>
.endm

#ifdef CONFIG_PAGE_OFFSET_80000000
#define MSA_SET cr<30, 15>
#define MSA_CLR cr<31, 15>
#endif

#ifdef CONFIG_PAGE_OFFSET_A0000000
#define MSA_SET cr<31, 15>
#define MSA_CLR cr<30, 15>
#endif

.macro SETUP_MMU
 /* Init psr and enable ee */
 lrw r6, DEFAULT_PSR_VALUE
 mtcr    r6, psr
 psrset  ee

 /* Invalid I/Dcache BTB BHT */
 movi r6, 7
 lsli r6, 16
 addi r6, (1<<4) | 3
 mtcr r6, cr17

 /* Invalid all TLB */
 bgeni   r6, 26
 mtcr r6, cr<8, 15> /* Set MCIR */

 /* Check MMU on/off */
 mfcr r6, cr18
 btsti r6, 0
 bt 1f

 /* MMU off: setup mapping tlb entry */
 movi r6, 0
 mtcr r6, cr<6, 15> /* Set MPR with 4K page size */

 grs r6, 1f /* Get current pa by PC */
 bmaski  r7, (PAGE_SHIFT + 1) /* r7 = 0x1fff */
 andn    r6, r7
 mtcr r6, cr<4, 15> /* Set MEH */

 mov r8, r6
 movi    r7, 0x00000006
 or      r8, r7
 mtcr r8, cr<2, 15> /* Set MEL0 */
 movi    r7, 0x00001006
 or      r8, r7
 mtcr r8, cr<3, 15> /* Set MEL1 */

 bgeni   r8, 28
 mtcr r8, cr<8, 15> /* Set MCIR to write TLB */

 br 2f
1:
 /*
 * MMU on: use origin MSA value from bootloader
 *
 * cr<30/31, 15> MSA register format:
 * 31 - 29 | 28 - 9 | 8 | 7 | 6 | 5 | 4 | 3 | 2 | 1 | 0
 *   BA     Reserved  SH  WA  B   SO SEC  C   D   V
 */
 mfcr r6, MSA_SET /* Get MSA */
2:
 lsri r6, 29
 lsli r6, 29
 addi r6, 0x1ce
 mtcr r6, MSA_SET /* Set MSA */

 movi    r6, 0
 mtcr r6, MSA_CLR /* Clr MSA */

 /* enable MMU */
 mfcr    r6, cr18
 bseti r6, 0
 mtcr    r6, cr18

 jmpi 3f /* jump to va */
3:
.endm
#endif /* __ASM_CSKY_ENTRY_H */