Subversion Repositories Kolibri OS

#include 

#include 

#include 

#include 

#include 

#include "acpi_bus.h"

{

    struct list_head    list;

    ACPI_PCI_ID         id;

    u8                  pin;

    ACPI_HANDLE         link;

    u32                 index;      /* GSI, or link _CRS index */

};

static DEFINE_SPINLOCK(acpi_prt_lock);

{

    return 'A' + pin - 1;

}

                         PCI IRQ Routing Table (PRT) Support

   -------------------------------------------------------------------------- */

                              int pin)

{

    struct acpi_prt_entry *entry;

    int segment = pci_domain_nr(dev->bus);

    int bus = dev->bus->number;

    int device = PCI_SLOT(dev->devfn);

    list_for_each_entry(entry, &acpi_prt_list, list) {

        if ((segment == entry->id.Segment)

            && (bus == entry->id.Bus)

            && (device == entry->id.Device)

            && (pin == entry->pin)) {

            spin_unlock(&acpi_prt_lock);

            return entry;

        }

    }

    spin_unlock(&acpi_prt_lock);

    return NULL;

}

                  struct acpi_pci_routing_table *prt)

{

    struct acpi_prt_entry *entry;

    if (!entry)

        return -ENOMEM;

     * Note that the _PRT uses 0=INTA, 1=INTB, etc, while PCI uses

     * 1=INTA, 2=INTB.  We use the PCI encoding throughout, so convert

     * it here.

     */

    entry->id.Segment = pci_domain_nr(bus);

    entry->id.Bus = bus->number;

    entry->id.Device = (prt->Address >> 16) & 0xFFFF;

    entry->pin = prt->Pin + 1;

     * Type 1: Dynamic

     * ---------------

     * The 'source' field specifies the PCI interrupt link device used to

     * configure the IRQ assigned to this slot|dev|pin.  The 'source_index'

     * indicates which resource descriptor in the resource template (of

     * the link device) this interrupt is allocated from.

     *

     * NOTE: Don't query the Link Device for IRQ information at this time

     *       because Link Device enumeration may not have occurred yet

     *       (e.g. exists somewhere 'below' this _PRT entry in the ACPI

     *       namespace).

     */

    if (prt->Source[0])

        AcpiGetHandle(handle, prt->Source, &entry->link);

     * Type 2: Static

     * --------------

     * The 'source' field is NULL, and the 'source_index' field specifies

     * the IRQ value, which is hardwired to specific interrupt inputs on

     * the interrupt controller.

     */

                  entry->id.Segment, entry->id.Bus,

                  entry->id.Device, pin_name(entry->pin),

                  prt->Source, entry->index);

    list_add_tail(&entry->list, &acpi_prt_list);

    spin_unlock(&acpi_prt_lock);

}

{

    ACPI_STATUS status;

    struct acpi_buffer buffer = { ACPI_ALLOCATE_BUFFER, NULL };

    struct acpi_pci_routing_table *entry;

    status = AcpiGetName(handle, ACPI_FULL_PATHNAME, &buffer);

    if (ACPI_FAILURE(status))

        return -ENODEV;

           (char *) buffer.Pointer);

    buffer.Pointer = NULL;

    if (ACPI_FAILURE(status))

    {

        dbgprintf("AcpiGetIrqRoutingTable failed "

                  "evaluating _PRT [%s]\n",AcpiFormatException(status));

        kfree(buffer.Pointer);

        return -ENODEV;

    }

    while (entry && (entry->Length > 0)) {

        acpi_pci_irq_add_entry(handle, bus, entry);

        entry = (struct acpi_pci_routing_table *)

            ((unsigned long)entry + entry->Length);

    }

    return 0;

}

