add dts config

hc

2023-12-06 08f87f769b595151be1afeff53e144f543faa614

 kernel/arch/x86/platform/efi/efi_stub_32.S
..
..
@@ -7,118 +7,54 @@
7
7
  */
8
8
 
9
9
 #include <linux/linkage.h>
10
+#include <linux/init.h>
11
+#include <asm/asm-offsets.h>
10
12
 #include <asm/page_types.h>
11
13
 
12
-/*
13
- * efi_call_phys(void *, ...) is a function with variable parameters.
14
- * All the callers of this function assure that all the parameters are 4-bytes.
15
- */
14
+	__INIT
15
+SYM_FUNC_START(efi_call_svam)
16
+	push	%ebp
17
+	movl	%esp, %ebp
18
+	push	%ebx
16
19
 
17
-/*
18
- * In gcc calling convention, EBX, ESP, EBP, ESI and EDI are all callee save.
19
- * So we'd better save all of them at the beginning of this function and restore
20
- * at the end no matter how many we use, because we can not assure EFI runtime
21
- * service functions will comply with gcc calling convention, too.
22
- */
23
-
24
-.text
25
-ENTRY(efi_call_phys)
26
-	/*
27
-	 * 0. The function can only be called in Linux kernel. So CS has been
28
-	 * set to 0x0010, DS and SS have been set to 0x0018. In EFI, I found
29
-	 * the values of these registers are the same. And, the corresponding
30
-	 * GDT entries are identical. So I will do nothing about segment reg
31
-	 * and GDT, but change GDT base register in prolog and epilog.
32
-	 */
20
+	push	16(%esp)
21
+	push	16(%esp)
22
+	push	%ecx
23
+	push	%edx
24
+	movl	%eax, %ebx		// &systab_phys->runtime
33
25
 
34
26
 	/*
35
-	 * 1. Now I am running with EIP = <physical address> + PAGE_OFFSET.
36
-	 * But to make it smoothly switch from virtual mode to flat mode.
37
-	 * The mapping of lower virtual memory has been created in prolog and
38
-	 * epilog.
27
+	 * Switch to the flat mapped alias of this routine, by jumping to the
28
+	 * address of label '1' after subtracting PAGE_OFFSET from it.
39
29
 	 */
40
30
 	movl	$1f, %edx
41
31
 	subl	$__PAGE_OFFSET, %edx
42
32
 	jmp	*%edx
43
33
 1:
44
34
 
45
-	/*
46
-	 * 2. Now on the top of stack is the return
47
-	 * address in the caller of efi_call_phys(), then parameter 1,
48
-	 * parameter 2, ..., param n. To make things easy, we save the return
49
-	 * address of efi_call_phys in a global variable.
50
-	 */
51
-	popl	%edx
52
-	movl	%edx, saved_return_addr
53
-	/* get the function pointer into ECX*/
54
-	popl	%ecx
55
-	movl	%ecx, efi_rt_function_ptr
56
-	movl	$2f, %edx
57
-	subl	$__PAGE_OFFSET, %edx
58
-	pushl	%edx
59
-
60
-	/*
61
-	 * 3. Clear PG bit in %CR0.
62
-	 */
35
+	/* disable paging */
63
36
 	movl	%cr0, %edx
64
37
 	andl	$0x7fffffff, %edx
65
38
 	movl	%edx, %cr0
66
-	jmp	1f
67
-1:
68
39
 
69
-	/*
70
-	 * 4. Adjust stack pointer.
71
-	 */
40
+	/* convert the stack pointer to a flat mapped address */
72
41
 	subl	$__PAGE_OFFSET, %esp
73
42
 
74
-	/*
75
-	 * 5. Call the physical function.
76
-	 */
77
-	jmp	*%ecx
43
+	/* call the EFI routine */
44
+	movl	(%eax), %eax
45
+	call	*EFI_svam(%eax)
78
46
 
79
-2:
80
-	/*
81
-	 * 6. After EFI runtime service returns, control will return to
82
-	 * following instruction. We'd better readjust stack pointer first.
83
-	 */
84
-	addl	$__PAGE_OFFSET, %esp
47
+	/* grab the virtually remapped EFI runtime services table pointer */
48
+	movl	(%ebx), %ecx
49
+	movl	36(%esp), %edx		// &efi.runtime
50
+	movl	%ecx, (%edx)
85
51
 
86
-	/*
87
-	 * 7. Restore PG bit
88
-	 */
52
+	/* re-enable paging */
89
53
 	movl	%cr0, %edx
90
54
 	orl	$0x80000000, %edx
91
55
 	movl	%edx, %cr0
92
-	jmp	1f
93
-1:
94
-	/*
95
-	 * 8. Now restore the virtual mode from flat mode by
96
-	 * adding EIP with PAGE_OFFSET.
97
-	 */
98
-	movl	$1f, %edx
99
-	jmp	*%edx
100
-1:
101
56
 
102
-	/*
103
-	 * 9. Balance the stack. And because EAX contain the return value,
104
-	 * we'd better not clobber it.
105
-	 */
106
-	leal	efi_rt_function_ptr, %edx
107
-	movl	(%edx), %ecx
108
-	pushl	%ecx
109
-
110
-	/*
111
-	 * 10. Push the saved return address onto the stack and return.
112
-	 */
113
-	leal	saved_return_addr, %edx
114
-	movl	(%edx), %ecx
115
-	pushl	%ecx
116
-	ret
117
-ENDPROC(efi_call_phys)
118
-.previous
119
-
120
-.data
121
-saved_return_addr:
122
-	.long 0
123
-efi_rt_function_ptr:
124
-	.long 0
57
+	movl	16(%esp), %ebx
58
+	leave
59
+	RET
60
+SYM_FUNC_END(efi_call_svam)