Subversion Repositories HelenOS-historic

Rev

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

Rev 311 Rev 331
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
#include <sort.h>
41
 
42
 
42
struct acpi_madt *acpi_madt = NULL;
43
struct acpi_madt *acpi_madt = NULL;
43
 
44
 
44
#ifdef __SMP__
45
#ifdef __SMP__
45
 
46
 
46
static void madt_l_apic_entry(struct madt_l_apic *la, __u32 index);
47
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);
48
static void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index);
-
 
49
static int madt_cmp(void * a, void * b);
48
 
50
 
49
struct madt_l_apic *madt_l_apic_entries = NULL;
51
struct madt_l_apic *madt_l_apic_entries = NULL;
50
struct madt_io_apic *madt_io_apic_entries = NULL;
52
struct madt_io_apic *madt_io_apic_entries = NULL;
51
 
53
 
52
__u32 madt_l_apic_entry_index = 0;
54
__u32 madt_l_apic_entry_index = 0;
53
__u32 madt_io_apic_entry_index = 0;
55
__u32 madt_io_apic_entry_index = 0;
54
int madt_l_apic_entry_cnt = 0;
56
int madt_l_apic_entry_cnt = 0;
55
int madt_io_apic_entry_cnt = 0;
57
int madt_io_apic_entry_cnt = 0;
56
 
58
 
57
struct madt_apic_header * * madt_entries_index = NULL;
59
struct madt_apic_header * * madt_entries_index = NULL;
58
int madt_entries_index_cnt = 0;
60
int madt_entries_index_cnt = 0;
59
 
61
 
60
char *entry[] = {
62
char *entry[] = {
61
    "L_APIC",
63
    "L_APIC",
62
    "IO_APIC",
64
    "IO_APIC",
63
    "INTR_SRC_OVRD",
65
    "INTR_SRC_OVRD",
64
    "NMI_SRC",
66
    "NMI_SRC",
65
    "L_APIC_NMI",
67
    "L_APIC_NMI",
66
    "L_APIC_ADDR_OVRD",
68
    "L_APIC_ADDR_OVRD",
67
    "IO_SAPIC",
69
    "IO_SAPIC",
68
    "L_SAPIC",
70
    "L_SAPIC",
69
    "PLATFORM_INTR_SRC"
71
    "PLATFORM_INTR_SRC"
70
};
72
};
71
 
73
 
72
/*
74
/*
73
 * ACPI MADT Implementation of SMP configuration interface.
75
 * ACPI MADT Implementation of SMP configuration interface.
74
 */
76
 */
75
static count_t madt_cpu_count(void);
77
static count_t madt_cpu_count(void);
76
static bool madt_cpu_enabled(index_t i);
78
static bool madt_cpu_enabled(index_t i);
77
static bool madt_cpu_bootstrap(index_t i);
79
static bool madt_cpu_bootstrap(index_t i);
78
static __u8 madt_cpu_apic_id(index_t i);
80
static __u8 madt_cpu_apic_id(index_t i);
79
 
81
 
80
struct smp_config_operations madt_config_operations = {
82
struct smp_config_operations madt_config_operations = {
81
    .cpu_count = madt_cpu_count,
83
    .cpu_count = madt_cpu_count,
82
    .cpu_enabled = madt_cpu_enabled,
84
    .cpu_enabled = madt_cpu_enabled,
83
    .cpu_bootstrap = madt_cpu_bootstrap,
85
    .cpu_bootstrap = madt_cpu_bootstrap,
84
    .cpu_apic_id = madt_cpu_apic_id
86
    .cpu_apic_id = madt_cpu_apic_id
85
};
87
};
86
 
88
 
87
static count_t madt_cpu_count(void)
89
static count_t madt_cpu_count(void)
88
{
90
{
89
    return madt_l_apic_entry_cnt;
91
    return madt_l_apic_entry_cnt;
90
}
92
}
91
 
93
 
92
static bool madt_cpu_enabled(index_t i)
94
static bool madt_cpu_enabled(index_t i)
93
{
95
{
94
    ASSERT(i < madt_l_apic_entry_cnt);
96
    ASSERT(i < madt_l_apic_entry_cnt);
95
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->flags & 0x1;
97
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->flags & 0x1;
96
 
98
 
97
}
99
}
98
 
