Blame view

kernel/linux-imx6_3.14.28/arch/arm/mach-s3c64xx/sleep.S 2.1 KB
6b13f685e   김민수   BSP 최초 추가
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
64
65
66
67
68
69
70
71
72
  /* linux/arch/arm/plat-s3c64xx/sleep.S
   *
   * Copyright 2008 Openmoko, Inc.
   * Copyright 2008 Simtec Electronics
   *	Ben Dooks <ben@simtec.co.uk>
   *	http://armlinux.simtec.co.uk/
   *
   * S3C64XX CPU sleep code
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License version 2 as
   * published by the Free Software Foundation.
  */
  
  #include <linux/linkage.h>
  #include <asm/assembler.h>
  #include <mach/map.h>
  
  #undef S3C64XX_VA_GPIO
  #define S3C64XX_VA_GPIO (0x0)
  
  #include <mach/regs-gpio.h>
  
  #define LL_UART (S3C_PA_UART + (0x400 * CONFIG_S3C_LOWLEVEL_UART_PORT))
  
  	.text
  
  	/* Sleep magic, the word before the resume entry point so that the
  	 * bootloader can check for a resumeable image. */
  
  	.word	0x2bedf00d
  
  	/* s3c_cpu_reusme
  	 *
  	 * This is the entry point, stored by whatever method the bootloader
  	 * requires to get the kernel runnign again. This code expects to be
  	 * entered with no caches live and the MMU disabled. It will then
  	 * restore the MMU and other basic CP registers saved and restart
  	 * the kernel C code to finish the resume code.
  	*/
  
  ENTRY(s3c_cpu_resume)
  	msr	cpsr_c, #PSR_I_BIT | PSR_F_BIT | SVC_MODE
  	ldr	r2, =LL_UART		/* for debug */
  
  #ifdef CONFIG_S3C_PM_DEBUG_LED_SMDK
  
  #define S3C64XX_GPNCON			(S3C64XX_GPN_BASE + 0x00)
  #define S3C64XX_GPNDAT			(S3C64XX_GPN_BASE + 0x04)
  
  #define S3C64XX_GPN_CONMASK(__gpio)	(0x3 << ((__gpio) * 2))
  #define S3C64XX_GPN_OUTPUT(__gpio)	(0x1 << ((__gpio) * 2))
  
  	/* Initialise the GPIO state if we are debugging via the SMDK LEDs,
  	 * as the uboot version supplied resets these to inputs during the
  	 * resume checks.
  	*/
  
  	ldr	r3, =S3C64XX_PA_GPIO
  	ldr	r0, [ r3, #S3C64XX_GPNCON ]
  	bic	r0, r0, #(S3C64XX_GPN_CONMASK(12) | S3C64XX_GPN_CONMASK(13) | \
  			  S3C64XX_GPN_CONMASK(14) | S3C64XX_GPN_CONMASK(15))
  	orr	r0, r0, #(S3C64XX_GPN_OUTPUT(12) | S3C64XX_GPN_OUTPUT(13) | \
  			  S3C64XX_GPN_OUTPUT(14) | S3C64XX_GPN_OUTPUT(15))
  	str	r0, [ r3, #S3C64XX_GPNCON ]
  
  	ldr	r0, [ r3, #S3C64XX_GPNDAT ]
  	bic	r0, r0, #0xf << 12			@ GPN12..15
  	orr	r0, r0, #1 << 15			@ GPN15
  	str	r0, [ r3, #S3C64XX_GPNDAT ]
  #endif
  	b	cpu_resume