workbench/hidds/nouveau/pci-device-mock/pcimockdriverclass.c

   1 /*
   2     Copyright 2011, The AROS Development Team. All rights reserved.
   3     $Id$
   4 */
   5
   6 #include <aros/debug.h>
   7 #include <proto/oop.h>
   8
   9 #include <aros/symbolsets.h>
  10
  11 #include "pcimock_intern.h"
  12
  13 #undef HiddPCIDriverAttrBase
  14 #define HiddPCIDriverAttrBase   (SD(cl)->hiddPCIDriverAB)
  15
  16 #undef HiddAttrBase
  17 #define HiddAttrBase            (SD(cl)->hiddAB)
  18
  19 #undef HiddPCIMockHardwareAttrBase
  20 #define HiddPCIMockHardwareAttrBase (SD(cl)->hiddPCIMockHardwareAB)
  21
  22 OOP_Object * METHOD(PCIMock, Root, New)
  23 {
  24     struct pRoot_New mymsg;
  25
  26     struct TagItem mytags[] =
  27     {
  28         { aHidd_Name, (IPTR)"PCIMock" },
  29         { aHidd_HardwareName, (IPTR)"Mock PCI Driver" },
  30         { TAG_DONE, 0 }
  31     };
  32
  33     mymsg.mID = msg->mID;
  34     mymsg.attrList = (struct TagItem *)&mytags;
  35
  36     if (msg->attrList)
  37     {
  38         mytags[2].ti_Tag = TAG_MORE;
  39         mytags[2].ti_Data = (IPTR)msg->attrList;
  40     }
  41
  42     msg = &mymsg;
  43
  44     o = (OOP_Object *)OOP_DoSuperMethod(cl, o, (OOP_Msg)msg);
  45
  46     return o;
  47 }
  48
  49 ULONG METHOD(PCIMock, Hidd_PCIDriver, ReadConfigLong)
  50 {
  51     IPTR pciconfigspace;
  52     OOP_Object * mockHardware = NULL;
  53     ULONG val;
  54
  55     if (!((msg->bus == 0) && (msg->sub == 0)))
  56         return 0;
  57
  58     if ((mockHardware = SD(cl)->mockHardwareBus0[msg->dev]) == NULL)
  59         return 0;
  60
  61     OOP_GetAttr(mockHardware, aHidd_PCIMockHardware_ConfigSpaceAddr, &pciconfigspace);
  62
  63
  64     val = *((ULONG *)(pciconfigspace + msg->reg));
  65
  66     /* Inform mock device that value in its address space region has been read */
  67     {
  68         struct pHidd_PCIMockHardware_MemoryReadAtAddress mraa =
  69         {
  70             mID : OOP_GetMethodID(IID_Hidd_PCIMockHardware, moHidd_PCIMockHardware_MemoryReadAtAddress),
  71             memoryaddress : pciconfigspace + msg->reg
  72         };
  73
  74         OOP_DoMethod(mockHardware, (OOP_Msg)&mraa);
  75     }
  76
  77     return val;
  78 }
  79
  80 VOID METHOD(PCIMock, Hidd_PCIDriver, WriteConfigLong)
  81 {
  82     IPTR pciconfigspace;
  83     OOP_Object * mockHardware = NULL;
  84
  85     if (!((msg->bus == 0) && (msg->sub == 0)))
  86         return;
  87
  88     if ((mockHardware = SD(cl)->mockHardwareBus0[msg->dev]) == NULL)
  89         return;
  90
  91     OOP_GetAttr(mockHardware, aHidd_PCIMockHardware_ConfigSpaceAddr, &pciconfigspace);
  92
  93     *((ULONG *)(pciconfigspace + msg->reg)) = msg->val;
  94
  95     /* Inform mock device that value in its address space region has changed */
  96     {
  97         struct pHidd_PCIMockHardware_MemoryChangedAtAddress mcaa =
  98         {
  99             mID : OOP_GetMethodID(IID_Hidd_PCIMockHardware, moHidd_PCIMockHardware_MemoryChangedAtAddress),
 100             memoryaddress : pciconfigspace + msg->reg
 101         };
 102
 103         OOP_DoMethod(mockHardware, (OOP_Msg)&mcaa);
 104     }
 105 }
 106
 107 static int PCIMock_ExpungeClass(LIBBASETYPEPTR LIBBASE)
 108 {
 109     ULONG i;
 110
 111     D(bug("[PCIMock] deleting classes\n"));
 112
 113     for (i = 0; i < MAX_BUS0_DEVICES; i++)
 114         if (LIBBASE->sd.mockHardwareBus0[i] != NULL)
 115         {
 116             OOP_DisposeObject(LIBBASE->sd.mockHardwareBus0[i]);
 117             LIBBASE->sd.mockHardwareBus0[i] = NULL;
 118         }
 119
 120     OOP_ReleaseAttrBase(IID_Hidd_PCIDriver);
 121     OOP_ReleaseAttrBase(IID_Hidd);
 122     OOP_ReleaseAttrBase(IID_Hidd_PCIMockHardware);
 123
 124
 125
 126     return TRUE;
 127 }
 128
 129 static int PCIMock_InitClass(LIBBASETYPEPTR LIBBASE)
 130 {
 131     OOP_Object *pci = NULL;
 132     ULONG i;
 133
 134     D(bug("[PCIMock] Driver initialization\n"));
 135
 136     LIBBASE->sd.hiddPCIDriverAB = OOP_ObtainAttrBase(IID_Hidd_PCIDriver);
 137     LIBBASE->sd.hiddAB = OOP_ObtainAttrBase(IID_Hidd);
 138     LIBBASE->sd.hiddPCIMockHardwareAB = OOP_ObtainAttrBase(IID_Hidd_PCIMockHardware);
 139     for (i = 0; i < MAX_BUS0_DEVICES; i++)
 140         LIBBASE->sd.mockHardwareBus0[i] = NULL;
 141
 142     ADD_DEVICE((&LIBBASE->sd), 0, CLID_Hidd_PCIMockHardware_SIS661FX);
 143     ADD_DEVICE((&LIBBASE->sd), 2, CLID_Hidd_PCIMockHardware_NV44A);
 144 //    ADD_DEVICE((&LIBBASE->sd), 3, CLID_Hidd_PCIMockHardware_NVG86);
 145 //    ADD_DEVICE((&LIBBASE->sd), 4, CLID_Hidd_PCIMockHardware_NVGTS250);
 146 //    ADD_DEVICE((&LIBBASE->sd), 5, CLID_Hidd_PCIMockHardware_NVGF100);
 147
 148     if (LIBBASE->sd.hiddPCIDriverAB)
 149     {
 150         /*
 151         * The class may be added to the system. Add the driver
 152         * to PCI subsystem as well
 153         */
 154         struct pHidd_PCI_AddHardwareDriver msg;
 155
 156         /*
 157         * PCI is suppose to destroy the class on its Dispose
 158         */
 159         msg.driverClass = LIBBASE->sd.driverClass;
 160         msg.mID = OOP_GetMethodID(IID_Hidd_PCI, moHidd_PCI_AddHardwareDriver);
 161
 162         pci = OOP_NewObject(NULL, CLID_Hidd_PCI, NULL);
 163         OOP_DoMethod(pci, (OOP_Msg)&msg);
 164         OOP_DisposeObject(pci);
 165     }
 166     else
 167         return FALSE;
 168
 169     D(bug("[PCIMock] Driver ClassPtr = %x\n", psd->driverClass));
 170
 171     return TRUE;
 172 }
 173
 174 ADD2INITLIB(PCIMock_InitClass, 0)
 175 ADD2EXPUNGELIB(PCIMock_ExpungeClass, 0)