60 lines
1.5 KiB
C
60 lines
1.5 KiB
C
|
/*
|
||
|
|
* CLPS711X CPU idle driver
|
||
|
|
*
|
||
|
|
* Copyright (C) 2014 Alexander Shiyan <shc_work@mail.ru>
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or modify
|
||
|
|
* it under the terms of the GNU General Public License as published by
|
||
|
|
* the Free Software Foundation; either version 2 of the License, or
|
||
|
|
* (at your option) any later version.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/cpuidle.h>
|
||
|
|
#include <linux/err.h>
|
||
|
|
#include <linux/io.h>
|
||
|
|
#include <linux/init.h>
|
||
|
|
#include <linux/platform_device.h>
|
||
|
|
|
||
|
|
#define CLPS711X_CPUIDLE_NAME "clps711x-cpuidle"
|
||
|
|
|
||
|
|
static void __iomem *clps711x_halt;
|
||
|
|
|
||
|
|
static int clps711x_cpuidle_halt(struct cpuidle_device *dev,
|
||
|
|
struct cpuidle_driver *drv, int index)
|
||
|
|
{
|
||
|
|
writel(0xaa, clps711x_halt);
|
||
|
|
|
||
|
|
return index;
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct cpuidle_driver clps711x_idle_driver = {
|
||
|
|
.name = CLPS711X_CPUIDLE_NAME,
|
||
|
|
.owner = THIS_MODULE,
|
||
|
|
.states[0] = {
|
||
|
|
.name = "HALT",
|
||
|
|
.desc = "CLPS711X HALT",
|
||
|
|
.enter = clps711x_cpuidle_halt,
|
||
|
|
.exit_latency = 1,
|
||
|
|
},
|
||
|
|
.state_count = 1,
|
||
|
|
};
|
||
|
|
|
||
|
|
static int __init clps711x_cpuidle_probe(struct platform_device *pdev)
|
||
|
|
{
|
||
|
|
struct resource *res;
|
||
|
|
|
||
|
|
res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
||
|
|
clps711x_halt = devm_ioremap_resource(&pdev->dev, res);
|
||
|
|
if (IS_ERR(clps711x_halt))
|
||
|
|
return PTR_ERR(clps711x_halt);
|
||
|
|
|
||
|
|
return cpuidle_register(&clps711x_idle_driver, NULL);
|
||
|
|
}
|
||
|
|
|
||
|
|
static struct platform_driver clps711x_cpuidle_driver = {
|
||
|
|
.driver = {
|
||
|
|
.name = CLPS711X_CPUIDLE_NAME,
|
||
|
|
},
|
||
|
|
};
|
||
|
|
builtin_platform_driver_probe(clps711x_cpuidle_driver, clps711x_cpuidle_probe);
|