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