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 257db91e57SPalmer Dabbelt extern asmlinkage void ret_from_fork(void); 267db91e57SPalmer Dabbelt extern asmlinkage void ret_from_kernel_thread(void); 277db91e57SPalmer Dabbelt 287db91e57SPalmer Dabbelt void arch_cpu_idle(void) 297db91e57SPalmer Dabbelt { 307db91e57SPalmer Dabbelt wait_for_interrupt(); 317db91e57SPalmer Dabbelt local_irq_enable(); 327db91e57SPalmer Dabbelt } 337db91e57SPalmer Dabbelt 347db91e57SPalmer Dabbelt void show_regs(struct pt_regs *regs) 357db91e57SPalmer Dabbelt { 367db91e57SPalmer Dabbelt show_regs_print_info(KERN_DEFAULT); 377db91e57SPalmer Dabbelt 38*a4c3733dSChristoph Hellwig pr_cont("epc: " REG_FMT " ra : " REG_FMT " sp : " REG_FMT "\n", 39*a4c3733dSChristoph Hellwig regs->epc, regs->ra, regs->sp); 407db91e57SPalmer Dabbelt pr_cont(" gp : " REG_FMT " tp : " REG_FMT " t0 : " REG_FMT "\n", 417db91e57SPalmer Dabbelt regs->gp, regs->tp, regs->t0); 427db91e57SPalmer Dabbelt pr_cont(" t1 : " REG_FMT " t2 : " REG_FMT " s0 : " REG_FMT "\n", 437db91e57SPalmer Dabbelt regs->t1, regs->t2, regs->s0); 447db91e57SPalmer Dabbelt pr_cont(" s1 : " REG_FMT " a0 : " REG_FMT " a1 : " REG_FMT "\n", 457db91e57SPalmer Dabbelt regs->s1, regs->a0, regs->a1); 467db91e57SPalmer Dabbelt pr_cont(" a2 : " REG_FMT " a3 : " REG_FMT " a4 : " REG_FMT "\n", 477db91e57SPalmer Dabbelt regs->a2, regs->a3, regs->a4); 487db91e57SPalmer Dabbelt pr_cont(" a5 : " REG_FMT " a6 : " REG_FMT " a7 : " REG_FMT "\n", 497db91e57SPalmer Dabbelt regs->a5, regs->a6, regs->a7); 507db91e57SPalmer Dabbelt pr_cont(" s2 : " REG_FMT " s3 : " REG_FMT " s4 : " REG_FMT "\n", 517db91e57SPalmer Dabbelt regs->s2, regs->s3, regs->s4); 527db91e57SPalmer Dabbelt pr_cont(" s5 : " REG_FMT " s6 : " REG_FMT " s7 : " REG_FMT "\n", 537db91e57SPalmer Dabbelt regs->s5, regs->s6, regs->s7); 547db91e57SPalmer Dabbelt pr_cont(" s8 : " REG_FMT " s9 : " REG_FMT " s10: " REG_FMT "\n", 557db91e57SPalmer Dabbelt regs->s8, regs->s9, regs->s10); 567db91e57SPalmer Dabbelt pr_cont(" s11: " REG_FMT " t3 : " REG_FMT " t4 : " REG_FMT "\n", 577db91e57SPalmer Dabbelt regs->s11, regs->t3, regs->t4); 587db91e57SPalmer Dabbelt pr_cont(" t5 : " REG_FMT " t6 : " REG_FMT "\n", 597db91e57SPalmer Dabbelt regs->t5, regs->t6); 607db91e57SPalmer Dabbelt 61*a4c3733dSChristoph Hellwig pr_cont("status: " REG_FMT " badaddr: " REG_FMT " cause: " REG_FMT "\n", 62*a4c3733dSChristoph Hellwig regs->status, regs->badaddr, regs->cause); 637db91e57SPalmer Dabbelt } 647db91e57SPalmer Dabbelt 657db91e57SPalmer Dabbelt void start_thread(struct pt_regs *regs, unsigned long pc, 667db91e57SPalmer Dabbelt unsigned long sp) 677db91e57SPalmer Dabbelt { 68*a4c3733dSChristoph Hellwig regs->status = SR_PIE; 698ac71d7eSVincent Chen if (has_fpu) { 70*a4c3733dSChristoph Hellwig regs->status |= SR_FS_INITIAL; 718ac71d7eSVincent Chen /* 728ac71d7eSVincent Chen * Restore the initial value to the FP register 738ac71d7eSVincent Chen * before starting the user program. 748ac71d7eSVincent Chen */ 758ac71d7eSVincent Chen fstate_restore(current, regs); 768ac71d7eSVincent Chen } 77*a4c3733dSChristoph Hellwig regs->epc = pc; 787db91e57SPalmer Dabbelt regs->sp = sp; 797db91e57SPalmer Dabbelt set_fs(USER_DS); 807db91e57SPalmer Dabbelt } 817db91e57SPalmer Dabbelt 827db91e57SPalmer Dabbelt void flush_thread(void) 837db91e57SPalmer Dabbelt { 849671f706SAlan Kao #ifdef CONFIG_FPU 857db91e57SPalmer Dabbelt /* 868ac71d7eSVincent Chen * Reset FPU state and context 877db91e57SPalmer Dabbelt * frm: round to nearest, ties to even (IEEE default) 887db91e57SPalmer Dabbelt * fflags: accrued exceptions cleared 897db91e57SPalmer Dabbelt */ 908ac71d7eSVincent Chen fstate_off(current, task_pt_regs(current)); 917db91e57SPalmer Dabbelt memset(¤t->thread.fstate, 0, sizeof(current->thread.fstate)); 929671f706SAlan Kao #endif 937db91e57SPalmer Dabbelt } 947db91e57SPalmer Dabbelt 957db91e57SPalmer Dabbelt int arch_dup_task_struct(struct task_struct *dst, struct task_struct *src) 967db91e57SPalmer Dabbelt { 977db91e57SPalmer Dabbelt fstate_save(src, task_pt_regs(src)); 987db91e57SPalmer Dabbelt *dst = *src; 997db91e57SPalmer Dabbelt return 0; 1007db91e57SPalmer Dabbelt } 1017db91e57SPalmer Dabbelt 1027db91e57SPalmer Dabbelt int copy_thread(unsigned long clone_flags, unsigned long usp, 1037db91e57SPalmer Dabbelt unsigned long arg, struct task_struct *p) 1047db91e57SPalmer Dabbelt { 1057db91e57SPalmer Dabbelt struct pt_regs *childregs = task_pt_regs(p); 1067db91e57SPalmer Dabbelt 1077db91e57SPalmer Dabbelt /* p->thread holds context to be restored by __switch_to() */ 1087db91e57SPalmer Dabbelt if (unlikely(p->flags & PF_KTHREAD)) { 1097db91e57SPalmer Dabbelt /* Kernel thread */ 1107db91e57SPalmer Dabbelt const register unsigned long gp __asm__ ("gp"); 1117db91e57SPalmer Dabbelt memset(childregs, 0, sizeof(struct pt_regs)); 1127db91e57SPalmer Dabbelt childregs->gp = gp; 113*a4c3733dSChristoph Hellwig /* Supervisor/Machine, irqs on: */ 114*a4c3733dSChristoph Hellwig childregs->status = SR_PP | SR_PIE; 1157db91e57SPalmer Dabbelt 1167db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_kernel_thread; 1177db91e57SPalmer Dabbelt p->thread.s[0] = usp; /* fn */ 1187db91e57SPalmer Dabbelt p->thread.s[1] = arg; 1197db91e57SPalmer Dabbelt } else { 1207db91e57SPalmer Dabbelt *childregs = *(current_pt_regs()); 1217db91e57SPalmer Dabbelt if (usp) /* User fork */ 1227db91e57SPalmer Dabbelt childregs->sp = usp; 1237db91e57SPalmer Dabbelt if (clone_flags & CLONE_SETTLS) 1247db91e57SPalmer Dabbelt childregs->tp = childregs->a5; 1257db91e57SPalmer Dabbelt childregs->a0 = 0; /* Return value of fork() */ 1267db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_fork; 1277db91e57SPalmer Dabbelt } 1287db91e57SPalmer Dabbelt p->thread.sp = (unsigned long)childregs; /* kernel sp */ 1297db91e57SPalmer Dabbelt return 0; 1307db91e57SPalmer Dabbelt } 131