17db91e57SPalmer Dabbelt /* 27db91e57SPalmer Dabbelt * Copyright (C) 2009 Sunplus Core Technology Co., Ltd. 37db91e57SPalmer Dabbelt * Chen Liqin <[email protected]> 47db91e57SPalmer Dabbelt * Lennox Wu <[email protected]> 57db91e57SPalmer Dabbelt * Copyright (C) 2012 Regents of the University of California 67db91e57SPalmer Dabbelt * Copyright (C) 2017 SiFive 77db91e57SPalmer Dabbelt * 87db91e57SPalmer Dabbelt * This program is free software; you can redistribute it and/or modify 97db91e57SPalmer Dabbelt * it under the terms of the GNU General Public License as published by 107db91e57SPalmer Dabbelt * the Free Software Foundation; either version 2 of the License, or 117db91e57SPalmer Dabbelt * (at your option) any later version. 127db91e57SPalmer Dabbelt * 137db91e57SPalmer Dabbelt * This program is distributed in the hope that it will be useful, 147db91e57SPalmer Dabbelt * but WITHOUT ANY WARRANTY; without even the implied warranty of 157db91e57SPalmer Dabbelt * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 167db91e57SPalmer Dabbelt * GNU General Public License for more details. 177db91e57SPalmer Dabbelt * 187db91e57SPalmer Dabbelt * You should have received a copy of the GNU General Public License 197db91e57SPalmer Dabbelt * along with this program; if not, see the file COPYING, or write 207db91e57SPalmer Dabbelt * to the Free Software Foundation, Inc., 217db91e57SPalmer Dabbelt */ 227db91e57SPalmer Dabbelt 237db91e57SPalmer Dabbelt #include <linux/kernel.h> 247db91e57SPalmer Dabbelt #include <linux/sched.h> 257db91e57SPalmer Dabbelt #include <linux/sched/task_stack.h> 267db91e57SPalmer Dabbelt #include <linux/tick.h> 277db91e57SPalmer Dabbelt #include <linux/ptrace.h> 285e454b54SAl Viro #include <linux/uaccess.h> 297db91e57SPalmer Dabbelt 307db91e57SPalmer Dabbelt #include <asm/unistd.h> 317db91e57SPalmer Dabbelt #include <asm/processor.h> 327db91e57SPalmer Dabbelt #include <asm/csr.h> 337db91e57SPalmer Dabbelt #include <asm/string.h> 347db91e57SPalmer Dabbelt #include <asm/switch_to.h> 357db91e57SPalmer Dabbelt 367db91e57SPalmer Dabbelt extern asmlinkage void ret_from_fork(void); 377db91e57SPalmer Dabbelt extern asmlinkage void ret_from_kernel_thread(void); 387db91e57SPalmer Dabbelt 397db91e57SPalmer Dabbelt void arch_cpu_idle(void) 407db91e57SPalmer Dabbelt { 417db91e57SPalmer Dabbelt wait_for_interrupt(); 427db91e57SPalmer Dabbelt local_irq_enable(); 437db91e57SPalmer Dabbelt } 447db91e57SPalmer Dabbelt 457db91e57SPalmer Dabbelt void show_regs(struct pt_regs *regs) 467db91e57SPalmer Dabbelt { 477db91e57SPalmer Dabbelt show_regs_print_info(KERN_DEFAULT); 487db91e57SPalmer Dabbelt 497db91e57SPalmer Dabbelt pr_cont("sepc: " REG_FMT " ra : " REG_FMT " sp : " REG_FMT "\n", 507db91e57SPalmer Dabbelt regs->sepc, regs->ra, regs->sp); 517db91e57SPalmer Dabbelt pr_cont(" gp : " REG_FMT " tp : " REG_FMT " t0 : " REG_FMT "\n", 527db91e57SPalmer Dabbelt regs->gp, regs->tp, regs->t0); 537db91e57SPalmer Dabbelt pr_cont(" t1 : " REG_FMT " t2 : " REG_FMT " s0 : " REG_FMT "\n", 547db91e57SPalmer Dabbelt regs->t1, regs->t2, regs->s0); 557db91e57SPalmer Dabbelt pr_cont(" s1 : " REG_FMT " a0 : " REG_FMT " a1 : " REG_FMT "\n", 567db91e57SPalmer Dabbelt regs->s1, regs->a0, regs->a1); 577db91e57SPalmer Dabbelt pr_cont(" a2 : " REG_FMT " a3 : " REG_FMT " a4 : " REG_FMT "\n", 587db91e57SPalmer Dabbelt regs->a2, regs->a3, regs->a4); 597db91e57SPalmer Dabbelt pr_cont(" a5 : " REG_FMT " a6 : " REG_FMT " a7 : " REG_FMT "\n", 607db91e57SPalmer Dabbelt regs->a5, regs->a6, regs->a7); 617db91e57SPalmer Dabbelt pr_cont(" s2 : " REG_FMT " s3 : " REG_FMT " s4 : " REG_FMT "\n", 627db91e57SPalmer Dabbelt regs->s2, regs->s3, regs->s4); 637db91e57SPalmer Dabbelt pr_cont(" s5 : " REG_FMT " s6 : " REG_FMT " s7 : " REG_FMT "\n", 647db91e57SPalmer Dabbelt regs->s5, regs->s6, regs->s7); 657db91e57SPalmer Dabbelt pr_cont(" s8 : " REG_FMT " s9 : " REG_FMT " s10: " REG_FMT "\n", 667db91e57SPalmer Dabbelt regs->s8, regs->s9, regs->s10); 677db91e57SPalmer Dabbelt pr_cont(" s11: " REG_FMT " t3 : " REG_FMT " t4 : " REG_FMT "\n", 687db91e57SPalmer Dabbelt regs->s11, regs->t3, regs->t4); 697db91e57SPalmer Dabbelt pr_cont(" t5 : " REG_FMT " t6 : " REG_FMT "\n", 707db91e57SPalmer Dabbelt regs->t5, regs->t6); 717db91e57SPalmer Dabbelt 727db91e57SPalmer Dabbelt pr_cont("sstatus: " REG_FMT " sbadaddr: " REG_FMT " scause: " REG_FMT "\n", 737db91e57SPalmer Dabbelt regs->sstatus, regs->sbadaddr, regs->scause); 747db91e57SPalmer Dabbelt } 757db91e57SPalmer Dabbelt 767db91e57SPalmer Dabbelt void start_thread(struct pt_regs *regs, unsigned long pc, 777db91e57SPalmer Dabbelt unsigned long sp) 787db91e57SPalmer Dabbelt { 79*9671f706SAlan Kao regs->sstatus = DEFAULT_SSTATUS; 807db91e57SPalmer Dabbelt regs->sepc = pc; 817db91e57SPalmer Dabbelt regs->sp = sp; 827db91e57SPalmer Dabbelt set_fs(USER_DS); 837db91e57SPalmer Dabbelt } 847db91e57SPalmer Dabbelt 857db91e57SPalmer Dabbelt void flush_thread(void) 867db91e57SPalmer Dabbelt { 87*9671f706SAlan Kao #ifdef CONFIG_FPU 887db91e57SPalmer Dabbelt /* 897db91e57SPalmer Dabbelt * Reset FPU context 907db91e57SPalmer Dabbelt * frm: round to nearest, ties to even (IEEE default) 917db91e57SPalmer Dabbelt * fflags: accrued exceptions cleared 927db91e57SPalmer Dabbelt */ 937db91e57SPalmer Dabbelt memset(¤t->thread.fstate, 0, sizeof(current->thread.fstate)); 94*9671f706SAlan 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 1047db91e57SPalmer Dabbelt int copy_thread(unsigned long clone_flags, unsigned long usp, 1057db91e57SPalmer Dabbelt unsigned long arg, struct task_struct *p) 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 const register unsigned long gp __asm__ ("gp"); 1137db91e57SPalmer Dabbelt memset(childregs, 0, sizeof(struct pt_regs)); 1147db91e57SPalmer Dabbelt childregs->gp = gp; 1151125203cSChristoph Hellwig childregs->sstatus = SR_SPP | SR_SPIE; /* Supervisor, irqs on */ 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) 1257db91e57SPalmer Dabbelt childregs->tp = childregs->a5; 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