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