| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 1 | /* | 
 | 2 |  * Copyright 2007-2009 Analog Devices Inc. | 
 | 3 |  *               Graff Yang <graf.yang@analog.com> | 
 | 4 |  * | 
 | 5 |  * Licensed under the GPL-2 or later. | 
 | 6 |  */ | 
 | 7 |  | 
| Graf Yang | 6f546bc | 2010-01-28 10:46:55 +0000 | [diff] [blame] | 8 | #include <linux/smp.h> | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 9 | #include <asm/blackfin.h> | 
| Graf Yang | 1e924e2 | 2010-03-19 08:01:27 +0000 | [diff] [blame] | 10 | #include <asm/cacheflush.h> | 
| Graf Yang | 6f546bc | 2010-01-28 10:46:55 +0000 | [diff] [blame] | 11 | #include <mach/pll.h> | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 12 |  | 
 | 13 | int hotplug_coreb; | 
 | 14 |  | 
 | 15 | void platform_cpu_die(void) | 
 | 16 | { | 
| Graf Yang | 6f546bc | 2010-01-28 10:46:55 +0000 | [diff] [blame] | 17 | 	unsigned long iwr; | 
| Graf Yang | 1e924e2 | 2010-03-19 08:01:27 +0000 | [diff] [blame] | 18 |  | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 19 | 	hotplug_coreb = 1; | 
 | 20 |  | 
| Graf Yang | 1e924e2 | 2010-03-19 08:01:27 +0000 | [diff] [blame] | 21 | 	/* | 
 | 22 | 	 * When CoreB wakes up, the code in _coreb_trampoline_start cannot | 
 | 23 | 	 * turn off the data cache. This causes the CoreB failed to boot. | 
 | 24 | 	 * As a workaround, we invalidate all the data cache before sleep. | 
 | 25 | 	 */ | 
 | 26 | 	blackfin_invalidate_entire_dcache(); | 
 | 27 |  | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 28 | 	/* disable core timer */ | 
 | 29 | 	bfin_write_TCNTL(0); | 
 | 30 |  | 
| Graf Yang | 6f546bc | 2010-01-28 10:46:55 +0000 | [diff] [blame] | 31 | 	/* clear ipi interrupt IRQ_SUPPLE_0 of CoreB */ | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 32 | 	bfin_write_SICB_SYSCR(bfin_read_SICB_SYSCR() | (1 << (10 + 1))); | 
 | 33 | 	SSYNC(); | 
 | 34 |  | 
| Graf Yang | 6f546bc | 2010-01-28 10:46:55 +0000 | [diff] [blame] | 35 | 	/* set CoreB wakeup by ipi0, iwr will be discarded */ | 
 | 36 | 	bfin_iwr_set_sup0(&iwr, &iwr, &iwr); | 
 | 37 | 	SSYNC(); | 
 | 38 |  | 
 | 39 | 	coreb_die(); | 
| Graf Yang | 0b39db2 | 2009-12-28 11:13:51 +0000 | [diff] [blame] | 40 | } |