cpuidle.c 1.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475
  1. /*
  2. * based on arch/arm/mach-kirkwood/cpuidle.c
  3. *
  4. * CPU idle support for AT91 SoC
  5. *
  6. * This file is licensed under the terms of the GNU General Public
  7. * License version 2. This program is licensed "as is" without any
  8. * warranty of any kind, whether express or implied.
  9. *
  10. * The cpu idle uses wait-for-interrupt and RAM self refresh in order
  11. * to implement two idle states -
  12. * #1 wait-for-interrupt
  13. * #2 wait-for-interrupt and RAM self refresh
  14. */
  15. #include <linux/kernel.h>
  16. #include <linux/init.h>
  17. #include <linux/platform_device.h>
  18. #include <linux/cpuidle.h>
  19. #include <linux/io.h>
  20. #include <linux/export.h>
  21. #include <asm/proc-fns.h>
  22. #include <asm/cpuidle.h>
  23. #include "pm.h"
  24. #define AT91_MAX_STATES 2
  25. static DEFINE_PER_CPU(struct cpuidle_device, at91_cpuidle_device);
  26. /* Actual code that puts the SoC in different idle states */
  27. static int at91_enter_idle(struct cpuidle_device *dev,
  28. struct cpuidle_driver *drv,
  29. int index)
  30. {
  31. at91_standby();
  32. return index;
  33. }
  34. static struct cpuidle_driver at91_idle_driver = {
  35. .name = "at91_idle",
  36. .owner = THIS_MODULE,
  37. .en_core_tk_irqen = 1,
  38. .states[0] = ARM_CPUIDLE_WFI_STATE,
  39. .states[1] = {
  40. .enter = at91_enter_idle,
  41. .exit_latency = 10,
  42. .target_residency = 100000,
  43. .flags = CPUIDLE_FLAG_TIME_VALID,
  44. .name = "RAM_SR",
  45. .desc = "WFI and DDR Self Refresh",
  46. },
  47. .state_count = AT91_MAX_STATES,
  48. };
  49. /* Initialize CPU idle by registering the idle states */
  50. static int at91_init_cpuidle(void)
  51. {
  52. struct cpuidle_device *device;
  53. device = &per_cpu(at91_cpuidle_device, smp_processor_id());
  54. device->state_count = AT91_MAX_STATES;
  55. cpuidle_register_driver(&at91_idle_driver);
  56. if (cpuidle_register_device(device)) {
  57. printk(KERN_ERR "at91_init_cpuidle: Failed registering\n");
  58. return -EIO;
  59. }
  60. return 0;
  61. }
  62. device_initcall(at91_init_cpuidle);