process.c revision a8fb748e89957426fafb2e2efccd5ce635d6f530
16496a23add642b7c9203411bdff3ff761835a80aMichal Simek/* 26496a23add642b7c9203411bdff3ff761835a80aMichal Simek * Copyright (C) 2008-2009 Michal Simek <monstr@monstr.eu> 36496a23add642b7c9203411bdff3ff761835a80aMichal Simek * Copyright (C) 2008-2009 PetaLogix 46496a23add642b7c9203411bdff3ff761835a80aMichal Simek * Copyright (C) 2006 Atmark Techno, Inc. 56496a23add642b7c9203411bdff3ff761835a80aMichal Simek * 66496a23add642b7c9203411bdff3ff761835a80aMichal Simek * This file is subject to the terms and conditions of the GNU General Public 76496a23add642b7c9203411bdff3ff761835a80aMichal Simek * License. See the file "COPYING" in the main directory of this archive 86496a23add642b7c9203411bdff3ff761835a80aMichal Simek * for more details. 96496a23add642b7c9203411bdff3ff761835a80aMichal Simek */ 106496a23add642b7c9203411bdff3ff761835a80aMichal Simek 116496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <linux/module.h> 126496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <linux/sched.h> 136496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <linux/pm.h> 146496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <linux/tick.h> 156496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <linux/bitops.h> 166496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <asm/system.h> 176496a23add642b7c9203411bdff3ff761835a80aMichal Simek#include <asm/pgalloc.h> 186496a23add642b7c9203411bdff3ff761835a80aMichal Simek 196496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid show_regs(struct pt_regs *regs) 206496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 216496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " Registers dump: mode=%X\r\n", regs->kernel_mode); 226496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r1=%08lX, r2=%08lX, r3=%08lX, r4=%08lX\n", 236496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r1, regs->r2, regs->r3, regs->r4); 246496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r5=%08lX, r6=%08lX, r7=%08lX, r8=%08lX\n", 256496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r5, regs->r6, regs->r7, regs->r8); 266496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r9=%08lX, r10=%08lX, r11=%08lX, r12=%08lX\n", 276496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r9, regs->r10, regs->r11, regs->r12); 286496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r13=%08lX, r14=%08lX, r15=%08lX, r16=%08lX\n", 296496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r13, regs->r14, regs->r15, regs->r16); 306496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r17=%08lX, r18=%08lX, r19=%08lX, r20=%08lX\n", 316496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r17, regs->r18, regs->r19, regs->r20); 326496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r21=%08lX, r22=%08lX, r23=%08lX, r24=%08lX\n", 336496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r21, regs->r22, regs->r23, regs->r24); 346496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r25=%08lX, r26=%08lX, r27=%08lX, r28=%08lX\n", 356496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r25, regs->r26, regs->r27, regs->r28); 366496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " r29=%08lX, r30=%08lX, r31=%08lX, rPC=%08lX\n", 376496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->r29, regs->r30, regs->r31, regs->pc); 386496a23add642b7c9203411bdff3ff761835a80aMichal Simek printk(KERN_INFO " msr=%08lX, ear=%08lX, esr=%08lX, fsr=%08lX\n", 396496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs->msr, regs->ear, regs->esr, regs->fsr); 406496a23add642b7c9203411bdff3ff761835a80aMichal Simek while (1) 416496a23add642b7c9203411bdff3ff761835a80aMichal Simek ; 426496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 436496a23add642b7c9203411bdff3ff761835a80aMichal Simek 446496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid (*pm_idle)(void); 456496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid (*pm_power_off)(void) = NULL; 466496a23add642b7c9203411bdff3ff761835a80aMichal SimekEXPORT_SYMBOL(pm_power_off); 476496a23add642b7c9203411bdff3ff761835a80aMichal Simek 486496a23add642b7c9203411bdff3ff761835a80aMichal Simekstatic int hlt_counter = 1; 496496a23add642b7c9203411bdff3ff761835a80aMichal Simek 506496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid disable_hlt(void) 516496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 526496a23add642b7c9203411bdff3ff761835a80aMichal Simek hlt_counter++; 536496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 546496a23add642b7c9203411bdff3ff761835a80aMichal SimekEXPORT_SYMBOL(disable_hlt); 556496a23add642b7c9203411bdff3ff761835a80aMichal Simek 566496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid enable_hlt(void) 576496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 586496a23add642b7c9203411bdff3ff761835a80aMichal Simek hlt_counter--; 596496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 606496a23add642b7c9203411bdff3ff761835a80aMichal SimekEXPORT_SYMBOL(enable_hlt); 616496a23add642b7c9203411bdff3ff761835a80aMichal Simek 626496a23add642b7c9203411bdff3ff761835a80aMichal Simekstatic int __init nohlt_setup(char *__unused) 636496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 646496a23add642b7c9203411bdff3ff761835a80aMichal Simek hlt_counter = 1; 656496a23add642b7c9203411bdff3ff761835a80aMichal Simek return 1; 666496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 676496a23add642b7c9203411bdff3ff761835a80aMichal Simek__setup("nohlt", nohlt_setup); 686496a23add642b7c9203411bdff3ff761835a80aMichal Simek 696496a23add642b7c9203411bdff3ff761835a80aMichal Simekstatic int __init hlt_setup(char *__unused) 706496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 716496a23add642b7c9203411bdff3ff761835a80aMichal Simek hlt_counter = 0; 726496a23add642b7c9203411bdff3ff761835a80aMichal Simek return 1; 736496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 746496a23add642b7c9203411bdff3ff761835a80aMichal Simek__setup("hlt", hlt_setup); 756496a23add642b7c9203411bdff3ff761835a80aMichal Simek 766496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid default_idle(void) 776496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 786496a23add642b7c9203411bdff3ff761835a80aMichal Simek if (!hlt_counter) { 796496a23add642b7c9203411bdff3ff761835a80aMichal Simek clear_thread_flag(TIF_POLLING_NRFLAG); 806496a23add642b7c9203411bdff3ff761835a80aMichal Simek smp_mb__after_clear_bit(); 816496a23add642b7c9203411bdff3ff761835a80aMichal Simek local_irq_disable(); 826496a23add642b7c9203411bdff3ff761835a80aMichal Simek while (!need_resched()) 836496a23add642b7c9203411bdff3ff761835a80aMichal Simek cpu_sleep(); 846496a23add642b7c9203411bdff3ff761835a80aMichal Simek local_irq_enable(); 856496a23add642b7c9203411bdff3ff761835a80aMichal Simek set_thread_flag(TIF_POLLING_NRFLAG); 866496a23add642b7c9203411bdff3ff761835a80aMichal Simek } else 876496a23add642b7c9203411bdff3ff761835a80aMichal Simek while (!need_resched()) 886496a23add642b7c9203411bdff3ff761835a80aMichal Simek cpu_relax(); 896496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 906496a23add642b7c9203411bdff3ff761835a80aMichal Simek 916496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid cpu_idle(void) 926496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 936496a23add642b7c9203411bdff3ff761835a80aMichal Simek set_thread_flag(TIF_POLLING_NRFLAG); 946496a23add642b7c9203411bdff3ff761835a80aMichal Simek 956496a23add642b7c9203411bdff3ff761835a80aMichal Simek /* endless idle loop with no priority at all */ 966496a23add642b7c9203411bdff3ff761835a80aMichal Simek while (1) { 976496a23add642b7c9203411bdff3ff761835a80aMichal Simek void (*idle)(void) = pm_idle; 986496a23add642b7c9203411bdff3ff761835a80aMichal Simek 996496a23add642b7c9203411bdff3ff761835a80aMichal Simek if (!idle) 1006496a23add642b7c9203411bdff3ff761835a80aMichal Simek idle = default_idle; 1016496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1026496a23add642b7c9203411bdff3ff761835a80aMichal Simek tick_nohz_stop_sched_tick(1); 1036496a23add642b7c9203411bdff3ff761835a80aMichal Simek while (!need_resched()) 1046496a23add642b7c9203411bdff3ff761835a80aMichal Simek idle(); 1056496a23add642b7c9203411bdff3ff761835a80aMichal Simek tick_nohz_restart_sched_tick(); 1066496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1076496a23add642b7c9203411bdff3ff761835a80aMichal Simek preempt_enable_no_resched(); 1086496a23add642b7c9203411bdff3ff761835a80aMichal Simek schedule(); 1096496a23add642b7c9203411bdff3ff761835a80aMichal Simek preempt_disable(); 1106496a23add642b7c9203411bdff3ff761835a80aMichal Simek check_pgt_cache(); 1116496a23add642b7c9203411bdff3ff761835a80aMichal Simek } 1126496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1136496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1146496a23add642b7c9203411bdff3ff761835a80aMichal Simekvoid flush_thread(void) 1156496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1166496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1176496a23add642b7c9203411bdff3ff761835a80aMichal Simek 118a8fb748e89957426fafb2e2efccd5ce635d6f530Michal Simekint copy_thread(unsigned long clone_flags, unsigned long usp, 1196496a23add642b7c9203411bdff3ff761835a80aMichal Simek unsigned long unused, 1206496a23add642b7c9203411bdff3ff761835a80aMichal Simek struct task_struct *p, struct pt_regs *regs) 1216496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1226496a23add642b7c9203411bdff3ff761835a80aMichal Simek struct pt_regs *childregs = task_pt_regs(p); 1236496a23add642b7c9203411bdff3ff761835a80aMichal Simek struct thread_info *ti = task_thread_info(p); 1246496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1256496a23add642b7c9203411bdff3ff761835a80aMichal Simek *childregs = *regs; 1266496a23add642b7c9203411bdff3ff761835a80aMichal Simek if (user_mode(regs)) 1276496a23add642b7c9203411bdff3ff761835a80aMichal Simek childregs->r1 = usp; 1286496a23add642b7c9203411bdff3ff761835a80aMichal Simek else 1296496a23add642b7c9203411bdff3ff761835a80aMichal Simek childregs->r1 = ((unsigned long) ti) + THREAD_SIZE; 1306496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1316496a23add642b7c9203411bdff3ff761835a80aMichal Simek memset(&ti->cpu_context, 0, sizeof(struct cpu_context)); 1326496a23add642b7c9203411bdff3ff761835a80aMichal Simek ti->cpu_context.r1 = (unsigned long)childregs; 1336496a23add642b7c9203411bdff3ff761835a80aMichal Simek ti->cpu_context.msr = (unsigned long)childregs->msr; 1346496a23add642b7c9203411bdff3ff761835a80aMichal Simek ti->cpu_context.r15 = (unsigned long)ret_from_fork - 8; 1356496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1366496a23add642b7c9203411bdff3ff761835a80aMichal Simek if (clone_flags & CLONE_SETTLS) 1376496a23add642b7c9203411bdff3ff761835a80aMichal Simek ; 1386496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1396496a23add642b7c9203411bdff3ff761835a80aMichal Simek return 0; 1406496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1416496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1426496a23add642b7c9203411bdff3ff761835a80aMichal Simek/* 1436496a23add642b7c9203411bdff3ff761835a80aMichal Simek * Return saved PC of a blocked thread. 1446496a23add642b7c9203411bdff3ff761835a80aMichal Simek */ 1456496a23add642b7c9203411bdff3ff761835a80aMichal Simekunsigned long thread_saved_pc(struct task_struct *tsk) 1466496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1476496a23add642b7c9203411bdff3ff761835a80aMichal Simek struct cpu_context *ctx = 1486496a23add642b7c9203411bdff3ff761835a80aMichal Simek &(((struct thread_info *)(tsk->stack))->cpu_context); 1496496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1506496a23add642b7c9203411bdff3ff761835a80aMichal Simek /* Check whether the thread is blocked in resume() */ 1516496a23add642b7c9203411bdff3ff761835a80aMichal Simek if (in_sched_functions(ctx->r15)) 1526496a23add642b7c9203411bdff3ff761835a80aMichal Simek return (unsigned long)ctx->r15; 1536496a23add642b7c9203411bdff3ff761835a80aMichal Simek else 1546496a23add642b7c9203411bdff3ff761835a80aMichal Simek return ctx->r14; 1556496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1566496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1576496a23add642b7c9203411bdff3ff761835a80aMichal Simekstatic void kernel_thread_helper(int (*fn)(void *), void *arg) 1586496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1596496a23add642b7c9203411bdff3ff761835a80aMichal Simek fn(arg); 1606496a23add642b7c9203411bdff3ff761835a80aMichal Simek do_exit(-1); 1616496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1626496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1636496a23add642b7c9203411bdff3ff761835a80aMichal Simekint kernel_thread(int (*fn)(void *), void *arg, unsigned long flags) 1646496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1656496a23add642b7c9203411bdff3ff761835a80aMichal Simek struct pt_regs regs; 1666496a23add642b7c9203411bdff3ff761835a80aMichal Simek int ret; 1676496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1686496a23add642b7c9203411bdff3ff761835a80aMichal Simek memset(®s, 0, sizeof(regs)); 1696496a23add642b7c9203411bdff3ff761835a80aMichal Simek /* store them in non-volatile registers */ 1706496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs.r5 = (unsigned long)fn; 1716496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs.r6 = (unsigned long)arg; 1726496a23add642b7c9203411bdff3ff761835a80aMichal Simek local_save_flags(regs.msr); 1736496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs.pc = (unsigned long)kernel_thread_helper; 1746496a23add642b7c9203411bdff3ff761835a80aMichal Simek regs.kernel_mode = 1; 1756496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1766496a23add642b7c9203411bdff3ff761835a80aMichal Simek ret = do_fork(flags | CLONE_VM | CLONE_UNTRACED, 0, 1776496a23add642b7c9203411bdff3ff761835a80aMichal Simek ®s, 0, NULL, NULL); 1786496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1796496a23add642b7c9203411bdff3ff761835a80aMichal Simek return ret; 1806496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 1816496a23add642b7c9203411bdff3ff761835a80aMichal Simek 1826496a23add642b7c9203411bdff3ff761835a80aMichal Simekunsigned long get_wchan(struct task_struct *p) 1836496a23add642b7c9203411bdff3ff761835a80aMichal Simek{ 1846496a23add642b7c9203411bdff3ff761835a80aMichal Simek/* TBD (used by procfs) */ 1856496a23add642b7c9203411bdff3ff761835a80aMichal Simek return 0; 1866496a23add642b7c9203411bdff3ff761835a80aMichal Simek} 187