rom/devs/ahci/bus_pci.c

   1 /*
   2     Copyright © 2004-2013, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: PCI bus driver for ahci.device
   6     Lang: English
   7 */
   8
   9 #define __OOP_NOMETHODBASES__
  10
  11 #include <aros/asmcall.h>
  12 #include <aros/debug.h>
  13 #include <aros/symbolsets.h>
  14 #include <asm/io.h>
  15 #include <exec/lists.h>
  16 #include <hardware/ahci.h>
  17 #include <hidd/pci.h>
  18 #include <oop/oop.h>
  19 #include <proto/exec.h>
  20 #include <proto/oop.h>
  21
  22 #include <string.h>
  23
  24 #include "ahci_intern.h"
  25 #include "ahci.h"
  26 #include "pci.h"
  27
  28 typedef struct
  29 {
  30     struct AHCIBase *AHCIBase;
  31     struct List     devices;
  32     OOP_AttrBase    HiddPCIDeviceAttrBase;
  33     OOP_MethodID    HiddPCIDriverMethodBase;
  34 } EnumeratorArgs;
  35
  36 int ahci_attach(device_t dev)
  37 {
  38     struct ahci_softc *sc = device_get_softc(dev);
  39
  40     sc->sc_ad = ahci_lookup_device(dev);
  41     if (sc->sc_ad == NULL)
  42         return ENXIO; /* WTF? This matched during the probe... */
  43
  44     return sc->sc_ad->ad_attach(dev);
  45 }
  46
  47 void ahci_release(device_t dev)
  48 {
  49     struct AHCIBase *AHCIBase = dev->dev_AHCIBase;
  50     OOP_MethodID HiddPCIDeviceBase = AHCIBase->ahci_HiddPCIDeviceMethodBase;
  51
  52     HIDD_PCIDevice_Release(dev->dev_Object);
  53     FreePooled(AHCIBase->ahci_MemPool, dev, sizeof(*dev) + sizeof(*(dev->dev_softc)));
  54 }
  55
  56 /*
  57  * PCI BUS ENUMERATOR
  58  *   collect all SATA devices and spawn concurrent tasks.
  59  *
  60  * ahci.device unit numbers are as follows:
  61  *   First AHCI device:  unit   0..31
  62  *   Second device:      units 32..63
  63  *   etc..
  64  */
  65
  66 static
  67 AROS_UFH3(void, ahci_PCIEnumerator_h,
  68     AROS_UFHA(struct Hook *,    hook,   A0),
  69     AROS_UFHA(OOP_Object *,     Device, A2),
  70     AROS_UFHA(APTR,             message,A1))
  71 {
  72     AROS_USERFUNC_INIT
  73
  74     device_t dev;
  75     const struct ahci_device *ad;
  76     EnumeratorArgs *a = hook->h_Data;
  77     struct AHCIBase *AHCIBase = a->AHCIBase;
  78     OOP_MethodID HiddPCIDeviceBase = AHCIBase->ahci_HiddPCIDeviceMethodBase;
  79     CONST_STRPTR owner;
  80
  81     dev = AllocPooled(AHCIBase->ahci_MemPool, sizeof(*dev) + sizeof(*(dev->dev_softc)));
  82     if (dev == NULL)
  83         return;
  84
  85     dev->dev_AHCIBase = AHCIBase;
  86     dev->dev_Object   = Device;
  87     dev->dev_softc    = (void *)&dev[1];
  88     dev->dev_HostID   = AHCIBase->ahci_HostCount;
  89
  90     D(bug("[PCI-AHCI] ahci_PCIEnumerator_h: Scan device %04x:%04x\n", pci_get_vendor(dev), pci_get_device(dev)));
  91
  92     ad = ahci_lookup_device(dev);
  93     if (!ad) {
  94         FreePooled(AHCIBase->ahci_MemPool, dev, sizeof(*dev) + sizeof(*(dev->dev_softc)));
  95         return;
  96     }
  97
  98     D(bug("[AHCI] Found PCI device %04x:%04x\n", pci_get_vendor(dev), pci_get_device(dev)));
  99
 100     owner = HIDD_PCIDevice_Obtain(Device, AHCIBase->ahci_Device.dd_Library.lib_Node.ln_Name);
 101     if (owner)
 102     {
 103         D(bug("[AHCI] Device is already in use by %s\n", owner));
 104         FreePooled(AHCIBase->ahci_MemPool, dev, sizeof(*dev) + sizeof(*(dev->dev_softc)));
 105         return;
 106     }
 107
 108     AHCIBase->ahci_HostCount++;
 109     AddTail(&a->devices, (struct Node *)dev);
 110
 111     return;
 112     AROS_USERFUNC_EXIT
 113 }
 114
 115 static const struct TagItem Requirements[] =
 116 {
 117     {tHidd_PCI_Class,     PCI_CLASS_MASSSTORAGE},
 118     {tHidd_PCI_SubClass,  PCI_SUBCLASS_SATA},
 119     {tHidd_PCI_Interface, 1},
 120     {TAG_DONE }
 121 };
 122
 123 static int ahci_pci_scan(struct AHCIBase *AHCIBase)
 124 {
 125     OOP_Object *pci;
 126     EnumeratorArgs Args;
 127     device_t dev;
 128
 129     D(bug("[PCI-AHCI] ahci_scan: Enumerating devices\n"));
 130
 131     Args.AHCIBase                 = AHCIBase;
 132     NEWLIST(&Args.devices);
 133
 134     pci = OOP_NewObject(NULL, CLID_Hidd_PCI, NULL);
 135
 136     if (pci)
 137     {
 138         struct Hook FindHook =
 139         {
 140             h_Entry:    (IPTR (*)())ahci_PCIEnumerator_h,
 141             h_Data:     &Args
 142         };
 143
 144         struct pHidd_PCI_EnumDevices enummsg =
 145         {
 146             mID:            OOP_GetMethodID(IID_Hidd_PCI, moHidd_PCI_EnumDevices),
 147             callback:       &FindHook,
 148             requirements:   Requirements,
 149         };
 150
 151         OOP_DoMethod(pci, &enummsg.mID);
 152         OOP_DisposeObject(pci);
 153     }
 154
 155     D(bug("[PCI-AHCI] ahci_scan: Registering Probed Hosts..\n"));
 156
 157     while ((dev = (device_t)RemHead(&Args.devices)) != NULL) {
 158         if (ahci_attach(dev) != 0) {
 159             ahci_release(dev);
 160         }
 161     }
 162
 163     return TRUE;
 164 }
 165
 166 /*
 167  * ahci.device main code has two init routines with 0 and 127 priorities.
 168  * All bus scanners must run between them.
 169  */
 170 ADD2INITLIB(ahci_pci_scan, 30)