arch/all-pc/kernel/apic_msi.c

   1 /*
   2     Copyright © 2017, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/kernel.h>
   7 #include <aros/libcall.h>
   8
   9 #define __KERNEL_NOLIBBASE__
  10 #include <proto/kernel.h>
  11 #include <proto/exec.h>
  12
  13 #include <kernel_base.h>
  14 #include <kernel_cpu.h>
  15 #include <kernel_debug.h>
  16 #include <kernel_interrupts.h>
  17 #include <kernel_objects.h>
  18
  19 #define D(x)
  20
  21 ULONG core_APIC_AllocMSI(ULONG count)
  22 {
  23     struct PlatformData *kernPlatD = (struct PlatformData *)KernelBase->kb_PlatformData;
  24     struct APICData *apicPrivate = kernPlatD->kb_APIC;
  25     apicid_t cpuNo = KrnGetCPUNumber();
  26     apicidt_t *IGATES = (apicidt_t *)apicPrivate->cores[cpuNo].cpu_IDT;
  27     ULONG msiID = APIC_MSI_BASE;
  28     int startIRQ = -1, cpuIRQ = -1, irq;
  29
  30     D(bug("[APIC:MSI] %s()\n"));
  31
  32     for (irq = (APIC_IRQ_BASE - X86_CPU_EXCEPT_COUNT); irq < ((APIC_IRQ_BASE - X86_CPU_EXCEPT_COUNT) + APIC_IRQ_COUNT); irq++)
  33     {
  34         if (KERNELIRQ_LIST(irq).lh_Type == APICInt_IntrController.ic_Node.ln_Type)
  35         {
  36             if (startIRQ == -1)
  37                 startIRQ = HW_IRQ_BASE + irq;
  38             else if ((HW_IRQ_BASE + irq) == (startIRQ + count))
  39             {
  40                 cpuIRQ = startIRQ;
  41                 break;
  42             }
  43         }
  44         else
  45             cpuIRQ = -1;
  46     }
  47     if (cpuIRQ != -1)
  48     {
  49         msiID += ((cpuNo << 8) | (cpuIRQ));
  50
  51         for (irq = cpuIRQ; irq < (cpuIRQ + count); irq++)
  52             IGATES[irq].p = 1;
  53
  54         D(bug("[APIC:MSI] %s: New MSI IRQ ID Base = %d, for %d IRQs\n", __func__, (int)msiID, count));
  55     }
  56     else
  57         msiID = (ULONG)-1;
  58
  59     return msiID;
  60 }
  61
  62 void core_APIC_RegisterMSI(void *handle)
  63 {
  64     struct IntrNode *msihandle = (struct IntrNode *)handle;
  65
  66     D(bug("[APIC:MSI] %s: MSI Handler @ 0x%p\n", msihandle));
  67     if ((msihandle->in_nr >= APIC_MSI_BASE) && (msihandle->in_nr < (ULONG)-1))
  68     {
  69         ULONG tmp = msihandle->in_nr - APIC_MSI_BASE;
  70         int msiCPUIRQ = (tmp & 0xFF);
  71         apicid_t msiCPUNo = (tmp >> 8) & 0xFF;
  72
  73         bug("[APIC:MSI] %s: Registering MSI %d (%03u:%02X)\n", (int)msihandle->in_nr, msiCPUNo, msiCPUIRQ);
  74     }
  75 }