2 * AcessOS/AcessBasic v0.1
\r
9 #include <fs_devfs.h>
\r
10 #include <drv_pci.h>
\r
11 #include <drv_pci_int.h>
\r
13 #define LIST_DEVICES 1
\r
15 // === STRUCTURES ===
\r
16 typedef struct sPCIDevice
\r
18 Uint16 bus, slot, fcn;
\r
19 Uint16 vendor, device;
\r
20 Uint32 class; // Class:Subclass:ProgIf
\r
22 Uint32 ConfigCache[256/4];
\r
27 // === CONSTANTS ===
\r
28 #define SPACE_STEP 5
\r
29 #define MAX_RESERVED_PORT 0xD00
\r
31 // === PROTOTYPES ===
\r
32 int PCI_Install(char **Arguments);
\r
33 int PCI_ScanBus(int ID, int bFill);
\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 Uint64 PCI_int_ReadDevice(tVFS_Node *node, Uint64 pos, Uint64 length, void *buffer);
\r
39 int PCI_int_EnumDevice(Uint16 bus, Uint16 dev, Uint16 fcn, tPCIDevice *info);
\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 tDevFS_Driver gPCI_DriverStruct = {
\r
50 .Flags = VFS_FFLAG_DIRECTORY,
\r
53 .ACLs = &gVFS_ACL_EveryoneRX,
\r
54 .ReadDir = PCI_int_ReadDirRoot,
\r
55 .FindDir = PCI_int_FindDirRoot
\r
58 Uint32 *gaPCI_PortBitmap = NULL;
\r
59 Uint32 gaPCI_BusBitmap[256/32];
\r
63 * \brief Scan the PCI Bus for devices
\r
64 * \param Arguments Boot-time parameters
\r
66 int PCI_Install(char **Arguments)
\r
72 gaPCI_PortBitmap = malloc( 1 << 13 );
\r
73 if( !gaPCI_PortBitmap ) {
\r
74 Log_Error("PCI", "Unable to allocate %i bytes for bitmap", 1 << 13);
\r
75 return MODULE_ERR_MALLOC;
\r
77 memset( gaPCI_PortBitmap, 0, 1 << 13 );
\r
78 for( i = 0; i < MAX_RESERVED_PORT / 32; i ++ )
\r
79 gaPCI_PortBitmap[i] = -1;
\r
80 for( i = 0; i < MAX_RESERVED_PORT % 32; i ++ )
\r
81 gaPCI_PortBitmap[MAX_RESERVED_PORT / 32] = 1 << i;
\r
83 // Scan Bus (Bus 0, Don't fill gPCI_Devices)
\r
84 i = PCI_ScanBus(0, 0);
\r
85 if(i != MODULE_ERR_OK) return i;
\r
87 if(giPCI_DeviceCount == 0) {
\r
88 Log_Notice("PCI", "No devices were found");
\r
89 return MODULE_ERR_NOTNEEDED;
\r
92 // Allocate device buffer
\r
93 tmpPtr = malloc(giPCI_DeviceCount * sizeof(tPCIDevice));
\r
94 if(tmpPtr == NULL) {
\r
95 Log_Warning("PCI", "Malloc ERROR");
\r
96 return MODULE_ERR_MALLOC;
\r
98 gPCI_Devices = tmpPtr;
\r
100 Log_Log("PCI", "%i devices, filling structure", giPCI_DeviceCount);
\r
103 giPCI_DeviceCount = 0;
\r
104 giPCI_BusCount = 0;
\r
105 memset(gaPCI_BusBitmap, 0, sizeof(gaPCI_BusBitmap));
\r
106 // Rescan, filling the PCI device array
\r
109 // Complete Driver Structure
\r
110 gPCI_DriverStruct.RootNode.Size = giPCI_DeviceCount;
\r
112 // And add to DevFS
\r
113 DevFS_AddDevice(&gPCI_DriverStruct);
\r
115 return MODULE_ERR_OK;
\r
119 * \brief Scans a specific PCI Bus
\r
120 * \param BusID PCI Bus ID to scan
\r
121 * \param bFill Fill the \a gPCI_Devices array?
\r
123 int PCI_ScanBus(int BusID, int bFill)
\r
126 tPCIDevice devInfo;
\r
128 if( gaPCI_BusBitmap[BusID/32] & (1 << (BusID%32)) )
\r
129 return MODULE_ERR_OK;
\r
131 gaPCI_BusBitmap[BusID/32] |= (1 << (BusID%32));
\r
133 for( dev = 0; dev < 32; dev++ ) // 32 Devices per bus
\r
135 for( fcn = 0; fcn < 8; fcn++ ) // Max 8 functions per device
\r
137 // Check if the device/function exists
\r
138 if(!PCI_int_EnumDevice(BusID, dev, fcn, &devInfo))
\r
141 if(devInfo.class == PCI_OC_PCIBRIDGE)
\r
145 Log_Log("PCI", "Bridge @ %i,%i:%i (0x%x:0x%x)",
\r
146 BusID, dev, fcn, devInfo.vendor, devInfo.device);
\r
148 //TODO: Handle PCI-PCI Bridges
\r
149 //PCI_ScanBus(devInfo.???, bFill);
\r
156 Log_Log("PCI", "Device %i,%i:%i %06x => 0x%04x:0x%04x",
\r
157 BusID, dev, fcn, devInfo.class, devInfo.vendor, devInfo.device);
\r
162 devInfo.Node.Inode = giPCI_DeviceCount;
\r
163 memcpy(&gPCI_Devices[giPCI_DeviceCount], &devInfo, sizeof(tPCIDevice));
\r
165 giPCI_DeviceCount ++;
\r
167 // If bit 23 of (soemthing) is set, there are sub-functions
\r
168 if(fcn == 0 && !(devInfo.ConfigCache[3] & 0x00800000) )
\r
173 return MODULE_ERR_OK;
\r
177 * \brief Read from Root of PCI Driver
\r
179 char *PCI_int_ReadDirRoot(tVFS_Node *Node, int Pos)
\r
181 ENTER("pNode iPos", Node, Pos);
\r
182 if(Pos < 0 || Pos >= giPCI_DeviceCount) {
\r
187 LEAVE('s', gPCI_Devices[Pos].Name);
\r
188 return strdup( gPCI_Devices[Pos].Name );
\r
192 tVFS_Node *PCI_int_FindDirRoot(tVFS_Node *node, const char *filename)
\r
196 // Validate Filename (Pointer and length)
\r
197 if(!filename || strlen(filename) != 7)
\r
199 // Check for spacers
\r
200 if(filename[2] != '.' || filename[5] != ':')
\r
204 if(filename[0] < '0' || filename[0] > '9') return NULL;
\r
205 bus = (filename[0] - '0')*10;
\r
206 if(filename[1] < '0' || filename[1] > '9') return NULL;
\r
207 bus += filename[1] - '0';
\r
208 if(filename[3] < '0' || filename[3] > '9') return NULL;
\r
209 slot = (filename[3] - '0')*10;
\r
210 if(filename[4] < '0' || filename[4] > '9') return NULL;
\r
211 slot += filename[4] - '0';
\r
212 if(filename[6] < '0' || filename[6] > '9') return NULL;
\r
213 fcn = filename[6] - '0';
\r
216 for(i=0;i<giPCI_DeviceCount;i++)
\r
218 if(gPCI_Devices[i].bus != bus) continue;
\r
219 if(gPCI_Devices[i].slot != slot) continue;
\r
220 if(gPCI_Devices[i].fcn != fcn) continue;
\r
222 return &gPCI_Devices[i].Node;
\r
231 Uint64 PCI_int_ReadDevice(tVFS_Node *node, Uint64 pos, Uint64 length, void *buffer)
\r
233 if( pos + length > 256 ) return 0;
\r
237 (char*)gPCI_Devices[node->Inode].ConfigCache + pos,
\r
243 // --- Kernel Code Interface ---
\r
245 * \brief Counts the devices with the specified codes
\r
246 * \param vendor Vendor ID
\r
247 * \param device Device ID
\r
249 int PCI_CountDevices(Uint16 vendor, Uint16 device)
\r
252 for(i=0;i<giPCI_DeviceCount;i++)
\r
254 if(gPCI_Devices[i].vendor != vendor) continue;
\r
255 if(gPCI_Devices[i].device != device) continue;
\r
262 * \brief Gets the ID of the specified PCI device
\r
263 * \param vendor Vendor ID
\r
264 * \param device Device ID
\r
265 * \param idx Number of matching entry wanted
\r
267 tPCIDev PCI_GetDevice(Uint16 vendor, Uint16 device, int idx)
\r
270 for( i = 0; i < giPCI_DeviceCount; i ++ )
\r
272 if(gPCI_Devices[i].vendor != vendor) continue;
\r
273 if(gPCI_Devices[i].device != device) continue;
\r
274 if(j == idx) return i;
\r
281 * \brief Gets the ID of a device by it's class code
\r
282 * \param class Class Code
\r
283 * \param mask Mask for class comparison
\r
284 * \param prev ID of previous device (-1 for no previous)
\r
286 tPCIDev PCI_GetDeviceByClass(Uint32 class, Uint32 mask, tPCIDev prev)
\r
289 // Check if prev is negative (meaning get first)
\r
290 if(prev < 0) i = 0;
\r
293 for( ; i < giPCI_DeviceCount; i++ )
\r
295 if((gPCI_Devices[i].class & mask) == class)
\r
301 int PCI_GetDeviceInfo(tPCIDev ID, Uint16 *Vendor, Uint16 *Device, Uint32 *Class)
\r
303 tPCIDevice *dev = &gPCI_Devices[ID];
\r
304 if(ID < 0 || ID >= giPCI_DeviceCount) return 1;
\r
306 if(Vendor) *Vendor = dev->vendor;
\r
307 if(Device) *Device = dev->device;
\r
308 if(Class) *Class = dev->class;
\r
312 int PCI_GetDeviceVersion(tPCIDev ID, Uint8 *Revision)
\r
314 tPCIDevice *dev = &gPCI_Devices[ID];
\r
315 if(ID < 0 || ID >= giPCI_DeviceCount) return 1;
\r
317 if(Revision) *Revision = dev->revision;
\r
321 int PCI_GetDeviceSubsys(tPCIDev ID, Uint16 *SubsystemVendor, Uint16 *SubsystemID)
\r
323 tPCIDevice *dev = &gPCI_Devices[ID];
\r
324 if(ID < 0 || ID >= giPCI_DeviceCount) return 1;
\r
326 if(SubsystemVendor) *SubsystemVendor = dev->ConfigCache[0x2c/4] & 0xFFFF;
\r
327 if(SubsystemID) *SubsystemID = dev->ConfigCache[0x2c/4] >> 16;
\r
332 Uint32 PCI_int_GetBusAddr(Uint16 Bus, Uint16 Slot, Uint16 Fcn, Uint8 Offset)
\r
338 return ((Uint32)Bus << 16) | (Slot << 11) | (Fcn << 8) | (Offset & 0xFC);
\r
341 Uint32 PCI_ConfigRead(tPCIDev ID, int Offset, int Size)
\r
344 Uint32 dword, addr;
\r
346 if( ID < 0 || ID >= giPCI_DeviceCount ) return 0;
\r
347 if( Offset < 0 || Offset > 256 ) return 0;
\r
349 // TODO: Should I support non-aligned reads?
\r
350 if( Offset & (Size - 1) ) return 0;
\r
352 dev = &gPCI_Devices[ID];
\r
353 addr = PCI_int_GetBusAddr(dev->bus, dev->slot, dev->fcn, Offset);
\r
355 dword = PCI_CfgReadDWord(addr);
\r
356 gPCI_Devices[ID].ConfigCache[Offset/4] = dword;
\r
359 case 1: return (dword >> (8 * (Offset&3))) & 0xFF;
\r
360 case 2: return (dword >> (8 * (Offset&2))) & 0xFFFF;
\r
361 case 4: return dword;
\r
367 void PCI_ConfigWrite(tPCIDev ID, int Offset, int Size, Uint32 Value)
\r
370 Uint32 dword, addr;
\r
372 if( ID < 0 || ID >= giPCI_DeviceCount ) return ;
\r
373 if( Offset < 0 || Offset > 256 ) return ;
\r
375 dev = &gPCI_Devices[ID];
\r
376 addr = PCI_int_GetBusAddr(dev->bus, dev->slot, dev->fcn, Offset);
\r
379 dword = PCI_CfgReadDWord(addr);
\r
383 shift = (Offset&3)*8;
\r
384 dword &= ~(0xFF << shift);
\r
385 dword |= Value << shift;
\r
388 shift = (Offset&2)*8;
\r
389 dword &= ~(0xFFFF << shift);
\r
390 dword |= Value << shift;
\r
398 PCI_CfgWriteDWord(addr, dword);
\r
402 * \brief Get the IRQ assigned to a device
\r
404 Uint8 PCI_GetIRQ(tPCIDev id)
\r
406 if(id < 0 || id >= giPCI_DeviceCount)
\r
408 return gPCI_Devices[id].ConfigCache[15] & 0xFF;
\r
409 //return PCI_CfgReadByte( gPCI_Devices[id].bus, gPCI_Devices[id].slot, gPCI_Devices[id].fcn, 0x3C);
\r
413 * \brief Read the a BAR (base address register) from the PCI config space
\r
415 Uint32 PCI_GetBAR(tPCIDev id, int BARNum)
\r
417 if(id < 0 || id >= giPCI_DeviceCount)
\r
419 if(BARNum < 0 || BARNum >= 6)
\r
421 return gPCI_Devices[id].ConfigCache[4+BARNum];
\r
425 * \brief Get device information for a slot/function
\r
427 int PCI_int_EnumDevice(Uint16 bus, Uint16 slot, Uint16 fcn, tPCIDevice *info)
\r
429 Uint32 vendor_dev, tmp;
\r
432 addr = PCI_int_GetBusAddr(bus, slot, fcn, 0);
\r
434 vendor_dev = PCI_CfgReadDWord( addr );
\r
435 if((vendor_dev & 0xFFFF) == 0xFFFF) // Invalid Device
\r
438 info->ConfigCache[0] = vendor_dev;
\r
439 for( i = 1, addr += 4; i < 256/4; i ++, addr += 4 )
\r
441 info->ConfigCache[i] = PCI_CfgReadDWord(addr);
\r
447 info->vendor = vendor_dev & 0xFFFF;
\r
448 info->device = vendor_dev >> 16;
\r
449 tmp = info->ConfigCache[2];
\r
450 info->revision = tmp & 0xFF;
\r
451 info->class = tmp >> 8;
\r
453 // #if LIST_DEVICES
\r
454 // Log("BAR0 0x%08x BAR1 0x%08x BAR2 0x%08x", info->ConfigCache[4], info->ConfigCache[5], info->ConfigCache[6]);
\r
455 // Log("BAR3 0x%08x BAR4 0x%08x BAR5 0x%08x", info->ConfigCache[7], info->ConfigCache[8], info->ConfigCache[9]);
\r
456 // Log("Class: 0x%06x", info->class);
\r
460 info->Name[0] = '0' + bus/10;
\r
461 info->Name[1] = '0' + bus%10;
\r
462 info->Name[2] = '.';
\r
463 info->Name[3] = '0' + slot/10;
\r
464 info->Name[4] = '0' + slot%10;
\r
465 info->Name[5] = ':';
\r
466 info->Name[6] = '0' + fcn;
\r
467 info->Name[7] = '\0';
\r
470 memset( &info->Node, 0, sizeof(tVFS_Node) );
\r
471 info->Node.Size = 256;
\r
473 info->Node.NumACLs = 1;
\r
474 info->Node.ACLs = &gVFS_ACL_EveryoneRO;
\r
476 info->Node.Read = PCI_int_ReadDevice;
\r
483 EXPORT(PCI_CountDevices);
\r
484 EXPORT(PCI_GetDevice);
\r
485 EXPORT(PCI_GetDeviceByClass);
\r
486 EXPORT(PCI_GetDeviceInfo);
\r
487 EXPORT(PCI_GetDeviceVersion);
\r
488 EXPORT(PCI_GetDeviceSubsys);
\r
489 //EXPORT(PCI_AssignPort);
\r
490 EXPORT(PCI_GetBAR);
\r
491 EXPORT(PCI_GetIRQ);
\r