KernelLand/Kernel/drv/pci.c

   1 /*\r
   2  * AcessOS/AcessBasic v0.1\r
   3  * PCI Bus Driver\r
   4  */\r
   5 #define DEBUG   0\r
   6 #include <acess.h>\r
   7 #include <modules.h>\r
   8 #include <vfs.h>\r
   9 #include <fs_devfs.h>\r
  10 #include <drv_pci.h>\r
  11 #include <drv_pci_int.h>\r
  12 \r
  13 #define LIST_DEVICES    1\r
  14 \r
  15 // === STRUCTURES ===\r
  16 typedef struct sPCIDevice\r
  17 {\r
  18         Uint16  bus, slot, fcn;\r
  19         Uint16  vendor, device;\r
  20         Uint32  class;  // Class:Subclass:ProgIf\r
  21         Uint8   revision;\r
  22         Uint32  ConfigCache[256/4];\r
  23         char    Name[8];\r
  24         tVFS_Node       Node;\r
  25 } tPCIDevice;\r
  26 \r
  27 // === CONSTANTS ===\r
  28 #define SPACE_STEP      5\r
  29 #define MAX_RESERVED_PORT       0xD00\r
  30 \r
  31 // === PROTOTYPES ===\r
  32  int    PCI_Install(char **Arguments);\r
  33  int    PCI_ScanBus(int ID, int bFill);\r
  34  \r
  35 char    *PCI_int_ReadDirRoot(tVFS_Node *node, int pos);\r
  36 tVFS_Node       *PCI_int_FindDirRoot(tVFS_Node *node, const char *filename);\r
  37 Uint32  PCI_int_GetBusAddr(Uint16 Bus, Uint16 Slot, Uint16 Fcn, Uint8 Offset);\r
  38 size_t  PCI_int_ReadDevice(tVFS_Node *node, off_t Offset, size_t Length, void *buffer);\r
  39  int    PCI_int_EnumDevice(Uint16 bus, Uint16 dev, Uint16 fcn, tPCIDevice *info);\r
  40 \r
  41 // === GLOBALS ===\r
  42 MODULE_DEFINE(0, 0x0100, PCI, PCI_Install, NULL, NULL);\r
  43  int    giPCI_BusCount = 1;\r
  44  int    giPCI_InodeHandle = -1;\r
  45  int    giPCI_DeviceCount = 0;\r
  46 tPCIDevice      *gPCI_Devices = NULL;\r
  47 tVFS_NodeType   gPCI_RootNodeType = {\r
  48         .TypeName = "PCI Root Node",\r
  49         .ReadDir = PCI_int_ReadDirRoot,\r
  50         .FindDir = PCI_int_FindDirRoot\r
  51 };\r
  52 tVFS_NodeType   gPCI_DevNodeType = {\r
  53         .TypeName = "PCI Dev Node",\r
  54         .Read = PCI_int_ReadDevice\r
  55 };\r
  56 tDevFS_Driver   gPCI_DriverStruct = {\r
  57         NULL, "pci",\r
  58         {\r
  59         .Flags = VFS_FFLAG_DIRECTORY,\r
  60         .Size = -1,\r
  61         .NumACLs = 1,\r
  62         .ACLs = &gVFS_ACL_EveryoneRX,\r
  63         .Type = &gPCI_RootNodeType\r
  64         }\r
  65 };\r
  66 Uint32  *gaPCI_PortBitmap = NULL;\r
  67 Uint32  gaPCI_BusBitmap[256/32];\r
  68  \r
  69 // === CODE ===\r
  70 /**\r
  71  * \brief Scan the PCI Bus for devices\r
  72  * \param Arguments     Boot-time parameters\r
  73  */\r
  74 int PCI_Install(char **Arguments)\r
  75 {\r
  76          int    i;\r
  77         void    *tmpPtr;\r
  78         \r
  79         // Build Portmap\r
  80         gaPCI_PortBitmap = malloc( 1 << 13 );\r
  81         if( !gaPCI_PortBitmap ) {\r
  82                 Log_Error("PCI", "Unable to allocate %i bytes for bitmap", 1 << 13);\r
  83                 return MODULE_ERR_MALLOC;\r
  84         }\r
  85         memset( gaPCI_PortBitmap, 0, 1 << 13 );\r
  86         for( i = 0; i < MAX_RESERVED_PORT / 32; i ++ )\r
  87                 gaPCI_PortBitmap[i] = -1;\r
  88         for( i = 0; i < MAX_RESERVED_PORT % 32; i ++ )\r
  89                 gaPCI_PortBitmap[MAX_RESERVED_PORT / 32] = 1 << i;\r
  90         \r
  91         // Scan Bus (Bus 0, Don't fill gPCI_Devices)\r
  92         i = PCI_ScanBus(0, 0);\r
  93         if(i != MODULE_ERR_OK)  return i;\r
  94                 \r
  95         if(giPCI_DeviceCount == 0) {\r
  96                 Log_Notice("PCI", "No devices were found");\r
  97                 return MODULE_ERR_NOTNEEDED;\r
  98         }\r
  99         \r
 100         // Allocate device buffer\r
 101         tmpPtr = malloc(giPCI_DeviceCount * sizeof(tPCIDevice));\r
 102         if(tmpPtr == NULL) {\r
 103                 Log_Warning("PCI", "Malloc ERROR");\r
 104                 return MODULE_ERR_MALLOC;\r
 105         }\r
 106         gPCI_Devices = tmpPtr;\r
 107         \r
 108         Log_Log("PCI", "%i devices, filling structure", giPCI_DeviceCount);\r
 109         \r
 110         // Reset counts\r
 111         giPCI_DeviceCount = 0;\r
 112         giPCI_BusCount = 0;\r
 113         memset(gaPCI_BusBitmap, 0, sizeof(gaPCI_BusBitmap));\r
 114         // Rescan, filling the PCI device array\r
 115         PCI_ScanBus(0, 1);\r
 116         \r
 117         // Complete Driver Structure\r
 118         gPCI_DriverStruct.RootNode.Size = giPCI_DeviceCount;\r
 119         \r
 120         // And add to DevFS\r
 121         DevFS_AddDevice(&gPCI_DriverStruct);\r
 122         \r
 123         return MODULE_ERR_OK;\r
 124 }\r
 125 \r
 126 /**\r
 127  * \brief Scans a specific PCI Bus\r
 128  * \param BusID PCI Bus ID to scan\r
 129  * \param bFill Fill the \a gPCI_Devices array?\r
 130  */\r
 131 int PCI_ScanBus(int BusID, int bFill)\r
 132 {\r
 133          int    dev, fcn;\r
 134         tPCIDevice      devInfo;\r
 135         \r
 136         if( gaPCI_BusBitmap[BusID/32] & (1 << (BusID%32)) )\r
 137                 return MODULE_ERR_OK;\r
 138         \r
 139         gaPCI_BusBitmap[BusID/32] |= (1 << (BusID%32));\r
 140         \r
 141         for( dev = 0; dev < 32; dev++ ) // 32 Devices per bus\r
 142         {\r
 143                 for( fcn = 0; fcn < 8; fcn++ )  // Max 8 functions per device\r
 144                 {\r
 145                         // Check if the device/function exists\r
 146                         if(!PCI_int_EnumDevice(BusID, dev, fcn, &devInfo))\r
 147                                 continue;\r
 148                         \r
 149                         if(devInfo.class == PCI_OC_PCIBRIDGE)\r
 150                         {\r
 151                                 #if LIST_DEVICES\r
 152                                 if( !bFill )\r
 153                                         Log_Log("PCI", "Bridge @ %i,%i:%i (0x%x:0x%x)",\r
 154                                                 BusID, dev, fcn, devInfo.vendor, devInfo.device);\r
 155                                 #endif\r
 156                                 //TODO: Handle PCI-PCI Bridges\r
 157                                 //PCI_ScanBus(devInfo.???, bFill);\r
 158                                 giPCI_BusCount ++;\r
 159                         }\r
 160                         else\r
 161                         {\r
 162                                 #if LIST_DEVICES\r
 163                                 if( !bFill )\r
 164                                         Log_Log("PCI", "Device %i,%i:%i %06x => 0x%04x:0x%04x",\r
 165                                                 BusID, dev, fcn, devInfo.class, devInfo.vendor, devInfo.device);\r
 166                                 #endif\r
 167                         }\r
 168                         \r
 169                         if( bFill ) {\r
 170                                 devInfo.Node.Inode = giPCI_DeviceCount;\r
 171                                 memcpy(&gPCI_Devices[giPCI_DeviceCount], &devInfo, sizeof(tPCIDevice));\r
 172                         }\r
 173                         giPCI_DeviceCount ++;\r
 174                         \r
 175                         // If bit 23 of (soemthing) is set, there are sub-functions\r
 176                         if(fcn == 0 && !(devInfo.ConfigCache[3] & 0x00800000) )\r
 177                                 break;\r
 178                 }\r
 179         }\r
 180         \r
 181         return MODULE_ERR_OK;\r
 182 }\r
 183 \r
 184 /**\r
 185  * \brief Read from Root of PCI Driver\r
 186 */\r
 187 char *PCI_int_ReadDirRoot(tVFS_Node *Node, int Pos)\r
 188 {\r
 189         ENTER("pNode iPos", Node, Pos);\r
 190         if(Pos < 0 || Pos >= giPCI_DeviceCount) {\r
 191                 LEAVE('n');\r
 192                 return NULL;\r
 193         }\r
 194         \r
 195         LEAVE('s', gPCI_Devices[Pos].Name);\r
 196         return strdup( gPCI_Devices[Pos].Name );\r
 197 }\r
 198 /**\r
 199  */\r
 200 tVFS_Node *PCI_int_FindDirRoot(tVFS_Node *node, const char *filename)\r
 201 {\r
 202          int    bus,slot,fcn;\r
 203          int    i;\r
 204         // Validate Filename (Pointer and length)\r
 205         if(!filename || strlen(filename) != 7)\r
 206                 return NULL;\r
 207         // Check for spacers\r
 208         if(filename[2] != '.' || filename[5] != ':')\r
 209                 return NULL;\r
 210         \r
 211         // Get Information\r
 212         if(filename[0] < '0' || filename[0] > '9')      return NULL;\r
 213         bus = (filename[0] - '0')*10;\r
 214         if(filename[1] < '0' || filename[1] > '9')      return NULL;\r
 215         bus += filename[1] - '0';\r
 216         if(filename[3] < '0' || filename[3] > '9')      return NULL;\r
 217         slot = (filename[3] - '0')*10;\r
 218         if(filename[4] < '0' || filename[4] > '9')      return NULL;\r
 219         slot += filename[4] - '0';\r
 220         if(filename[6] < '0' || filename[6] > '9')      return NULL;\r
 221         fcn = filename[6] - '0';\r
 222         \r
 223         // Find Match\r
 224         for(i=0;i<giPCI_DeviceCount;i++)\r
 225         {\r
 226                 if(gPCI_Devices[i].bus != bus)          continue;\r
 227                 if(gPCI_Devices[i].slot != slot)        continue;\r
 228                 if(gPCI_Devices[i].fcn != fcn)  continue;\r
 229                 \r
 230                 return &gPCI_Devices[i].Node;\r
 231         }\r
 232         \r
 233         // Error Return\r
 234         return NULL;\r
 235 }\r
 236 \r
 237 /**\r
 238  * \brief Read the PCI configuration space of a device\r
 239  */\r
 240 size_t PCI_int_ReadDevice(tVFS_Node *node, off_t pos, size_t length, void *buffer)\r
 241 {       \r
 242         if( pos + length > 256 )        return 0;\r
 243         \r
 244         memcpy(\r
 245                 buffer,\r
 246                 (char*)gPCI_Devices[node->Inode].ConfigCache + pos,\r
 247                 length);\r
 248         \r
 249         return length;\r
 250 }\r
 251 \r
 252 // --- Kernel Code Interface ---\r
 253 /**\r
 254  * \brief Counts the devices with the specified codes\r
 255  * \param vendor        Vendor ID\r
 256  * \param device        Device ID\r
 257  */\r
 258 int PCI_CountDevices(Uint16 vendor, Uint16 device)\r
 259 {\r
 260         int i, ret=0;\r
 261         for(i=0;i<giPCI_DeviceCount;i++)\r
 262         {\r
 263                 if(gPCI_Devices[i].vendor != vendor)    continue;\r
 264                 if(gPCI_Devices[i].device != device)    continue;\r
 265                 ret ++;\r
 266         }\r
 267         return ret;\r
 268 }\r
 269 \r
 270 /**\r
 271  * \brief Gets the ID of the specified PCI device\r
 272  * \param vendor        Vendor ID\r
 273  * \param device        Device ID\r
 274  * \param idx   Number of matching entry wanted\r
 275  */\r
 276 tPCIDev PCI_GetDevice(Uint16 vendor, Uint16 device, int idx)\r
 277 {\r
 278          int    i, j=0;\r
 279         for( i = 0; i < giPCI_DeviceCount; i ++ )\r
 280         {\r
 281                 if(gPCI_Devices[i].vendor != vendor)    continue;\r
 282                 if(gPCI_Devices[i].device != device)    continue;\r
 283                 if(j == idx)    return i;\r
 284                 j ++;\r
 285         }\r
 286         return -1;\r
 287 }\r
 288 \r
 289 /**\r
 290  * \brief Gets the ID of a device by it's class code\r
 291  * \param class Class Code\r
 292  * \param mask  Mask for class comparison\r
 293  * \param prev  ID of previous device (-1 for no previous)\r
 294  */\r
 295 tPCIDev PCI_GetDeviceByClass(Uint32 class, Uint32 mask, tPCIDev prev)\r
 296 {\r
 297          int    i;\r
 298         // Check if prev is negative (meaning get first)\r
 299         if(prev < 0)    i = 0;\r
 300         else    i = prev+1;\r
 301         \r
 302         for( ; i < giPCI_DeviceCount; i++ )\r
 303         {\r
 304                 if((gPCI_Devices[i].class & mask) == class)\r
 305                         return i;\r
 306         }\r
 307         return -1;\r
 308 }\r
 309 \r
 310 int PCI_GetDeviceInfo(tPCIDev ID, Uint16 *Vendor, Uint16 *Device, Uint32 *Class)\r
 311 {\r
 312         tPCIDevice      *dev = &gPCI_Devices[ID];\r
 313         if(ID < 0 || ID >= giPCI_DeviceCount)   return 1;\r
 314         \r
 315         if(Vendor)      *Vendor = dev->vendor;\r
 316         if(Device)      *Device = dev->device;\r
 317         if(Class)       *Class = dev->class;\r
 318         return 0;\r
 319 }\r
 320 \r
 321 int PCI_GetDeviceVersion(tPCIDev ID, Uint8 *Revision)\r
 322 {\r
 323         tPCIDevice      *dev = &gPCI_Devices[ID];\r
 324         if(ID < 0 || ID >= giPCI_DeviceCount)   return 1;\r
 325         \r
 326         if(Revision)    *Revision = dev->revision;\r
 327         return 0;\r
 328 }\r
 329 \r
 330 int PCI_GetDeviceSubsys(tPCIDev ID, Uint16 *SubsystemVendor, Uint16 *SubsystemID)\r
 331 {\r
 332         tPCIDevice      *dev = &gPCI_Devices[ID];\r
 333         if(ID < 0 || ID >= giPCI_DeviceCount)   return 1;\r
 334         \r
 335         if(SubsystemVendor)     *SubsystemVendor = dev->ConfigCache[0x2c/4] & 0xFFFF;\r
 336         if(SubsystemID) *SubsystemID = dev->ConfigCache[0x2c/4] >> 16;\r
 337 \r
 338         return 0;\r
 339 }\r
 340 \r
 341 Uint32 PCI_int_GetBusAddr(Uint16 Bus, Uint16 Slot, Uint16 Fcn, Uint8 Offset)\r
 342 {\r
 343         Bus &= 0xFF;\r
 344         Slot &= 0x1F;\r
 345         Fcn &= 7;\r
 346         Offset &= 0xFC;\r
 347         return ((Uint32)Bus << 16) | (Slot << 11) | (Fcn << 8) | (Offset & 0xFC);\r
 348 }\r
 349 \r
 350 Uint32 PCI_ConfigRead(tPCIDev ID, int Offset, int Size)\r
 351 {\r
 352         tPCIDevice      *dev;\r
 353         Uint32  dword, addr;\r
 354         \r
 355         if( ID < 0 || ID >= giPCI_DeviceCount ) return 0;\r
 356         if( Offset < 0 || Offset > 256 )        return 0;\r
 357 \r
 358         // TODO: Should I support non-aligned reads?\r
 359         if( Offset & (Size - 1) )       return 0;\r
 360 \r
 361         dev = &gPCI_Devices[ID];\r
 362         addr = PCI_int_GetBusAddr(dev->bus, dev->slot, dev->fcn, Offset);\r
 363 \r
 364         dword = PCI_CfgReadDWord(addr);\r
 365         gPCI_Devices[ID].ConfigCache[Offset/4] = dword;\r
 366         switch( Size )\r
 367         {\r
 368         case 1: return (dword >> (8 * (Offset&3))) & 0xFF;\r
 369         case 2: return (dword >> (8 * (Offset&2))) & 0xFFFF;\r
 370         case 4: return dword;\r
 371         default:\r
 372                 return 0;\r
 373         }\r
 374 }\r
 375 \r
 376 void PCI_ConfigWrite(tPCIDev ID, int Offset, int Size, Uint32 Value)\r
 377 {\r
 378         tPCIDevice      *dev;\r
 379         Uint32  dword, addr;\r
 380          int    shift;\r
 381         if( ID < 0 || ID >= giPCI_DeviceCount ) return ;\r
 382         if( Offset < 0 || Offset > 256 )        return ;\r
 383         \r
 384         dev = &gPCI_Devices[ID];\r
 385         addr = PCI_int_GetBusAddr(dev->bus, dev->slot, dev->fcn, Offset);\r
 386 \r
 387         if(Size != 4)\r
 388                 dword = PCI_CfgReadDWord(addr);\r
 389         switch(Size)\r
 390         {\r
 391         case 1:\r
 392                 shift = (Offset&3)*8;\r
 393                 dword &= ~(0xFF << shift);\r
 394                 dword |= Value << shift;\r
 395                 break;\r
 396         case 2:\r
 397                 shift = (Offset&2)*8;\r
 398                 dword &= ~(0xFFFF << shift);\r
 399                 dword |= Value << shift;\r
 400                 break;\r
 401         case 4:\r
 402                 dword = Value;\r
 403                 break;\r
 404         default:\r
 405                 return;\r
 406         }\r
 407         PCI_CfgWriteDWord(addr, dword);\r
 408 }\r
 409 \r
 410 /**\r
 411  * \brief Get the IRQ assigned to a device\r
 412  */\r
 413 Uint8 PCI_GetIRQ(tPCIDev id)\r
 414 {\r
 415         if(id < 0 || id >= giPCI_DeviceCount)\r
 416                 return 0;\r
 417         return gPCI_Devices[id].ConfigCache[15] & 0xFF;\r
 418         //return PCI_CfgReadByte( gPCI_Devices[id].bus, gPCI_Devices[id].slot, gPCI_Devices[id].fcn, 0x3C);\r
 419 }\r
 420 \r
 421 /**\r
 422  * \brief Read the a BAR (base address register) from the PCI config space\r
 423  */\r
 424 Uint32 PCI_GetBAR(tPCIDev id, int BARNum)\r
 425 {\r
 426         if(id < 0 || id >= giPCI_DeviceCount)\r
 427                 return 0;\r
 428         if(BARNum < 0 || BARNum >= 6)\r
 429                 return 0;\r
 430         return gPCI_Devices[id].ConfigCache[4+BARNum];\r
 431 }\r
 432 \r
 433 /**\r
 434  * \brief Get device information for a slot/function\r
 435  */\r
 436 int PCI_int_EnumDevice(Uint16 bus, Uint16 slot, Uint16 fcn, tPCIDevice *info)\r
 437 {\r
 438         Uint32  vendor_dev, tmp;\r
 439          int    i;\r
 440         Uint32  addr;\r
 441         addr = PCI_int_GetBusAddr(bus, slot, fcn, 0);   \r
 442 \r
 443         vendor_dev = PCI_CfgReadDWord( addr );\r
 444         if((vendor_dev & 0xFFFF) == 0xFFFF)     // Invalid Device\r
 445                 return 0;\r
 446 \r
 447         info->ConfigCache[0] = vendor_dev;\r
 448         for( i = 1, addr += 4; i < 256/4; i ++, addr += 4 )\r
 449         {\r
 450                 info->ConfigCache[i] = PCI_CfgReadDWord(addr);\r
 451         }       \r
 452 \r
 453         info->bus = bus;\r
 454         info->slot = slot;\r
 455         info->fcn = fcn;\r
 456         info->vendor = vendor_dev & 0xFFFF;\r
 457         info->device = vendor_dev >> 16;\r
 458         tmp = info->ConfigCache[2];\r
 459         info->revision = tmp & 0xFF;\r
 460         info->class = tmp >> 8;\r
 461         \r
 462 //      #if LIST_DEVICES\r
 463 //      Log("BAR0 0x%08x BAR1 0x%08x BAR2 0x%08x", info->ConfigCache[4], info->ConfigCache[5], info->ConfigCache[6]);\r
 464 //      Log("BAR3 0x%08x BAR4 0x%08x BAR5 0x%08x", info->ConfigCache[7], info->ConfigCache[8], info->ConfigCache[9]);\r
 465 //      Log("Class: 0x%06x", info->class);\r
 466 //      #endif\r
 467         \r
 468         // Make node name\r
 469         info->Name[0] = '0' + bus/10;\r
 470         info->Name[1] = '0' + bus%10;\r
 471         info->Name[2] = '.';\r
 472         info->Name[3] = '0' + slot/10;\r
 473         info->Name[4] = '0' + slot%10;\r
 474         info->Name[5] = ':';\r
 475         info->Name[6] = '0' + fcn;\r
 476         info->Name[7] = '\0';\r
 477         \r
 478         // Create VFS Node\r
 479         memset( &info->Node, 0, sizeof(tVFS_Node) );\r
 480         info->Node.Size = 256;\r
 481         \r
 482         info->Node.NumACLs = 1;\r
 483         info->Node.ACLs = &gVFS_ACL_EveryoneRO;\r
 484         \r
 485         info->Node.Type = &gPCI_RootNodeType;\r
 486         \r
 487         return 1;\r
 488 }\r
 489 \r
 490 // === EXPORTS ===\r
 491 //*\r
 492 EXPORT(PCI_CountDevices);\r
 493 EXPORT(PCI_GetDevice);\r
 494 EXPORT(PCI_GetDeviceByClass);\r
 495 EXPORT(PCI_GetDeviceInfo);\r
 496 EXPORT(PCI_GetDeviceVersion);\r
 497 EXPORT(PCI_GetDeviceSubsys);\r
 498 //EXPORT(PCI_AssignPort);\r
 499 EXPORT(PCI_GetBAR);\r
 500 EXPORT(PCI_GetIRQ);\r
 501 //*/\r