arch/i386-pc/cpu/cpu_init.c

   1 /*
   2     Copyright © 1995-2006, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: CPU Initialisation.
   6     Lang: english
   7 */
   8
   9 #include <aros/symbolsets.h>
  10 #include "cpu_intern.h"
  11 #include LC_LIBDEFS_FILE
  12
  13 void i386_CheckCPU_Type( struct i386_compat_intern *CPU_intern );
  14
  15 #define SMP_SUPPORT 1
  16
  17 static struct CPU_Definition *BootCPU;                      /* Pointer used by the exec launched boot cpu probe */
  18
  19 static int GM_UNIQUENAME(Init)(LIBBASETYPEPTR CPUBase)
  20 {
  21     struct intel_mp_confblock       *mpcfb = NULL;
  22     struct CPU_Definition           *AvailCPUs = NULL;
  23     struct i386_compat_intern       *BootCPU_intern = NULL;
  24     struct  ACPIBase                *ACPIBase = NULL;
  25
  26     CPUBase->CPUB_BOOT_Physical = -1;                                                   /* set to a single cpu for now          */
  27     CPUBase->CPUB_BOOT_Logical = -1;
  28
  29     mpcfb = find_smp_config();
  30
  31     if ( mpcfb )
  32     {
  33         kprintf(DEBUG_NAME_STR ": Found SMP 1.4 MP table = 0x%p\n", mpcfb);
  34         AllocAbs( 4096, mpcfb);
  35         if (mpcfb->mpcf_physptr) AllocAbs( 4096, mpcfb->mpcf_physptr );
  36         kprintf(DEBUG_NAME_STR ": SMP Table(s) protected\n");
  37     }
  38     else kprintf(DEBUG_NAME_STR ": NO compatable SMP hardware found.\n");
  39
  40     AvailCPUs = AllocMem( sizeof(struct CPU_Definition), MEMF_CLEAR | MEMF_PUBLIC );    /* Create our new CPU List              */
  41
  42     if( AvailCPUs )
  43     {
  44
  45         NEWLIST((struct List *)&(AvailCPUs->CPU_CPUList));
  46         AvailCPUs->CPU_Physical = 1;
  47
  48         InitSemaphore( &CPUBase->CPUB_ListLock);
  49         kprintf(DEBUG_NAME_STR ": Initialised CPU List Semaphore\n");
  50     }
  51     else
  52     {
  53         kprintf(DEBUG_NAME_STR ": ERROR - Couldnt allocate CPU list memory!\n");
  54         return FALSE;
  55     }
  56
  57 #warning TODO: Patch functions with suitable replacements (bug fixes/speed ups) - BEFORE SMP SETUP!
  58
  59     if ( mpcfb )  /* SMP? */
  60     {
  61         AllocAbs( 4096, smp_alloc_memory());                                    /* Create The Trampoline page..
  62                                                                                  Has to be in very low memory so we can execute
  63                                                                                  real-mode AP code.                               */
  64         BootCPU->CPU_Private2 = mpcfb;                                          /* Store the pointer to the SMP config block        */
  65         kprintf(DEBUG_NAME_STR ": SMP Trampoline page protected, SMP config stored.\n");
  66     }
  67
  68     CPUBase->CPUB_Processors = AvailCPUs; // done !
  69
  70     AddTail(&AvailCPUs->CPU_CPUList,&BootCPU->CPU_CPUList);
  71     kprintf(DEBUG_NAME_STR ": CPU List created = 0x%p, Boot CPU inserted..0x%p\n",AvailCPUs,BootCPU);
  72
  73     /*  Parse the ACPI tables for possible boot-time SMP configuration. */
  74     CPUBase->CPUB_ACPIBase = OpenResource("acpi.resource");
  75     kprintf(DEBUG_NAME_STR ": acpi.resource @ %p\n",CPUBase->CPUB_ACPIBase);
  76
  77     ACPIBase = CPUBase->CPUB_ACPIBase;
  78     ACPIBase->ACPIB_CPUBase = CPUBase;                                          /* pass our base poiner over   */
  79
  80     //ACPI_Init();                                                                /* make sure ACPI is online .. */
  81
  82     if (mpcfb) get_smp_config( mpcfb, CPUBase );
  83
  84     return TRUE;
  85 }
  86
  87 ADD2INITLIB(GM_UNIQUENAME(Init), 0)
  88
  89 /* WARNING!!! THIS NEXT FUNCTION RUS IN KERNEL LAND _ NO DEBUG OUTPUT ETC>> BE CAREFULL! */
  90
  91 void prepare_primary_cpu(struct ExecBase *SysBase)
  92 {
  93     struct i386_compat_intern       *BootCPU_intern;
  94
  95     BootCPU = AllocMem( sizeof(struct CPU_Definition), MEMF_CLEAR | MEMF_PUBLIC );                  /* Add the boot CPU to the CPU List     */
  96     if( BootCPU )
  97     {
  98
  99         BootCPU->CPU_Family = CPU_Family_i386;                                                      /* we are i386 compatable..             */
 100         BootCPU->CPU_Model = CPU_i386_386;
 101         BootCPU->CPU_ID = 1;                                                                        /* we are the only CPU at this time ..  */
 102         BootCPU->CPU_IsOnline = TRUE;                                                               /* CPU is online ..                     */
 103         BootCPU->CPU_BootCPU = TRUE;                                                                /* CPU bootd system..                   */
 104
 105         BootCPU_intern = AllocMem(sizeof(struct i386_compat_intern), MEMF_CLEAR | MEMF_PUBLIC );    /* Create its per CPU internal struct   */
 106
 107         if( BootCPU_intern )
 108         {
 109
 110 #warning TODO: The next line is broken - fix the checkcpu function
 111             i386_CheckCPU_Type( BootCPU_intern );
 112
 113             BootCPU->CPU_Private1 = BootCPU_intern;
 114
 115             switch (BootCPU_intern->x86_model)
 116             {
 117                 case 4:
 118                     BootCPU->CPU_Model = CPU_i386_486;
 119                     break;
 120                 case 5:
 121                     BootCPU->CPU_Model = CPU_i386_586;
 122                     break;
 123                 case 6:
 124                     BootCPU->CPU_Model = CPU_i386_686;
 125                     break;
 126                 case 7:
 127                     BootCPU->CPU_Model = CPU_i386_786;
 128                     break;
 129                 case 8:
 130                     BootCPU->CPU_Model = CPU_i386_886;
 131                     break;
 132             }
 133         }
 134     }
 135 }