arch/ppc-sam440/pci/driverclass.c

   1 /*
   2     Copyright © 2004-2006, The AROS Development Team. All rights reserved.
   3     $Id$
   4
   5     Desc: PCI direct driver for i386 native.
   6     Lang: English
   7 */
   8
   9 #define __OOP_NOATTRBASES__
  10
  11 #include <exec/types.h>
  12 #include <hidd/pci.h>
  13 #include <oop/oop.h>
  14
  15 #include <utility/tagitem.h>
  16
  17 #include <proto/exec.h>
  18 #include <proto/utility.h>
  19 #include <proto/oop.h>
  20
  21 #include <resources/processor.h>
  22 #include <proto/processor.h>
  23
  24 #include <aros/symbolsets.h>
  25 #include <asm/amcc440.h>
  26 #include <asm/io.h>
  27
  28 #include "pci.h"
  29
  30 #define DEBUG 1
  31 #include <aros/debug.h>
  32
  33 #undef HiddPCIDriverAttrBase
  34 #undef HiddAttrBase
  35
  36 #define HiddPCIDriverAttrBase   (PSD(cl)->hiddPCIDriverAB)
  37 #define HiddAttrBase            (PSD(cl)->hiddAB)
  38
  39 #define CFGADD(bus,dev,func,reg)    \
  40     ( psd->CfgBase | ((bus)<<16) |    \
  41     ((dev)<<11) | ((func)<<8) | ((reg)&~3))
  42
  43 typedef union _pcicfg
  44 {
  45     ULONG   ul;
  46     UWORD   uw[2];
  47     UBYTE   ub[4];
  48 } pcicfg;
  49
  50 /*
  51     We overload the New method in order to introduce the Hidd Name and
  52     HardwareName attributes.
  53 */
  54 OOP_Object *PCI440__Root__New(OOP_Class *cl, OOP_Object *o, struct pRoot_New *msg)
  55 {
  56     struct pRoot_New mymsg;
  57
  58     struct TagItem mytags[] = {
  59         { aHidd_Name, (IPTR)"PCINative" },
  60         { aHidd_HardwareName, (IPTR)"AMCC440 native direct access PCI driver" },
  61         { aHidd_PCIDriver_IOBase, PCI0_IO },
  62         { TAG_DONE, 0 }
  63     };
  64
  65     mymsg.mID = msg->mID;
  66     mymsg.attrList = (struct TagItem *)&mytags[0];
  67
  68     if (msg->attrList)
  69     {
  70         mytags[3].ti_Tag = TAG_MORE;
  71         mytags[3].ti_Data = (IPTR)msg->attrList;
  72     }
  73
  74     msg = &mymsg;
  75
  76     o = (OOP_Object *)OOP_DoSuperMethod(cl, o, (OOP_Msg)msg);
  77
  78     return o;
  79 }
  80
  81 static ULONG ReadConfigLong(struct pci_staticdata *psd, UBYTE bus, UBYTE dev, UBYTE sub, UWORD reg)
  82 {
  83     ULONG temp;
  84
  85     Disable();
  86     outl_le(CFGADD(bus, dev, sub, reg),PCI0_CFGADDR);
  87     temp=inl_le(PCI0_CFGDATA);
  88     Enable();
  89 #if 0
  90     /* FIXME: Is this really needed on SAM460? Other OSes do not seem to confirm this. */
  91     if (reg == 0x3c && psd->IntLine != 0xff) { /* PCICS_INT_LINE */
  92         temp &= ~0xff;
  93         temp |= psd->IntLine;
  94     }
  95 #endif
  96     DB2(bug("[PCI440] -> %08x = %08x\n", CFGADD(bus, dev, sub, reg), temp));
  97
  98     return temp;
  99 }
 100
 101 ULONG PCI440__Hidd_PCIDriver__ReadConfigLong(OOP_Class *cl, OOP_Object *o,
 102                                             struct pHidd_PCIDriver_ReadConfigLong *msg)
 103 {
 104     return ReadConfigLong(PSD(cl), msg->bus, msg->dev, msg->sub, msg->reg);
 105 }
 106
 107 static void WriteConfigLong(struct pci_staticdata *psd, UBYTE bus, UBYTE dev, UBYTE sub, UWORD reg, ULONG val)
 108 {
 109     DB2(bug("[PCI440] <- %08x = %08x\n", CFGADD(bus, dev, sub, reg), val));
 110     Disable();
 111     outl_le(CFGADD(bus, dev, sub, reg),PCI0_CFGADDR);
 112     outl_le(val,PCI0_CFGDATA);
 113     Enable();
 114 }
 115
 116 void PCI440__Hidd_PCIDriver__WriteConfigLong(OOP_Class *cl, OOP_Object *o,
 117                                             struct pHidd_PCIDriver_WriteConfigLong *msg)
 118 {
 119     WriteConfigLong(PSD(cl), msg->bus, msg->dev, msg->sub, msg->reg, msg->val);
 120 }
 121
 122 /* Class initialization and destruction */
 123 static inline ULONG GetPVR(void)
 124 {
 125     struct Library *ProcessorBase = OpenResource(PROCESSORNAME);
 126     ULONG pvr = 0;
 127
 128     if (ProcessorBase) {
 129         struct TagItem tags[] = {
 130             { GCIT_Model, (IPTR)&pvr },
 131             { TAG_END }
 132         };
 133         GetCPUInfo(tags);
 134     }
 135
 136     return pvr;
 137 }
 138
 139 static int PCI440_InitClass(LIBBASETYPEPTR LIBBASE)
 140 {
 141     OOP_Object *pci;
 142     ULONG pvr;
 143
 144     D(bug("PCI440: Driver initialization\n"));
 145
 146     pvr = GetPVR();
 147     if (pvr == PVR_PPC460EX_B) {
 148         LIBBASE->psd.IntLine = INTR_UIC0_PCI0_IN;
 149         LIBBASE->psd.CfgBase = 0x00000000;
 150     } else {
 151         LIBBASE->psd.IntLine = 0xff;
 152         LIBBASE->psd.CfgBase = 0x80000000;
 153     }
 154
 155     struct pHidd_PCI_AddHardwareDriver msg,*pmsg=&msg;
 156
 157     LIBBASE->psd.hiddPCIDriverAB = OOP_ObtainAttrBase(IID_Hidd_PCIDriver);
 158     LIBBASE->psd.hiddAB = OOP_ObtainAttrBase(IID_Hidd);
 159     if (LIBBASE->psd.hiddPCIDriverAB == 0 || LIBBASE->psd.hiddAB == 0)
 160     {
 161         D(bug("PCI440: ObtainAttrBases failed\n"));
 162         return FALSE;
 163     }
 164
 165     msg.driverClass = LIBBASE->psd.driverClass;
 166     msg.mID = OOP_GetMethodID(IID_Hidd_PCI, moHidd_PCI_AddHardwareDriver);
 167     D(bug("PCI440: Adding Driver to main the class OK\n"));
 168
 169     pci = OOP_NewObject(NULL, CLID_Hidd_PCI, NULL);
 170     OOP_DoMethod(pci, (OOP_Msg)pmsg);
 171     OOP_DisposeObject(pci);
 172
 173     D(bug("PCI440: CPU %p%p:%p%p PCI (0x%08x)\n",
 174                 inl_le(PCI0_POM0LAH), inl_le(PCI0_POM0LAL),
 175                 inl_le(PCI0_POM0PCIAH), inl_le(PCI0_POM0PCIAL),
 176                 ~(inl_le(PCI0_POM0SA) & ~0xf) + 1
 177                 ));
 178     D(bug("PCI440: CPU %p%p:%p%p PCI (0x%08x)\n",
 179                 inl_le(PCI0_POM1LAH), inl_le(PCI0_POM1LAL),
 180                 inl_le(PCI0_POM1PCIAH), inl_le(PCI0_POM1PCIAL),
 181                 ~(inl_le(PCI0_POM1SA) & ~0xf) + 1
 182                 ));
 183     uint64_t sa = ((uint64_t)inl_le(PCI0_PIM0SAH) << 32) | inl_le(PCI0_PIM0SAL);
 184     sa = ~(sa & ~0xfULL) + 1;
 185     D(bug("PCI440: PCI %p%p:%p%p CPU (0x%08x%08x)\n",
 186                 inl_le(PCI0_BAR0H), inl_le(PCI0_BAR0L) & ~0xf,
 187                 inl_le(PCI0_PIM0LAH), inl_le(PCI0_PIM0LAL),
 188                 (uint32_t)(sa >>32), (uint32_t)sa
 189                 ));
 190
 191     D(bug("PCI440: All OK\n"));
 192
 193     return TRUE;
 194 }
 195
 196 static int PCI440_ExpungeClass(LIBBASETYPEPTR LIBBASE)
 197 {
 198     D(bug("PCI440: Class destruction\n"));
 199
 200     OOP_ReleaseAttrBase(IID_Hidd_PCIDriver);
 201     OOP_ReleaseAttrBase(IID_Hidd);
 202
 203     return TRUE;
 204 }
 205
 206 ADD2INITLIB(PCI440_InitClass, 0)
 207 ADD2EXPUNGELIB(PCI440_ExpungeClass, 0)