Subversion Repositories HelenOS

Rev

Rev 422 | 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
}
-