{

    struct acpi_prt_entry *entry;

    struct pci_dev *bridge;

    u8 bridge_pin, orig_pin = pin;

    if (entry) {

        ACPI_DEBUG_PRINT((ACPI_DB_INFO, "Found %s[%c] _PRT entry\n",

                  pci_name(dev), pin_name(pin)));

        return entry;

    }

     * Attempt to derive an IRQ for this device from a parent bridge's

     * PCI interrupt routing entry (eg. yenta bridge and add-in card bridge).

     */

    bridge = dev->bus->self;

    while (bridge)

    {

        pin = pci_swizzle_interrupt_pin(dev, pin);

            /* PC card has the same IRQ as its cardbridge */

            bridge_pin = bridge->pin;

            if (!bridge_pin) {

                ACPI_DEBUG_PRINT((ACPI_DB_INFO,

                          "No interrupt pin configured for device %s\n",

                          pci_name(bridge)));

                return NULL;

            }

            pin = bridge_pin;

        }

        if (entry) {

            ACPI_DEBUG_PRINT((ACPI_DB_INFO,

                     "Derived GSI for %s INT %c from %s\n",

                     pci_name(dev), pin_name(orig_pin),

                     pci_name(bridge)));

            return entry;

        }

        bridge = dev->bus->self;

    }

         pin_name(orig_pin));

    return NULL;

}

{

    struct acpi_prt_entry *entry;

    int gsi = -1;

    u8 pin;

    int polarity = ACPI_ACTIVE_LOW;

    char link_desc[16];

    int rc;

    {

        dbgprintf("No interrupt pin configured for device %s\n",

                  pci_name(dev));

        return 0;

    }

    if (!entry) {

        /*

         * IDE legacy mode controller IRQs are magic. Why do compat

         * extensions always make such a nasty mess.

         */

        if (dev->class >> 8 == PCI_CLASS_STORAGE_IDE &&

                (dev->class & 0x05) == 0)

            return 0;

    }

    {

        if (entry->link)

        {

            gsi = acpi_pci_link_allocate_irq(entry->link,

                             entry->index,

                             &triggering, &polarity,

                             &link);

//            dbgprintf("link not implemen\n");

        }

        else

            gsi = entry->index;

    } else

        gsi = -1;

     * No IRQ known to the ACPI subsystem - maybe the BIOS /

     * driver reported one, then use it. Exit in any case.

     */

    if (gsi < 0) {

        u32 dev_gsi;

        dev_warn(&dev->dev, "PCI INT %c: no GSI", pin_name(pin));

        /* Interrupt Line values above 0xF are forbidden */

        if (dev->irq > 0 && (dev->irq <= 0xF) &&

            (acpi_isa_irq_to_gsi(dev->irq, &dev_gsi) == 0)) {

            printk(" - using ISA IRQ %d\n", dev->irq);

            acpi_register_gsi(&dev->dev, dev_gsi,

                      ACPI_LEVEL_SENSITIVE,

                      ACPI_ACTIVE_LOW);

            return 0;

        } else {

            printk("\n");

            return 0;

        }

    }

    if (rc < 0) {

        dev_warn(&dev->dev, "PCI INT %c: failed to register GSI\n",

             pin_name(pin));

        return rc;

    }

    dev->irq = rc;

        snprintf(link_desc, sizeof(link_desc), " -> Link[%s]", link);

    else

        link_desc[0] = '\0';

         pin_name(pin), link_desc, gsi,

         (triggering == ACPI_LEVEL_SENSITIVE) ? "level" : "edge",

         (polarity == ACPI_ACTIVE_LOW) ? "low" : "high", dev->irq);

#endif

    return gsi;

}

 * If a link is initialized, we never change its active and initialized

 * later even the link is disable. Instead, we just repick the active irq

 */

struct acpi_pci_link_irq {

    u8 active;      /* Current IRQ */

    u8 triggering;      /* All IRQs */

    u8 polarity;        /* All IRQs */

    u8 resource_type;

    u8 possible_count;

    u8 possible[ACPI_PCI_LINK_MAX_POSSIBLE];

    u8 initialized:1;

    u8 reserved:7;

};

    struct list_head        list;

    struct acpi_device      *device;

    struct acpi_pci_link_irq    irq;

    int             refcnt;

};

static DEFINE_MUTEX(acpi_link_lock);

