Subversion Repositories HelenOS

Rev

Rev 310 | Rev 331 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 310 Rev 311
1
/*
1
/*
2
 * Copyright (C) 2005 Jakub Jermar
2
 * Copyright (C) 2005 Jakub Jermar
3
 * All rights reserved.
3
 * All rights reserved.
4
 *
4
 *
5
 * Redistribution and use in source and binary forms, with or without
5
 * Redistribution and use in source and binary forms, with or without
6
 * modification, are permitted provided that the following conditions
6
 * modification, are permitted provided that the following conditions
7
 * are met:
7
 * are met:
8
 *
8
 *
9
 * - Redistributions of source code must retain the above copyright
9
 * - Redistributions of source code must retain the above copyright
10
 *   notice, this list of conditions and the following disclaimer.
10
 *   notice, this list of conditions and the following disclaimer.
11
 * - Redistributions in binary form must reproduce the above copyright
11
 * - Redistributions in binary form must reproduce the above copyright
12
 *   notice, this list of conditions and the following disclaimer in the
12
 *   notice, this list of conditions and the following disclaimer in the
13
 *   documentation and/or other materials provided with the distribution.
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
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.
15
 *   derived from this software without specific prior written permission.
16
 *
16
 *
17
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
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
18
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
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
23
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
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 <arch/types.h>
29
#include <arch/types.h>
30
#include <typedefs.h>
30
#include <typedefs.h>
31
#include <arch/acpi/acpi.h>
31
#include <arch/acpi/acpi.h>
32
#include <arch/acpi/madt.h>
32
#include <arch/acpi/madt.h>
33
#include <arch/smp/apic.h>
33
#include <arch/smp/apic.h>
34
#include <arch/smp/smp.h>
34
#include <arch/smp/smp.h>
35
#include <panic.h>
35
#include <panic.h>
36
#include <debug.h>
36
#include <debug.h>
37
#include <config.h>
37
#include <config.h>
38
#include <print.h>
38
#include <print.h>
39
#include <mm/heap.h>
39
#include <mm/heap.h>
40
#include <memstr.h>
40
#include <memstr.h>
41
 
41
 
42
struct acpi_madt *acpi_madt = NULL;
42
struct acpi_madt *acpi_madt = NULL;
43
 
43
 
44
#ifdef __SMP__
44
#ifdef __SMP__
45
 
45
 
46
static void madt_l_apic_entry(struct madt_l_apic *la, __u32 index);
46
static void madt_l_apic_entry(struct madt_l_apic *la, __u32 index);
47
static void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index);
47
static void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index);
48
 
48
 
49
struct madt_l_apic *madt_l_apic_entries = NULL;
49
struct madt_l_apic *madt_l_apic_entries = NULL;
50
struct madt_io_apic *madt_io_apic_entries = NULL;
50
struct madt_io_apic *madt_io_apic_entries = NULL;
51
 
51
 
52
__u32 madt_l_apic_entry_index = 0;
52
__u32 madt_l_apic_entry_index = 0;
53
__u32 madt_io_apic_entry_index = 0;
53
__u32 madt_io_apic_entry_index = 0;
54
int madt_l_apic_entry_cnt = 0;
54
int madt_l_apic_entry_cnt = 0;
55
int madt_io_apic_entry_cnt = 0;
55
int madt_io_apic_entry_cnt = 0;
56
 
56
 
57
struct madt_apic_header * * madt_entries_index = NULL;
57
struct madt_apic_header * * madt_entries_index = NULL;
58
int madt_entries_index_cnt = 0;
58
int madt_entries_index_cnt = 0;
59
 
59
 
60
char *entry[] = {
60
char *entry[] = {
61
    "L_APIC",
61
    "L_APIC",
62
    "IO_APIC",
62
    "IO_APIC",
63
    "INTR_SRC_OVRD",
63
    "INTR_SRC_OVRD",
64
    "NMI_SRC",
64
    "NMI_SRC",
65
    "L_APIC_NMI",
65
    "L_APIC_NMI",
66
    "L_APIC_ADDR_OVRD",
66
    "L_APIC_ADDR_OVRD",
67
    "IO_SAPIC",
67
    "IO_SAPIC",
68
    "L_SAPIC",
68
    "L_SAPIC",
69
    "PLATFORM_INTR_SRC"
69
    "PLATFORM_INTR_SRC"
70
};
70
};
71
 
71
 
72
/*
72
/*
73
 * ACPI MADT Implementation of SMP configuration interface.
73
 * ACPI MADT Implementation of SMP configuration interface.
74
 */
74
 */
