hc
2023-12-09 b22da3d8526a935aa31e086e63f60ff3246cb61c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
/* SPDX-License-Identifier: GPL-2.0-or-later */
/*
 * sleep mode for CSR SiRFprimaII
 *
 * Copyright (c) 2011 Cambridge Silicon Radio Limited, a CSR plc group company.
 */
 
#include <linux/linkage.h>
#include <asm/ptrace.h>
#include <asm/assembler.h>
 
#include "pm.h"
 
#define DENALI_CTL_22_OFF    0x58
#define DENALI_CTL_112_OFF    0x1c0
 
   .text
 
ENTRY(sirfsoc_finish_suspend)
   @ r5:     mem controller
   ldr     r0, =sirfsoc_memc_base
   ldr    r5, [r0]
   @ r6:     pwrc base offset
   ldr     r0, =sirfsoc_pwrc_base
   ldr    r6, [r0]
   @ r7:     rtc iobrg controller
   ldr     r0, =sirfsoc_rtciobrg_base
   ldr    r7, [r0]
 
   @ Read the power control register and set the
   @ sleep force bit.
   add    r0, r6, #SIRFSOC_PWRC_PDN_CTRL
   bl    __sirfsoc_rtc_iobrg_readl
   orr    r0,r0,#SIRFSOC_PWR_SLEEPFORCE
   add    r1, r6, #SIRFSOC_PWRC_PDN_CTRL
   bl    sirfsoc_rtc_iobrg_pre_writel
   mov    r1, #0x1
 
   @ read the MEM ctl register and set the self
   @ refresh bit
 
   ldr    r2, [r5, #DENALI_CTL_22_OFF]
   orr    r2, r2, #0x1
 
   @ Following code has to run from cache since
   @ the RAM is going to self refresh mode
   .align 5
   str    r2, [r5, #DENALI_CTL_22_OFF]
 
1:
   ldr    r4, [r5, #DENALI_CTL_112_OFF]
   tst    r4, #0x1
   bne    1b
 
   @ write SLEEPFORCE through rtc iobridge
 
   str    r1, [r7]
   @ wait rtc io bridge sync
1:
   ldr    r3, [r7]
   tst    r3, #0x01
   bne    1b
   b .