151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* 251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Copyright (C) 2000-2003 Axis Communications AB 351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * 451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Authors: Bjorn Wesen (bjornw@axis.com) 551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Mikael Starvik (starvik@axis.com) 651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Tobias Anderberg (tobiasa@axis.com), CRISv32 port. 751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * 851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * This file handles the architecture-dependent parts of process handling.. 951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 1051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 1151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#include <linux/sched.h> 125a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/slab.h> 1351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#include <linux/err.h> 1451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#include <linux/fs.h> 158cca29b7137a08f25b05e1cddf7dbc8fe8dfad05Jesper Nilsson#include <hwregs/reg_rdwr.h> 168cca29b7137a08f25b05e1cddf7dbc8fe8dfad05Jesper Nilsson#include <hwregs/reg_map.h> 178cca29b7137a08f25b05e1cddf7dbc8fe8dfad05Jesper Nilsson#include <hwregs/timer_defs.h> 188cca29b7137a08f25b05e1cddf7dbc8fe8dfad05Jesper Nilsson#include <hwregs/intr_vect_defs.h> 1927d892fb27f492921cfd6df15ab4153f1badbb46Al Viro#include <linux/ptrace.h> 2051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 2151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikextern void stop_watchdog(void); 2251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 2351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* We use this if we don't have any better idle routine. */ 2451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikvoid default_idle(void) 2551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 268dc7c5ecd8d0f739728d844ee794c4fae169f9c2Thomas Gleixner /* Halt until exception. */ 278dc7c5ecd8d0f739728d844ee794c4fae169f9c2Thomas Gleixner __asm__ volatile("ei \n\t" 288dc7c5ecd8d0f739728d844ee794c4fae169f9c2Thomas Gleixner "halt "); 2951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 3051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 3151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* 3251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Free current thread data structures etc.. 3351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 3451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 3551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikextern void deconfigure_bp(long pid); 3651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikvoid exit_thread(void) 3751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 3851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik deconfigure_bp(current->pid); 3951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 4051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 4151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* 4251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * If the watchdog is enabled, disable interrupts and enter an infinite loop. 4351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * The watchdog will reset the CPU after 0.1s. If the watchdog isn't enabled 4451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * then enable it and wait. 4551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 4651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikextern void arch_enable_nmi(void); 4751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 4851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikvoid 4951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikhard_reset_now(void) 5051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 5151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* 5251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Don't declare this variable elsewhere. We don't want any other 5351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * code to know about it than the watchdog handler in entry.S and 5451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * this code, implementing hard reset through the watchdog. 5551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 5651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#if defined(CONFIG_ETRAX_WATCHDOG) 5751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik extern int cause_of_death; 5851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#endif 5951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 6051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk("*** HARD RESET ***\n"); 6151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik local_irq_disable(); 6251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 6351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#if defined(CONFIG_ETRAX_WATCHDOG) 6451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik cause_of_death = 0xbedead; 6551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#else 6651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 6751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik reg_timer_rw_wd_ctrl wd_ctrl = {0}; 6851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 6951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik stop_watchdog(); 7051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 7151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik wd_ctrl.key = 16; /* Arbitrary key. */ 7251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik wd_ctrl.cnt = 1; /* Minimum time. */ 7351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik wd_ctrl.cmd = regk_timer_start; 7451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 7551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik arch_enable_nmi(); 768cca29b7137a08f25b05e1cddf7dbc8fe8dfad05Jesper Nilsson REG_WR(timer, regi_timer0, rw_wd_ctrl, wd_ctrl); 7751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 7851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#endif 7951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 8051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik while (1) 8151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik ; /* Wait for reset. */ 8251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 8351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 8451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* 8551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Return saved PC of a blocked thread. 8651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 8751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikunsigned long thread_saved_pc(struct task_struct *t) 8851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 8995ca0dc603ab58f3e4c5a1c23f675bd1f5b5fef3Al Viro return task_pt_regs(t)->erp; 9051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 9151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 9251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik/* 9351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Setup the child's kernel stack with a pt_regs and call switch_stack() on it. 9451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * It will be unnested during _resume and _ret_from_sys_call when the new thread 9551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * is scheduled. 9651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * 9751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Also setup the thread switching structure which is used to keep 9851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * thread-specific data during _resumes. 9951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 10051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 10151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikextern asmlinkage void ret_from_fork(void); 10269b58a67213506f98835b0ee8cf24324f59a1442Al Viroextern asmlinkage void ret_from_kernel_thread(void); 10351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 10451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikint 1056f2c55b843836d26528c56a0968689accaedbc67Alexey Dobriyancopy_thread(unsigned long clone_flags, unsigned long usp, 106afa86fc426ff7e7f5477f15da9c405d08d5cf790Al Viro unsigned long arg, struct task_struct *p) 10751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 10869b58a67213506f98835b0ee8cf24324f59a1442Al Viro struct pt_regs *childregs = task_pt_regs(p); 10969b58a67213506f98835b0ee8cf24324f59a1442Al Viro struct switch_stack *swstack = ((struct switch_stack *) childregs) - 1; 11051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 11151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* 11251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * Put the pt_regs structure at the end of the new kernel stack page and 11351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * fix it up. Note: the task_struct doubles as the kernel stack for the 11451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * task. 11551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 11669b58a67213506f98835b0ee8cf24324f59a1442Al Viro if (unlikely(p->flags & PF_KTHREAD)) { 11769b58a67213506f98835b0ee8cf24324f59a1442Al Viro memset(swstack, 0, 11869b58a67213506f98835b0ee8cf24324f59a1442Al Viro sizeof(struct switch_stack) + sizeof(struct pt_regs)); 11969b58a67213506f98835b0ee8cf24324f59a1442Al Viro swstack->r1 = usp; 12069b58a67213506f98835b0ee8cf24324f59a1442Al Viro swstack->r2 = arg; 12169b58a67213506f98835b0ee8cf24324f59a1442Al Viro childregs->ccs = 1 << (I_CCS_BITNR + CCS_SHIFT); 12269b58a67213506f98835b0ee8cf24324f59a1442Al Viro swstack->return_ip = (unsigned long) ret_from_kernel_thread; 12369b58a67213506f98835b0ee8cf24324f59a1442Al Viro p->thread.ksp = (unsigned long) swstack; 12469b58a67213506f98835b0ee8cf24324f59a1442Al Viro p->thread.usp = 0; 12569b58a67213506f98835b0ee8cf24324f59a1442Al Viro return 0; 12669b58a67213506f98835b0ee8cf24324f59a1442Al Viro } 12727d892fb27f492921cfd6df15ab4153f1badbb46Al Viro *childregs = *current_pt_regs(); /* Struct copy of pt_regs. */ 12851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik childregs->r10 = 0; /* Child returns 0 after a fork/clone. */ 12951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 13051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* Set a new TLS ? 13125985edcedea6396277003854657b5f3cb31a628Lucas De Marchi * The TLS is in $mof because it is the 5th argument to sys_clone. 13251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 13351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik if (p->mm && (clone_flags & CLONE_SETTLS)) { 13427d892fb27f492921cfd6df15ab4153f1badbb46Al Viro task_thread_info(p)->tls = childregs->mof; 13551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik } 13651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 13751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* Put the switch stack right below the pt_regs. */ 13851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 13949b4ff3304b52b18c490fc4deb400b61bb7ed142Simon Arlott /* Parameter to ret_from_sys_call. 0 is don't restart the syscall. */ 14051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik swstack->r9 = 0; 14151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 14251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* 14351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * We want to return into ret_from_sys_call after the _resume. 14451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik * ret_from_fork will call ret_from_sys_call. 14551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik */ 14651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik swstack->return_ip = (unsigned long) ret_from_fork; 14751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 14851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* Fix the user-mode and kernel-mode stackpointer. */ 14927d892fb27f492921cfd6df15ab4153f1badbb46Al Viro p->thread.usp = usp ?: rdusp(); 15051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik p->thread.ksp = (unsigned long) swstack; 15151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 15251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik return 0; 15351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 15451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 15551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikunsigned long 15651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikget_wchan(struct task_struct *p) 15751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 15851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik /* TODO */ 15951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik return 0; 16051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 16151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#undef last_sched 16251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik#undef first_sched 16351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 16451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvikvoid show_regs(struct pt_regs * regs) 16551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik{ 16651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik unsigned long usp = rdusp(); 167a43cb95d547a061ed5bf1acb28e0f5fd575e26c1Tejun Heo 168a43cb95d547a061ed5bf1acb28e0f5fd575e26c1Tejun Heo show_regs_print_info(KERN_DEFAULT); 169a43cb95d547a061ed5bf1acb28e0f5fd575e26c1Tejun Heo 17051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk("ERP: %08lx SRP: %08lx CCS: %08lx USP: %08lx MOF: %08lx\n", 17151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik regs->erp, regs->srp, regs->ccs, usp, regs->mof); 17251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 17351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk(" r0: %08lx r1: %08lx r2: %08lx r3: %08lx\n", 17451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik regs->r0, regs->r1, regs->r2, regs->r3); 17551533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 17651533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk(" r4: %08lx r5: %08lx r6: %08lx r7: %08lx\n", 17751533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik regs->r4, regs->r5, regs->r6, regs->r7); 17851533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 17951533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk(" r8: %08lx r9: %08lx r10: %08lx r11: %08lx\n", 18051533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik regs->r8, regs->r9, regs->r10, regs->r11); 18151533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik 18251533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik printk("r12: %08lx r13: %08lx oR10: %08lx\n", 18351533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik regs->r12, regs->r13, regs->orig_r10); 18451533b615e605d86154ec1b4e585c8ca1b0b15b7Mikael Starvik} 185