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