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
13ENTRY(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
241:	/* 68851 or 68030 */
25
26	lea %pc@(.Lcopy),%a4
272:	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
403:
41	btst #MMU_BASE + MMUB_68030,%d1
42	jne 1b
43
44	btst #MMU_BASE + MMUB_68040,%d1
45	jeq 6f
46
474:	/* 68040 or 68060 */
48
49	lea %pc@(.Lcont040),%a4
505:	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
766:
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
931:
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
1002:
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 */
1073:
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
1251:	/* 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
1332:
134	btst #CPUB_68030,%d1
135	jne 1b
136
137	btst #CPUB_68040,%d1
138	jeq 4f
139
1403:	/* 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
1504:
151	btst #CPUB_68060,%d1
152	jne 3b
153
154.Lreincarnate:
155	jmp %a1@
156
157relocate_new_kernel_end:
158
159ENTRY(relocate_new_kernel_size)
160	.long relocate_new_kernel_end - relocate_new_kernel
161