cos2000v2/lib/pci.c

/*******************************************************************************/
/* COS2000 - Compatible Operating System - LGPL v3 - Hord<72> Nicolas             */
/*                                                                             */

#include "asm.h"
#include "types.h"
#include "pci.h"
#include "PCI/class.c"

#define MAX_BUS_SCAN        256
#define MAX_DEVICE_SCAN     32
#define MAX_FUNCTION_SCAN   8

/*******************************************************************************/
/* Retourne une chaine correspondant <20> l'ID class/subclass PCI */

u8 * pcigetclassname( const pcidev *device)
{
    pciclass *class = NULL;
	if ( device == NULL ) {
		return NULL;
	}
	if ( device->base_class == 0xff ) {
		return "Unassigned class";
	}
	class = classcodes[device->base_class];
	if (!class) {
		return "Unknowned class";
	}
	while (class->name != NULL) {
		if (class->number == device->sub_class) {
			return class->name;
		}
		class++;
	}

	return "Unknowned class";
}

/*******************************************************************************/
/* R<>cup<75>re les identifiants vendeur / periph<70>rique du periph<70>rique PCI donn<6E>e */

pcidevmini getPCImininfo(const u8 bus, const u8 dev, const u8 function)
{
    pcidevmini result;
    if ((result.vendor_id = pciConfigReadWord(bus,dev,function,0x0)) != 0xFFFF) {
       result.device_id = pciConfigReadWord(bus,dev,function,0x2);
    }
    return result;
}

/*******************************************************************************/
/* R<>cup<75>re toutes les informations du periph<70>rique PCI donn<6E>e */

bool getPCInfo(pcidev *device, const u8 bus, const u8 dev, const u8 function)
{
    if ((device->vendor_id = pciConfigReadWord(bus,dev,function,0x0)) != 0xFFFF) 
    {
        u16 temp;
        device->device_id = pciConfigReadWord(bus,dev,function,0x2);
        device->command = pciConfigReadWord(bus,dev,function,0x4);
        device->status = pciConfigReadWord(bus,dev,function,0x6);
        temp=pciConfigReadWord(bus,dev,function,0x8);
        device->revision_id = temp & 0xFF;
        device->interface = temp>>8;
        temp=pciConfigReadWord(bus,dev,function,0xA);
        device->sub_class = temp & 0xFF;
        device->base_class = temp>>8;
        temp=pciConfigReadWord(bus,dev,function,0xC);
        device->cache_line_size = temp & 0xFF;
        device->latency_timer = temp>>8;
        temp=pciConfigReadWord(bus,dev,function,0xE);
        device->header_type = temp & 0xFF;
        device->bist = temp>>8;
        return true;
    }
    else
        return false;
}

/*******************************************************************************/
/* R<>cup<75>re les informations sur le periph<70>rique PCI donn<6E>e */

u16 pciConfigReadWord(const u8 bus, const u8 dev, const u8 function, const u8 offset)
{
    u16 tmp = 0;
    u32 addr = (0x80000000|(bus << 16)|(dev << 11)|(function << 8)|(offset & 0xFC));
    outd(0xCF8, addr);
    tmp = (u16)((ind(0xCFC) >> ((offset & 2) * 8)) & 0xffff);
    return tmp;
}

/*******************************************************************************/
/* Scan le bus PCI et affiche les p<>riph<70>riques */

void scanPCImini(void)
{
    u16 bus,device,function;
    pcidevmini result;    
    for (bus=0; bus<MAX_BUS_SCAN; ++bus)
      for (device=0; device<MAX_DEVICE_SCAN; ++device)
        for (function=0; function<MAX_FUNCTION_SCAN; ++function)
        {
          result = getPCImininfo(bus,device,function);
          if (result.vendor_id != 0xFFFF)
            printf("Bus:%hx Dev:%hx Func:%hx %hx:%hx\r\n",bus, device, function, result.vendor_id, result.device_id);
        }
    return;
}

/*******************************************************************************/

/* Scan le bus PCI et affiche les p<>riph<70>riques */

void scanPCI(void)
{
    u16 bus,device,function;
    pcidev result;    
    for (bus=0; bus<MAX_BUS_SCAN; ++bus)
      for (device=0; device<MAX_DEVICE_SCAN; ++device)
        for (function=0; function<MAX_FUNCTION_SCAN; ++function)
          if (getPCInfo(&result,bus,device,function))
            printf("Bus:%hx Dev:%hx Func:%hx %hx:%hx ->%s\r\n",bus, device, function, result.vendor_id, result.device_id,pcigetclassname(&result));
    return;
}

/*******************************************************************************/