smemc.c 1.2 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859
  1. /*
  2. * Static Memory Controller
  3. */
  4. #include <linux/module.h>
  5. #include <linux/kernel.h>
  6. #include <linux/init.h>
  7. #include <linux/io.h>
  8. #include <linux/syscore_ops.h>
  9. #include <mach/hardware.h>
  10. #include <mach/smemc.h>
  11. #ifdef CONFIG_PM
  12. static unsigned long msc[2];
  13. static unsigned long sxcnfg, memclkcfg;
  14. static unsigned long csadrcfg[4];
  15. static int pxa3xx_smemc_suspend(void)
  16. {
  17. msc[0] = __raw_readl(MSC0);
  18. msc[1] = __raw_readl(MSC1);
  19. sxcnfg = __raw_readl(SXCNFG);
  20. memclkcfg = __raw_readl(MEMCLKCFG);
  21. csadrcfg[0] = __raw_readl(CSADRCFG0);
  22. csadrcfg[1] = __raw_readl(CSADRCFG1);
  23. csadrcfg[2] = __raw_readl(CSADRCFG2);
  24. csadrcfg[3] = __raw_readl(CSADRCFG3);
  25. return 0;
  26. }
  27. static void pxa3xx_smemc_resume(void)
  28. {
  29. __raw_writel(msc[0], MSC0);
  30. __raw_writel(msc[1], MSC1);
  31. __raw_writel(sxcnfg, SXCNFG);
  32. __raw_writel(memclkcfg, MEMCLKCFG);
  33. __raw_writel(csadrcfg[0], CSADRCFG0);
  34. __raw_writel(csadrcfg[1], CSADRCFG1);
  35. __raw_writel(csadrcfg[2], CSADRCFG2);
  36. __raw_writel(csadrcfg[3], CSADRCFG3);
  37. }
  38. static struct syscore_ops smemc_syscore_ops = {
  39. .suspend = pxa3xx_smemc_suspend,
  40. .resume = pxa3xx_smemc_resume,
  41. };
  42. static int __init smemc_init(void)
  43. {
  44. if (cpu_is_pxa3xx())
  45. register_syscore_ops(&smemc_syscore_ops);
  46. return 0;
  47. }
  48. subsys_initcall(smemc_init);
  49. #endif