{

    int result;

    ACPI_STATUS status;

    struct {

        struct acpi_resource res;

        struct acpi_resource end;

    } *resource;

        return -EINVAL;

    if (!resource)

        return -ENOMEM;

    buffer.Pointer = resource;

    case ACPI_RESOURCE_TYPE_IRQ:

        resource->res.Type = ACPI_RESOURCE_TYPE_IRQ;

        resource->res.Length = sizeof(struct acpi_resource);

        resource->res.Data.Irq.Triggering = link->irq.triggering;

        resource->res.Data.Irq.Polarity =

            link->irq.polarity;

        if (link->irq.triggering == ACPI_EDGE_SENSITIVE)

            resource->res.Data.Irq.Sharable =

                ACPI_EXCLUSIVE;

        else

            resource->res.Data.Irq.Sharable = ACPI_SHARED;

        resource->res.Data.Irq.InterruptCount = 1;

        resource->res.Data.Irq.Interrupts[0] = irq;

        break;

        resource->res.Type = ACPI_RESOURCE_TYPE_EXTENDED_IRQ;

        resource->res.Length = sizeof(struct acpi_resource);

        resource->res.Data.ExtendedIrq.ProducerConsumer =

            ACPI_CONSUMER;

        resource->res.Data.ExtendedIrq.Triggering =

            link->irq.triggering;

        resource->res.Data.ExtendedIrq.Polarity =

            link->irq.polarity;

        if (link->irq.triggering == ACPI_EDGE_SENSITIVE)

            resource->res.Data.Irq.Sharable =

                ACPI_EXCLUSIVE;

        else

            resource->res.Data.Irq.Sharable = ACPI_SHARED;

        resource->res.Data.ExtendedIrq.InterruptCount = 1;

        resource->res.Data.ExtendedIrq.Interrupts[0] = irq;

        /* ignore resource_source, it's optional */

        break;

    default:

        printk(KERN_ERR PREFIX "Invalid Resource_type %d\n", link->irq.resource_type);

        result = -EINVAL;

        goto end;

    resource->end.Type = ACPI_RESOURCE_TYPE_END_TAG;

    /* Attempt to set the resource */

    status = acpi_set_current_resources(link->device->handle, &buffer);

    if (ACPI_FAILURE(status)) {

        dbgprintf("%s failure Evaluating _SRS", __FUNCTION__);

        result = -ENODEV;

        goto end;

    }

    result = acpi_bus_get_status(link->device);

    if (result) {

        printk(KERN_ERR PREFIX "Unable to read status\n");

        goto end;

    }

    if (!link->device->status.enabled) {

        printk(KERN_WARNING PREFIX

                  "%s [%s] disabled and referenced, BIOS bug\n",

                  acpi_device_name(link->device),

                  acpi_device_bid(link->device));

    }

    result = acpi_pci_link_get_current(link);

    if (result) {

        goto end;

    }

     * Is current setting not what we set?

     * set link->irq.active

     */

    if (link->irq.active != irq) {

        /*

         * policy: when _CRS doesn't return what we just _SRS

         * assume _SRS worked and override _CRS value.

         */

        printk(KERN_WARNING PREFIX

                  "%s [%s] BIOS reported IRQ %d, using IRQ %d\n",

                  acpi_device_name(link->device),

                  acpi_device_bid(link->device), link->irq.active, irq);

        link->irq.active = irq;

    }

#endif

    kfree(resource);

    return result;

}

#define ACPI_MAX_ISA_IRQ    16

#define PIRQ_PENALTY_PCI_POSSIBLE   (16*16)

#define PIRQ_PENALTY_PCI_USING      (16*16*16)

#define PIRQ_PENALTY_ISA_TYPICAL    (16*16*16*16)

#define PIRQ_PENALTY_ISA_USED       (16*16*16*16*16)

