Hi, On Mon, May 20, 2013 at 3:33 PM, Sanjay Singh Rawat <sanjay.ra...@linaro.org > wrote:
> Add function which prepare arm processors to enter the low power for > hotplug > functionality and handle the return path. > > Signed-off-by: Sanjay Singh Rawat <sanjay.ra...@linaro.org> > --- > arch/arm/include/asm/hotplug.h | 24 +++++++++++++++ > arch/arm/kernel/Makefile | 1 + > arch/arm/kernel/cpuhotplug.c | 64 > ++++++++++++++++++++++++++++++++++++++++ > 3 files changed, 89 insertions(+) > create mode 100644 arch/arm/include/asm/hotplug.h > create mode 100644 arch/arm/kernel/cpuhotplug.c > > diff --git a/arch/arm/include/asm/hotplug.h > b/arch/arm/include/asm/hotplug.h > new file mode 100644 > index 0000000..ae80f0e > --- /dev/null > +++ b/arch/arm/include/asm/hotplug.h > @@ -0,0 +1,24 @@ > +/* > + * arch/arm/include/asm/hotplug.h > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > + */ > + > +#ifdef CONFIG_HOTPLUG_CPU > + > +extern inline void cpu_enter_lowpower(void); > +extern inline void cpu_leave_lowpower(void); > + > +#else > +static inline void cpu_enter_lowpower(void) > +{ > + return -ENODEV; > +} > +static inline void cpu_leave_lowpower(void) > +{ > + return -ENODEV; > +} > + > +#endif > diff --git a/arch/arm/kernel/Makefile b/arch/arm/kernel/Makefile > index 5f3338e..9bd370b 100644 > --- a/arch/arm/kernel/Makefile > +++ b/arch/arm/kernel/Makefile > @@ -33,6 +33,7 @@ obj-$(CONFIG_ISA_DMA) += dma-isa.o > obj-$(CONFIG_PCI) += bios32.o isa.o > obj-$(CONFIG_ARM_CPU_SUSPEND) += sleep.o suspend.o > obj-$(CONFIG_SMP) += smp.o smp_tlb.o > +obj-$(CONFIG_HOTPLUG_CPU) += cpuhotplug.o > obj-$(CONFIG_HAVE_ARM_SCU) += smp_scu.o > obj-$(CONFIG_HAVE_ARM_TWD) += smp_twd.o > obj-$(CONFIG_ARM_ARCH_TIMER) += arch_timer.o > diff --git a/arch/arm/kernel/cpuhotplug.c b/arch/arm/kernel/cpuhotplug.c > new file mode 100644 > index 0000000..8651b96 > --- /dev/null > +++ b/arch/arm/kernel/cpuhotplug.c > @@ -0,0 +1,64 @@ > +/* > + * Copyright (C) 2002 ARM Ltd. > + * All Rights Reserved > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License version 2 as > + * published by the Free Software Foundation. > + */ > + > +#include <linux/kernel.h> > +#include <asm/cp15.h> > + > +/* > + * For Cortex-A9 processor > + */ > +static inline void ca9_enter_lowpower(void) > +{ > + unsigned int v; > + > + asm volatile( > + " mcr p15, 0, %1, c7, c5, 0\n" > + " mcr p15, 0, %1, c7, c10, 4\n" > + /* > + * Turn off coherency > + */ > + " mrc p15, 0, %0, c1, c0, 1\n" > + " bic %0, %0, %3\n" > + " mcr p15, 0, %0, c1, c0, 1\n" > + " mrc p15, 0, %0, c1, c0, 0\n" > + " bic %0, %0, %2\n" > + " mcr p15, 0, %0, c1, c0, 0\n" > + : "=&r" (v) > + : "r" (0), "Ir" (CR_C), "Ir" (0x40) > + : "cc"); > +} > + > +inline void cpu_leave_lowpower(void) > +{ > + unsigned int v; > + > + asm volatile( > + "mrc p15, 0, %0, c1, c0, 0\n" > + " orr %0, %0, %1\n" > + " mcr p15, 0, %0, c1, c0, 0\n" > + " mrc p15, 0, %0, c1, c0, 1\n" > + " orr %0, %0, %2\n" > + " mcr p15, 0, %0, c1, c0, 1\n" > + : "=&r" (v) > + : "Ir" (CR_C), "Ir" (0x40) > + : "cc"); > +} > + > +void cpu_enter_lowpower(void) > +{ > + int id = 0; > + > + /* check the cpuid */ > + asm("mrc p15, 0, %0, c0, c0, 0" : "=r"(id) : : "cc"); > do you want to call it every time? doesn't better to run it once and use the variable? or make function pointer and use it. > + > + if ((id & 0xffffffff) == 0x411fc090) > + ca9_enter_lowpower(); > + else > + pr_warn(KERN_WARNING "Unknown CPU type\n"); > +} > Thank you, Kyungmin Park > -- > 1.7.9.5 > > > _______________________________________________ > linaro-dev mailing list > linaro-dev@lists.linaro.org > http://lists.linaro.org/mailman/listinfo/linaro-dev >
_______________________________________________ linaro-dev mailing list linaro-dev@lists.linaro.org http://lists.linaro.org/mailman/listinfo/linaro-dev