source: mainline/uspace/srv/dd/isa.c@ 1787e527

#include <futex.h>
#include <assert.h>

#include "isa.h"

LIST_INITIALIZE(isa_bridges_list);
LIST_INITIALIZE(isa_drivers_list);

static atomic_t isa_bus_futex = FUTEX_INITIALIZER;

static void isa_probe_all(bridge_to_isa_t *bridge);
static void isa_drv_probe(isa_drv_t *drv);

int isa_bus_init()
{
        return 1;
}

void isa_register_bridge(bridge_to_isa_t *bridge)
{
        futex_down(&isa_bus_futex);
        
        printf("ISA: registering new sth-to-isa bridge.\n");
        
        // add bridge to the list 
        list_append(&(bridge->link), &isa_bridges_list);
        
        // call probe function of all registered  drivers of isa devices
        isa_probe_all(bridge);
        
        futex_up(&isa_bus_futex);
}

void isa_register_driver(isa_drv_t *drv)
{
        assert(drv->name != NULL);
        
        futex_down(&isa_bus_futex);
        
        printf("ISA: registering new driver '%s'.\n", drv->name);
        
        // add bridge to the list 
        list_append(&(drv->link), &isa_drivers_list);
        
        // call driver's probe function on all registered bridges
        isa_drv_probe(drv);
        
        futex_up(&isa_bus_futex);
}

static void isa_probe_all(bridge_to_isa_t *bridge)
{
        link_t *item = isa_drivers_list.next;
        isa_drv_t *drv = NULL; 
        
        while (item != &isa_drivers_list) {
                drv = list_get_instance(item, isa_drv_t, link);
                if (drv->ops != NULL && drv->ops->probe != NULL) {
                        drv->ops->probe(bridge);
                }
                item = item->next;
        }
}

static void isa_drv_probe(isa_drv_t *drv)
{
        link_t *item = isa_bridges_list.next;
        bridge_to_isa_t *bridge = NULL; 
        
        if (drv->ops != NULL && drv->ops->probe != NULL) {
                while (item != &isa_bridges_list) {
                        bridge = list_get_instance(item, bridge_to_isa_t, link);
                        {
                                drv->ops->probe(bridge);
                        }
                        item = item->next;
                }
        }       
}