sleep-sh7372.S 2.6 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697
  1. /*
  2. * sh7372 lowlevel sleep code for "Core Standby Mode"
  3. *
  4. * Copyright (C) 2011 Magnus Damm
  5. *
  6. * In "Core Standby Mode" the ARM core is off, but L2 cache is still on
  7. *
  8. * Based on mach-omap2/sleep34xx.S
  9. *
  10. * (C) Copyright 2007 Texas Instruments
  11. * Karthik Dasu <karthik-dp@ti.com>
  12. *
  13. * (C) Copyright 2004 Texas Instruments, <www.ti.com>
  14. * Richard Woodruff <r-woodruff2@ti.com>
  15. *
  16. * This program is free software; you can redistribute it and/or
  17. * modify it under the terms of the GNU General Public License as
  18. * published by the Free Software Foundation; either version 2 of
  19. * the License, or (at your option) any later version.
  20. *
  21. * This program is distributed in the hope that it will be useful,
  22. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  23. * MERCHANTABILITY or FITNESS FOR A PARTICULAR /PURPOSE. See the
  24. * GNU General Public License for more details.
  25. *
  26. * You should have received a copy of the GNU General Public License
  27. * along with this program; if not, write to the Free Software
  28. * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
  29. * MA 02111-1307 USA
  30. */
  31. #include <linux/linkage.h>
  32. #include <linux/init.h>
  33. #include <asm/memory.h>
  34. #include <asm/assembler.h>
  35. #if defined(CONFIG_SUSPEND) || defined(CONFIG_CPU_IDLE)
  36. .align 12
  37. .text
  38. .global sh7372_resume_core_standby_sysc
  39. sh7372_resume_core_standby_sysc:
  40. ldr pc, 1f
  41. 1: .long cpu_resume - PAGE_OFFSET + PLAT_PHYS_OFFSET
  42. #define SPDCR 0xe6180008
  43. /* A3SM & A4S power down */
  44. .global sh7372_do_idle_sysc
  45. sh7372_do_idle_sysc:
  46. mov r8, r0 /* sleep mode passed in r0 */
  47. /*
  48. * Clear the SCTLR.C bit to prevent further data cache
  49. * allocation. Clearing SCTLR.C would make all the data accesses
  50. * strongly ordered and would not hit the cache.
  51. */
  52. mrc p15, 0, r0, c1, c0, 0
  53. bic r0, r0, #(1 << 2) @ Disable the C bit
  54. mcr p15, 0, r0, c1, c0, 0
  55. isb
  56. /* disable L2 cache in the aux control register */
  57. mrc p15, 0, r10, c1, c0, 1
  58. bic r10, r10, #2
  59. mcr p15, 0, r10, c1, c0, 1
  60. /*
  61. * Invalidate data cache again.
  62. */
  63. ldr r1, kernel_flush
  64. blx r1
  65. /*
  66. * The kernel doesn't interwork: v7_flush_dcache_all in particluar will
  67. * always return in Thumb state when CONFIG_THUMB2_KERNEL is enabled.
  68. * This sequence switches back to ARM. Note that .align may insert a
  69. * nop: bx pc needs to be word-aligned in order to work.
  70. */
  71. THUMB( .thumb )
  72. THUMB( .align )
  73. THUMB( bx pc )
  74. THUMB( nop )
  75. .arm
  76. /* Data memory barrier and Data sync barrier */
  77. dsb
  78. dmb
  79. /* SYSC power down */
  80. ldr r0, =SPDCR
  81. str r8, [r0]
  82. 1:
  83. b 1b
  84. kernel_flush:
  85. .word v7_flush_dcache_all
  86. #endif