arch/all-pc/kernel/apic.c

   1 /*
   2     Copyright © 1995-2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <exec/memory.h>
   7 #include <proto/exec.h>
   8
   9 #include "kernel_base.h"
  10 #include "kernel_debug.h"
  11 #include "kernel_intern.h"
  12 #include "apic.h"
  13
  14 #define D(x)
  15
  16 /* Initialize APIC by probing */
  17 struct APICData *core_APIC_Probe(void)
  18 {
  19     struct APICData *data;
  20     APTR ssp;
  21
  22 #ifdef __i386__
  23     /* Only i386 needs detection. On x86-64 APIC is always present. */
  24     ULONG arg = 1;
  25     ULONG res;
  26
  27     asm volatile("cpuid":"+a"(arg),"=d"(res)::"%ebx", "%ecx");
  28
  29     if (!(res & (1 << 9)))
  30         return NULL;
  31
  32     D(bug("[APIC] Detected by CPUID instruction\n"));
  33 #endif
  34
  35     /* Assuming uniprocessor IBM PC compatible */
  36     data = AllocMem(sizeof(struct APICData) + sizeof(struct CPUData), MEMF_CLEAR);
  37     if (!data)
  38         return NULL;
  39
  40     D(bug("[APIC] APIC Data @ 0x%p\n", data));
  41
  42     if ((ssp = SuperState()) != NULL)
  43     {
  44         data->lapicBase    = core_APIC_GetBase();
  45
  46         D(bug("[APIC] APIC Base = 0x%p\n", data->lapicBase));
  47
  48         data->apic_count                   = 1;
  49         data->flags                = APF_8259;
  50         data->cores[0].cpu_LocalID = core_APIC_GetID(data->lapicBase);
  51
  52         UserState(ssp);
  53
  54         D(bug("[APIC] ID #%d\n", data->cores[0].cpu_LocalID));
  55
  56         data->cores[0].cpu_GDT = __KernBootPrivate->BOOTGDT;
  57         data->cores[0].cpu_TLS = __KernBootPrivate->BOOTTLS;
  58         data->cores[0].cpu_IDT = __KernBootPrivate->BOOTIDT;
  59         data->cores[0].cpu_MMU = &__KernBootPrivate->MMU;
  60
  61         /* Just initialize to default state */
  62         core_APIC_Init(data, 0);
  63     }
  64     else
  65     {
  66         FreeMem(data, sizeof(struct APICData) + sizeof(struct CPUData));
  67         data = NULL;
  68     }
  69     return data;
  70 }
  71
  72 apicid_t core_APIC_GetNumberFromLocal(struct APICData *data, apicid_t apicLocalID)
  73 {
  74     apicid_t __APICNo;
  75
  76     D(bug("[APIC] %s()\n", __func__));
  77
  78     if (!data)
  79     {
  80         /* No APIC data -> uniprocessor system */
  81         if (apicLocalID > 0)
  82             return -1;
  83         else
  84             return 0;
  85     }
  86
  87     for (__APICNo = 0; __APICNo < data->apic_count; __APICNo++)
  88     {
  89         if (data->cores[__APICNo].cpu_LocalID == apicLocalID)
  90             return __APICNo;
  91     }
  92
  93     return -1;
  94 }
  95
  96 apicid_t core_APIC_GetNumber(struct APICData *data)
  97 {
  98     apicid_t __APICLogicalID;
  99
 100     D(bug("[APIC] %s()\n", __func__));
 101
 102     if (!data)
 103     {
 104         D(bug("[APIC] %s: BSP or uniprocessor\n", __func__));
 105         /* No APIC data -> uniprocessor system */
 106         return 0;
 107     }
 108
 109     __APICLogicalID = core_APIC_GetID(data->lapicBase);
 110
 111     D(bug("[APIC] %s: APIC ID %03u\n", __func__, __APICLogicalID));
 112
 113     return core_APIC_GetNumberFromLocal(data, __APICLogicalID);
 114 }
 115
 116 void core_APIC_GetMask(struct APICData *data, apicid_t cpuNo, cpumask_t *mask)
 117 {
 118     ULONG *apicMask;
 119     int idlong, idbit;
 120
 121     D(bug("[APIC] %s()\n", __func__));
 122
 123     if ((IPTR)mask != TASKAFFINITY_ANY)
 124     {
 125         idlong = cpuNo / 32;
 126         idbit = cpuNo - (idlong * 32);
 127
 128         D(bug("[APIC] %s: %d -> %d:%d\n", __func__, cpuNo, idlong, idbit));
 129         D(bug("[APIC] %s: mask @ 0x%p\n", __func__, mask));
 130
 131         if ((apicMask = (ULONG *)mask) != NULL)
 132             apicMask[idlong] = (1 << idbit);
 133     }
 134
 135     return;
 136 }
 137
 138 BOOL core_APIC_CPUInMask(apicid_t cpuNo, cpumask_t *mask)
 139 {
 140     ULONG *apicMask;
 141     int idlong, idbit;
 142
 143     D(bug("[APIC] %s()\n", __func__));
 144
 145     if (mask == NULL)
 146     {
 147         if (cpuNo == 0)
 148             return TRUE;
 149         return FALSE;
 150     }
 151
 152     if ((IPTR)mask == TASKAFFINITY_ANY)
 153     {
 154         // TODO: make sure it is a valid cpu number in the range of available cpus.
 155         return TRUE;
 156     }
 157
 158     idlong = cpuNo / 32;
 159     idbit = cpuNo - (idlong * 32);
 160
 161     D(bug("[APIC] %s: %d -> %d:%d\n", __func__, cpuNo, idlong, idbit));
 162     D(bug("[APIC] %s: mask @ 0x%p\n", __func__, mask));
 163
 164     if (((apicMask = (ULONG *)mask) != NULL) && (apicMask[idlong] & (1 << idbit)))
 165         return TRUE;
 166
 167     return FALSE;
 168 }