2005-04-16 16:20:36 -06:00
|
|
|
/*
|
|
|
|
* arch/sh/kernel/smp.c
|
|
|
|
*
|
|
|
|
* SMP support for the SuperH processors.
|
|
|
|
*
|
2010-03-29 21:38:01 -06:00
|
|
|
* Copyright (C) 2002 - 2010 Paul Mundt
|
2007-09-21 03:32:32 -06:00
|
|
|
* Copyright (C) 2006 - 2007 Akio Idehara
|
2005-04-16 16:20:36 -06:00
|
|
|
*
|
2007-09-21 03:32:32 -06:00
|
|
|
* This file is subject to the terms and conditions of the GNU General Public
|
|
|
|
* License. See the file "COPYING" in the main directory of this archive
|
|
|
|
* for more details.
|
2005-04-16 16:20:36 -06:00
|
|
|
*/
|
2007-05-30 22:46:21 -06:00
|
|
|
#include <linux/err.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/cache.h>
|
|
|
|
#include <linux/cpumask.h>
|
|
|
|
#include <linux/delay.h>
|
|
|
|
#include <linux/init.h>
|
|
|
|
#include <linux/spinlock.h>
|
2007-09-21 03:32:32 -06:00
|
|
|
#include <linux/mm.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <linux/module.h>
|
2008-10-20 21:39:24 -06:00
|
|
|
#include <linux/cpu.h>
|
2007-09-21 03:32:32 -06:00
|
|
|
#include <linux/interrupt.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
#include <asm/atomic.h>
|
|
|
|
#include <asm/processor.h>
|
|
|
|
#include <asm/system.h>
|
|
|
|
#include <asm/mmu_context.h>
|
|
|
|
#include <asm/smp.h>
|
2007-09-21 03:32:32 -06:00
|
|
|
#include <asm/cacheflush.h>
|
|
|
|
#include <asm/sections.h>
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
int __cpu_number_map[NR_CPUS]; /* Map physical to logical */
|
|
|
|
int __cpu_logical_map[NR_CPUS]; /* Map logical to physical */
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2010-03-29 21:38:01 -06:00
|
|
|
struct plat_smp_ops *mp_ops = NULL;
|
|
|
|
|
|
|
|
void __cpuinit register_smp_ops(struct plat_smp_ops *ops)
|
|
|
|
{
|
|
|
|
if (mp_ops)
|
|
|
|
printk(KERN_WARNING "Overriding previously set SMP ops\n");
|
|
|
|
|
|
|
|
mp_ops = ops;
|
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
static inline void __init smp_store_cpu_info(unsigned int cpu)
|
|
|
|
{
|
2007-09-21 03:32:32 -06:00
|
|
|
struct sh_cpuinfo *c = cpu_data + cpu;
|
|
|
|
|
2009-10-13 23:14:30 -06:00
|
|
|
memcpy(c, &boot_cpu_data, sizeof(struct sh_cpuinfo));
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
c->loops_per_jiffy = loops_per_jiffy;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
void __init smp_prepare_cpus(unsigned int max_cpus)
|
|
|
|
{
|
|
|
|
unsigned int cpu = smp_processor_id();
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
init_new_context(current, &init_mm);
|
|
|
|
current_thread_info()->cpu = cpu;
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->prepare_cpus(max_cpus);
|
2007-09-21 03:32:32 -06:00
|
|
|
|
|
|
|
#ifndef CONFIG_HOTPLUG_CPU
|
2009-06-12 07:03:14 -06:00
|
|
|
init_cpu_present(&cpu_possible_map);
|
2007-09-21 03:32:32 -06:00
|
|
|
#endif
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
void __devinit smp_prepare_boot_cpu(void)
|
|
|
|
{
|
|
|
|
unsigned int cpu = smp_processor_id();
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
__cpu_number_map[0] = cpu;
|
|
|
|
__cpu_logical_map[0] = cpu;
|
|
|
|
|
2009-06-12 07:03:14 -06:00
|
|
|
set_cpu_online(cpu, true);
|
|
|
|
set_cpu_possible(cpu, true);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
asmlinkage void __cpuinit start_secondary(void)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-09-21 03:32:32 -06:00
|
|
|
unsigned int cpu;
|
|
|
|
struct mm_struct *mm = &init_mm;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2010-03-28 14:08:25 -06:00
|
|
|
enable_mmu();
|
2007-09-21 03:32:32 -06:00
|
|
|
atomic_inc(&mm->mm_count);
|
|
|
|
atomic_inc(&mm->mm_users);
|
|
|
|
current->active_mm = mm;
|
|
|
|
BUG_ON(current->mm);
|
|
|
|
enter_lazy_tlb(mm, current);
|
|
|
|
|
|
|
|
per_cpu_trap_init();
|
|
|
|
|
|
|
|
preempt_disable();
|
|
|
|
|
2008-09-07 08:57:22 -06:00
|
|
|
notify_cpu_starting(smp_processor_id());
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
local_irq_enable();
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-08-06 03:37:07 -06:00
|
|
|
cpu = smp_processor_id();
|
|
|
|
|
|
|
|
/* Enable local timers */
|
|
|
|
local_timer_setup(cpu);
|
2007-09-21 03:32:32 -06:00
|
|
|
calibrate_delay();
|
|
|
|
|
|
|
|
smp_store_cpu_info(cpu);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2010-04-26 03:39:50 -06:00
|
|
|
set_cpu_online(cpu, true);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
cpu_idle();
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
extern struct {
|
|
|
|
unsigned long sp;
|
|
|
|
unsigned long bss_start;
|
|
|
|
unsigned long bss_end;
|
|
|
|
void *start_kernel_fn;
|
|
|
|
void *cpu_init_fn;
|
|
|
|
void *thread_info;
|
|
|
|
} stack_start;
|
|
|
|
|
|
|
|
int __cpuinit __cpu_up(unsigned int cpu)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2007-09-21 03:32:32 -06:00
|
|
|
struct task_struct *tsk;
|
|
|
|
unsigned long timeout;
|
2005-11-08 22:39:01 -07:00
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
tsk = fork_idle(cpu);
|
|
|
|
if (IS_ERR(tsk)) {
|
|
|
|
printk(KERN_ERR "Failed forking idle task for cpu %d\n", cpu);
|
|
|
|
return PTR_ERR(tsk);
|
|
|
|
}
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
/* Fill in data in head.S for secondary cpus */
|
|
|
|
stack_start.sp = tsk->thread.sp;
|
|
|
|
stack_start.thread_info = tsk->stack;
|
|
|
|
stack_start.bss_start = 0; /* don't clear bss for secondary cpus */
|
|
|
|
stack_start.start_kernel_fn = start_secondary;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2009-10-13 20:51:28 -06:00
|
|
|
flush_icache_range((unsigned long)&stack_start,
|
|
|
|
(unsigned long)&stack_start + sizeof(stack_start));
|
|
|
|
wmb();
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->start_cpu(cpu, (unsigned long)_stext);
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2007-09-21 03:32:32 -06:00
|
|
|
timeout = jiffies + HZ;
|
|
|
|
while (time_before(jiffies, timeout)) {
|
|
|
|
if (cpu_online(cpu))
|
|
|
|
break;
|
|
|
|
|
|
|
|
udelay(10);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (cpu_online(cpu))
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
return -ENOENT;
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
void __init smp_cpus_done(unsigned int max_cpus)
|
|
|
|
{
|
2007-09-21 03:32:32 -06:00
|
|
|
unsigned long bogosum = 0;
|
|
|
|
int cpu;
|
|
|
|
|
|
|
|
for_each_online_cpu(cpu)
|
|
|
|
bogosum += cpu_data[cpu].loops_per_jiffy;
|
|
|
|
|
|
|
|
printk(KERN_INFO "SMP: Total of %d processors activated "
|
|
|
|
"(%lu.%02lu BogoMIPS).\n", num_online_cpus(),
|
|
|
|
bogosum / (500000/HZ),
|
|
|
|
(bogosum / (5000/HZ)) % 100);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
void smp_send_reschedule(int cpu)
|
|
|
|
{
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->send_ipi(cpu, SMP_MSG_RESCHEDULE);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
void smp_send_stop(void)
|
|
|
|
{
|
2008-06-06 03:18:06 -06:00
|
|
|
smp_call_function(stop_this_cpu, 0, 0);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2009-06-12 07:02:35 -06:00
|
|
|
void arch_send_call_function_ipi_mask(const struct cpumask *mask)
|
2005-04-16 16:20:36 -06:00
|
|
|
{
|
2008-06-10 12:52:59 -06:00
|
|
|
int cpu;
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2009-06-12 07:02:35 -06:00
|
|
|
for_each_cpu(cpu, mask)
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->send_ipi(cpu, SMP_MSG_FUNCTION);
|
2008-06-10 12:52:59 -06:00
|
|
|
}
|
2005-04-16 16:20:36 -06:00
|
|
|
|
2008-06-10 12:52:59 -06:00
|
|
|
void arch_send_call_function_single_ipi(int cpu)
|
|
|
|
{
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->send_ipi(cpu, SMP_MSG_FUNCTION_SINGLE);
|
2005-04-16 16:20:36 -06:00
|
|
|
}
|
|
|
|
|
2008-12-13 03:50:26 -07:00
|
|
|
void smp_timer_broadcast(const struct cpumask *mask)
|
2008-08-06 03:21:03 -06:00
|
|
|
{
|
|
|
|
int cpu;
|
|
|
|
|
2008-12-13 03:50:26 -07:00
|
|
|
for_each_cpu(cpu, mask)
|
2010-03-29 21:38:01 -06:00
|
|
|
mp_ops->send_ipi(cpu, SMP_MSG_TIMER);
|
2008-08-06 03:21:03 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static void ipi_timer(void)
|
|
|
|
{
|
|
|
|
irq_enter();
|
2008-08-06 03:37:07 -06:00
|
|
|
local_timer_interrupt();
|
2008-08-06 03:21:03 -06:00
|
|
|
irq_exit();
|
|
|
|
}
|
|
|
|
|
2008-08-06 03:02:48 -06:00
|
|
|
void smp_message_recv(unsigned int msg)
|
|
|
|
{
|
|
|
|
switch (msg) {
|
|
|
|
case SMP_MSG_FUNCTION:
|
|
|
|
generic_smp_call_function_interrupt();
|
|
|
|
break;
|
|
|
|
case SMP_MSG_RESCHEDULE:
|
|
|
|
break;
|
|
|
|
case SMP_MSG_FUNCTION_SINGLE:
|
|
|
|
generic_smp_call_function_single_interrupt();
|
|
|
|
break;
|
2008-08-06 03:21:03 -06:00
|
|
|
case SMP_MSG_TIMER:
|
|
|
|
ipi_timer();
|
|
|
|
break;
|
2008-08-06 03:02:48 -06:00
|
|
|
default:
|
|
|
|
printk(KERN_WARNING "SMP %d: %s(): unknown IPI %d\n",
|
|
|
|
smp_processor_id(), __func__, msg);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
2005-04-16 16:20:36 -06:00
|
|
|
/* Not really SMP stuff ... */
|
|
|
|
int setup_profiling_timer(unsigned int multiplier)
|
|
|
|
{
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2007-09-21 03:09:55 -06:00
|
|
|
static void flush_tlb_all_ipi(void *info)
|
|
|
|
{
|
|
|
|
local_flush_tlb_all();
|
|
|
|
}
|
|
|
|
|
|
|
|
void flush_tlb_all(void)
|
|
|
|
{
|
2008-05-09 01:39:44 -06:00
|
|
|
on_each_cpu(flush_tlb_all_ipi, 0, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static void flush_tlb_mm_ipi(void *mm)
|
|
|
|
{
|
|
|
|
local_flush_tlb_mm((struct mm_struct *)mm);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*
|
|
|
|
* The following tlb flush calls are invoked when old translations are
|
|
|
|
* being torn down, or pte attributes are changing. For single threaded
|
|
|
|
* address spaces, a new context is obtained on the current cpu, and tlb
|
|
|
|
* context on other cpus are invalidated to force a new context allocation
|
|
|
|
* at switch_mm time, should the mm ever be used on other cpus. For
|
|
|
|
* multithreaded address spaces, intercpu interrupts have to be sent.
|
|
|
|
* Another case where intercpu interrupts are required is when the target
|
|
|
|
* mm might be active on another cpu (eg debuggers doing the flushes on
|
|
|
|
* behalf of debugees, kswapd stealing pages from another process etc).
|
|
|
|
* Kanoj 07/00.
|
|
|
|
*/
|
|
|
|
|
|
|
|
void flush_tlb_mm(struct mm_struct *mm)
|
|
|
|
{
|
|
|
|
preempt_disable();
|
|
|
|
|
|
|
|
if ((atomic_read(&mm->mm_users) != 1) || (current->mm != mm)) {
|
2008-06-06 03:18:06 -06:00
|
|
|
smp_call_function(flush_tlb_mm_ipi, (void *)mm, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
} else {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < num_online_cpus(); i++)
|
|
|
|
if (smp_processor_id() != i)
|
|
|
|
cpu_context(i, mm) = 0;
|
|
|
|
}
|
|
|
|
local_flush_tlb_mm(mm);
|
|
|
|
|
|
|
|
preempt_enable();
|
|
|
|
}
|
|
|
|
|
|
|
|
struct flush_tlb_data {
|
|
|
|
struct vm_area_struct *vma;
|
|
|
|
unsigned long addr1;
|
|
|
|
unsigned long addr2;
|
|
|
|
};
|
|
|
|
|
|
|
|
static void flush_tlb_range_ipi(void *info)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data *fd = (struct flush_tlb_data *)info;
|
|
|
|
|
|
|
|
local_flush_tlb_range(fd->vma, fd->addr1, fd->addr2);
|
|
|
|
}
|
|
|
|
|
|
|
|
void flush_tlb_range(struct vm_area_struct *vma,
|
|
|
|
unsigned long start, unsigned long end)
|
|
|
|
{
|
|
|
|
struct mm_struct *mm = vma->vm_mm;
|
|
|
|
|
|
|
|
preempt_disable();
|
|
|
|
if ((atomic_read(&mm->mm_users) != 1) || (current->mm != mm)) {
|
|
|
|
struct flush_tlb_data fd;
|
|
|
|
|
|
|
|
fd.vma = vma;
|
|
|
|
fd.addr1 = start;
|
|
|
|
fd.addr2 = end;
|
2008-06-06 03:18:06 -06:00
|
|
|
smp_call_function(flush_tlb_range_ipi, (void *)&fd, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
} else {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < num_online_cpus(); i++)
|
|
|
|
if (smp_processor_id() != i)
|
|
|
|
cpu_context(i, mm) = 0;
|
|
|
|
}
|
|
|
|
local_flush_tlb_range(vma, start, end);
|
|
|
|
preempt_enable();
|
|
|
|
}
|
|
|
|
|
|
|
|
static void flush_tlb_kernel_range_ipi(void *info)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data *fd = (struct flush_tlb_data *)info;
|
|
|
|
|
|
|
|
local_flush_tlb_kernel_range(fd->addr1, fd->addr2);
|
|
|
|
}
|
|
|
|
|
|
|
|
void flush_tlb_kernel_range(unsigned long start, unsigned long end)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data fd;
|
|
|
|
|
|
|
|
fd.addr1 = start;
|
|
|
|
fd.addr2 = end;
|
2008-05-09 01:39:44 -06:00
|
|
|
on_each_cpu(flush_tlb_kernel_range_ipi, (void *)&fd, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
}
|
|
|
|
|
|
|
|
static void flush_tlb_page_ipi(void *info)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data *fd = (struct flush_tlb_data *)info;
|
|
|
|
|
|
|
|
local_flush_tlb_page(fd->vma, fd->addr1);
|
|
|
|
}
|
|
|
|
|
|
|
|
void flush_tlb_page(struct vm_area_struct *vma, unsigned long page)
|
|
|
|
{
|
|
|
|
preempt_disable();
|
|
|
|
if ((atomic_read(&vma->vm_mm->mm_users) != 1) ||
|
|
|
|
(current->mm != vma->vm_mm)) {
|
|
|
|
struct flush_tlb_data fd;
|
|
|
|
|
|
|
|
fd.vma = vma;
|
|
|
|
fd.addr1 = page;
|
2008-06-06 03:18:06 -06:00
|
|
|
smp_call_function(flush_tlb_page_ipi, (void *)&fd, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
} else {
|
|
|
|
int i;
|
|
|
|
for (i = 0; i < num_online_cpus(); i++)
|
|
|
|
if (smp_processor_id() != i)
|
|
|
|
cpu_context(i, vma->vm_mm) = 0;
|
|
|
|
}
|
|
|
|
local_flush_tlb_page(vma, page);
|
|
|
|
preempt_enable();
|
|
|
|
}
|
|
|
|
|
|
|
|
static void flush_tlb_one_ipi(void *info)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data *fd = (struct flush_tlb_data *)info;
|
|
|
|
local_flush_tlb_one(fd->addr1, fd->addr2);
|
|
|
|
}
|
|
|
|
|
|
|
|
void flush_tlb_one(unsigned long asid, unsigned long vaddr)
|
|
|
|
{
|
|
|
|
struct flush_tlb_data fd;
|
|
|
|
|
|
|
|
fd.addr1 = asid;
|
|
|
|
fd.addr2 = vaddr;
|
|
|
|
|
2008-06-06 03:18:06 -06:00
|
|
|
smp_call_function(flush_tlb_one_ipi, (void *)&fd, 1);
|
2007-09-21 03:09:55 -06:00
|
|
|
local_flush_tlb_one(asid, vaddr);
|
|
|
|
}
|