arch/arm/mach-s3c/sleep-s3c2412.S

   1 /* SPDX-License-Identifier: GPL-2.0+ */
   2 /*
   3  * Copyright (c) 2007 Simtec Electronics
   4  *      Ben Dooks <ben@simtec.co.uk>
   5  *
   6  * S3C2412 Power Manager low-level sleep support
   7  */
   8
   9 #include <linux/linkage.h>
  10 #include <asm/assembler.h>
  11 #include "map.h"
  12
  13 #include "regs-irq.h"
  14
  15         .text
  16
  17         .global s3c2412_sleep_enter
  18
  19 s3c2412_sleep_enter:
  20         mov     r0, #0                  /* argument for coprocessors */
  21         ldr     r1, =S3C2410_INTPND
  22         ldr     r2, =S3C2410_SRCPND
  23         ldr     r3, =S3C2410_EINTPEND
  24
  25         teq     r0, r0
  26         bl      s3c2412_sleep_enter1
  27         teq     pc, r0
  28         bl      s3c2412_sleep_enter1
  29
  30         .align  5
  31
  32         /* this is called twice, first with the Z flag to ensure that the
  33          * instructions have been loaded into the cache, and the second
  34          * time to try and suspend the system.
  35         */
  36 s3c2412_sleep_enter1:
  37         mcr     p15, 0, r0, c7, c10, 4
  38         mcrne   p15, 0, r0, c7, c0, 4
  39
  40         /* if we return from here, it is because an interrupt was
  41          * active when we tried to shutdown. Try and ack the IRQ and
  42          * retry, as simply returning causes the system to lock.
  43         */
  44
  45         ldrne   r9, [r1]
  46         strne   r9, [r1]
  47         ldrne   r9, [r2]
  48         strne   r9, [r2]
  49         ldrne   r9, [r3]
  50         strne   r9, [r3]
  51         bne     s3c2412_sleep_enter1
  52
  53         ret     lr