WebSVN – HelenOS – Diff – /branches/dd/uspace/srv/pci/pci.c



#include "pci.h"
#include "pci_bus.h"
#include "pci_regs.h"
#include "pci_conf.h"
 
#define NAME "PCI"
 
LIST_INITIALIZE(devices_list);
LIST_INITIALIZE(buses_list);
LIST_INITIALIZE(drivers_list);
 
static atomic_t pci_bus_futex = FUTEX_INITIALIZER;

            if (fnum == 0) {
                 multi = header_type >> 7;  // is the device multifunction?
            }
            header_type = header_type & 0x7F; // clear the multifunction bit
           
            printf(NAME ": adding new device %3d : %2d : %2d", dev->bus->num, dnum, fnum);
            printf(" - vendor = 0x%04X, device = 0x%04X.\n", dev->vendor_id, dev->device_id);
            pci_device_register(dev);          
           
            if (header_type == PCI_HEADER_TYPE_BRIDGE || header_type == PCI_HEADER_TYPE_CARDBUS ) {
                bus_num = pci_conf_read_8(dev, PCI_BRIDGE_SEC_BUS_NUM);
                printf(NAME ": device is pci-to-pci bridge, secondary bus number = %d.\n", bus_num);
                if(bus_num > bus->num) {                   
                    child_bus = pci_alloc_bus();
                    pci_init_bus(child_bus, bus, bus_num);
                    pci_bus_register(child_bus);
                    pci_bus_scan(child_bus);   

 * Usage: pci_bus_futex must be down.
 */
static int pci_pass_dev(pci_drv_t *drv, pci_dev_t *dev)
{
    assert(dev->driver == NULL);
    assert(drv->name != NULL);
   
    printf(NAME ": passing device to driver '%s'.\n", drv->name);
    if (drv->ops->add_device != NULL && drv->ops->add_device(dev)) {
        dev->driver = drv;
        return 1;
    }
   
    return 0;

    pci_drv_t *drv = NULL;
   
    while (item != &drivers_list) {
        drv = list_get_instance(item, pci_drv_t, link);
        if (pci_match(drv, dev) && pci_pass_dev(drv, dev)) {
            return;
        }
        item = item->next;
    }
}
 

static void pci_lookup_devices(pci_drv_t *drv)
{
    link_t *item = devices_list.next;
    pci_dev_t *dev = NULL;
   
    printf(NAME ": looking up devices for a newly added driver '%s'.\n", drv->name);
   
    while (item != &devices_list) {
        dev = list_get_instance(item, pci_dev_t, link);
        if (dev->driver == NULL && pci_match(drv, dev)) {
            pci_pass_dev(drv, dev);
        }

    }
}
 
static int pci_match(pci_drv_t *drv, pci_dev_t *dev)
{
    return drv->vendor_id == dev->vendor_id && drv->device_id == dev->device_id;
}
 
void pci_bus_register(pci_bus_t *bus)
{
    futex_down(&pci_bus_futex);

   
    futex_up(&pci_bus_futex);  
}
 
void pci_driver_register(pci_drv_t *drv)
{  
    assert(drv->name != NULL);
   
    futex_down(&pci_bus_futex);
    printf(NAME ": registering new driver '%s'.\n", drv->name);
    list_append(&(drv->link), &drivers_list);
   
    // try to find compatible devices
    pci_lookup_devices(drv);
   

Rev 4438	Rev 4667
Line 4...	Line 4...
4	#include "pci.h"	4	#include "pci.h"
5	#include "pci_bus.h"	5	#include "pci_bus.h"
6	#include "pci_regs.h"	6	#include "pci_regs.h"
7	#include "pci_conf.h"	7	#include "pci_conf.h"
8		8
-		9	#define NAME "PCI"
-		10
9	LIST_INITIALIZE(devices_list);	11	LIST_INITIALIZE(devices_list);
10	LIST_INITIALIZE(buses_list);	12	LIST_INITIALIZE(buses_list);
11	LIST_INITIALIZE(drivers_list);	13	LIST_INITIALIZE(drivers_list);
12		14
13	static atomic_t pci_bus_futex = FUTEX_INITIALIZER;	15	static atomic_t pci_bus_futex = FUTEX_INITIALIZER;
Line 43...	Line 45...
43	if (fnum == 0) {	45	if (fnum == 0) {
44	multi = header_type >> 7; // is the device multifunction?	46	multi = header_type >> 7; // is the device multifunction?
45	}	47	}
46	header_type = header_type & 0x7F; // clear the multifunction bit	48	header_type = header_type & 0x7F; // clear the multifunction bit
47		49
48	printf("PCI: adding new device %d : %d : %d", dev->bus->num, dnum, fnum);	50	printf(NAME ": adding new device %3d : %2d : %2d", dev->bus->num, dnum, fnum);
49	printf(" - vendor = 0x%04X, device = 0x%04X.\n", dev->vendor_id, dev->device_id);	51	printf(" - vendor = 0x%04X, device = 0x%04X.\n", dev->vendor_id, dev->device_id);
50	pci_device_register(dev);	52	pci_device_register(dev);
51		53
52	if (header_type == PCI_HEADER_TYPE_BRIDGE \|\| header_type == PCI_HEADER_TYPE_CARDBUS ) {	54	if (header_type == PCI_HEADER_TYPE_BRIDGE \|\| header_type == PCI_HEADER_TYPE_CARDBUS ) {
53	bus_num = pci_conf_read_8(dev, PCI_BRIDGE_SEC_BUS_NUM);	55	bus_num = pci_conf_read_8(dev, PCI_BRIDGE_SEC_BUS_NUM);
54	printf("PCI: device is pci-to-pci bridge, secondary bus number = %d.\n", bus_num);	56	printf(NAME ": device is pci-to-pci bridge, secondary bus number = %d.\n", bus_num);
55	if(bus_num > bus->num) {	57	if(bus_num > bus->num) {
56	child_bus = pci_alloc_bus();	58	child_bus = pci_alloc_bus();
57	pci_init_bus(child_bus, bus, bus_num);	59	pci_init_bus(child_bus, bus, bus_num);
58	pci_bus_register(child_bus);	60	pci_bus_register(child_bus);
59	pci_bus_scan(child_bus);	61	pci_bus_scan(child_bus);
Line 73...	Line 75...
73	* Usage: pci_bus_futex must be down.	75	* Usage: pci_bus_futex must be down.
74	*/	76	*/
75	static int pci_pass_dev(pci_drv_t drv, pci_dev_t dev)	77	static int pci_pass_dev(pci_drv_t drv, pci_dev_t dev)
76	{	78	{
77	assert(dev->driver == NULL);	79	assert(dev->driver == NULL);
-		80	assert(drv->name != NULL);
78		81
-		82	printf(NAME ": passing device to driver '%s'.\n", drv->name);
79	if (drv->ops->add_device(dev)) {	83	if (drv->ops->add_device != NULL && drv->ops->add_device(dev)) {
80	dev->driver = drv;	84	dev->driver = drv;
81	return 1;	85	return 1;
82	}	86	}
83		87
84	return 0;	88	return 0;
Line 93...	Line 97...
93	pci_drv_t *drv = NULL;	97	pci_drv_t *drv = NULL;
94		98
95	while (item != &drivers_list) {	99	while (item != &drivers_list) {
96	drv = list_get_instance(item, pci_drv_t, link);	100	drv = list_get_instance(item, pci_drv_t, link);
97	if (pci_match(drv, dev) && pci_pass_dev(drv, dev)) {	101	if (pci_match(drv, dev) && pci_pass_dev(drv, dev)) {
98	break;	102	return;
99	}	103	}
100	item = item->next;	104	item = item->next;
101	}	105	}
102	}	106	}
103		107
Line 107...	Line 111...
107	static void pci_lookup_devices(pci_drv_t *drv)	111	static void pci_lookup_devices(pci_drv_t *drv)
108	{	112	{
109	link_t *item = devices_list.next;	113	link_t *item = devices_list.next;
110	pci_dev_t *dev = NULL;	114	pci_dev_t *dev = NULL;
111		115
-		116	printf(NAME ": looking up devices for a newly added driver '%s'.\n", drv->name);
-		117
112	while (item != &devices_list) {	118	while (item != &devices_list) {
113	dev = list_get_instance(item, pci_dev_t, link);	119	dev = list_get_instance(item, pci_dev_t, link);
114	if (dev->driver == NULL && pci_match(drv, dev)) {	120	if (dev->driver == NULL && pci_match(drv, dev)) {
115	pci_pass_dev(drv, dev);	121	pci_pass_dev(drv, dev);
116	}	122	}
Line 118...	Line 124...
118	}	124	}
119	}	125	}
120		126
121	static int pci_match(pci_drv_t drv, pci_dev_t dev)	127	static int pci_match(pci_drv_t drv, pci_dev_t dev)
122	{	128	{
123	return drv->vendor_id == dev->vendor_id && drv->device_id == dev->vendor_id;	129	return drv->vendor_id == dev->vendor_id && drv->device_id == dev->device_id;
124	}	130	}
125		131
126	void pci_bus_register(pci_bus_t *bus)	132	void pci_bus_register(pci_bus_t *bus)
127	{	133	{
128	futex_down(&pci_bus_futex);	134	futex_down(&pci_bus_futex);
Line 145...	Line 151...
145		151
146	futex_up(&pci_bus_futex);	152	futex_up(&pci_bus_futex);
147	}	153	}
148		154
149	void pci_driver_register(pci_drv_t *drv)	155	void pci_driver_register(pci_drv_t *drv)
150	{	156	{
-		157	assert(drv->name != NULL);
-		158
151	futex_down(&pci_bus_futex);	159	futex_down(&pci_bus_futex);
-		160	printf(NAME ": registering new driver '%s'.\n", drv->name);
152	list_append(&(drv->link), &drivers_list);	161	list_append(&(drv->link), &drivers_list);
153		162
154	// try to find compatible devices	163	// try to find compatible devices
155	pci_lookup_devices(drv);	164	pci_lookup_devices(drv);
156		165

Subversion Repositories HelenOS

(root)/branches/dd/uspace/srv/pci/pci.c – Rev 4438 → 4667