| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  * drivers/power/smp.c - Functions for stopping other CPUs. | 
 | 3 |  * | 
 | 4 |  * Copyright 2004 Pavel Machek <pavel@suse.cz> | 
 | 5 |  * Copyright (C) 2002-2003 Nigel Cunningham <ncunningham@clear.net.nz> | 
 | 6 |  * | 
 | 7 |  * This file is released under the GPLv2. | 
 | 8 |  */ | 
 | 9 |  | 
 | 10 | #undef DEBUG | 
 | 11 |  | 
 | 12 | #include <linux/smp_lock.h> | 
 | 13 | #include <linux/interrupt.h> | 
 | 14 | #include <linux/suspend.h> | 
 | 15 | #include <linux/module.h> | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 16 | #include <linux/cpu.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 17 | #include <asm/atomic.h> | 
 | 18 | #include <asm/tlbflush.h> | 
 | 19 |  | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 20 | /* This is protected by pm_sem semaphore */ | 
 | 21 | static cpumask_t frozen_cpus; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 22 |  | 
 | 23 | void disable_nonboot_cpus(void) | 
 | 24 | { | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 25 | 	int cpu, error; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 |  | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 27 | 	error = 0; | 
 | 28 | 	cpus_clear(frozen_cpus); | 
 | 29 | 	printk("Freezing cpus ...\n"); | 
 | 30 | 	for_each_online_cpu(cpu) { | 
 | 31 | 		if (cpu == 0) | 
 | 32 | 			continue; | 
 | 33 | 		error = cpu_down(cpu); | 
 | 34 | 		if (!error) { | 
 | 35 | 			cpu_set(cpu, frozen_cpus); | 
 | 36 | 			printk("CPU%d is down\n", cpu); | 
 | 37 | 			continue; | 
 | 38 | 		} | 
 | 39 | 		printk("Error taking cpu %d down: %d\n", cpu, error); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | 	} | 
| Nigel Cunningham | bba0e46 | 2005-07-27 11:43:41 -0700 | [diff] [blame] | 41 | 	BUG_ON(raw_smp_processor_id() != 0); | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 42 | 	if (error) | 
 | 43 | 		panic("cpus not sleeping"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 44 | } | 
 | 45 |  | 
 | 46 | void enable_nonboot_cpus(void) | 
 | 47 | { | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 48 | 	int cpu, error; | 
 | 49 |  | 
 | 50 | 	printk("Thawing cpus ...\n"); | 
 | 51 | 	for_each_cpu_mask(cpu, frozen_cpus) { | 
| Ashok Raj | 34f361a | 2006-03-25 03:08:18 -0800 | [diff] [blame] | 52 | 		error = cpu_up(cpu); | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 53 | 		if (!error) { | 
 | 54 | 			printk("CPU%d is up\n", cpu); | 
 | 55 | 			continue; | 
 | 56 | 		} | 
 | 57 | 		printk("Error taking cpu %d up: %d\n", cpu, error); | 
 | 58 | 		panic("Not enough cpus"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 | 	} | 
| Li Shaohua | 5a72e04 | 2005-06-25 14:55:06 -0700 | [diff] [blame] | 60 | 	cpus_clear(frozen_cpus); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 61 | } | 
 | 62 |  |