Subversion Repositories HelenOS

Rev

Rev 1735 | Rev 1787 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1735 Rev 1780
Line 53... Line 53...
53
#ifdef CONFIG_SMP
53
#ifdef CONFIG_SMP
54
 
54
 
55
/** Standard ISA IRQ map; can be overriden by Interrupt Source Override entries of MADT. */
55
/** Standard ISA IRQ map; can be overriden by Interrupt Source Override entries of MADT. */
56
int isa_irq_map[] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15 };
56
int isa_irq_map[] = { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15 };
57
 
57
 
58
static void madt_l_apic_entry(struct madt_l_apic *la, __u32 index);
58
static void madt_l_apic_entry(struct madt_l_apic *la, uint32_t index);
59
static void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index);
59
static void madt_io_apic_entry(struct madt_io_apic *ioa, uint32_t index);
60
static void madt_intr_src_ovrd_entry(struct madt_intr_src_ovrd *override, __u32 index);
60
static void madt_intr_src_ovrd_entry(struct madt_intr_src_ovrd *override, uint32_t index);
61
static int madt_cmp(void * a, void * b);
61
static int madt_cmp(void * a, void * b);
62
 
62
 
63
struct madt_l_apic *madt_l_apic_entries = NULL;
63
struct madt_l_apic *madt_l_apic_entries = NULL;
64
struct madt_io_apic *madt_io_apic_entries = NULL;
64
struct madt_io_apic *madt_io_apic_entries = NULL;
65
 
65
 
Line 88... Line 88...
88
 * ACPI MADT Implementation of SMP configuration interface.
88
 * ACPI MADT Implementation of SMP configuration interface.
89
 */
89
 */
90
static count_t madt_cpu_count(void);
90
static count_t madt_cpu_count(void);
91
static bool madt_cpu_enabled(index_t i);
91
static bool madt_cpu_enabled(index_t i);
92
static bool madt_cpu_bootstrap(index_t i);
92
static bool madt_cpu_bootstrap(index_t i);
93
static __u8 madt_cpu_apic_id(index_t i);
93
static uint8_t madt_cpu_apic_id(index_t i);
94
static int madt_irq_to_pin(int irq);
94
static int madt_irq_to_pin(int irq);
95
 
95
 
96
struct smp_config_operations madt_config_operations = {
96
struct smp_config_operations madt_config_operations = {
97
    .cpu_count = madt_cpu_count,
97
    .cpu_count = madt_cpu_count,
98
    .cpu_enabled = madt_cpu_enabled,
98
    .cpu_enabled = madt_cpu_enabled,
Line 117... Line 117...
117
{
117
{
118
    ASSERT(i < madt_l_apic_entry_cnt);
118
    ASSERT(i < madt_l_apic_entry_cnt);
119
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id == l_apic_id();
119
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id == l_apic_id();
120
}
120
}
121
 
121
 
122
__u8 madt_cpu_apic_id(index_t i)
122
uint8_t madt_cpu_apic_id(index_t i)
123
{
123
{
124
    ASSERT(i < madt_l_apic_entry_cnt);
124
    ASSERT(i < madt_l_apic_entry_cnt);
125
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
125
    return ((struct madt_l_apic *) madt_entries_index[madt_l_apic_entry_index + i])->apic_id;
126
}
126
}
127
 
127
 
Line 139... Line 139...
139
        ((((struct madt_apic_header *) a)->type < ((struct madt_apic_header *) b)->type) ? -1 : 0);
139
        ((((struct madt_apic_header *) a)->type < ((struct madt_apic_header *) b)->type) ? -1 : 0);
140
}
140
}
141
   
141
   
142
void acpi_madt_parse(void)
142
void acpi_madt_parse(void)
143
{
143
{
144
    struct madt_apic_header *end = (struct madt_apic_header *) (((__u8 *) acpi_madt) + acpi_madt->header.length);
144
    struct madt_apic_header *end = (struct madt_apic_header *) (((uint8_t *) acpi_madt) + acpi_madt->header.length);
145
    struct madt_apic_header *h;
145
    struct madt_apic_header *h;
146
   
146
   
147
        l_apic = (__u32 *) (__native) acpi_madt->l_apic_address;
147
        l_apic = (uint32_t *) (unative_t) acpi_madt->l_apic_address;
148
 
148
 
149
    /* calculate madt entries */
149
    /* calculate madt entries */
150
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
150
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((uint8_t *) h) + h->length)) {
151
        madt_entries_index_cnt++;
151
        madt_entries_index_cnt++;
152
    }
