Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  *  linux/arch/m68k/kernel/process.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  *  Copyright (C) 1995  Hamish Macdonald
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7)  *  68060 fixes by Jesper Skov
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11)  * This file handles the architecture-dependent parts of process handling..
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/sched.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/sched/debug.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/sched/task.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/sched/task_stack.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <linux/fs.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/smp.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/stddef.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) #include <linux/unistd.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/ptrace.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) #include <linux/user.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #include <linux/reboot.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #include <linux/init_task.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include <linux/mqueue.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #include <linux/rcupdate.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #include <linux/syscalls.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) #include <asm/traps.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) #include <asm/machdep.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) #include <asm/setup.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) asmlinkage void ret_from_fork(void);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) asmlinkage void ret_from_kernel_thread(void);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) void arch_cpu_idle(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) #if defined(MACH_ATARI_ONLY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	/* block out HSYNC on the atari (falcon) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	__asm__("stop #0x2200" : : : "cc");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) #else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 	__asm__("stop #0x2000" : : : "cc");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) void machine_restart(char * __unused)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 	if (mach_reset)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 		mach_reset();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	for (;;);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) void machine_halt(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	if (mach_halt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) 		mach_halt();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	for (;;);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) void machine_power_off(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (mach_power_off)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		mach_power_off();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 	for (;;);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) void (*pm_power_off)(void) = machine_power_off;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) EXPORT_SYMBOL(pm_power_off);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) void show_regs(struct pt_regs * regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	pr_info("Format %02x  Vector: %04x  PC: %08lx  Status: %04x    %s\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		regs->format, regs->vector, regs->pc, regs->sr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		print_tainted());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 	pr_info("ORIG_D0: %08lx  D0: %08lx  A2: %08lx  A1: %08lx\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		regs->orig_d0, regs->d0, regs->a2, regs->a1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	pr_info("A0: %08lx  D5: %08lx  D4: %08lx\n", regs->a0, regs->d5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		regs->d4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	pr_info("D3: %08lx  D2: %08lx  D1: %08lx\n", regs->d3, regs->d2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 		regs->d1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) 	if (!(regs->sr & PS_S))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 		pr_info("USP: %08lx\n", rdusp());
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) void flush_thread(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	current->thread.fs = __USER_DS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) #ifdef CONFIG_FPU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	if (!FPU_IS_EMU) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 		unsigned long zero = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 		asm volatile("frestore %0": :"m" (zero));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)  * Why not generic sys_clone, you ask?  m68k passes all arguments on stack.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106)  * And we need all registers saved, which means a bunch of stuff pushed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107)  * on top of pt_regs, which means that sys_clone() arguments would be
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108)  * buried.  We could, of course, copy them, but it's too costly for no
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)  * good reason - generic clone() would have to copy them *again* for
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110)  * kernel_clone() anyway.  So in this case it's actually better to pass pt_regs *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111)  * and extract arguments for kernel_clone() from there.  Eventually we might
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112)  * go for calling kernel_clone() directly from the wrapper, but only after we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)  * are finished with kernel_clone() prototype conversion.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) asmlinkage int m68k_clone(struct pt_regs *regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	/* regs will be equal to current_pt_regs() */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 	struct kernel_clone_args args = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		.flags		= regs->d1 & ~CSIGNAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 		.pidfd		= (int __user *)regs->d3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 		.child_tid	= (int __user *)regs->d4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 		.parent_tid	= (int __user *)regs->d3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 		.exit_signal	= regs->d1 & CSIGNAL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 		.stack		= regs->d2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 		.tls		= regs->d5,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 	};
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	return kernel_clone(&args);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)  * Because extra registers are saved on the stack after the sys_clone3()
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133)  * arguments, this C wrapper extracts them from pt_regs * and then calls the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134)  * generic sys_clone3() implementation.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) asmlinkage int m68k_clone3(struct pt_regs *regs)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	return sys_clone3((struct clone_args __user *)regs->d1, regs->d2);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) int copy_thread(unsigned long clone_flags, unsigned long usp, unsigned long arg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 		struct task_struct *p, unsigned long tls)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 	struct fork_frame {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 		struct switch_stack sw;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 		struct pt_regs regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	} *frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	frame = (struct fork_frame *) (task_stack_page(p) + THREAD_SIZE) - 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	p->thread.ksp = (unsigned long)frame;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	p->thread.esp0 = (unsigned long)&frame->regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	 * Must save the current SFC/DFC value, NOT the value when
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	 * the parent was last descheduled - RGH  10-08-96
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	p->thread.fs = get_fs().seg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	if (unlikely(p->flags & PF_KTHREAD)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 		/* kernel thread */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 		memset(frame, 0, sizeof(struct fork_frame));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		frame->regs.sr = PS_S;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 		frame->sw.a3 = usp; /* function */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 		frame->sw.d7 = arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 		frame->sw.retpc = (unsigned long)ret_from_kernel_thread;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 		p->thread.usp = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	memcpy(frame, container_of(current_pt_regs(), struct fork_frame, regs),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 		sizeof(struct fork_frame));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	frame->regs.d0 = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 	frame->sw.retpc = (unsigned long)ret_from_fork;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 	p->thread.usp = usp ?: rdusp();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	if (clone_flags & CLONE_SETTLS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 		task_thread_info(p)->tp_value = tls;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) #ifdef CONFIG_FPU
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	if (!FPU_IS_EMU) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		/* Copy the current fpu state */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 		asm volatile ("fsave %0" : : "m" (p->thread.fpstate[0]) : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 		if (!CPU_IS_060 ? p->thread.fpstate[0] : p->thread.fpstate[2]) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 			if (CPU_IS_COLDFIRE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 				asm volatile ("fmovemd %/fp0-%/fp7,%0\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 					      "fmovel %/fpiar,%1\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 					      "fmovel %/fpcr,%2\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 					      "fmovel %/fpsr,%3"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 					      :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 					      : "m" (p->thread.fp[0]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 						"m" (p->thread.fpcntl[0]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 						"m" (p->thread.fpcntl[1]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 						"m" (p->thread.fpcntl[2])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 					      : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 			} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 				asm volatile ("fmovemx %/fp0-%/fp7,%0\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 					      "fmoveml %/fpiar/%/fpcr/%/fpsr,%1"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 					      :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 					      : "m" (p->thread.fp[0]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 						"m" (p->thread.fpcntl[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 					      : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 		/* Restore the state in case the fpu was busy */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 		asm volatile ("frestore %0" : : "m" (p->thread.fpstate[0]));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) #endif /* CONFIG_FPU */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) /* Fill in the fpu structure for a core dump.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) int dump_fpu (struct pt_regs *regs, struct user_m68kfp_struct *fpu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	if (FPU_IS_EMU) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 		int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 		memcpy(fpu->fpcntl, current->thread.fpcntl, 12);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 		memcpy(fpu->fpregs, current->thread.fp, 96);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) 		/* Convert internal fpu reg representation
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 		 * into long double format
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 		 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) 		for (i = 0; i < 24; i += 3)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 			fpu->fpregs[i] = ((fpu->fpregs[i] & 0xffff0000) << 15) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 			                 ((fpu->fpregs[i] & 0x0000ffff) << 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 		return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	if (IS_ENABLED(CONFIG_FPU)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 		char fpustate[216];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 		/* First dump the fpu context to avoid protocol violation.  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 		asm volatile ("fsave %0" :: "m" (fpustate[0]) : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 		if (!CPU_IS_060 ? !fpustate[0] : !fpustate[2])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 		if (CPU_IS_COLDFIRE) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 			asm volatile ("fmovel %/fpiar,%0\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 				      "fmovel %/fpcr,%1\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) 				      "fmovel %/fpsr,%2\n\t"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) 				      "fmovemd %/fp0-%/fp7,%3"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 				      :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) 				      : "m" (fpu->fpcntl[0]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) 					"m" (fpu->fpcntl[1]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 					"m" (fpu->fpcntl[2]),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 					"m" (fpu->fpregs[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 				      : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 		} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 			asm volatile ("fmovem %/fpiar/%/fpcr/%/fpsr,%0"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 				      :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 				      : "m" (fpu->fpcntl[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 				      : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 			asm volatile ("fmovemx %/fp0-%/fp7,%0"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 				      :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 				      : "m" (fpu->fpregs[0])
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 				      : "memory");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) EXPORT_SYMBOL(dump_fpu);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) unsigned long get_wchan(struct task_struct *p)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 	unsigned long fp, pc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 	unsigned long stack_page;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 	int count = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 	if (!p || p == current || p->state == TASK_RUNNING)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 	stack_page = (unsigned long)task_stack_page(p);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 	fp = ((struct switch_stack *)p->thread.ksp)->a6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 		if (fp < stack_page+sizeof(struct thread_info) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 		    fp >= 8184+stack_page)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 		pc = ((unsigned long *)fp)[1];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 		if (!in_sched_functions(pc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) 			return pc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) 		fp = *(unsigned long *) fp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 	} while (count++ < 16);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) }