#define PIRQ_PENALTY_ISA_ALWAYS     (16*16*16*16*16*16)

    PIRQ_PENALTY_ISA_ALWAYS,    /* IRQ0 timer */

    PIRQ_PENALTY_ISA_ALWAYS,    /* IRQ1 keyboard */

    PIRQ_PENALTY_ISA_ALWAYS,    /* IRQ2 cascade */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ3 serial */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ4 serial */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ5 sometimes SoundBlaster */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ6 */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ7 parallel, spurious */

    PIRQ_PENALTY_ISA_TYPICAL,   /* IRQ8 rtc, sometimes */

    PIRQ_PENALTY_PCI_AVAILABLE, /* IRQ9  PCI, often acpi */

    PIRQ_PENALTY_PCI_AVAILABLE, /* IRQ10 PCI */

    PIRQ_PENALTY_PCI_AVAILABLE, /* IRQ11 PCI */

    PIRQ_PENALTY_ISA_USED,      /* IRQ12 mouse */

    PIRQ_PENALTY_ISA_USED,      /* IRQ13 fpe, sometimes */

    PIRQ_PENALTY_ISA_USED,      /* IRQ14 ide0 */

    PIRQ_PENALTY_ISA_USED,      /* IRQ15 ide1 */

    /* >IRQ15 */

};

{

    int irq;

    int i;

        if (link->refcnt == 0)

            /* This means the link is disabled but initialized */

            acpi_pci_link_set(link, link->irq.active);

        return 0;

    }

     * search for active IRQ in list of possible IRQs.

     */

    for (i = 0; i < link->irq.possible_count; ++i) {

        if (link->irq.active == link->irq.possible[i])

            break;

    }

    /*

     * forget active IRQ that is not in possible list

     */

    if (i == link->irq.possible_count) {

        dbgprintf(KERN_WARNING PREFIX "_CRS %d not found"

                      " in _PRS\n", link->irq.active);

        link->irq.active = 0;

    }

     * if active found, use it; else pick entry from end of possible list.

     */

    if (link->irq.active)

        irq = link->irq.active;

    else

        irq = link->irq.possible[link->irq.possible_count - 1];

        /*

         * Select the best IRQ.  This is done in reverse to promote

         * the use of IRQs 9, 10, 11, and >15.

         */

        for (i = (link->irq.possible_count - 1); i >= 0; i--) {

            if (acpi_irq_penalty[irq] >

                acpi_irq_penalty[link->irq.possible[i]])

                irq = link->irq.possible[i];

        }

    }

    if (acpi_pci_link_set(link, irq)) {

        printk(KERN_ERR PREFIX "Unable to set IRQ for %s [%s]. "

                "Try pci=noacpi or acpi=off\n",

                acpi_device_name(link->device),

                acpi_device_bid(link->device));

        return -ENODEV;

    } else {

        acpi_irq_penalty[link->irq.active] += PIRQ_PENALTY_PCI_USING;

        printk(KERN_WARNING PREFIX "%s [%s] enabled at IRQ %d\n",

               acpi_device_name(link->device),

               acpi_device_bid(link->device), link->irq.active);

    }

    return 0;

}

 * acpi_pci_link_allocate_irq

 * success: return IRQ >= 0

 * failure: return -1

 */

int acpi_pci_link_allocate_irq(ACPI_HANDLE handle, int index,

                               int *triggering, int *polarity, char **name)

{

    int result;

    struct acpi_device *device;

    struct acpi_pci_link *link;

    if (result) {

        printk(KERN_ERR PREFIX "Invalid link device\n");

        return -1;

    }

    if (!link) {

        printk(KERN_ERR PREFIX "Invalid link context\n");

        return -1;

    }

    if (index) {

        printk(KERN_ERR PREFIX "Invalid index %d\n", index);

        return -1;

    }

    if (acpi_pci_link_allocate(link)) {

        mutex_unlock(&acpi_link_lock);

        return -1;

    }

        mutex_unlock(&acpi_link_lock);

        printk(KERN_ERR PREFIX "Link active IRQ is 0!\n");

        return -1;

    }

    link->refcnt++;

    mutex_unlock(&acpi_link_lock);

        *triggering = link->irq.triggering;

    if (polarity)

        *polarity = link->irq.polarity;

    if (name)

        *name = acpi_device_bid(link->device);

    ACPI_DEBUG_PRINT((ACPI_DB_INFO,

              "Link %s is referenced\n",

              acpi_device_bid(link->device)));

    return (link->irq.active);

}