100
 
99
static bool madt_cpu_bootstrap(index_t i)
101
static bool madt_cpu_bootstrap(index_t i)
100
{
102
{
101
    ASSERT(i < madt_l_apic_entry_cnt);
103
    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();
104
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id == l_apic_id();
103
}
105
}
104
 
106
 
105
static __u8 madt_cpu_apic_id(index_t i)
107
static __u8 madt_cpu_apic_id(index_t i)
106
{
108
{
107
    ASSERT(i < madt_l_apic_entry_cnt);
109
    ASSERT(i < madt_l_apic_entry_cnt);
108
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
110
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
109
}
111
}
110
 
112
 
-
 
113
int madt_cmp(void * a, void * b)
-
 
114
{
-
 
115
    return
-
 
116
    (((struct madt_apic_header *) a)->type > ((struct madt_apic_header *) b)->type) ?
-
 
117
    1 :
-
 
118
    ((((struct madt_apic_header *) a)->type < ((struct madt_apic_header *) b)->type) ? -1 : 0);
-
 
119
}
-
 
120
   
111
void acpi_madt_parse(void)
121
void acpi_madt_parse(void)
112
{
122
{
-
 
123
 
-
 
124
 
113
    struct madt_apic_header *end = (struct madt_apic_header *) (((__u8 *) acpi_madt) + acpi_madt->header.length);
125
    struct madt_apic_header *end = (struct madt_apic_header *) (((__u8 *) acpi_madt) + acpi_madt->header.length);
114
    struct madt_apic_header *h;
126
    struct madt_apic_header *h;
115
   
127
   
116
        l_apic = (__u32 *) (__native) acpi_madt->l_apic_address;
128
        l_apic = (__u32 *) (__native) acpi_madt->l_apic_address;
117
 
129
 
118
    /* calculate madt entries */
130
    /* calculate madt entries */
119
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
131
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
120
        madt_entries_index_cnt++;
132
        madt_entries_index_cnt++;
121
    }
133
    }
122
    printf("MADT: Found %d entries\n", madt_entries_index_cnt);
134
    printf("MADT: Found %d entries\n", madt_entries_index_cnt);
123
 
135
 
124
    /* create madt apic entries index array */
136
    /* create madt apic entries index array */
125
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *));
137
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *));
126
 
138
 
127
    __u32 index = 0;
139
    __u32 index = 0;
128
 
140
 
129
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
141
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
130
        madt_entries_index[index++] = h;
142
        madt_entries_index[index++] = h;
131
    }
143
    }
132
 
144
 
133
 
145
 
134
    /* Bublesort madt index. Quicksort later. */
146
    /* Quicksort MADT index structure */
135
    bool done = false;
-
 
136
 
-
 
137
    while (!done) {
-
 
138
        done = true;
-
 
139
        for (index = 0; index < madt_entries_index_cnt - 1; index++) {
147
    qsort(madt_entries_index, madt_entries_index_cnt, sizeof(__address), &madt_cmp);
140
            if (madt_entries_index[index]->type > madt_entries_index[index + 1]->type) {
-
 
141
                h = madt_entries_index[index];
-
 
142
                madt_entries_index[index] = madt_entries_index[index + 1];
-
 
143
                madt_entries_index[index + 1] = h;
-
 
144
                done = false;
-
 
145
            }
-
 
146
            }
-
 
147
   
-
 
148
    }
-
 
149
       
-
 
150
 
148
 
151
    /* Parse MADT entries */   
149
    /* Parse MADT entries */   
152
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
150
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
153
        h = madt_entries_index[index];
151
        h = madt_entries_index[index];
