WebSVN – HelenOS – Diff – /trunk/kernel/arch/ia32/src/smp/mps.c

 /*
- * Copyright (c) 2001-2005 Jakub Jermar
+ * Copyright (c) 2008 Jakub Jermar
  * All rights reserved.
+ *
  * Redistribution and use in source and binary forms, with or without
  * modification, are permitted provided that the following conditions
  * are met:
     uint8_t *ext = base + ct->base_table_length;
     uint8_t sum;
     int i;
     /* count the checksum for the base table */
-    for (i=0,sum=0; i < ct->base_table_length; i++)
+    for (i = 0,sum = 0; i < ct->base_table_length; i++)
         sum = (uint8_t) (sum + base[i]);
     if (sum)
         return 0;
     /* count the checksum for the extended table */
-    for (i=0,sum=0; i < ct->ext_table_length; i++)
+    for (i = 0, sum = 0; i < ct->ext_table_length; i++)
         sum = (uint8_t) (sum + ext[i]);
     return sum == ct->ext_table_checksum;
+}
      */
     addr[0] = (uint8_t *) PA2KA(ebda ? ebda : 639 * 1024);
     for (i = 0; i < 2; i++) {
         for (j = 0; j < length[i]; j += 16) {
+            if (*((uint32_t *) &addr[i][j]) ==
-            if (*((uint32_t *) &addr[i][j]) == FS_SIGNATURE && mps_fs_check(&addr[i][j])) {
+                FS_SIGNATURE && mps_fs_check(&addr[i][j])) {
                 fs = (struct mps_fs *) &addr[i][j];
                 goto fs_found;
+            }
+        }
+    }
     l_apic = (uint32_t *)(uintptr_t)ct->l_apic;
     cnt = 0;
     cur = &ct->base_table[0];
-    for (i=0; i < ct->entry_count; i++) {
+    for (i = 0; i < ct->entry_count; i++) {
         switch (*cur) {
-            /* Processor entry */
+        /* Processor entry */
-            case 0:
+        case 0:
-                processor_entries = processor_entries ? processor_entries : (struct __processor_entry *) cur;
+            processor_entries = processor_entries ?
+                processor_entries :
+                (struct __processor_entry *) cur;
-                processor_entry_cnt++;
+            processor_entry_cnt++;
-                cnt += ct_processor_entry((struct __processor_entry *) cur);
+            cnt += ct_processor_entry((struct __processor_entry *)
+                cur);
-                cur += 20;
+            cur += 20;
-                break;
+            break;
-            /* Bus entry */
+        /* Bus entry */
-            case 1:
+        case 1:
+            bus_entries = bus_entries ?
-                bus_entries = bus_entries ? bus_entries : (struct __bus_entry *) cur;
+                bus_entries : (struct __bus_entry *) cur;
-                bus_entry_cnt++;
+            bus_entry_cnt++;
-                ct_bus_entry((struct __bus_entry *) cur);
+            ct_bus_entry((struct __bus_entry *) cur);
-                cur += 8;
+            cur += 8;
-                break;
+            break;
-            /* I/O Apic */
+        /* I/O Apic */
-            case 2:
+        case 2:
+            io_apic_entries = io_apic_entries ?
-                io_apic_entries = io_apic_entries ? io_apic_entries : (struct __io_apic_entry *) cur;
+                io_apic_entries : (struct __io_apic_entry *) cur;
                 io_apic_entry_cnt++;
-                ct_io_apic_entry((struct __io_apic_entry *) cur);
+            ct_io_apic_entry((struct __io_apic_entry *) cur);
-                cur += 8;
+            cur += 8;
-                break;
+            break;
-            /* I/O Interrupt Assignment */
+        /* I/O Interrupt Assignment */
-            case 3:
+        case 3:
+            io_intr_entries = io_intr_entries ?
-                io_intr_entries = io_intr_entries ? io_intr_entries : (struct __io_intr_entry *) cur;
+                io_intr_entries : (struct __io_intr_entry *) cur;
-                io_intr_entry_cnt++;
+            io_intr_entry_cnt++;
-                ct_io_intr_entry((struct __io_intr_entry *) cur);
+            ct_io_intr_entry((struct __io_intr_entry *) cur);
-                cur += 8;
+            cur += 8;
-                break;
+            break;
-            /* Local Interrupt Assignment */
+        /* Local Interrupt Assignment */
-            case 4:
+        case 4:
+            l_intr_entries = l_intr_entries ?
-                l_intr_entries = l_intr_entries ? l_intr_entries : (struct __l_intr_entry *) cur;
+                l_intr_entries : (struct __l_intr_entry *) cur;
-                l_intr_entry_cnt++;
+            l_intr_entry_cnt++;
-                ct_l_intr_entry((struct __l_intr_entry *) cur);
+            ct_l_intr_entry((struct __l_intr_entry *) cur);
-                cur += 8;
+            cur += 8;
-                break;
+            break;
-            default:
+        default:
-                /*
+            /*
-                 * Something is wrong. Fallback to UP mode.
+             * Something is wrong. Fallback to UP mode.
-                 */
+             */
-                printf("%s: ct badness\n", __func__);
+            printf("%s: ct badness\n", __func__);
-                return 1;
+            return 1;
+        }
+    }
     /*
      * Process extended entries.
 int ct_processor_entry(struct __processor_entry *pr __attribute__((unused)))
+{
     /*
      * Ignore processors which are not marked enabled.
      */
-    if ((pr->cpu_flags & (1<<0)) == 0)
+    if ((pr->cpu_flags & (1 << 0)) == 0)
         return 0;
-    apic_id_mask |= (1<<pr->l_apic_id);
+    apic_id_mask |= (1 << pr->l_apic_id);
     return 1;
+}
 void ct_bus_entry(struct __bus_entry *bus __attribute__((unused)))
+{
 //#define MPSCT_VERBOSE
 void ct_io_intr_entry(struct __io_intr_entry *iointr __attribute__((unused)))
+{
 #ifdef MPSCT_VERBOSE
     switch (iointr->intr_type) {
+    case 0:
-        case 0: printf("INT"); break;
+        printf("INT");
+        break;
+    case 1:
-        case 1: printf("NMI"); break;
+        printf("NMI");
+        break;
+    case 2:
-        case 2: printf("SMI"); break;
+        printf("SMI");
+        break;
+    case 3:
-        case 3: printf("ExtINT"); break;
+        printf("ExtINT");
+        break;
+    }
     putchar(',');
-    switch (iointr->poel&3) {
+    switch (iointr->poel & 3) {
+    case 0:
-        case 0: printf("bus-like"); break;
+        printf("bus-like");
+        break;
+    case 1:
-        case 1: printf("active high"); break;
+        printf("active high");
+        break;
+    case 2:
-        case 2: printf("reserved"); break;
+        printf("reserved");
+        break;
+    case 3:
-        case 3: printf("active low"); break;
+        printf("active low");
+        break;
+    }
     putchar(',');
-    switch ((iointr->poel>>2)&3) {
+    switch ((iointr->poel >> 2) & 3) {
+    case 0:
-        case 0: printf("bus-like"); break;
+        printf("bus-like");
+        break;
+    case 1:
-        case 1: printf("edge-triggered"); break;
+        printf("edge-triggered");
+        break;
+    case 2:
-        case 2: printf("reserved"); break;
+        printf("reserved");
+        break;
+    case 3:
-        case 3: printf("level-triggered"); break;
+        printf("level-triggered");
+        break;
+    }
     putchar(',');
     printf("bus%d,irq%d", iointr->src_bus_id, iointr->src_bus_irq);
     putchar(',');
-    printf("io_apic%d,pin%d", iointr->dst_io_apic_id, iointr->dst_io_apic_pin);
+    printf("io_apic%d,pin%d", iointr->dst_io_apic_id,
+        iointr->dst_io_apic_pin);
     putchar('\n');
 #endif
+}
 void ct_l_intr_entry(struct __l_intr_entry *lintr __attribute__((unused)))
+{
 #ifdef MPSCT_VERBOSE
     switch (lintr->intr_type) {
+    case 0:
-        case 0: printf("INT"); break;
+        printf("INT");
+        break;
+    case 1:
-        case 1: printf("NMI"); break;
+        printf("NMI");
+        break;
+    case 2:
-        case 2: printf("SMI"); break;
+        printf("SMI");
+        break;
+    case 3:
-        case 3: printf("ExtINT"); break;
+        printf("ExtINT");
+        break;
+    }
     putchar(',');
-    switch (lintr->poel&3) {
+    switch (lintr->poel & 3) {
+    case 0:
-        case 0: printf("bus-like"); break;
+        printf("bus-like");
+        break;
+    case 1:
-        case 1: printf("active high"); break;
+        printf("active high");
+        break;
+    case 2:
-        case 2: printf("reserved"); break;
+        printf("reserved");
+        break;
+    case 3:
-        case 3: printf("active low"); break;
+        printf("active low");
+        break;
+    }
     putchar(',');
-    switch ((lintr->poel>>2)&3) {
+    switch ((lintr->poel >> 2) & 3) {
+    case 0:
-        case 0: printf("bus-like"); break;
+        printf("bus-like");
+        break;
+    case 1:
-        case 1: printf("edge-triggered"); break;
+        printf("edge-triggered");
+        break;
+    case 2:
-        case 2: printf("reserved"); break;
+        printf("reserved");
+        break;
+    case 3:
-        case 3: printf("level-triggered"); break;
+        printf("level-triggered");
+        break;
+    }
     putchar(',');
     printf("bus%d,irq%d", lintr->src_bus_id, lintr->src_bus_irq);
     putchar(',');
     printf("l_apic%d,pin%d", lintr->dst_l_apic_id, lintr->dst_l_apic_pin);
 void ct_extended_entries(void)
+{
     uint8_t *ext = (uint8_t *) ct + ct->base_table_length;
     uint8_t *cur;
-    for (cur = ext; cur < ext + ct->ext_table_length; cur += cur[CT_EXT_ENTRY_LEN]) {
+    for (cur = ext; cur < ext + ct->ext_table_length;
+        cur += cur[CT_EXT_ENTRY_LEN]) {
         switch (cur[CT_EXT_ENTRY_TYPE]) {
-            default:
+        default:
-                printf("%p: skipping MP Configuration Table extended entry type %d\n", cur, cur[CT_EXT_ENTRY_TYPE]);
+            printf("%p: skipping MP Configuration Table extended "
+                "entry type %d\n", cur, cur[CT_EXT_ENTRY_TYPE]);
-                break;
+            break;
+        }
+    }
+}
 int mps_irq_to_pin(unsigned int irq)
+{
     unsigned int i;
     for (i = 0; i < io_intr_entry_cnt; i++) {
-        if (io_intr_entries[i].src_bus_irq == irq && io_intr_entries[i].intr_type == 0)
+        if (io_intr_entries[i].src_bus_irq == irq &&
+            io_intr_entries[i].intr_type == 0)
             return io_intr_entries[i].dst_io_apic_pin;
+    }
     return -1;
+}

Subversion Repositories HelenOS

(root)/trunk/kernel/arch/ia32/src/smp/mps.c – Rev 2462 → 2701