1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21#include <console/console.h>
22#include <arch/io.h>
23#include <cpu/cpu.h>
24#include <cpu/x86/lapic.h>
25#include <cpu/x86/msr.h>
26#include <cpu/x86/mtrr.h>
27#include <cpu/amd/mtrr.h>
28#include <cpu/amd/model_fxx_msr.h>
29#include <cpu/x86/cache.h>
30#include <cpu/x86/smm.h>
31#include <string.h>
32
33#define SMM_BASE_MSR 0xc0010111
34#define SMM_ADDR_MSR 0xc0010112
35#define SMM_MASK_MSR 0xc0010113
36#define SMM_BASE 0xa0000
37
38extern unsigned char _binary_smm_start;
39extern unsigned char _binary_smm_size;
40
41static int smm_handler_copied = 0;
42
43void smm_init(void)
44{
45 msr_t msr;
46
47 msr = rdmsr(HWCR_MSR);
48 if (msr.lo & (1 << 0)) {
49
50 printk(BIOS_DEBUG, "SMM is still locked from last boot, using old handler.\n");
51 return;
52 }
53
54
55 if (!smm_handler_copied) {
56 msr_t syscfg_orig, mtrr_aseg_orig;
57
58 smm_handler_copied = 1;
59
60
61 syscfg_orig = rdmsr(SYSCFG_MSR);
62 mtrr_aseg_orig = rdmsr(MTRRfix16K_A0000_MSR);
63
64
65 disable_cache();
66
67 msr = syscfg_orig;
68
69 msr.lo |= SYSCFG_MSR_MtrrFixDramModEn;
70
71
72
73 msr.lo &= ~SYSCFG_MSR_MtrrFixDramEn;
74 wrmsr(SYSCFG_MSR, msr);
75
76
77
78 msr.lo = 0x18181818;
79 msr.hi = 0x18181818;
80 wrmsr(MTRRfix16K_A0000_MSR, msr);
81
82
83 msr = syscfg_orig;
84 msr.lo |= SYSCFG_MSR_MtrrFixDramModEn;
85 msr.lo |= SYSCFG_MSR_MtrrFixDramEn;
86 wrmsr(SYSCFG_MSR, msr);
87
88 enable_cache();
89
90 memcpy((void *)SMM_BASE, &_binary_smm_start, (size_t)&_binary_smm_size);
91 wbinvd();
92
93
94 disable_cache();
95
96
97 wrmsr(SYSCFG_MSR, syscfg_orig);
98
99 wrmsr(MTRRfix16K_A0000_MSR, mtrr_aseg_orig);
100 enable_cache();
101 }
102
103
104
105 msr = rdmsr(SMM_BASE_MSR);
106 msr.lo = SMM_BASE - (lapicid() * 0x400);
107 wrmsr(SMM_BASE_MSR, msr);
108
109
110 msr = rdmsr(SMM_MASK_MSR);
111 msr.lo |= (1 << 0);
112 wrmsr(SMM_MASK_MSR, msr);
113
114
115 msr = rdmsr(HWCR_MSR);
116 msr.lo |= (1 << 0);
117 wrmsr(HWCR_MSR, msr);
118}
119
120void smm_lock(void)
121{
122
123}
124