hc
2024-03-22 a0752693d998599af469473b8dc239ef973a012f
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
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
## @file
//
# Copyright (c) 2019 Intel Corporation. All rights reserved. <BR>
#
# SPDX-License-Identifier: BSD-2-Clause-Patent
#
##
 
//-----------------------------------------------------------------------------
//
//  Section:     SaMmioRead64
//
//  Description: Read 64 bits from the Memory Mapped I/O space.
//  Use MMX instruction for atomic access, because some MC registers have side effect.
//
//  @param[in] Address - Memory mapped I/O address.
//
//-----------------------------------------------------------------------------
//UINT64
//SaMmioRead64 (
//  IN  UINTN Address
//  )
 
ASM_GLOBAL ASM_PFX(SaMmioRead64)
ASM_PFX(SaMmioRead64):
   subl    $16, %esp
   movq    %mm0, (%esp)       //Save mm0 on stack
   movl    20(%esp), %edx     //edx = Address
   movq    (%edx), %mm0       //mm0 = [Address]
   movq    %mm0, 8(%esp)      //Store mm0 on Stack
   movq    (%esp), %mm0       //Restore mm0
   emms
   movl    8(%esp), %eax      //eax = [Address][31:0]
   movl    12(%esp), %edx     //edx = [Address][64:32]
   addl    $16, %esp
   ret
 
//-----------------------------------------------------------------------------
//
//  Section:     SaMmioWrite64
//
//  Description: Write 64 bits to the Memory Mapped I/O space.
//  Use MMX instruction for atomic access, because some MC registers have side effect.
//
//  @param[in] Address - Memory mapped I/O address.
//  @param[in] Value   - The value to write.
//
//-----------------------------------------------------------------------------
 
//UINT64
//SaMmioWrite64 (
//  IN UINTN Address,
//  IN UINT64 Value
//  )
 
ASM_GLOBAL ASM_PFX(SaMmioWrite64)
ASM_PFX(SaMmioWrite64):
   subl    $8, %esp
   movq    %mm0, (%esp)       //Save mm0 on Stack
   movl    12(%esp), %edx     //edx = Address
   movq    16(%esp), %mm0     //mm0 = Value
   movq    %mm0, (%edx)       //[Address] = Value
   movq    (%esp), %mm0       //Restore mm0
   emms
   movl     16(%esp), %eax    //eax = Value[31:0]
   movl     20(%esp), %edx    //edx = Value[64:32]
   addl     $8, %esp
   ret
 
//-----------------------------------------------------------------------------
//  Intel Silicon View Technology check point interface based on IO port reading
//
//  @param CheckPoint        Check point AH value.
//                           AH = 0x10:  End of MRC State
//                           AH = 0x20:  End of DXE State
//                           AH = 0x30:  Ready to boot before INT-19h or UEFI boot
//                           AH = 0x40:  After OS booting, need a timer SMI trigger to implement (TBD);
//
//  @param PortReading       IO port reading address used for breakpoints
//-----------------------------------------------------------------------------
 
//VOID
//EFIAPI
//IsvtCheckPoint (
//  IN UINT32          CheckPoint,
//  IN UINT32          PortReading
//  )
 
ASM_GLOBAL ASM_PFX(IsvtCheckPoint)
ASM_PFX(IsvtCheckPoint):
   pushl    %eax
   pushl    %edx
 
   // Stack layout at this point:
   //-------------
   // PortReading     ESP + 16
   //-------------
   // CheckPoint      ESP + 12
   //-------------
   // EIP             ESP + 8
   //-------------
   // EAX             ESP + 4
   //-------------
   // EDX         <-- ESP
   //-------------
 
   mov      12(%esp), %ah    // CheckPoint
   mov      16(%esp), %dx    // PortReading
   in       %dx, %al         // signal debugger
 
   popl     %edx
   popl     %eax
   ret