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

2
#include <linux/linkage.h>

3


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

5
#include <asm/page.h>

6
#include <asm/setup.h>

7


8


9
#define MMU_BASE	8		/* MMU flags base in cpu_mmu_flags */

10


11
.text

12


13
ENTRY(relocate_new_kernel)

14
	movel %sp@(4),%a0		/* a0 = ptr */

15
	movel %sp@(8),%a1		/* a1 = start */

16
	movel %sp@(12),%d1		/* d1 = cpu_mmu_flags */

17
	movew #PAGE_MASK,%d2		/* d2 = PAGE_MASK */

18


19
	/* Disable MMU */

20


21
	btst #MMU_BASE + MMUB_68851,%d1

22
	jeq 3f

23


24
1:	/* 68851 or 68030 */

25


26
	lea %pc@(.Lcopy),%a4

27
2:	addl #0x00000000,%a4		/* virt_to_phys() */

28


29
	.section .m68k_fixup,"aw"

30
	.long M68K_FIXUP_MEMOFFSET, 2b+2

31
	.previous

32


33
	.chip 68030

34
	pmove %tc,%d0			/* Disable MMU */

35
	bclr #7,%d0

36
	pmove %d0,%tc

37
	jmp %a4@			/* Jump to physical .Lcopy */

38
	.chip 68k

39


40
3:

41
	btst #MMU_BASE + MMUB_68030,%d1

42
	jne 1b

43


44
	btst #MMU_BASE + MMUB_68040,%d1

45
	jeq 6f

46


47
4:	/* 68040 or 68060 */

48


49
	lea %pc@(.Lcont040),%a4

50
5:	addl #0x00000000,%a4		/* virt_to_phys() */

51


52
	.section .m68k_fixup,"aw"

53
	.long M68K_FIXUP_MEMOFFSET, 5b+2

54
	.previous

55


56
	movel %a4,%d0

57
	andl #0xff000000,%d0

58
	orw #0xe020,%d0			/* Map 16 MiB, enable, cacheable */

59
	.chip 68040

60
	movec %d0,%itt0

61
	movec %d0,%dtt0

62
	.chip 68k

63
	jmp %a4@			/* Jump to physical .Lcont040 */

64


65
.Lcont040:

66
	moveq #0,%d0

67
	.chip 68040

68
	movec %d0,%tc			/* Disable MMU */

69
	movec %d0,%itt0

70
	movec %d0,%itt1

71
	movec %d0,%dtt0

72
	movec %d0,%dtt1

73
	.chip 68k

74
	jra .Lcopy

75


76
6:

77
	btst #MMU_BASE + MMUB_68060,%d1

78
	jne 4b

79


80
.Lcopy:

81
	movel %a0@+,%d0			/* d0 = entry = *ptr */

82
	jeq .Lflush

83


84
	btst #2,%d0			/* entry & IND_DONE? */

85
	jne .Lflush

86


87
	btst #1,%d0			/* entry & IND_INDIRECTION? */

88
	jeq 1f

89
	andw %d2,%d0

90
	movel %d0,%a0			/* ptr = entry & PAGE_MASK */

91
	jra .Lcopy

92


93
1:

94
	btst #0,%d0			/* entry & IND_DESTINATION? */

95
	jeq 2f

96
	andw %d2,%d0

97
	movel %d0,%a2			/* a2 = dst = entry & PAGE_MASK */

98
	jra .Lcopy

99


100
2:

101
	btst #3,%d0			/* entry & IND_SOURCE? */

102
	jeq .Lcopy

103


104
	andw %d2,%d0

105
	movel %d0,%a3			/* a3 = src = entry & PAGE_MASK */

106
	movew #PAGE_SIZE/32 - 1,%d0	/* d0 = PAGE_SIZE/32 - 1 */

107
3:

108
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

109
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

110
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

111
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

112
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

113
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

114
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

115
	movel %a3@+,%a2@+		/* *dst++ = *src++ */

116
	dbf %d0, 3b

117
	jra .Lcopy

118


119
.Lflush:

120
	/* Flush all caches */

121


122
	btst #CPUB_68020,%d1

123
	jeq 2f

124


125
1:	/* 68020 or 68030 */

126
	.chip 68030

127
	movec %cacr,%d0

128
	orw #0x808,%d0

129
	movec %d0,%cacr

130
	.chip 68k

131
	jra .Lreincarnate

132


133
2:

134
	btst #CPUB_68030,%d1

135
	jne 1b

136


137
	btst #CPUB_68040,%d1

138
	jeq 4f

139


140
3:	/* 68040 or 68060 */

141
	.chip 68040

142
	nop

143
	cpusha %bc

144
	nop

145
	cinva %bc

146
	nop

147
	.chip 68k

148
	jra .Lreincarnate

149


150
4:

151
	btst #CPUB_68060,%d1

152
	jne 3b

153


154
.Lreincarnate:

155
	jmp %a1@

156


157
relocate_new_kernel_end:

158


159
ENTRY(relocate_new_kernel_size)

160
	.long relocate_new_kernel_end - relocate_new_kernel

161


162