arch/hexagon/kernel/process.c

   1 /*
   2  * Process creation support for Hexagon
   3  *
   4  * Copyright (c) 2010-2012, The Linux Foundation. All rights reserved.
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 and
   8  * only version 2 as published by the Free Software Foundation.
   9  *
  10  * This program is distributed in the hope that it will be useful,
  11  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  * GNU General Public License for more details.
  14  *
  15  * You should have received a copy of the GNU General Public License
  16  * along with this program; if not, write to the Free Software
  17  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
  18  * 02110-1301, USA.
  19  */
  20
  21 #include <linux/sched.h>
  22 #include <linux/types.h>
  23 #include <linux/module.h>
  24 #include <linux/tick.h>
  25 #include <linux/uaccess.h>
  26 #include <linux/slab.h>
  27 #include <linux/tracehook.h>
  28
  29 /*
  30  * Program thread launch.  Often defined as a macro in processor.h,
  31  * but we're shooting for a small footprint and it's not an inner-loop
  32  * performance-critical operation.
  33  *
  34  * The Hexagon ABI specifies that R28 is zero'ed before program launch,
  35  * so that gets automatically done here.  If we ever stop doing that here,
  36  * we'll probably want to define the ELF_PLAT_INIT macro.
  37  */
  38 void start_thread(struct pt_regs *regs, unsigned long pc, unsigned long sp)
  39 {
  40         /* Set to run with user-mode data segmentation */
  41         set_fs(USER_DS);
  42         /* We want to zero all data-containing registers. Is this overkill? */
  43         memset(regs, 0, sizeof(*regs));
  44         /* We might want to also zero all Processor registers here */
  45         pt_set_usermode(regs);
  46         pt_set_elr(regs, pc);
  47         pt_set_rte_sp(regs, sp);
  48 }
  49
  50 /*
  51  *  Spin, or better still, do a hardware or VM wait instruction
  52  *  If hardware or VM offer wait termination even though interrupts
  53  *  are disabled.
  54  */
  55 static void default_idle(void)
  56 {
  57         __vmwait();
  58 }
  59
  60 void (*idle_sleep)(void) = default_idle;
  61
  62 void cpu_idle(void)
  63 {
  64         while (1) {
  65                 tick_nohz_idle_enter();
  66                 local_irq_disable();
  67                 while (!need_resched()) {
  68                         idle_sleep();
  69                         /*  interrupts wake us up, but aren't serviced  */
  70                         local_irq_enable();     /* service interrupt   */
  71                         local_irq_disable();
  72                 }
  73                 local_irq_enable();
  74                 tick_nohz_idle_exit();
  75                 schedule();
  76         }
  77 }
  78
  79 /*
  80  *  Return saved PC of a blocked thread
  81  */
  82 unsigned long thread_saved_pc(struct task_struct *tsk)
  83 {
  84         return 0;
  85 }
  86
  87 /*
  88  * Copy architecture-specific thread state
  89  */
  90 int copy_thread(unsigned long clone_flags, unsigned long usp,
  91                 unsigned long arg, struct task_struct *p)
  92 {
  93         struct thread_info *ti = task_thread_info(p);
  94         struct hexagon_switch_stack *ss;
  95         struct pt_regs *childregs;
  96         asmlinkage void ret_from_fork(void);
  97
  98         childregs = (struct pt_regs *) (((unsigned long) ti + THREAD_SIZE) -
  99                                         sizeof(*childregs));
 100
 101         ti->regs = childregs;
 102
 103         /*
 104          * Establish kernel stack pointer and initial PC for new thread
 105          * Note that unlike the usual situation, we do not copy the
 106          * parent's callee-saved here; those are in pt_regs and whatever
 107          * we leave here will be overridden on return to userland.
 108          */
 109         ss = (struct hexagon_switch_stack *) ((unsigned long) childregs -
 110                                                     sizeof(*ss));
 111         ss->lr = (unsigned long)ret_from_fork;
 112         p->thread.switch_sp = ss;
 113         if (unlikely(p->flags & PF_KTHREAD)) {
 114                 memset(childregs, 0, sizeof(struct pt_regs));
 115                 /* r24 <- fn, r25 <- arg */
 116                 ss->r24 = usp;
 117                 ss->r25 = arg;
 118                 pt_set_kmode(childregs);
 119                 return 0;
 120         }
 121         memcpy(childregs, current_pt_regs(), sizeof(*childregs));
 122         ss->r2524 = 0;
 123
 124         if (usp)
 125                 pt_set_rte_sp(childregs, usp);
 126
 127         /* Child sees zero return value */
 128         childregs->r00 = 0;
 129
 130         /*
 131          * The clone syscall has the C signature:
 132          * int [r0] clone(int flags [r0],
 133          *           void *child_frame [r1],
 134          *           void *parent_tid [r2],
 135          *           void *child_tid [r3],
 136          *           void *thread_control_block [r4]);
 137          * ugp is used to provide TLS support.
 138          */
 139         if (clone_flags & CLONE_SETTLS)
 140                 childregs->ugp = childregs->r04;
 141
 142         /*
 143          * Parent sees new pid -- not necessary, not even possible at
 144          * this point in the fork process
 145          * Might also want to set things like ti->addr_limit
 146          */
 147
 148         return 0;
 149 }
 150
 151 /*
 152  * Release any architecture-specific resources locked by thread
 153  */
 154 void release_thread(struct task_struct *dead_task)
 155 {
 156 }
 157
 158 /*
 159  * Free any architecture-specific thread data structures, etc.
 160  */
 161 void exit_thread(void)
 162 {
 163 }
 164
 165 /*
 166  * Some archs flush debug and FPU info here
 167  */
 168 void flush_thread(void)
 169 {
 170 }
 171
 172 /*
 173  * The "wait channel" terminology is archaic, but what we want
 174  * is an identification of the point at which the scheduler
 175  * was invoked by a blocked thread.
 176  */
 177 unsigned long get_wchan(struct task_struct *p)
 178 {
 179         unsigned long fp, pc;
 180         unsigned long stack_page;
 181         int count = 0;
 182         if (!p || p == current || p->state == TASK_RUNNING)
 183                 return 0;
 184
 185         stack_page = (unsigned long)task_stack_page(p);
 186         fp = ((struct hexagon_switch_stack *)p->thread.switch_sp)->fp;
 187         do {
 188                 if (fp < (stack_page + sizeof(struct thread_info)) ||
 189                         fp >= (THREAD_SIZE - 8 + stack_page))
 190                         return 0;
 191                 pc = ((unsigned long *)fp)[1];
 192                 if (!in_sched_functions(pc))
 193                         return pc;
 194                 fp = *(unsigned long *) fp;
 195         } while (count++ < 16);
 196
 197         return 0;
 198 }
 199
 200 /*
 201  * Required placeholder.
 202  */
 203 int dump_fpu(struct pt_regs *regs, elf_fpregset_t *fpu)
 204 {
 205         return 0;
 206 }
 207
 208
 209 /*
 210  * Called on the exit path of event entry; see vm_entry.S
 211  *
 212  * Interrupts will already be disabled.
 213  *
 214  * Returns 0 if there's no need to re-check for more work.
 215  */
 216
 217 int do_work_pending(struct pt_regs *regs, u32 thread_info_flags)
 218 {
 219         if (!(thread_info_flags & _TIF_WORK_MASK)) {
 220                 return 0;
 221         }  /* shortcut -- no work to be done */
 222
 223         local_irq_enable();
 224
 225         if (thread_info_flags & _TIF_NEED_RESCHED) {
 226                 schedule();
 227                 return 1;
 228         }
 229
 230         if (thread_info_flags & _TIF_SIGPENDING) {
 231                 do_signal(regs);
 232                 return 1;
 233         }
 234
 235         if (thread_info_flags & _TIF_NOTIFY_RESUME) {
 236                 clear_thread_flag(TIF_NOTIFY_RESUME);
 237                 tracehook_notify_resume(regs);
 238         }
 239
 240         /* Should not even reach here */
 241         panic("%s: bad thread_info flags 0x%08x\n", __func__,
 242                 thread_info_flags);
 243 }