75
static count_t madt_cpu_count(void);
75
static count_t madt_cpu_count(void);
76
static bool madt_cpu_enabled(index_t i);
76
static bool madt_cpu_enabled(index_t i);
77
static bool madt_cpu_bootstrap(index_t i);
77
static bool madt_cpu_bootstrap(index_t i);
78
static __u8 madt_cpu_apic_id(index_t i);
78
static __u8 madt_cpu_apic_id(index_t i);
79
 
79
 
80
struct smp_config_operations madt_config_operations = {
80
struct smp_config_operations madt_config_operations = {
81
    .cpu_count = madt_cpu_count,
81
    .cpu_count = madt_cpu_count,
82
    .cpu_enabled = madt_cpu_enabled,
82
    .cpu_enabled = madt_cpu_enabled,
83
    .cpu_bootstrap = madt_cpu_bootstrap,
83
    .cpu_bootstrap = madt_cpu_bootstrap,
84
    .cpu_apic_id = madt_cpu_apic_id
84
    .cpu_apic_id = madt_cpu_apic_id
85
};
85
};
86
 
86
 
87
static count_t madt_cpu_count(void)
87
static count_t madt_cpu_count(void)
88
{
88
{
89
    return madt_l_apic_entry_cnt;
89
    return madt_l_apic_entry_cnt;
90
}
90
}
91
 
91
 
92
static bool madt_cpu_enabled(index_t i)
92
static bool madt_cpu_enabled(index_t i)
93
{
93
{
94
    ASSERT(i < madt_l_apic_entry_cnt);
94
    ASSERT(i < madt_l_apic_entry_cnt);
95
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->flags & 0x1;
95
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->flags & 0x1;
96
 
96
 
97
}
97
}
98
 
98
 
99
static bool madt_cpu_bootstrap(index_t i)
99
static bool madt_cpu_bootstrap(index_t i)
100
{
100
{
101
    ASSERT(i < madt_l_apic_entry_cnt);
101
    ASSERT(i < madt_l_apic_entry_cnt);
102
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id == l_apic_id();
102
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id == l_apic_id();
103
}
103
}
104
 
104
 
105
static __u8 madt_cpu_apic_id(index_t i)
105
static __u8 madt_cpu_apic_id(index_t i)
106
{
106
{
107
    ASSERT(i < madt_l_apic_entry_cnt);
107
    ASSERT(i < madt_l_apic_entry_cnt);
108
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
108
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
109
}
109
}
110
 
110
 
111
void acpi_madt_parse(void)
111
void acpi_madt_parse(void)
112
{
112
{
113
    struct madt_apic_header *end = (struct madt_apic_header *) (((__u8 *) acpi_madt) + acpi_madt->header.length);
113
    struct madt_apic_header *end = (struct madt_apic_header *) (((__u8 *) acpi_madt) + acpi_madt->header.length);
114
    struct madt_apic_header *h;
114
    struct madt_apic_header *h;
-
 
115
   
-
 
116
        l_apic = (__u32 *) (__native) acpi_madt->l_apic_address;
115
 
117
 
116
    /* calculate madt entries */
118
    /* calculate madt entries */
117
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
119
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
118
        madt_entries_index_cnt++;
120
        madt_entries_index_cnt++;
119
    }
121
    }
120
    printf("MADT: Found %d entries\n", madt_entries_index_cnt);
122
    printf("MADT: Found %d entries\n", madt_entries_index_cnt);
121
 
123
 
122
    /* create madt apic entries index array */
124
    /* create madt apic entries index array */
123
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *));
125
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *));
124
 
126
 
125
    __u32 index = 0;
127
    __u32 index = 0;
126
 
128
 
127
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
129
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
128
        madt_entries_index[index++] = h;
130
        madt_entries_index[index++] = h;
129
    }
131
    }
130
 
132
 
131
 
133
 
132
    /* Bublesort madt index. Quicksort later. */
134
    /* Bublesort madt index. Quicksort later. */
133
    bool done = false;
135
    bool done = false;
134
 
136
 
135
    while (!done) {
137
    while (!done) {
136
        done = true;
138
        done = true;
137
        for (index = 0; index < madt_entries_index_cnt - 1; index++) {
139
        for (index = 0; index < madt_entries_index_cnt - 1; index++) {
138
            if (madt_entries_index[index]->type > madt_entries_index[index + 1]->type) {
140
            if (madt_entries_index[index]->type > madt_entries_index[index + 1]->type) {
139
                h = madt_entries_index[index];
141
                h = madt_entries_index[index];
140
                madt_entries_index[index] = madt_entries_index[index + 1];
142
                madt_entries_index[index] = madt_entries_index[index + 1];
141
                madt_entries_index[index + 1] = h;
143
                madt_entries_index[index + 1] = h;
142
                done = false;
144
                done = false;
143
            }
145
            }
144
            }
146
            }
145
   
147
   
146
    }
148
    }
147
       
149
       
148
 
150
 
