← Back to branch summary

~galfy/helenos/bird-port-mainline

« back to all changes in this revision

Viewing changes to kernel/genarch/src/acpi/acpi.c

  • Committer: Martin Decky
  • Date: 2009-08-04 11:19:19 UTC
  • Revision ID: martin@uranus.dsrg.hide.ms.mff.cuni.cz-20090804111919-evyclddlr3v5lhmp
Initial import

Show diffs side-by-side

added added

removed removed

Lines of Context:
kernel/genarch/src/acpi/acpi.c
 
1
/*
 
2
 * Copyright (c) 2005 Jakub Jermar
 
3
 * All rights reserved.
 
4
 *
 
5
 * Redistribution and use in source and binary forms, with or without
 
6
 * modification, are permitted provided that the following conditions
 
7
 * are met:
 
8
 *
 
9
 * - Redistributions of source code must retain the above copyright
 
10
 *   notice, this list of conditions and the following disclaimer.
 
11
 * - Redistributions in binary form must reproduce the above copyright
 
12
 *   notice, this list of conditions and the following disclaimer in the
 
13
 *   documentation and/or other materials provided with the distribution.
 
14
 * - The name of the author may not be used to endorse or promote products
 
15
 *   derived from this software without specific prior written permission.
 
16
 *
 
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 
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
 
26
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 
27
 */
 
28
 
 
29
/** @addtogroup genarch
 
30
 * @{
 
31
 */
 
32
 
 
33
/**
 
34
 * @file
 
35
 * @brief       Advanced Configuration and Power Interface (ACPI) initialization.
 
36
 */
 
37
 
 
38
#include <genarch/acpi/acpi.h>
 
39
#include <genarch/acpi/madt.h>
 
40
#include <arch/bios/bios.h>
 
41
#include <mm/as.h>
 
42
#include <mm/page.h>
 
43
#include <print.h>
 
44
 
 
45
#define RSDP_SIGNATURE          "RSD PTR "
 
46
#define RSDP_REVISION_OFFS      15
 
47
 
 
48
struct acpi_rsdp *acpi_rsdp = NULL;
 
49
struct acpi_rsdt *acpi_rsdt = NULL;
 
50
struct acpi_xsdt *acpi_xsdt = NULL;
 
51
 
 
52
struct acpi_signature_map signature_map[] = {
 
53
        {
 
54
                (uint8_t *) "APIC",
 
55
                (void *) &acpi_madt,
 
56
                "Multiple APIC Description Table"
 
57
        }
 
58
};
 
59
 
 
60
static int rsdp_check(uint8_t *rsdp) {
 
61
        struct acpi_rsdp *r = (struct acpi_rsdp *) rsdp;
 
62
        uint8_t sum = 0;
 
63
        unsigned int i;
 
64
        
 
65
        for (i = 0; i < 20; i++)
 
66
                sum = (uint8_t) (sum + rsdp[i]);
 
67
                
 
68
        if (sum)        
 
69
                return 0; /* bad checksum */
 
70
 
 
71
        if (r->revision == 0)
 
72
                return 1; /* ACPI 1.0 */
 
73
                
 
74
        for (; i < r->length; i++)
 
75
                sum = (uint8_t) (sum + rsdp[i]);
 
76
                
 
77
        return !sum;
 
78
        
 
79
}
 
80
 
 
81
int acpi_sdt_check(uint8_t *sdt)
 
82
{
 
83
        struct acpi_sdt_header *h = (struct acpi_sdt_header *) sdt;
 
84
        uint8_t sum = 0;
 
85
        unsigned int i;
 
86
 
 
87
        for (i = 0; i < h->length; i++)
 
88
                sum = (uint8_t) (sum + sdt[i]);
 
89
                
 
90
        return !sum;
 
91
}
 
92
 
 
93
static void map_sdt(struct acpi_sdt_header *sdt)
 
94
{
 
95
        page_mapping_insert(AS_KERNEL, (uintptr_t) sdt, (uintptr_t) sdt, PAGE_NOT_CACHEABLE | PAGE_WRITE);
 
96
        map_structure((uintptr_t) sdt, sdt->length);
 
97
}
 
98
 
 
99
static void configure_via_rsdt(void)
 
