1588cb88cSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 27db91e57SPalmer Dabbelt /* 37db91e57SPalmer Dabbelt * Copyright (C) 2009 Sunplus Core Technology Co., Ltd. 47db91e57SPalmer Dabbelt * Chen Liqin <[email protected]> 57db91e57SPalmer Dabbelt * Lennox Wu <[email protected]> 67db91e57SPalmer Dabbelt * Copyright (C) 2012 Regents of the University of California 77db91e57SPalmer Dabbelt * Copyright (C) 2017 SiFive 87db91e57SPalmer Dabbelt */ 97db91e57SPalmer Dabbelt 105ed881bcSPaul Walmsley #include <linux/cpu.h> 117db91e57SPalmer Dabbelt #include <linux/kernel.h> 127db91e57SPalmer Dabbelt #include <linux/sched.h> 137db91e57SPalmer Dabbelt #include <linux/sched/task_stack.h> 147db91e57SPalmer Dabbelt #include <linux/tick.h> 157db91e57SPalmer Dabbelt #include <linux/ptrace.h> 165e454b54SAl Viro #include <linux/uaccess.h> 177db91e57SPalmer Dabbelt 187db91e57SPalmer Dabbelt #include <asm/unistd.h> 197db91e57SPalmer Dabbelt #include <asm/processor.h> 207db91e57SPalmer Dabbelt #include <asm/csr.h> 217db91e57SPalmer Dabbelt #include <asm/string.h> 227db91e57SPalmer Dabbelt #include <asm/switch_to.h> 235ed881bcSPaul Walmsley #include <asm/thread_info.h> 247db91e57SPalmer Dabbelt 258356c379SPalmer Dabbelt register unsigned long gp_in_global __asm__("gp"); 2652e7c52dSPalmer Dabbelt 277db91e57SPalmer Dabbelt extern asmlinkage void ret_from_fork(void); 287db91e57SPalmer Dabbelt extern asmlinkage void ret_from_kernel_thread(void); 297db91e57SPalmer Dabbelt 307db91e57SPalmer Dabbelt void arch_cpu_idle(void) 317db91e57SPalmer Dabbelt { 327db91e57SPalmer Dabbelt wait_for_interrupt(); 337db91e57SPalmer Dabbelt local_irq_enable(); 347db91e57SPalmer Dabbelt } 357db91e57SPalmer Dabbelt 367db91e57SPalmer Dabbelt void show_regs(struct pt_regs *regs) 377db91e57SPalmer Dabbelt { 387db91e57SPalmer Dabbelt show_regs_print_info(KERN_DEFAULT); 397db91e57SPalmer Dabbelt 40a4c3733dSChristoph Hellwig pr_cont("epc: " REG_FMT " ra : " REG_FMT " sp : " REG_FMT "\n", 41a4c3733dSChristoph Hellwig regs->epc, regs->ra, regs->sp); 427db91e57SPalmer Dabbelt pr_cont(" gp : " REG_FMT " tp : " REG_FMT " t0 : " REG_FMT "\n", 437db91e57SPalmer Dabbelt regs->gp, regs->tp, regs->t0); 447db91e57SPalmer Dabbelt pr_cont(" t1 : " REG_FMT " t2 : " REG_FMT " s0 : " REG_FMT "\n", 457db91e57SPalmer Dabbelt regs->t1, regs->t2, regs->s0); 467db91e57SPalmer Dabbelt pr_cont(" s1 : " REG_FMT " a0 : " REG_FMT " a1 : " REG_FMT "\n", 477db91e57SPalmer Dabbelt regs->s1, regs->a0, regs->a1); 487db91e57SPalmer Dabbelt pr_cont(" a2 : " REG_FMT " a3 : " REG_FMT " a4 : " REG_FMT "\n", 497db91e57SPalmer Dabbelt regs->a2, regs->a3, regs->a4); 507db91e57SPalmer Dabbelt pr_cont(" a5 : " REG_FMT " a6 : " REG_FMT " a7 : " REG_FMT "\n", 517db91e57SPalmer Dabbelt regs->a5, regs->a6, regs->a7); 527db91e57SPalmer Dabbelt pr_cont(" s2 : " REG_FMT " s3 : " REG_FMT " s4 : " REG_FMT "\n", 537db91e57SPalmer Dabbelt regs->s2, regs->s3, regs->s4); 547db91e57SPalmer Dabbelt pr_cont(" s5 : " REG_FMT " s6 : " REG_FMT " s7 : " REG_FMT "\n", 557db91e57SPalmer Dabbelt regs->s5, regs->s6, regs->s7); 567db91e57SPalmer Dabbelt pr_cont(" s8 : " REG_FMT " s9 : " REG_FMT " s10: " REG_FMT "\n", 577db91e57SPalmer Dabbelt regs->s8, regs->s9, regs->s10); 587db91e57SPalmer Dabbelt pr_cont(" s11: " REG_FMT " t3 : " REG_FMT " t4 : " REG_FMT "\n", 597db91e57SPalmer Dabbelt regs->s11, regs->t3, regs->t4); 607db91e57SPalmer Dabbelt pr_cont(" t5 : " REG_FMT " t6 : " REG_FMT "\n", 617db91e57SPalmer Dabbelt regs->t5, regs->t6); 627db91e57SPalmer Dabbelt 63a4c3733dSChristoph Hellwig pr_cont("status: " REG_FMT " badaddr: " REG_FMT " cause: " REG_FMT "\n", 64a4c3733dSChristoph Hellwig regs->status, regs->badaddr, regs->cause); 657db91e57SPalmer Dabbelt } 667db91e57SPalmer Dabbelt 677db91e57SPalmer Dabbelt void start_thread(struct pt_regs *regs, unsigned long pc, 687db91e57SPalmer Dabbelt unsigned long sp) 697db91e57SPalmer Dabbelt { 70a4c3733dSChristoph Hellwig regs->status = SR_PIE; 718ac71d7eSVincent Chen if (has_fpu) { 72a4c3733dSChristoph Hellwig regs->status |= SR_FS_INITIAL; 738ac71d7eSVincent Chen /* 748ac71d7eSVincent Chen * Restore the initial value to the FP register 758ac71d7eSVincent Chen * before starting the user program. 768ac71d7eSVincent Chen */ 778ac71d7eSVincent Chen fstate_restore(current, regs); 788ac71d7eSVincent Chen } 79a4c3733dSChristoph Hellwig regs->epc = pc; 807db91e57SPalmer Dabbelt regs->sp = sp; 817db91e57SPalmer Dabbelt set_fs(USER_DS); 827db91e57SPalmer Dabbelt } 837db91e57SPalmer Dabbelt 847db91e57SPalmer Dabbelt void flush_thread(void) 857db91e57SPalmer Dabbelt { 869671f706SAlan Kao #ifdef CONFIG_FPU 877db91e57SPalmer Dabbelt /* 888ac71d7eSVincent Chen * Reset FPU state and context 897db91e57SPalmer Dabbelt * frm: round to nearest, ties to even (IEEE default) 907db91e57SPalmer Dabbelt * fflags: accrued exceptions cleared 917db91e57SPalmer Dabbelt */ 928ac71d7eSVincent Chen fstate_off(current, task_pt_regs(current)); 937db91e57SPalmer Dabbelt memset(¤t->thread.fstate, 0, sizeof(current->thread.fstate)); 949671f706SAlan Kao #endif 957db91e57SPalmer Dabbelt } 967db91e57SPalmer Dabbelt 977db91e57SPalmer Dabbelt int arch_dup_task_struct(struct task_struct *dst, struct task_struct *src) 987db91e57SPalmer Dabbelt { 997db91e57SPalmer Dabbelt fstate_save(src, task_pt_regs(src)); 1007db91e57SPalmer Dabbelt *dst = *src; 1017db91e57SPalmer Dabbelt return 0; 1027db91e57SPalmer Dabbelt } 1037db91e57SPalmer Dabbelt 104*714acdbdSChristian Brauner int copy_thread(unsigned long clone_flags, unsigned long usp, unsigned long arg, 105*714acdbdSChristian Brauner struct task_struct *p, unsigned long tls) 1067db91e57SPalmer Dabbelt { 1077db91e57SPalmer Dabbelt struct pt_regs *childregs = task_pt_regs(p); 1087db91e57SPalmer Dabbelt 1097db91e57SPalmer Dabbelt /* p->thread holds context to be restored by __switch_to() */ 1107db91e57SPalmer Dabbelt if (unlikely(p->flags & PF_KTHREAD)) { 1117db91e57SPalmer Dabbelt /* Kernel thread */ 1127db91e57SPalmer Dabbelt memset(childregs, 0, sizeof(struct pt_regs)); 11352e7c52dSPalmer Dabbelt childregs->gp = gp_in_global; 114a4c3733dSChristoph Hellwig /* Supervisor/Machine, irqs on: */ 115a4c3733dSChristoph Hellwig childregs->status = SR_PP | SR_PIE; 1167db91e57SPalmer Dabbelt 1177db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_kernel_thread; 1187db91e57SPalmer Dabbelt p->thread.s[0] = usp; /* fn */ 1197db91e57SPalmer Dabbelt p->thread.s[1] = arg; 1207db91e57SPalmer Dabbelt } else { 1217db91e57SPalmer Dabbelt *childregs = *(current_pt_regs()); 1227db91e57SPalmer Dabbelt if (usp) /* User fork */ 1237db91e57SPalmer Dabbelt childregs->sp = usp; 1247db91e57SPalmer Dabbelt if (clone_flags & CLONE_SETTLS) 12520bda4edSAmanieu d'Antras childregs->tp = tls; 1267db91e57SPalmer Dabbelt childregs->a0 = 0; /* Return value of fork() */ 1277db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_fork; 1287db91e57SPalmer Dabbelt } 1297db91e57SPalmer Dabbelt p->thread.sp = (unsigned long)childregs; /* kernel sp */ 1307db91e57SPalmer Dabbelt return 0; 1317db91e57SPalmer Dabbelt } 132