Rev 422 | Rev 492 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 422 | Rev 452 | ||
---|---|---|---|
Line 24... | Line 24... | ||
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | #include <genarch/firmware/acpi/acpi.h> |
29 | #include <genarch/acpi/acpi.h> |
30 | #include <genarch/firmware/acpi/madt.h> |
30 | #include <genarch/acpi/madt.h> |
31 | #include <arch/bios/bios.h> |
31 | #include <arch/bios/bios.h> |
32 | 32 | ||
33 | #include <mm/page.h> |
33 | #include <mm/page.h> |
34 | #include <print.h> |
34 | #include <print.h> |
35 | 35 | ||
Line 42... | Line 42... | ||
42 | 42 | ||
43 | struct acpi_signature_map signature_map[] = { |
43 | struct acpi_signature_map signature_map[] = { |
44 | { (__u8 *)"APIC", (struct acpi_sdt_header **) &acpi_madt, "Multiple APIC Description Table" } |
44 | { (__u8 *)"APIC", (struct acpi_sdt_header **) &acpi_madt, "Multiple APIC Description Table" } |
45 | }; |
45 | }; |
46 | 46 | ||
47 | int rsdp_check(__u8 *rsdp) { |
47 | static int rsdp_check(__u8 *rsdp) { |
48 | struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp; |
48 | struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp; |
49 | __u8 sum = 0; |
49 | __u8 sum = 0; |
50 | int i; |
50 | int i; |
51 | 51 | ||
52 | for (i=0; i<20; i++) |
52 | for (i=0; i<20; i++) |
Line 75... | Line 75... | ||
75 | sum += sdt[i]; |
75 | sum += sdt[i]; |
76 | 76 | ||
77 | return !sum; |
77 | return !sum; |
78 | } |
78 | } |
79 | 79 | ||
80 | void map_sdt(struct acpi_sdt_header *sdt) |
80 | static void map_sdt(struct acpi_sdt_header *sdt) |
81 | { |
81 | { |
82 | map_page_to_frame((__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0); |
82 | map_page_to_frame((__address) sdt, (__address) sdt, PAGE_NOT_CACHEABLE, 0); |
83 | map_structure((__address) sdt, sdt->length); |
83 | map_structure((__address) sdt, sdt->length); |
84 | } |
84 | } |
85 | 85 | ||
- | 86 | static void configure_via_rsdt(void) |
|
- | 87 | { |
|
- | 88 | int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32); |
|
- | 89 | ||
- | 90 | for (i=0; i<cnt; i++) { |
|
- | 91 | for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) { |
|
- | 92 | struct acpi_sdt_header *h = (struct acpi_sdt_header *) (__native) acpi_rsdt->entry[i]; |
|
- | 93 | ||
- | 94 | map_sdt(h); |
|
- | 95 | if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) { |
|
- | 96 | if (!acpi_sdt_check((__u8 *) h)) |
|
- | 97 | goto next; |
|
- | 98 | *signature_map[j].sdt_ptr = h; |
|
- | 99 | printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description); |
|
- | 100 | } |
|
- | 101 | } |
|
- | 102 | next: |
|
- | 103 | ; |
|
- | 104 | } |
|
- | 105 | } |
|
- | 106 | ||
- | 107 | static void configure_via_xsdt(void) |
|
- | 108 | { |
|
- | 109 | int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64); |
|
- | 110 | ||
- | 111 | for (i=0; i<cnt; i++) { |
|
- | 112 | for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) { |
|
- | 113 | struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]); |
|
- | 114 | ||
- | 115 | map_sdt(h); |
|
- | 116 | if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) { |
|
- | 117 | if (!acpi_sdt_check((__u8 *) h)) |
|
- | 118 | goto next; |
|
- | 119 | *signature_map[j].sdt_ptr = h; |
|
- | 120 | printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description); |
|
- | 121 | } |
|
- | 122 | } |
|
- | 123 | next: |
|
- | 124 | ; |
|
- | 125 | } |
|
- | 126 | ||
- | 127 | } |
|
- | 128 | ||
86 | void acpi_init(void) |
129 | void acpi_init(void) |
87 | { |
130 | { |
88 | __u8 *addr[2] = { NULL, (__u8 *) PA2KA(0xe0000) }; |
131 | __u8 *addr[2] = { NULL, (__u8 *) PA2KA(0xe0000) }; |
89 | int i, j, length[2] = { 1024, 128*1024 }; |
132 | int i, j, length[2] = { 1024, 128*1024 }; |
90 | __u64 *sig = (__u64 *) RSDP_SIGNATURE; |
133 | __u64 *sig = (__u64 *) RSDP_SIGNATURE; |
Line 128... | Line 171... | ||
128 | if (acpi_xsdt) configure_via_xsdt(); |
171 | if (acpi_xsdt) configure_via_xsdt(); |
129 | else if (acpi_rsdt) configure_via_rsdt(); |
172 | else if (acpi_rsdt) configure_via_rsdt(); |
130 | 173 | ||
131 | } |
174 | } |
132 | 175 | ||
133 | void configure_via_rsdt(void) |
- | |
134 | { |
- | |
135 | int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u32); |
- | |
136 | - | ||
137 | for (i=0; i<cnt; i++) { |
- | |
138 | for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) { |
- | |
139 | struct acpi_sdt_header *h = (struct acpi_sdt_header *) (__native) acpi_rsdt->entry[i]; |
- | |
140 | - | ||
141 | map_sdt(h); |
- | |
142 | if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) { |
- | |
143 | if (!acpi_sdt_check((__u8 *) h)) |
- | |
144 | goto next; |
- | |
145 | *signature_map[j].sdt_ptr = h; |
- | |
146 | printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description); |
- | |
147 | } |
- | |
148 | } |
- | |
149 | next: |
- | |
150 | ; |
- | |
151 | } |
- | |
152 | } |
- | |
153 | - | ||
154 | void configure_via_xsdt(void) |
- | |
155 | { |
- | |
156 | int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header))/sizeof(__u64); |
- | |
157 | - | ||
158 | for (i=0; i<cnt; i++) { |
- | |
159 | for (j=0; j<sizeof(signature_map)/sizeof(struct acpi_signature_map); j++) { |
- | |
160 | struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((__address) acpi_rsdt->entry[i]); |
- | |
161 | - | ||
162 | map_sdt(h); |
- | |
163 | if (*((__u32 *) &h->signature[0])==*((__u32 *) &signature_map[j].signature[0])) { |
- | |
164 | if (!acpi_sdt_check((__u8 *) h)) |
- | |
165 | goto next; |
- | |
166 | *signature_map[j].sdt_ptr = h; |
- | |
167 | printf("%P: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description); |
- | |
168 | } |
- | |
169 | } |
- | |
170 | next: |
- | |
171 | ; |
- | |
172 | } |
- | |
173 | - | ||
174 | } |
- |