3995eb8205
It's really unnecessary to have plat-mxc, and let's merge it into mach-imx. It's pretty much just a bunch of file renaming and Kconfig/Makefile merge. To make the change less invasive, we keep using Kconfig symbol CONFIG_ARCH_MXC for mach-imx sub-architecture. Signed-off-by: Shawn Guo <shawn.guo@linaro.org> Acked-by: Sascha Hauer <s.hauer@pengutronix.de> Acked-by: Arnd Bergmann <arnd@arndb.de>
80 lines
1.8 KiB
C
80 lines
1.8 KiB
C
/*
|
|
* Copyright 2012 Freescale Semiconductor, Inc.
|
|
* Copyright 2012 Linaro Ltd.
|
|
*
|
|
* The code contained herein is licensed under the GNU General Public
|
|
* License. You may obtain a copy of the GNU General Public License
|
|
* Version 2 or later at the following locations:
|
|
*
|
|
* http://www.opensource.org/licenses/gpl-license.html
|
|
* http://www.gnu.org/copyleft/gpl.html
|
|
*/
|
|
|
|
#include <linux/cpuidle.h>
|
|
#include <linux/err.h>
|
|
#include <linux/hrtimer.h>
|
|
#include <linux/io.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/slab.h>
|
|
|
|
static struct cpuidle_device __percpu * imx_cpuidle_devices;
|
|
|
|
static void __init imx_cpuidle_devices_uninit(void)
|
|
{
|
|
int cpu_id;
|
|
struct cpuidle_device *dev;
|
|
|
|
for_each_possible_cpu(cpu_id) {
|
|
dev = per_cpu_ptr(imx_cpuidle_devices, cpu_id);
|
|
cpuidle_unregister_device(dev);
|
|
}
|
|
|
|
free_percpu(imx_cpuidle_devices);
|
|
}
|
|
|
|
int __init imx_cpuidle_init(struct cpuidle_driver *drv)
|
|
{
|
|
struct cpuidle_device *dev;
|
|
int cpu_id, ret;
|
|
|
|
if (drv->state_count > CPUIDLE_STATE_MAX) {
|
|
pr_err("%s: state_count exceeds maximum\n", __func__);
|
|
return -EINVAL;
|
|
}
|
|
|
|
ret = cpuidle_register_driver(drv);
|
|
if (ret) {
|
|
pr_err("%s: Failed to register cpuidle driver with error: %d\n",
|
|
__func__, ret);
|
|
return ret;
|
|
}
|
|
|
|
imx_cpuidle_devices = alloc_percpu(struct cpuidle_device);
|
|
if (imx_cpuidle_devices == NULL) {
|
|
ret = -ENOMEM;
|
|
goto unregister_drv;
|
|
}
|
|
|
|
/* initialize state data for each cpuidle_device */
|
|
for_each_possible_cpu(cpu_id) {
|
|
dev = per_cpu_ptr(imx_cpuidle_devices, cpu_id);
|
|
dev->cpu = cpu_id;
|
|
dev->state_count = drv->state_count;
|
|
|
|
ret = cpuidle_register_device(dev);
|
|
if (ret) {
|
|
pr_err("%s: Failed to register cpu %u, error: %d\n",
|
|
__func__, cpu_id, ret);
|
|
goto uninit;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
|
|
uninit:
|
|
imx_cpuidle_devices_uninit();
|
|
|
|
unregister_drv:
|
|
cpuidle_unregister_driver(drv);
|
|
return ret;
|
|
}
|