C6X: replace tick_nohz_stop/restart_sched_tick calls
[linux-3.10.git] / arch / c6x / kernel / process.c
1 /*
2  *  Port on Texas Instruments TMS320C6x architecture
3  *
4  *  Copyright (C) 2004, 2006, 2009, 2010, 2011 Texas Instruments Incorporated
5  *  Author: Aurelien Jacquiot (aurelien.jacquiot@jaluna.com)
6  *
7  *  This program is free software; you can redistribute it and/or modify
8  *  it under the terms of the GNU General Public License version 2 as
9  *  published by the Free Software Foundation.
10  *
11  */
12 #include <linux/module.h>
13 #include <linux/unistd.h>
14 #include <linux/ptrace.h>
15 #include <linux/init_task.h>
16 #include <linux/tick.h>
17 #include <linux/mqueue.h>
18 #include <linux/syscalls.h>
19 #include <linux/reboot.h>
20
21 #include <asm/syscalls.h>
22
23 /* hooks for board specific support */
24 void    (*c6x_restart)(void);
25 void    (*c6x_halt)(void);
26
27 extern asmlinkage void ret_from_fork(void);
28
29 static struct signal_struct init_signals = INIT_SIGNALS(init_signals);
30 static struct sighand_struct init_sighand = INIT_SIGHAND(init_sighand);
31
32 /*
33  * Initial thread structure.
34  */
35 union thread_union init_thread_union __init_task_data = {
36         INIT_THREAD_INFO(init_task)
37 };
38
39 /*
40  * Initial task structure.
41  */
42 struct task_struct init_task = INIT_TASK(init_task);
43 EXPORT_SYMBOL(init_task);
44
45 /*
46  * power off function, if any
47  */
48 void (*pm_power_off)(void);
49 EXPORT_SYMBOL(pm_power_off);
50
51 static void c6x_idle(void)
52 {
53         unsigned long tmp;
54
55         /*
56          * Put local_irq_enable and idle in same execute packet
57          * to make them atomic and avoid race to idle with
58          * interrupts enabled.
59          */
60         asm volatile ("   mvc .s2 CSR,%0\n"
61                       "   or  .d2 1,%0,%0\n"
62                       "   mvc .s2 %0,CSR\n"
63                       "|| idle\n"
64                       : "=b"(tmp));
65 }
66
67 /*
68  * The idle loop for C64x
69  */
70 void cpu_idle(void)
71 {
72         /* endless idle loop with no priority at all */
73         while (1) {
74                 tick_nohz_idle_enter();
75                 rcu_idle_enter();
76                 while (1) {
77                         local_irq_disable();
78                         if (need_resched()) {
79                                 local_irq_enable();
80                                 break;
81                         }
82                         c6x_idle(); /* enables local irqs */
83                 }
84                 rcu_idle_exit();
85                 tick_nohz_idle_exit();
86
87                 preempt_enable_no_resched();
88                 schedule();
89                 preempt_disable();
90         }
91 }
92
93 static void halt_loop(void)
94 {
95         printk(KERN_EMERG "System Halted, OK to turn off power\n");
96         local_irq_disable();
97         while (1)
98                 asm volatile("idle\n");
99 }
100
101 void machine_restart(char *__unused)
102 {
103         if (c6x_restart)
104                 c6x_restart();
105         halt_loop();
106 }
107
108 void machine_halt(void)
109 {
110         if (c6x_halt)
111                 c6x_halt();
112         halt_loop();
113 }
114
115 void machine_power_off(void)
116 {
117         if (pm_power_off)
118                 pm_power_off();
119         halt_loop();
120 }
121
122 static void kernel_thread_helper(int dummy, void *arg, int (*fn)(void *))
123 {
124         do_exit(fn(arg));
125 }
126
127 /*
128  * Create a kernel thread
129  */
130 int kernel_thread(int (*fn)(void *), void * arg, unsigned long flags)
131 {
132         struct pt_regs regs;
133
134         /*
135          * copy_thread sets a4 to zero (child return from fork)
136          * so we can't just set things up to directly return to
137          * fn.
138          */
139         memset(&regs, 0, sizeof(regs));
140         regs.b4 = (unsigned long) arg;
141         regs.a6 = (unsigned long) fn;
142         regs.pc = (unsigned long) kernel_thread_helper;
143         local_save_flags(regs.csr);
144         regs.csr |= 1;
145         regs.tsr = 5; /* Set GEE and GIE in TSR */
146
147         /* Ok, create the new process.. */
148         return do_fork(flags | CLONE_VM | CLONE_UNTRACED, -1, &regs,
149                        0, NULL, NULL);
150 }
151 EXPORT_SYMBOL(kernel_thread);
152
153 void flush_thread(void)
154 {
155 }
156
157 void exit_thread(void)
158 {
159 }
160
161 SYSCALL_DEFINE1(c6x_clone, struct pt_regs *, regs)
162 {
163         unsigned long clone_flags;
164         unsigned long newsp;
165
166         /* syscall puts clone_flags in A4 and usp in B4 */
167         clone_flags = regs->orig_a4;
168         if (regs->b4)
169                 newsp = regs->b4;
170         else
171                 newsp = regs->sp;
172
173         return do_fork(clone_flags, newsp, regs, 0, (int __user *)regs->a6,
174                        (int __user *)regs->b6);
175 }
176
177 /*
178  * Do necessary setup to start up a newly executed thread.
179  */
180 void start_thread(struct pt_regs *regs, unsigned int pc, unsigned long usp)
181 {
182         /*
183          * The binfmt loader will setup a "full" stack, but the C6X
184          * operates an "empty" stack. So we adjust the usp so that
185          * argc doesn't get destroyed if an interrupt is taken before
186          * it is read from the stack.
187          *
188          * NB: Library startup code needs to match this.
189          */
190         usp -= 8;
191
192         set_fs(USER_DS);
193         regs->pc  = pc;
194         regs->sp  = usp;
195         regs->tsr |= 0x40; /* set user mode */
196         current->thread.usp = usp;
197 }
198
199 /*
200  * Copy a new thread context in its stack.
201  */
202 int copy_thread(unsigned long clone_flags, unsigned long usp,
203                 unsigned long ustk_size,
204                 struct task_struct *p, struct pt_regs *regs)
205 {
206         struct pt_regs *childregs;
207
208         childregs = task_pt_regs(p);
209
210         *childregs = *regs;
211         childregs->a4 = 0;
212
213         if (usp == -1)
214                 /* case of  __kernel_thread: we return to supervisor space */
215                 childregs->sp = (unsigned long)(childregs + 1);
216         else
217                 /* Otherwise use the given stack */
218                 childregs->sp = usp;
219
220         /* Set usp/ksp */
221         p->thread.usp = childregs->sp;
222         /* switch_to uses stack to save/restore 14 callee-saved regs */
223         thread_saved_ksp(p) = (unsigned long)childregs - 8;
224         p->thread.pc = (unsigned int) ret_from_fork;
225         p->thread.wchan = (unsigned long) ret_from_fork;
226 #ifdef __DSBT__
227         {
228                 unsigned long dp;
229
230                 asm volatile ("mv .S2 b14,%0\n" : "=b"(dp));
231
232                 thread_saved_dp(p) = dp;
233                 if (usp == -1)
234                         childregs->dp = dp;
235         }
236 #endif
237         return 0;
238 }
239
240 /*
241  * c6x_execve() executes a new program.
242  */
243 SYSCALL_DEFINE4(c6x_execve, const char __user *, name,
244                 const char __user *const __user *, argv,
245                 const char __user *const __user *, envp,
246                 struct pt_regs *, regs)
247 {
248         int error;
249         char *filename;
250
251         filename = getname(name);
252         error = PTR_ERR(filename);
253         if (IS_ERR(filename))
254                 goto out;
255
256         error = do_execve(filename, argv, envp, regs);
257         putname(filename);
258 out:
259         return error;
260 }
261
262 unsigned long get_wchan(struct task_struct *p)
263 {
264         return p->thread.wchan;
265 }