rom/devs/ahci/ahci_init.c

   1 /*
   2     Copyright © 2004-2011, The AROS Development Team. All rights reserved
   3     $Id$
   4
   5     Desc:
   6     Lang: English
   7 */
   8
   9 /* Maintainer: Jason S. McMullan <jason.mcmullan@gmail.com>
  10  */
  11
  12 #define DEBUG 0
  13
  14 #include <aros/debug.h>
  15 #include <aros/atomic.h>
  16 #include <aros/symbolsets.h>
  17 #include <exec/exec.h>
  18 #include <exec/resident.h>
  19 #include <exec/tasks.h>
  20 #include <exec/memory.h>
  21 #include <exec/nodes.h>
  22 #include <utility/utility.h>
  23 #include <libraries/expansion.h>
  24 #include <libraries/configvars.h>
  25 #include <devices/trackdisk.h>
  26 #include <devices/newstyle.h>
  27 #include <dos/bptr.h>
  28 #include <dos/dosextens.h>
  29
  30 #include <proto/exec.h>
  31 #include <proto/timer.h>
  32 #include <proto/bootloader.h>
  33 #include <proto/expansion.h>
  34 #include <proto/oop.h>
  35
  36 #include <hidd/pci.h>
  37
  38 #include <string.h>
  39
  40 #include "ahci.h"
  41 #include "ahci_intern.h"
  42 #include "timer.h"
  43
  44 u_int32_t AhciForceGen;
  45 u_int32_t AhciNoFeatures;
  46
  47 #include LC_LIBDEFS_FILE
  48
  49 /*
  50     Here shall we start. Make function static as it shouldn't be visible from
  51     outside.
  52 */
  53 static int AHCI_Init(LIBBASETYPEPTR LIBBASE)
  54 {
  55     D(bug("[AHCI--] AHCI_Init: ahci.device Initialization\n"));
  56
  57     /*
  58      * I've decided to use memory pools again. Alloc everything needed from
  59      * a pool, so that we avoid memory fragmentation.
  60      */
  61     LIBBASE->ahci_MemPool = CreatePool(MEMF_CLEAR | MEMF_PUBLIC | MEMF_SEM_PROTECTED , 8192, 4096);
  62     if (LIBBASE->ahci_MemPool == NULL)
  63         return FALSE;
  64
  65     D(bug("[AHCI--] AHCI_Init: MemPool @ %p\n", LIBBASE->ahci_MemPool));
  66
  67     /* Initialize lists */
  68     NEWLIST(&LIBBASE->ahci_Units);
  69     LIBBASE->ahci_UnitCount=0;
  70
  71     /* Get some useful bases */
  72     LIBBASE->ahci_HiddPCIDeviceAttrBase = OOP_ObtainAttrBase(IID_Hidd_PCIDevice);
  73     LIBBASE->ahci_HiddPCIDeviceMethodBase = OOP_GetMethodID(IID_Hidd_PCIDevice, 0);
  74
  75     LIBBASE->ahci_HiddPCIDriverMethodBase = OOP_GetMethodID(IID_Hidd_PCIDriver, 0);
  76     return TRUE;
  77 }
  78
  79 static int AHCI_Open
  80 (
  81     LIBBASETYPEPTR LIBBASE,
  82     struct IORequest *iorq,
  83     ULONG unitnum,
  84     ULONG flags
  85 )
  86 {
  87     struct cam_sim *tmp, *unit = NULL;
  88
  89     /*
  90      * Assume it failed
  91      */
  92     iorq->io_Error = IOERR_OPENFAIL;
  93
  94     ForeachNode(&LIBBASE->ahci_Units, tmp) {
  95         if (tmp->sim_Unit == unitnum &&
  96             !(tmp->sim_Flags & SIMF_OffLine)) {
  97             unit = tmp;
  98             AROS_ATOMIC_INC(unit->sim_UseCount);
  99             break;
 100         }
 101     }
 102
 103     if (unit == NULL)
 104         return FALSE;
 105
 106     /*
 107      * set up iorequest
 108      */
 109     iorq->io_Device     = &LIBBASE->ahci_Device;
 110     iorq->io_Unit       = (struct Unit *)unit;
 111     iorq->io_Error      = 0;
 112
 113     return TRUE;
 114 }
 115
 116 /* Close given device */
 117 static int AHCI_Close
 118 (
 119     LIBBASETYPEPTR LIBBASE,
 120     struct IORequest *iorq
 121 )
 122 {
 123     struct cam_sim *unit = (struct cam_sim *)iorq->io_Unit;
 124
 125     /* First of all make the important fields of struct IORequest invalid! */
 126     iorq->io_Unit = (struct Unit *)~0;
 127
 128     /* Decrease use counters of unit */
 129     AROS_ATOMIC_DEC(unit->sim_UseCount);
 130
 131     return TRUE;
 132 }
 133
 134 ADD2INITLIB(AHCI_Init, 0)
 135 ADD2OPENDEV(AHCI_Open, 0)
 136 ADD2CLOSEDEV(AHCI_Close, 0)
 137