arch/csky/kernel/entry.S

   1 /* SPDX-License-Identifier: GPL-2.0 */
   2 // Copyright (C) 2018 Hangzhou C-SKY Microsystems co.,ltd.
   3
   4 #include <linux/linkage.h>
   5 #include <abi/entry.h>
   6 #include <abi/pgtable-bits.h>
   7 #include <asm/errno.h>
   8 #include <asm/setup.h>
   9 #include <asm/unistd.h>
  10 #include <asm/asm-offsets.h>
  11 #include <linux/threads.h>
  12 #include <asm/setup.h>
  13 #include <asm/page.h>
  14 #include <asm/thread_info.h>
  15
  16 #define PTE_INDX_MSK    0xffc
  17 #define PTE_INDX_SHIFT  10
  18 #define _PGDIR_SHIFT    22
  19
  20 .macro  zero_fp
  21 #ifdef CONFIG_STACKTRACE
  22         movi    r8, 0
  23 #endif
  24 .endm
  25
  26 .macro tlbop_begin name, val0, val1, val2
  27 ENTRY(csky_\name)
  28         mtcr    a3, ss2
  29         mtcr    r6, ss3
  30         mtcr    a2, ss4
  31
  32         RD_PGDR r6
  33         RD_MEH  a3
  34 #ifdef CONFIG_CPU_HAS_TLBI
  35         tlbi.vaas a3
  36         sync.is
  37
  38         btsti   a3, 31
  39         bf      1f
  40         RD_PGDR_K r6
  41 1:
  42 #else
  43         bgeni   a2, 31
  44         WR_MCIR a2
  45         bgeni   a2, 25
  46         WR_MCIR a2
  47 #endif
  48         bclri   r6, 0
  49         lrw     a2, va_pa_offset
  50         ld.w    a2, (a2, 0)
  51         subu    r6, a2
  52         bseti   r6, 31
  53
  54         mov     a2, a3
  55         lsri    a2, _PGDIR_SHIFT
  56         lsli    a2, 2
  57         addu    r6, a2
  58         ldw     r6, (r6)
  59
  60         lrw     a2, va_pa_offset
  61         ld.w    a2, (a2, 0)
  62         subu    r6, a2
  63         bseti   r6, 31
  64
  65         lsri    a3, PTE_INDX_SHIFT
  66         lrw     a2, PTE_INDX_MSK
  67         and     a3, a2
  68         addu    r6, a3
  69         ldw     a3, (r6)
  70
  71         movi    a2, (_PAGE_PRESENT | \val0)
  72         and     a3, a2
  73         cmpne   a3, a2
  74         bt      \name
  75
  76         /* First read/write the page, just update the flags */
  77         ldw     a3, (r6)
  78         bgeni   a2, PAGE_VALID_BIT
  79         bseti   a2, PAGE_ACCESSED_BIT
  80         bseti   a2, \val1
  81         bseti   a2, \val2
  82         or      a3, a2
  83         stw     a3, (r6)
  84
  85         /* Some cpu tlb-hardrefill bypass the cache */
  86 #ifdef CONFIG_CPU_NEED_TLBSYNC
  87         movi    a2, 0x22
  88         bseti   a2, 6
  89         mtcr    r6, cr22
  90         mtcr    a2, cr17
  91         sync
  92 #endif
  93
  94         mfcr    a3, ss2
  95         mfcr    r6, ss3
  96         mfcr    a2, ss4
  97         rte
  98 \name:
  99         mfcr    a3, ss2
 100         mfcr    r6, ss3
 101         mfcr    a2, ss4
 102         SAVE_ALL 0
 103 .endm
 104 .macro tlbop_end is_write
 105         zero_fp
 106         RD_MEH  a2
 107         psrset  ee, ie
 108         mov     a0, sp
 109         movi    a1, \is_write
 110         jbsr    do_page_fault
 111         jmpi    ret_from_exception
 112 .endm
 113
 114 .text
 115
 116 tlbop_begin tlbinvalidl, _PAGE_READ, PAGE_VALID_BIT, PAGE_ACCESSED_BIT
 117 tlbop_end 0
 118
 119 tlbop_begin tlbinvalids, _PAGE_WRITE, PAGE_DIRTY_BIT, PAGE_MODIFIED_BIT
 120 tlbop_end 1
 121
 122 tlbop_begin tlbmodified, _PAGE_WRITE, PAGE_DIRTY_BIT, PAGE_MODIFIED_BIT
 123 #ifndef CONFIG_CPU_HAS_LDSTEX
 124 jbsr csky_cmpxchg_fixup
 125 #endif
 126 tlbop_end 1
 127
 128 ENTRY(csky_systemcall)
 129         SAVE_ALL TRAP0_SIZE
 130         zero_fp
 131
 132         psrset  ee, ie
 133
 134         lrw     r11, __NR_syscalls
 135         cmphs   syscallid, r11          /* Check nr of syscall */
 136         bt      ret_from_exception
 137
 138         lrw     r13, sys_call_table
 139         ixw     r13, syscallid
 140         ldw     r11, (r13)
 141         cmpnei  r11, 0
 142         bf      ret_from_exception
 143
 144         mov     r9, sp
 145         bmaski  r10, THREAD_SHIFT
 146         andn    r9, r10
 147         ldw     r12, (r9, TINFO_FLAGS)
 148         ANDI_R3 r12, (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_TRACEPOINT | _TIF_SYSCALL_AUDIT)
 149         cmpnei  r12, 0
 150         bt      csky_syscall_trace
 151 #if defined(__CSKYABIV2__)
 152         subi    sp, 8
 153         stw     r5, (sp, 0x4)
 154         stw     r4, (sp, 0x0)
 155         jsr     r11                      /* Do system call */
 156         addi    sp, 8
 157 #else
 158         jsr     r11
 159 #endif
 160         stw     a0, (sp, LSAVE_A0)      /* Save return value */
 161         jmpi    ret_from_exception
 162
 163 csky_syscall_trace:
 164         mov     a0, sp                  /* sp = pt_regs pointer */
 165         jbsr    syscall_trace_enter
 166         /* Prepare args before do system call */
 167         ldw     a0, (sp, LSAVE_A0)
 168         ldw     a1, (sp, LSAVE_A1)
 169         ldw     a2, (sp, LSAVE_A2)
 170         ldw     a3, (sp, LSAVE_A3)
 171 #if defined(__CSKYABIV2__)
 172         subi    sp, 8
 173         stw     r5, (sp, 0x4)
 174         stw     r4, (sp, 0x0)
 175 #else
 176         ldw     r6, (sp, LSAVE_A4)
 177         ldw     r7, (sp, LSAVE_A5)
 178 #endif
 179         jsr     r11                     /* Do system call */
 180 #if defined(__CSKYABIV2__)
 181         addi    sp, 8
 182 #endif
 183         stw     a0, (sp, LSAVE_A0)      /* Save return value */
 184
 185         mov     a0, sp                  /* right now, sp --> pt_regs */
 186         jbsr    syscall_trace_exit
 187         br      ret_from_exception
 188
 189 ENTRY(ret_from_kernel_thread)
 190         jbsr    schedule_tail
 191         mov     a0, r10
 192         jsr     r9
 193         jbsr    ret_from_exception
 194
 195 ENTRY(ret_from_fork)
 196         jbsr    schedule_tail
 197         mov     r9, sp
 198         bmaski  r10, THREAD_SHIFT
 199         andn    r9, r10
 200         ldw     r12, (r9, TINFO_FLAGS)
 201         ANDI_R3 r12, (_TIF_SYSCALL_TRACE | _TIF_SYSCALL_TRACEPOINT | _TIF_SYSCALL_AUDIT)
 202         cmpnei  r12, 0
 203         bf      ret_from_exception
 204         mov     a0, sp                  /* sp = pt_regs pointer */
 205         jbsr    syscall_trace_exit
 206
 207 ret_from_exception:
 208         ld      syscallid, (sp, LSAVE_PSR)
 209         btsti   syscallid, 31
 210         bt      1f
 211
 212         /*
 213          * Load address of current->thread_info, Then get address of task_struct
 214          * Get task_needreshed in task_struct
 215          */
 216         mov     r9, sp
 217         bmaski  r10, THREAD_SHIFT
 218         andn    r9, r10
 219
 220         ldw     r12, (r9, TINFO_FLAGS)
 221         andi    r12, (_TIF_SIGPENDING | _TIF_NOTIFY_RESUME | _TIF_NEED_RESCHED)
 222         cmpnei  r12, 0
 223         bt      exit_work
 224 1:
 225         RESTORE_ALL
 226
 227 exit_work:
 228         lrw     syscallid, ret_from_exception
 229         mov     lr, syscallid
 230
 231         btsti   r12, TIF_NEED_RESCHED
 232         bt      work_resched
 233
 234         mov     a0, sp
 235         mov     a1, r12
 236         jmpi    do_notify_resume
 237
 238 work_resched:
 239         jmpi    schedule
 240
 241 ENTRY(csky_trap)
 242         SAVE_ALL 0
 243         zero_fp
 244         psrset  ee
 245         mov     a0, sp                 /* Push Stack pointer arg */
 246         jbsr    trap_c                 /* Call C-level trap handler */
 247         jmpi    ret_from_exception
 248
 249 /*
 250  * Prototype from libc for abiv1:
 251  * register unsigned int __result asm("a0");
 252  * asm( "trap 3" :"=r"(__result)::);
 253  */
 254 ENTRY(csky_get_tls)
 255         USPTOKSP
 256
 257         /* increase epc for continue */
 258         mfcr    a0, epc
 259         addi    a0, TRAP0_SIZE
 260         mtcr    a0, epc
 261
 262         /* get current task thread_info with kernel 8K stack */
 263         bmaski  a0, THREAD_SHIFT
 264         not     a0
 265         subi    sp, 1
 266         and     a0, sp
 267         addi    sp, 1
 268
 269         /* get tls */
 270         ldw     a0, (a0, TINFO_TP_VALUE)
 271
 272         KSPTOUSP
 273         rte
 274
 275 ENTRY(csky_irq)
 276         SAVE_ALL 0
 277         zero_fp
 278         psrset  ee
 279
 280 #ifdef CONFIG_PREEMPT
 281         mov     r9, sp                  /* Get current stack  pointer */
 282         bmaski  r10, THREAD_SHIFT
 283         andn    r9, r10                 /* Get thread_info */
 284
 285         /*
 286          * Get task_struct->stack.preempt_count for current,
 287          * and increase 1.
 288          */
 289         ldw     r12, (r9, TINFO_PREEMPT)
 290         addi    r12, 1
 291         stw     r12, (r9, TINFO_PREEMPT)
 292 #endif
 293
 294         mov     a0, sp
 295         jbsr    csky_do_IRQ
 296
 297 #ifdef CONFIG_PREEMPT
 298         subi    r12, 1
 299         stw     r12, (r9, TINFO_PREEMPT)
 300         cmpnei  r12, 0
 301         bt      2f
 302         ldw     r12, (r9, TINFO_FLAGS)
 303         btsti   r12, TIF_NEED_RESCHED
 304         bf      2f
 305 1:
 306         jbsr    preempt_schedule_irq    /* irq en/disable is done inside */
 307         ldw     r7, (r9, TINFO_FLAGS)   /* get new tasks TI_FLAGS */
 308         btsti   r7, TIF_NEED_RESCHED
 309         bt      1b                      /* go again */
 310 #endif
 311 2:
 312         jmpi    ret_from_exception
 313
 314 /*
 315  * a0 =  prev task_struct *
 316  * a1 =  next task_struct *
 317  * a0 =  return next
 318  */
 319 ENTRY(__switch_to)
 320         lrw     a3, TASK_THREAD
 321         addu    a3, a0
 322
 323         mfcr    a2, psr                 /* Save PSR value */
 324         stw     a2, (a3, THREAD_SR)     /* Save PSR in task struct */
 325         bclri   a2, 6                   /* Disable interrupts */
 326         mtcr    a2, psr
 327
 328         SAVE_SWITCH_STACK
 329
 330         stw     sp, (a3, THREAD_KSP)
 331
 332         /* Set up next process to run */
 333         lrw     a3, TASK_THREAD
 334         addu    a3, a1
 335
 336         ldw     sp, (a3, THREAD_KSP)    /* Set next kernel sp */
 337
 338         ldw     a2, (a3, THREAD_SR)     /* Set next PSR */
 339         mtcr    a2, psr
 340
 341 #if  defined(__CSKYABIV2__)
 342         addi    r7, a1, TASK_THREAD_INFO
 343         ldw     tls, (r7, TINFO_TP_VALUE)
 344 #endif
 345
 346         RESTORE_SWITCH_STACK
 347
 348         rts
 349 ENDPROC(__switch_to)