release/src-rt-6.x.4708/linux/linux-2.6.36/arch/blackfin/mach-bf561/hotplug.c

   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
   8 #include <asm/blackfin.h>
   9 #include <asm/smp.h>
  10 #define SIC_SYSIRQ(irq) (irq - (IRQ_CORETMR + 1))
  11
  12 int hotplug_coreb;
  13
  14 void platform_cpu_die(void)
  15 {
  16         unsigned long iwr[2] = {0, 0};
  17         unsigned long bank = SIC_SYSIRQ(IRQ_SUPPLE_0) / 32;
  18         unsigned long bit = 1 << (SIC_SYSIRQ(IRQ_SUPPLE_0) % 32);
  19
  20         hotplug_coreb = 1;
  21
  22         iwr[bank] = bit;
  23
  24         /* disable core timer */
  25         bfin_write_TCNTL(0);
  26
  27         /* clear ipi interrupt IRQ_SUPPLE_0 */
  28         bfin_write_SICB_SYSCR(bfin_read_SICB_SYSCR() | (1 << (10 + 1)));
  29         SSYNC();
  30
  31         coreb_sleep(iwr[0], iwr[1], 0);
  32 }