154
        switch (h->type) {
152
        switch (h->type) {
155
            case MADT_L_APIC:
153
            case MADT_L_APIC:
156
                madt_l_apic_entry((struct madt_l_apic *) h, index);
154
                madt_l_apic_entry((struct madt_l_apic *) h, index);
157
                break;
155
                break;
158
            case MADT_IO_APIC:
156
            case MADT_IO_APIC:
159
                madt_io_apic_entry((struct madt_io_apic *) h, index);
157
                madt_io_apic_entry((struct madt_io_apic *) h, index);
160
                break;
158
                break;
161
            case MADT_INTR_SRC_OVRD:
159
            case MADT_INTR_SRC_OVRD:
162
            case MADT_NMI_SRC:
160
            case MADT_NMI_SRC:
163
            case MADT_L_APIC_NMI:
161
            case MADT_L_APIC_NMI:
164
            case MADT_L_APIC_ADDR_OVRD:
162
            case MADT_L_APIC_ADDR_OVRD:
165
            case MADT_IO_SAPIC:
163
            case MADT_IO_SAPIC:
166
            case MADT_L_SAPIC:
164
            case MADT_L_SAPIC:
167
            case MADT_PLATFORM_INTR_SRC:
165
            case MADT_PLATFORM_INTR_SRC:
168
                printf("MADT: skipping %s entry (type=%d)\n", entry[h->type], h->type);
166
                printf("MADT: skipping %s entry (type=%d)\n", entry[h->type], h->type);
169
                break;
167
                break;
170
 
168
 
171
            default:
169
            default:
172
                if (h->type >= MADT_RESERVED_SKIP_BEGIN && h->type <= MADT_RESERVED_SKIP_END) {
170
                if (h->type >= MADT_RESERVED_SKIP_BEGIN && h->type <= MADT_RESERVED_SKIP_END) {
173
                    printf("MADT: skipping reserved entry (type=%d)\n", h->type);
171
                    printf("MADT: skipping reserved entry (type=%d)\n", h->type);
174
                }
172
                }
175
                if (h->type >= MADT_RESERVED_OEM_BEGIN) {
173
                if (h->type >= MADT_RESERVED_OEM_BEGIN) {
176
                    printf("MADT: skipping OEM entry (type=%d)\n", h->type);
174
                    printf("MADT: skipping OEM entry (type=%d)\n", h->type);
177
                }
175
                }
178
                break;
176
                break;
179
        }
177
        }
180
   
178
   
181
   
179
   
182
    }
180
    }
183
   
181
   
184
 
182
 
185
    if (madt_l_apic_entry_cnt)
183
    if (madt_l_apic_entry_cnt)
186
        config.cpu_count = madt_l_apic_entry_cnt;
184
        config.cpu_count = madt_l_apic_entry_cnt;
187
}
185
}
188
 
186
 
189
 
187
 
190
void madt_l_apic_entry(struct madt_l_apic *la, __u32 index)
188
void madt_l_apic_entry(struct madt_l_apic *la, __u32 index)
191
{
189
{
192
    if (!madt_l_apic_entry_cnt++) {
190
    if (!madt_l_apic_entry_cnt++) {
193
        madt_l_apic_entry_index = index;
191
        madt_l_apic_entry_index = index;
194
    }
192
    }
195
       
193
       
196
    if (!(la->flags & 0x1)) {
194
    if (!(la->flags & 0x1)) {
197
        /* Processor is unusable, skip it. */
195
        /* Processor is unusable, skip it. */
198
        return;
196
        return;
199
    }
197
    }
200
       
198
       
201
    apic_id_mask |= 1<<la->apic_id;
199
    apic_id_mask |= 1<<la->apic_id;
202
}
200
}
203
 
201
 
204
void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index)
202
void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index)
205
{
203
{
206
    if (!madt_io_apic_entry_cnt++) {
204
    if (!madt_io_apic_entry_cnt++) {
207
        /* remember index of the first io apic entry */
205
        /* remember index of the first io apic entry */
208
        madt_io_apic_entry_index = index;
206
        madt_io_apic_entry_index = index;
209
        io_apic = (__u32 *) (__native) ioa->io_apic_address;
207
        io_apic = (__u32 *) (__native) ioa->io_apic_address;
210
    } else {
208
    } else {
211
        /* currently not supported */
209
        /* currently not supported */
212
        return;
210
        return;
213
    }
211
    }
214
}
212
}
215
 
213
 
216
 
214
 
217
#endif /* __SMP__ */
215
#endif /* __SMP__ */
218
 
216