arch/all-pc/hpet/hpet_init.c

   1 /*
   2     Copyright © 1995-2014, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/asmcall.h>
   7 #include <aros/debug.h>
   8 #include <aros/symbolsets.h>
   9 #include <exec/memory.h>
  10 #include <utility/hooks.h>
  11 #include <proto/exec.h>
  12 #include <proto/acpica.h>
  13
  14 #include "hpet_intern.h"
  15
  16 /* acpica.library is optional */
  17 struct Library *ACPICABase = NULL;
  18
  19 AROS_UFH3(static BOOL, hpetEnumFunc,
  20           AROS_UFHA(struct Hook *, hook, A0),
  21           AROS_UFHA(ACPI_TABLE_HPET *, table, A2),
  22           AROS_UFHA(struct HPETBase *, base, A1))
  23 {
  24     AROS_USERFUNC_INIT
  25
  26     ULONG n;
  27
  28     if (table->Address.SpaceId != ACPI_ADR_SPACE_SYSTEM_MEMORY)
  29         return FALSE;
  30
  31     n = (table->Id & HPET_NUM_COMPARATORS_MASK) >> HPET_NUM_COMPARATORS_SHIFT;
  32
  33     if (base->units)
  34     {
  35         IPTR blk = table->Address.Address + 0x0100;
  36         ULONG i;
  37
  38         for (i = 0; i < n; i++)
  39         {
  40             base->units[base->unitCnt + i].base  = table->Address.Address;
  41             base->units[base->unitCnt + i].block = blk;
  42             base->units[base->unitCnt + i].Owner = NULL;
  43
  44             blk += 0x0020;
  45         }
  46     }
  47
  48     base->unitCnt += n;
  49     return TRUE;
  50
  51     AROS_USERFUNC_EXIT
  52 }
  53
  54 static const struct Hook enumHook =
  55 {
  56     .h_Entry = (APTR)hpetEnumFunc
  57 };
  58
  59 static int hpet_Init(struct HPETBase *base)
  60 {
  61     base->unitCnt = 0;
  62
  63     ACPICABase = OpenLibrary("acpica.library", 0);
  64     if (!ACPICABase)
  65         return FALSE;
  66
  67     /* During the 1st pass base->units is NULL, so we will just count HPETs */
  68     AcpiScanTables("HPET", &enumHook, base);
  69
  70     D(bug("[HPET] %u units total\n", base->unitCnt));
  71     if (base->unitCnt) {
  72         base->units = AllocMem(sizeof(struct HPETUnit) * base->unitCnt, MEMF_CLEAR);
  73         if (base->units) {
  74             InitSemaphore(&base->lock);
  75
  76             /* Fill in the data */
  77             base->unitCnt = 0;
  78             AcpiScanTables("HPET", &enumHook, base);
  79             CloseLibrary(ACPICABase);
  80             ACPICABase = NULL;
  81
  82             return TRUE;
  83         }
  84     }
  85
  86     CloseLibrary(ACPICABase);
  87     ACPICABase = NULL;
  88     return TRUE;
  89 }
  90
  91 ADD2INITLIB(hpet_Init, 0);