1*588cb88cSThomas 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 107db91e57SPalmer Dabbelt #include <linux/kernel.h> 117db91e57SPalmer Dabbelt #include <linux/sched.h> 127db91e57SPalmer Dabbelt #include <linux/sched/task_stack.h> 137db91e57SPalmer Dabbelt #include <linux/tick.h> 147db91e57SPalmer Dabbelt #include <linux/ptrace.h> 155e454b54SAl Viro #include <linux/uaccess.h> 167db91e57SPalmer Dabbelt 177db91e57SPalmer Dabbelt #include <asm/unistd.h> 187db91e57SPalmer Dabbelt #include <asm/processor.h> 197db91e57SPalmer Dabbelt #include <asm/csr.h> 207db91e57SPalmer Dabbelt #include <asm/string.h> 217db91e57SPalmer Dabbelt #include <asm/switch_to.h> 227db91e57SPalmer Dabbelt 237db91e57SPalmer Dabbelt extern asmlinkage void ret_from_fork(void); 247db91e57SPalmer Dabbelt extern asmlinkage void ret_from_kernel_thread(void); 257db91e57SPalmer Dabbelt 267db91e57SPalmer Dabbelt void arch_cpu_idle(void) 277db91e57SPalmer Dabbelt { 287db91e57SPalmer Dabbelt wait_for_interrupt(); 297db91e57SPalmer Dabbelt local_irq_enable(); 307db91e57SPalmer Dabbelt } 317db91e57SPalmer Dabbelt 327db91e57SPalmer Dabbelt void show_regs(struct pt_regs *regs) 337db91e57SPalmer Dabbelt { 347db91e57SPalmer Dabbelt show_regs_print_info(KERN_DEFAULT); 357db91e57SPalmer Dabbelt 367db91e57SPalmer Dabbelt pr_cont("sepc: " REG_FMT " ra : " REG_FMT " sp : " REG_FMT "\n", 377db91e57SPalmer Dabbelt regs->sepc, regs->ra, regs->sp); 387db91e57SPalmer Dabbelt pr_cont(" gp : " REG_FMT " tp : " REG_FMT " t0 : " REG_FMT "\n", 397db91e57SPalmer Dabbelt regs->gp, regs->tp, regs->t0); 407db91e57SPalmer Dabbelt pr_cont(" t1 : " REG_FMT " t2 : " REG_FMT " s0 : " REG_FMT "\n", 417db91e57SPalmer Dabbelt regs->t1, regs->t2, regs->s0); 427db91e57SPalmer Dabbelt pr_cont(" s1 : " REG_FMT " a0 : " REG_FMT " a1 : " REG_FMT "\n", 437db91e57SPalmer Dabbelt regs->s1, regs->a0, regs->a1); 447db91e57SPalmer Dabbelt pr_cont(" a2 : " REG_FMT " a3 : " REG_FMT " a4 : " REG_FMT "\n", 457db91e57SPalmer Dabbelt regs->a2, regs->a3, regs->a4); 467db91e57SPalmer Dabbelt pr_cont(" a5 : " REG_FMT " a6 : " REG_FMT " a7 : " REG_FMT "\n", 477db91e57SPalmer Dabbelt regs->a5, regs->a6, regs->a7); 487db91e57SPalmer Dabbelt pr_cont(" s2 : " REG_FMT " s3 : " REG_FMT " s4 : " REG_FMT "\n", 497db91e57SPalmer Dabbelt regs->s2, regs->s3, regs->s4); 507db91e57SPalmer Dabbelt pr_cont(" s5 : " REG_FMT " s6 : " REG_FMT " s7 : " REG_FMT "\n", 517db91e57SPalmer Dabbelt regs->s5, regs->s6, regs->s7); 527db91e57SPalmer Dabbelt pr_cont(" s8 : " REG_FMT " s9 : " REG_FMT " s10: " REG_FMT "\n", 537db91e57SPalmer Dabbelt regs->s8, regs->s9, regs->s10); 547db91e57SPalmer Dabbelt pr_cont(" s11: " REG_FMT " t3 : " REG_FMT " t4 : " REG_FMT "\n", 557db91e57SPalmer Dabbelt regs->s11, regs->t3, regs->t4); 567db91e57SPalmer Dabbelt pr_cont(" t5 : " REG_FMT " t6 : " REG_FMT "\n", 577db91e57SPalmer Dabbelt regs->t5, regs->t6); 587db91e57SPalmer Dabbelt 597db91e57SPalmer Dabbelt pr_cont("sstatus: " REG_FMT " sbadaddr: " REG_FMT " scause: " REG_FMT "\n", 607db91e57SPalmer Dabbelt regs->sstatus, regs->sbadaddr, regs->scause); 617db91e57SPalmer Dabbelt } 627db91e57SPalmer Dabbelt 637db91e57SPalmer Dabbelt void start_thread(struct pt_regs *regs, unsigned long pc, 647db91e57SPalmer Dabbelt unsigned long sp) 657db91e57SPalmer Dabbelt { 669411ec60SAlan Kao regs->sstatus = SR_SPIE; 679411ec60SAlan Kao if (has_fpu) 689411ec60SAlan Kao regs->sstatus |= SR_FS_INITIAL; 697db91e57SPalmer Dabbelt regs->sepc = pc; 707db91e57SPalmer Dabbelt regs->sp = sp; 717db91e57SPalmer Dabbelt set_fs(USER_DS); 727db91e57SPalmer Dabbelt } 737db91e57SPalmer Dabbelt 747db91e57SPalmer Dabbelt void flush_thread(void) 757db91e57SPalmer Dabbelt { 769671f706SAlan Kao #ifdef CONFIG_FPU 777db91e57SPalmer Dabbelt /* 787db91e57SPalmer Dabbelt * Reset FPU context 797db91e57SPalmer Dabbelt * frm: round to nearest, ties to even (IEEE default) 807db91e57SPalmer Dabbelt * fflags: accrued exceptions cleared 817db91e57SPalmer Dabbelt */ 827db91e57SPalmer Dabbelt memset(¤t->thread.fstate, 0, sizeof(current->thread.fstate)); 839671f706SAlan Kao #endif 847db91e57SPalmer Dabbelt } 857db91e57SPalmer Dabbelt 867db91e57SPalmer Dabbelt int arch_dup_task_struct(struct task_struct *dst, struct task_struct *src) 877db91e57SPalmer Dabbelt { 887db91e57SPalmer Dabbelt fstate_save(src, task_pt_regs(src)); 897db91e57SPalmer Dabbelt *dst = *src; 907db91e57SPalmer Dabbelt return 0; 917db91e57SPalmer Dabbelt } 927db91e57SPalmer Dabbelt 937db91e57SPalmer Dabbelt int copy_thread(unsigned long clone_flags, unsigned long usp, 947db91e57SPalmer Dabbelt unsigned long arg, struct task_struct *p) 957db91e57SPalmer Dabbelt { 967db91e57SPalmer Dabbelt struct pt_regs *childregs = task_pt_regs(p); 977db91e57SPalmer Dabbelt 987db91e57SPalmer Dabbelt /* p->thread holds context to be restored by __switch_to() */ 997db91e57SPalmer Dabbelt if (unlikely(p->flags & PF_KTHREAD)) { 1007db91e57SPalmer Dabbelt /* Kernel thread */ 1017db91e57SPalmer Dabbelt const register unsigned long gp __asm__ ("gp"); 1027db91e57SPalmer Dabbelt memset(childregs, 0, sizeof(struct pt_regs)); 1037db91e57SPalmer Dabbelt childregs->gp = gp; 1041125203cSChristoph Hellwig childregs->sstatus = SR_SPP | SR_SPIE; /* Supervisor, irqs on */ 1057db91e57SPalmer Dabbelt 1067db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_kernel_thread; 1077db91e57SPalmer Dabbelt p->thread.s[0] = usp; /* fn */ 1087db91e57SPalmer Dabbelt p->thread.s[1] = arg; 1097db91e57SPalmer Dabbelt } else { 1107db91e57SPalmer Dabbelt *childregs = *(current_pt_regs()); 1117db91e57SPalmer Dabbelt if (usp) /* User fork */ 1127db91e57SPalmer Dabbelt childregs->sp = usp; 1137db91e57SPalmer Dabbelt if (clone_flags & CLONE_SETTLS) 1147db91e57SPalmer Dabbelt childregs->tp = childregs->a5; 1157db91e57SPalmer Dabbelt childregs->a0 = 0; /* Return value of fork() */ 1167db91e57SPalmer Dabbelt p->thread.ra = (unsigned long)ret_from_fork; 1177db91e57SPalmer Dabbelt } 1187db91e57SPalmer Dabbelt p->thread.sp = (unsigned long)childregs; /* kernel sp */ 1197db91e57SPalmer Dabbelt return 0; 1207db91e57SPalmer Dabbelt } 121