100
{
 
101
        unsigned int i, j, cnt = (acpi_rsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint32_t);
 
102
        
 
103
        for (i = 0; i < cnt; i++) {
 
104
                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
 
105
                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) (unative_t) acpi_rsdt->entry[i];
 
106
                
 
107
                        map_sdt(h);     
 
108
                        if (*((uint32_t *) &h->signature[0]) == *((uint32_t *) &signature_map[j].signature[0])) {
 
109
                                if (!acpi_sdt_check((uint8_t *) h))
 
110
                                        goto next;
 
111
                                *signature_map[j].sdt_ptr = h;
 
112
                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
 
113
                        }
 
114
                }
 
115
next:
 
116
                ;
 
117
        }
 
118
}
 
119
 
 
120
static void configure_via_xsdt(void)
 
121
{
 
122
        unsigned int i, j, cnt = (acpi_xsdt->header.length - sizeof(struct acpi_sdt_header)) / sizeof(uint64_t);
 
123
        
 
124
        for (i = 0; i < cnt; i++) {
 
125
                for (j = 0; j < sizeof(signature_map) / sizeof(struct acpi_signature_map); j++) {
 
126
                        struct acpi_sdt_header *h = (struct acpi_sdt_header *) ((uintptr_t) acpi_rsdt->entry[i]);
 
127
 
 
128
                        map_sdt(h);
 
129
                        if (*((uint32_t *) &h->signature[0]) == *((uint32_t *) &signature_map[j].signature[0])) {
 
130
                                if (!acpi_sdt_check((uint8_t *) h))
 
131
                                        goto next;
 
132
                                *signature_map[j].sdt_ptr = h;
 
133
                                LOG("%p: ACPI %s\n", *signature_map[j].sdt_ptr, signature_map[j].description);
 
134
                        }
 
135
                }
 
136
next:
 
137
                ;
 
138
        }
 
139
 
 
140
}
 
141
 
 
142
void acpi_init(void)
 
143
{
 
144
        uint8_t *addr[2] = { NULL, (uint8_t *) PA2KA(0xe0000) };
 
145
        int i, j, length[2] = { 1024, 128*1024 };
 
146
        uint64_t *sig = (uint64_t *) RSDP_SIGNATURE;
 
147
 
 
148
        /*
 
149
         * Find Root System Description Pointer
 
150
         * 1. search first 1K of EBDA
 
151
         * 2. search 128K starting at 0xe0000
 
152
         */
 
153
 
 
154
        addr[0] = (uint8_t *) PA2KA(ebda);
 
155
        for (i = (ebda ? 0 : 1); i < 2; i++) {
 
156
                for (j = 0; j < length[i]; j += 16) {
 
157
                        if (*((uint64_t *) &addr[i][j]) == *sig && rsdp_check(&addr[i][j])) {
 
158
                                acpi_rsdp = (struct acpi_rsdp *) &addr[i][j];
 
159
                                goto rsdp_found;
 
160
                        }
 
161
                }
 
162
        }
 
163
 
 
164
        return;
 
165
 
 
166
rsdp_found:
 
167
        LOG("%p: ACPI Root System Description Pointer\n", acpi_rsdp);
 
168
 
 
169
        acpi_rsdt = (struct acpi_rsdt *) (unative_t) acpi_rsdp->rsdt_address;
 
170
        if (acpi_rsdp->revision)
 
171
                acpi_xsdt = (struct acpi_xsdt *) ((uintptr_t) acpi_rsdp->xsdt_address);
 
172
 
 
173
        if (acpi_rsdt)
 
174
                map_sdt((struct acpi_sdt_header *) acpi_rsdt);
 
175
        if (acpi_xsdt)
 
176
                map_sdt((struct acpi_sdt_header *) acpi_xsdt);
 
177
 
 
178
        if (acpi_rsdt && !acpi_sdt_check((uint8_t *) acpi_rsdt)) {
 
179
                printf("RSDT: bad checksum\n");
 
180
                return;
 
181
        }
 
182
        if (acpi_xsdt && !acpi_sdt_check((uint8_t *) acpi_xsdt)) {
 
183
                printf("XSDT: bad checksum\n");
 
184
                return;
 
185
        }
 
186
 
 
187
        if (acpi_xsdt)
 
188
                configure_via_xsdt();
 
189
        else if (acpi_rsdt)
 
190
                configure_via_rsdt();
 
191
 
 
192
}
 
193
 
 
194
/** @}
 
195
 */