arch/i386-pc/kernel/platform_init.c

   1 /*
   2     Copyright © 1995-2014, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/symbolsets.h>
   7 #include <asm/cpu.h>
   8 #include <exec/execbase.h>
   9 #include <proto/exec.h>
  10
  11 #include "kernel_base.h"
  12 #include "kernel_debug.h"
  13 #include "kernel_intern.h"
  14 #include "apic.h"
  15 #include "traps.h"
  16 #include "utils.h"
  17 #include "xtpic.h"
  18
  19 #define D(x) x
  20
  21 static int PlatformInit(struct KernelBase *KernelBase)
  22 {
  23     struct PlatformData *data;
  24     struct table_desc idtr;
  25
  26     data = AllocMem(sizeof(struct PlatformData), MEMF_PUBLIC);
  27     if (!data)
  28         return FALSE;
  29
  30     D(bug("[Kernel] Allocated platform data at 0x%p\n", data));
  31     KernelBase->kb_PlatformData = data;
  32
  33     /* By default we have no APIC data */
  34     data->kb_APIC = NULL;
  35
  36     /*
  37      * Now we have a complete memory list and working AllocMem().
  38      * We can allocate space for IDT and TSS now and build them to make
  39      * interrupts working.
  40      */
  41     data->tss            = krnAllocMemAligned(sizeof(struct tss), 64);
  42     data->idt            = krnAllocMemAligned(sizeof(long long) * 256, 256);
  43     SysBase->SysStkLower = AllocMem(0x10000, MEMF_PUBLIC);  /* 64KB of system stack */
  44
  45     if ((!data->tss) || (!data->idt) || (!SysBase->SysStkLower))
  46         return FALSE;
  47
  48     data->tss->ssp_seg = KERNEL_DS; /* SSP segment descriptor */
  49     data->tss->cs      = USER_CS;
  50     data->tss->ds      = USER_DS;
  51     data->tss->es      = USER_DS;
  52     data->tss->ss      = USER_DS;
  53     data->tss->iomap   = 104;
  54
  55     /* Set up system stack */
  56     SysBase->SysStkUpper = SysBase->SysStkLower + 0x10000;
  57     data->tss->ssp       = (IPTR)SysBase->SysStkUpper;
  58
  59     /* Restore IDT structure */
  60     Init_Traps(data);
  61
  62     /* Set correct TSS address in the GDT */
  63     GDT[6].base_low  = ((unsigned long)data->tss) & 0xffff;
  64     GDT[6].base_mid  = (((unsigned long)data->tss) >> 16) & 0xff;
  65     GDT[6].base_high = (((unsigned long)data->tss) >> 24) & 0xff;
  66
  67     /*
  68      * As we prepared all necessary stuff, we can hopefully load IDT
  69      * into CPU. We may also play a bit with TSS
  70      */
  71     idtr.size = 0x07FF;
  72     idtr.base = (unsigned long)data->idt;
  73     asm
  74     (
  75         "lidt %0\n\t"
  76         "ltr %%ax\n\t"
  77         ::"m"(idtr),"ax"(0x30)
  78     );
  79
  80     D(bug("[Kernel] System restored\n"));
  81
  82     return TRUE;
  83 }
  84
  85 ADD2INITLIB(PlatformInit, 10);
  86
  87 /* acpica.library is optional */
  88 struct Library *ACPICABase = NULL;
  89
  90 void PlatformPostInit(void)
  91 {
  92     struct PlatformData *pdata = KernelBase->kb_PlatformData;
  93
  94     ACPICABase = OpenLibrary("acpica.library", 0);
  95
  96     if (ACPICABase)
  97         pdata->kb_APIC = acpi_APIC_Init();
  98
  99     if (!pdata->kb_APIC)
 100     {
 101         /* No APIC was discovered by ACPI/whatever else. Do the probe. */
 102         pdata->kb_APIC = core_APIC_Probe();
 103     }
 104
 105     if ((!pdata->kb_APIC) || (pdata->kb_APIC->flags & APF_8259))
 106     {
 107         /* Initialize our XT-PIC */
 108         XTPIC_Init(&pdata->xtpic_mask);
 109     }
 110
 111     if (pdata->kb_APIC && (pdata->kb_APIC->count > 1))
 112     {
 113         if (smp_Setup())
 114         {
 115             smp_Wake();
 116         }
 117         else
 118         {
 119             D(bug("[Kernel] Failed to prepare the environment!\n"));
 120
 121             pdata->kb_APIC->count = 1;  /* We have only one workinng CPU */
 122         }
 123     }
 124 }