152
    }
153
 
153
 
154
    /* create madt apic entries index array */
154
    /* create madt apic entries index array */
155
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *), FRAME_ATOMIC);
155
    madt_entries_index = (struct madt_apic_header * *) malloc(madt_entries_index_cnt * sizeof(struct madt_apic_header * *), FRAME_ATOMIC);
156
    if (!madt_entries_index)
156
    if (!madt_entries_index)
157
        panic("Memory allocation error.");
157
        panic("Memory allocation error.");
158
 
158
 
159
    __u32 index = 0;
159
    uint32_t index = 0;
160
 
160
 
161
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((__u8 *) h) + h->length)) {
161
    for (h = &acpi_madt->apic_header[0]; h < end; h = (struct madt_apic_header *) (((uint8_t *) h) + h->length)) {
162
        madt_entries_index[index++] = h;
162
        madt_entries_index[index++] = h;
163
    }
163
    }
164
 
164
 
165
    /* Quicksort MADT index structure */
165
    /* Quicksort MADT index structure */
166
    qsort(madt_entries_index, madt_entries_index_cnt, sizeof(__address), &madt_cmp);
166
    qsort(madt_entries_index, madt_entries_index_cnt, sizeof(uintptr_t), &madt_cmp);
167
 
167
 
168
    /* Parse MADT entries */   
168
    /* Parse MADT entries */   
169
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
169
    for (index = 0; index < madt_entries_index_cnt - 1; index++) {
170
        h = madt_entries_index[index];
170
        h = madt_entries_index[index];
171
        switch (h->type) {
171
        switch (h->type) {
Line 204... Line 204...
204
    if (cpu_count)
204
    if (cpu_count)
205
        config.cpu_count = cpu_count;
205
        config.cpu_count = cpu_count;
206
}
206
}
207
 
207
 
208
 
208
 
209
void madt_l_apic_entry(struct madt_l_apic *la, __u32 index)
209
void madt_l_apic_entry(struct madt_l_apic *la, uint32_t index)
210
{
210
{
211
    if (!madt_l_apic_entry_cnt++) {
211
    if (!madt_l_apic_entry_cnt++) {
212
        madt_l_apic_entry_index = index;
212
        madt_l_apic_entry_index = index;
213
    }
213
    }
214
       
214
       
Line 219... Line 219...
219
   
219
   
220
    cpu_count++;   
220
    cpu_count++;   
221
    apic_id_mask |= 1<<la->apic_id;
221
    apic_id_mask |= 1<<la->apic_id;
222
}
222
}
223
 
223
 
224
void madt_io_apic_entry(struct madt_io_apic *ioa, __u32 index)
224
void madt_io_apic_entry(struct madt_io_apic *ioa, uint32_t index)
225
{
225
{
226
    if (!madt_io_apic_entry_cnt++) {
226
    if (!madt_io_apic_entry_cnt++) {
227
        /* remember index of the first io apic entry */
227
        /* remember index of the first io apic entry */
228
        madt_io_apic_entry_index = index;
228
        madt_io_apic_entry_index = index;
229
        io_apic = (__u32 *) (__native) ioa->io_apic_address;
229
        io_apic = (uint32_t *) (unative_t) ioa->io_apic_address;
230
    } else {
230
    } else {
231
        /* currently not supported */
231
        /* currently not supported */
232
        return;
232
        return;
233
    }
233
    }
234
}
234
}
235
 
235
 
236
void madt_intr_src_ovrd_entry(struct madt_intr_src_ovrd *override, __u32 index)
236
void madt_intr_src_ovrd_entry(struct madt_intr_src_ovrd *override, uint32_t index)
237
{
237
{
238
    ASSERT(override->source < sizeof(isa_irq_map)/sizeof(int));
238
    ASSERT(override->source < sizeof(isa_irq_map)/sizeof(int));
239
    printf("MADT: ignoring %s entry: bus=%zd, source=%zd, global_int=%zd, flags=%#hx\n",
239
    printf("MADT: ignoring %s entry: bus=%zd, source=%zd, global_int=%zd, flags=%#hx\n",
240
        entry[override->header.type], override->bus, override->source,
240
        entry[override->header.type], override->bus, override->source,
241
        override->global_int, override->flags);
241
        override->global_int, override->flags);