149
    /* Parse MADT entries */   
151
    /* Parse MADT entries */   
150
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
152
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
151
        h = madt_entries_index[index];
153
        h = madt_entries_index[index];
152
        switch (h->type) {
154
        switch (h->type) {
153
            case MADT_L_APIC:
155
            case MADT_L_APIC:
154
                madt_l_apic_entry((struct madt_l_apic *) h, index);
156
                madt_l_apic_entry((struct madt_l_apic *) h, index);
155
                break;
157
                break;
156
            case MADT_IO_APIC:
158
            case MADT_IO_APIC:
157
                madt_io_apic_entry((struct madt_io_apic *) h, index);
159
                madt_io_apic_entry((struct madt_io_apic *) h, index);
158
                break;
160
                break;
159
            case MADT_INTR_SRC_OVRD:
161
            case MADT_INTR_SRC_OVRD:
160
            case MADT_NMI_SRC:
162
            case MADT_NMI_SRC:
161
            case MADT_L_APIC_NMI:
163
            case MADT_L_APIC_NMI:
162
            case MADT_L_APIC_ADDR_OVRD:
164
            case MADT_L_APIC_ADDR_OVRD:
163
            case MADT_IO_SAPIC:
165
            case MADT_IO_SAPIC:
164
            case MADT_L_SAPIC:
166
            case MADT_L_SAPIC:
165
            case MADT_PLATFORM_INTR_SRC:
167
            case MADT_PLATFORM_INTR_SRC:
166
                printf("MADT: skipping %s entry (type=%d)\n", entry[h->type], h->type);
168
                printf("MADT: skipping %s entry (type=%d)\n", entry[h->type], h->type);
167
                break;
169
                break;
168
 
170
 
169
            default:
171
            default:
170
                if (h->type >= MADT_RESERVED_SKIP_BEGIN && h->type <= MADT_RESERVED_SKIP_END) {
172
                if (h->type >= MADT_RESERVED_SKIP_BEGIN && h->type <= MADT_RESERVED_SKIP_END) {
171
                    printf("MADT: skipping reserved entry (type=%d)\n", h->type);
173
                    printf("MADT: skipping reserved entry (type=%d)\n", h->type);
172
                }
174
                }
173
                if (h->type >= MADT_RESERVED_OEM_BEGIN) {
175
                if (h->type >= MADT_RESERVED_OEM_BEGIN) {
174
                    printf("MADT: skipping OEM entry (type=%d)\n", h->type);
176
                    printf("MADT: skipping OEM entry (type=%d)\n", h->type);
175
                }
177
                }
176
                break;
178
                break;
177
        }
179
        }
178
   
180
   
179
   
181
   
180
    }
182
    }
181
   
183
   
182
 
184
 
183
    if (madt_l_apic_entry_cnt)
185
    if (madt_l_apic_entry_cnt)
184
        config.cpu_count = madt_l_apic_entry_cnt;
186
        config.cpu_count = madt_l_apic_entry_cnt;
185
}
187
}
186
 
188
 
187
 
189
 
188
void madt_l_apic_entry(struct madt_l_apic *la, __u32 index)
190
void madt_l_apic_entry(struct madt_l_apic *la, __u32 index)
189
{
191
{
190
    if (!madt_l_apic_entry_cnt++) {
192
    if (!madt_l_apic_entry_cnt++) {
191
        madt_l_apic_entry_index = index;
193
        madt_l_apic_entry_index = index;
192
    }
194
    }
193
       
195
       
194
    if (!(la->flags & 0x1)) {
196
    if (!(la->flags & 0x1)) {
195
        /* Processor is unusable, skip it. */
197
        /* Processor is unusable, skip it. */
196
        return;
198
        return;
197
    }
199
    }
198
       
200
       
199
    apic_id_mask |= 1<<la->apic_id;
201
    apic_id_mask |= 1<<la->apic_id;
200
}
202
}
201
 
203
 
202
void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index)
204
void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index)
203
{
205
{
204
    if (!madt_io_apic_entry_cnt++) {
206
    if (!madt_io_apic_entry_cnt++) {
205
        /* remember index of the first io apic entry */
207
        /* remember index of the first io apic entry */
206
        madt_io_apic_entry_index = index;
208
        madt_io_apic_entry_index = index;
207
        /* ????!!!! */
-
 
208
        io_apic = (__u32 *) (__native) ioa->io_apic_address;
209
        io_apic = (__u32 *) (__native) ioa->io_apic_address;
209
    } else {
210
    } else {
210
        /* currently not supported */
211
        /* currently not supported */
211
        return;
212
        return;
212
    }
213
    }
213
}
214
}
214
 
215
 
215
 
216
 
216
#endif /* __SMP__ */
217
#endif /* __SMP__ */
217
 
218