Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
torvalds
GitHub Repository: torvalds/linux
 Path: blob/master/arch/sh/kernel/cpu/sh3/swsusp.S
26495 views
1
/* SPDX-License-Identifier: GPL-2.0

2
 *

3
 * arch/sh/kernel/cpu/sh3/swsusp.S

4
 *

5
 * Copyright (C) 2009 Magnus Damm

6
 */

7
#include <linux/sys.h>

8
#include <linux/errno.h>

9
#include <linux/linkage.h>

10
#include <asm/asm-offsets.h>

11
#include <asm/page.h>

12


13
#define k0	r0

14
#define k1	r1

15
#define k2	r2

16
#define k3	r3

17
#define k4	r4

18


19
! swsusp_arch_resume()

20
! - copy restore_pblist pages

21
! - restore registers from swsusp_arch_regs_cpu0

22


23
ENTRY(swsusp_arch_resume)

24
	mov.l	1f, r15

25
	mov.l	2f, r4

26
	mov.l	@r4, r4

27


28
swsusp_copy_loop:

29
	mov	r4, r0

30
	cmp/eq	#0, r0

31
	bt	swsusp_restore_regs

32


33
	mov.l	@(PBE_ADDRESS, r4), r2

34
	mov.l	@(PBE_ORIG_ADDRESS, r4), r5

35


36
	mov	#(PAGE_SIZE >> 10), r3

37
	shll8	r3

38
	shlr2	r3 /* PAGE_SIZE / 16 */

39
swsusp_copy_page:

40
	dt	r3

41
	mov.l	@r2+,r1   /*  16n+0 */

42
	mov.l	r1,@r5

43
	add	#4,r5

44
	mov.l	@r2+,r1	  /*  16n+4 */

45
	mov.l	r1,@r5

46
	add	#4,r5

47
	mov.l	@r2+,r1   /*  16n+8 */

48
	mov.l	r1,@r5

49
	add	#4,r5

50
	mov.l	@r2+,r1   /*  16n+12 */

51
	mov.l	r1,@r5

52
	bf/s	swsusp_copy_page

53
	 add	#4,r5

54


55
	bra	swsusp_copy_loop

56
	 mov.l	@(PBE_NEXT, r4), r4

57


58
swsusp_restore_regs:

59
	! BL=0: R7->R0 is bank0

60
	mov.l	3f, r8

61
	mov.l	4f, r5

62
	jsr	@r5

63
	 nop

64


65
	! BL=1: R7->R0 is bank1

66
	lds	k2, pr

67
	ldc	k3, ssr

68


69
	mov.l	@r15+, r0

70
	mov.l	@r15+, r1

71
	mov.l	@r15+, r2

72
	mov.l	@r15+, r3

73
	mov.l	@r15+, r4

74
	mov.l	@r15+, r5

75
	mov.l	@r15+, r6

76
	mov.l	@r15+, r7

77


78
	rte

79
	 nop

80
	! BL=0: R7->R0 is bank0

81


82
	.align	2

83
1:	.long	swsusp_arch_regs_cpu0

84
2:	.long	restore_pblist

85
3:	.long	0x20000000 ! RB=1

86
4:	.long	restore_regs

87


88
! swsusp_arch_suspend()

89
! - prepare pc for resume, return from function without swsusp_save on resume

90
! - save registers in swsusp_arch_regs_cpu0

91
! - call swsusp_save write suspend image

92


93
ENTRY(swsusp_arch_suspend)

94
	sts	pr, r0		! save pr in r0

95
	mov	r15, r2		! save sp in r2

96
	mov	r8, r5		! save r8 in r5

97
	stc	sr, r1

98
	ldc	r1, ssr		! save sr in ssr

99
	mov.l	1f, r1

100
	ldc	r1, spc		! setup pc value for resuming

101
	mov.l	5f, r15		! use swsusp_arch_regs_cpu0 as stack

102
	mov.l	6f, r3

103
	add	r3, r15		! save from top of structure

104


105
	! BL=0: R7->R0 is bank0

106
	mov.l	2f, r3		! get new SR value for bank1

107
	mov	#0, r4

108
	mov.l	7f, r1

109
	jsr	@r1		! switch to bank1 and save bank1 r7->r0

110
	 not	r4, r4

111


112
	! BL=1: R7->R0 is bank1

113
	stc	r2_bank, k0	! fetch old sp from r2_bank0

114
	mov.l	3f, k4		! SR bits to clear in k4

115
	mov.l	8f, k1

116
	jsr	@k1		! switch to bank0 and save all regs

117
	 stc	r0_bank, k3	! fetch old pr from r0_bank0

118


119
	! BL=0: R7->R0 is bank0

120
	mov	r2, r15		! restore old sp

121
	mov	r5, r8		! restore old r8

122
	stc	ssr, r1

123
	ldc	r1, sr		! restore old sr

124
	lds	r0, pr		! restore old pr

125
	mov.l	4f, r0

126
	jmp	@r0

127
	 nop

128


129
swsusp_call_save:

130
	mov	r2, r15		! restore old sp

131
	mov	r5, r8		! restore old r8

132
	lds	r0, pr		! restore old pr

133
	rts

134
	 mov	#0, r0

135


136
	.align	2

137
1:	.long	swsusp_call_save

138
2:	.long	0x20000000 ! RB=1

139
3:	.long	0xdfffffff ! RB=0

140
4:	.long	swsusp_save

141
5:	.long	swsusp_arch_regs_cpu0

142
6:	.long	SWSUSP_ARCH_REGS_SIZE

143
7:	.long	save_low_regs

144
8:	.long	save_regs

145


146