Subversion Repositories Kolibri OS

#include 

#include 

#define IORESOURCE_PCI_FIXED            (1<<4)  /* Do not move resource */

 * Translate the low bits of the PCI base

 * to the resource type

 */

static inline unsigned int pci_calc_resource_flags(unsigned int flags)

{

    if (flags & PCI_BASE_ADDRESS_SPACE_IO)

        return IORESOURCE_IO;

        return IORESOURCE_MEM | IORESOURCE_PREFETCH;

}

{

    u32_t size = mask & maxbase;      /* Find the significant bits */

        return 0;

       from that the extent.  */

    size = (size & ~(size-1)) - 1;

       already been programmed with all 1s.  */

    if (base == maxbase && ((base | size) & mask) != mask)

        return 0;

}

{

    u64_t size = mask & maxbase;      /* Find the significant bits */

        return 0;

       from that the extent.  */

    size = (size & ~(size-1)) - 1;

       already been programmed with all 1s.  */

    if (base == maxbase && ((base | size) & mask) != mask)

        return 0;

}

{

    if ((mask & (PCI_BASE_ADDRESS_SPACE|PCI_BASE_ADDRESS_MEM_TYPE_MASK)) ==

        (PCI_BASE_ADDRESS_SPACE_MEMORY|PCI_BASE_ADDRESS_MEM_TYPE_64))

        return 1;

    return 0;

}

{

    u32_t  pos, reg, next;

    u32_t  l, sz;

    struct resource *res;

    {

        u64_t  l64;

        u64_t  sz64;

        u32_t  raw_sz;

        l = PciRead32(dev->bus, dev->devfn, reg);

        PciWrite32(dev->bus, dev->devfn, reg, ~0);

        sz = PciRead32(dev->bus, dev->devfn, reg);

        PciWrite32(dev->bus, dev->devfn, reg, l);

            continue;

            l = 0;

        if ((l & PCI_BASE_ADDRESS_SPACE) ==

                        PCI_BASE_ADDRESS_SPACE_MEMORY)

        {

            sz = pci_size(l, sz, (u32_t)PCI_BASE_ADDRESS_MEM_MASK);

            /*

             * For 64bit prefetchable memory sz could be 0, if the

             * real size is bigger than 4G, so we need to check

             * szhi for that.

             */

            if (!is_64bit_memory(l) && !sz)

                    continue;

            res->start = l & PCI_BASE_ADDRESS_MEM_MASK;

            res->flags |= l & ~PCI_BASE_ADDRESS_MEM_MASK;

        }

        else {

            sz = pci_size(l, sz, PCI_BASE_ADDRESS_IO_MASK & 0xffff);

            if (!sz)

                continue;

            res->start = l & PCI_BASE_ADDRESS_IO_MASK;

            res->flags |= l & ~PCI_BASE_ADDRESS_IO_MASK;

        }

        res->end = res->start + (unsigned long) sz;

        res->flags |= pci_calc_resource_flags(l);

        if (is_64bit_memory(l))

        {

            u32_t szhi, lhi;

            PciWrite32(dev->bus, dev->devfn, reg+4, ~0);

            szhi = PciRead32(dev->bus, dev->devfn, reg+4);

            PciWrite32(dev->bus, dev->devfn, reg+4, lhi);

            sz64 = ((u64_t)szhi << 32) | raw_sz;

            l64 = ((u64_t)lhi << 32) | l;

            sz64 = pci_size64(l64, sz64, PCI_BASE_ADDRESS_MEM_MASK);

            next++;

            if (!sz64) {

                res->start = 0;

                res->end = 0;

                res->flags = 0;

                continue;

            }

            res->start = l64 & PCI_BASE_ADDRESS_MEM_MASK;

            res->end = res->start + sz64;

#else

            if (sz64 > 0x100000000ULL) {

                printk(KERN_ERR "PCI: Unable to handle 64-bit "

                                "BAR for device %s\n", pci_name(dev));

                res->start = 0;

                res->flags = 0;

            }

            else if (lhi)

            {

                /* 64-bit wide address, treat as disabled */

                PciWrite32(dev->bus, dev->devfn, reg,

                        l & ~(u32_t)PCI_BASE_ADDRESS_MEM_MASK);

                PciWrite32(dev->bus, dev->devfn, reg+4, 0);

                res->start = 0;

                res->end = sz;

            }

#endif

        }

    }

    {

        dev->rom_base_reg = rom;

        res = &dev->resource[PCI_ROM_RESOURCE];

        PciWrite32(dev->bus, dev->devfn, rom, ~PCI_ROM_ADDRESS_ENABLE);

        sz = PciRead32(dev->bus, dev->devfn, rom);

        PciWrite32(dev->bus, dev->devfn, rom, l);

            l = 0;

        {

            sz = pci_size(l, sz, (u32_t)PCI_ROM_ADDRESS_MASK);

            {

                res->flags = (l & IORESOURCE_ROM_ENABLE) |

                                  IORESOURCE_MEM | IORESOURCE_PREFETCH |

                                  IORESOURCE_READONLY | IORESOURCE_CACHEABLE;

                res->start = l & PCI_ROM_ADDRESS_MASK;

                res->end = res->start + (unsigned long) sz;

            }

        }

    }

}

{

    u8_t irq;

    dev->pin = irq;

    if (irq)

        PciRead8(dev->bus, dev->devfn, PCI_INTERRUPT_LINE);

    dev->irq = irq;

};

{

    u32_t  class;

    dev->revision = class & 0xff;

    class >>= 8;                                /* upper 3 bytes */

    dev->class = class;

//    dev->current_state = PCI_UNKNOWN;

 //   pci_fixup_device(pci_fixup_early, dev);

    class = dev->class >> 8;

    {

        case PCI_HEADER_TYPE_NORMAL:                /* standard header */

            if (class == PCI_CLASS_BRIDGE_PCI)

                goto bad;

            pci_read_irq(dev);

            pci_read_bases(dev, 6, PCI_ROM_ADDRESS);

            dev->subsystem_vendor = PciRead16(dev->bus, dev->devfn,PCI_SUBSYSTEM_VENDOR_ID);

            dev->subsystem_device = PciRead16(dev->bus, dev->devfn, PCI_SUBSYSTEM_ID);

             *      Do the ugly legacy mode stuff here rather than broken chip

             *      quirk code. Legacy mode ATA controllers have fixed

             *      addresses. These are not always echoed in BAR0-3, and

             *      BAR0-3 in a few cases contain junk!

             */

            if (class == PCI_CLASS_STORAGE_IDE)

            {

                u8_t progif;

                if ((progif & 1) == 0)

                {

                    dev->resource[0].start = 0x1F0;

                    dev->resource[0].end = 0x1F7;

                    dev->resource[0].flags = LEGACY_IO_RESOURCE;

                    dev->resource[1].start = 0x3F6;

                    dev->resource[1].end = 0x3F6;

                    dev->resource[1].flags = LEGACY_IO_RESOURCE;

                }

                if ((progif & 4) == 0)

                {

                    dev->resource[2].start = 0x170;

                    dev->resource[2].end = 0x177;

                    dev->resource[2].flags = LEGACY_IO_RESOURCE;

                    dev->resource[3].start = 0x376;

                    dev->resource[3].end = 0x376;

                    dev->resource[3].flags = LEGACY_IO_RESOURCE;

                };

            }

            break;

                if (class != PCI_CLASS_BRIDGE_PCI)

                        goto bad;

                /* The PCI-to-PCI bridge spec requires that subtractive

                   decoding (i.e. transparent) bridge must have programming

                   interface code of 0x01. */

                pci_read_irq(dev);

                dev->transparent = ((dev->class & 0xff) == 1);

                pci_read_bases(dev, 2, PCI_ROM_ADDRESS1);

                break;

                if (class != PCI_CLASS_BRIDGE_CARDBUS)

                        goto bad;

                pci_read_irq(dev);

                pci_read_bases(dev, 1, 0);

                dev->subsystem_vendor = PciRead16(dev->bus,

                                                  dev->devfn,

                                                  PCI_CB_SUBSYSTEM_VENDOR_ID);

                                                  dev->devfn,

                                                  PCI_CB_SUBSYSTEM_ID);

                break;

                printk(KERN_ERR "PCI: device %s has unknown header type %02x, ignoring.\n",

                        pci_name(dev), dev->hdr_type);

                return -1;

                printk(KERN_ERR "PCI: %s: class %x doesn't match header type %02x. Ignoring class.\n",

                       pci_name(dev), class, dev->hdr_type);

                dev->class = PCI_CLASS_NOT_DEFINED;

    }

};

{

    dev_t  *dev;

    u8_t    hdr;

    if (id == 0xffffffff || id == 0x00000000 ||

        id == 0x0000ffff || id == 0xffff0000)

        return NULL;

    {

        timeout *= 2;

        if (timeout > 60 * 100)

        {

            printk(KERN_WARNING "Device %04x:%02x:%02x.%d not "

                   "responding\n", bus,PCI_SLOT(devfn),PCI_FUNC(devfn));

            return NULL;

        }

    };

        return NULL;

    dev->pci_dev.devfn    = devfn;

    dev->pci_dev.hdr_type = hdr & 0x7f;

    dev->pci_dev.multifunction    = !!(hdr & 0x80);

    dev->pci_dev.vendor   = id & 0xffff;

    dev->pci_dev.device   = (id >> 16) & 0xffff;

{

    int  func, nr = 0;

    {

        dev_t  *dev;

        if( dev )

        {

            list_append(&dev->link, &devices);

             * If this is a single function device,

             * don't scan past the first function.

             */

            if (!dev->pci_dev.multifunction)

            {

                if (func > 0) {

                    dev->pci_dev.multifunction = 1;

                }

                else {

                    break;

                }

             }

        }

        else {

            if (func == 0)

                break;

        }

    };

};

{

    u32_t devfn;

    dev_t *dev;

        pci_scan_slot(bus, devfn);

{

    dev_t  *dev;

    u32_t   last_bus;

    u32_t   bus = 0 , devfn = 0;

        return -1;

        pci_scan_bus(bus);

//        &dev->link != &devices;

//        dev = (dev_t*)dev->link.next)

//    {

//        dbgprintf("PCI device %x:%x bus:%x devfn:%x\n",

//                dev->pci_dev.vendor,

//                dev->pci_dev.device,

//                dev->pci_dev.bus,

//                dev->pci_dev.devfn);

//

//    }

    return 0;

}

/**

 * pci_set_power_state - Set the power state of a PCI device

 * @dev: PCI device to be suspended

 * @state: PCI power state (D0, D1, D2, D3hot, D3cold) we're entering

 *

 * Transition a device to a new power state, using the Power Management

 * Capabilities in the device's config space.

 *

 * RETURN VALUE:

 * -EINVAL if trying to enter a lower state than we're already in.

 * 0 if we're already in the requested state.

 * -EIO if device does not support PCI PM.

 * 0 if we can successfully change the power state.

 */

int

pci_set_power_state(struct pci_dev *dev, pci_power_t state)

{

        int pm, need_restore = 0;

        u16 pmcsr, pmc;

        if (state > PCI_D3hot)

                state = PCI_D3hot;

         * If the device or the parent bridge can't support PCI PM, ignore

         * the request if we're doing anything besides putting it into D0

         * (which would only happen on boot).

         */

        if ((state == PCI_D1 || state == PCI_D2) && pci_no_d1d2(dev))

                return 0;

        pm = pci_find_capability(dev, PCI_CAP_ID_PM);

        if (!pm)

                return -EIO;

         * Can enter D0 from any state, but if we can only go deeper

         * to sleep if we're already in a low power state

         */

        if (state != PCI_D0 && dev->current_state > state) {

                printk(KERN_ERR "%s(): %s: state=%d, current state=%d\n",

                        __FUNCTION__, pci_name(dev), state, dev->current_state);

                return -EINVAL;

        } else if (dev->current_state == state)

                return 0;        /* we're already there */

        if ((pmc & PCI_PM_CAP_VER_MASK) > 3) {

                printk(KERN_DEBUG

                       "PCI: %s has unsupported PM cap regs version (%u)\n",

                       pci_name(dev), pmc & PCI_PM_CAP_VER_MASK);

                return -EIO;

        }

        if (state == PCI_D1 && !(pmc & PCI_PM_CAP_D1))

                return -EIO;

        else if (state == PCI_D2 && !(pmc & PCI_PM_CAP_D2))

                return -EIO;

         * This doesn't affect PME_Status, disables PME_En, and

         * sets PowerState to 0.

         */

        switch (dev->current_state) {

        case PCI_D0:

        case PCI_D1:

        case PCI_D2:

                pmcsr &= ~PCI_PM_CTRL_STATE_MASK;

                pmcsr |= state;

                break;

        case PCI_UNKNOWN: /* Boot-up */

                if ((pmcsr & PCI_PM_CTRL_STATE_MASK) == PCI_D3hot

                 && !(pmcsr & PCI_PM_CTRL_NO_SOFT_RESET))

                        need_restore = 1;

                /* Fall-through: force to D0 */

        default:

                pmcsr = 0;

                break;

        }

        pci_write_config_word(dev, pm + PCI_PM_CTRL, pmcsr);

        /* see PCI PM 1.1 5.6.1 table 18 */

        if (state == PCI_D3hot || dev->current_state == PCI_D3hot)

                msleep(pci_pm_d3_delay);

        else if (state == PCI_D2 || dev->current_state == PCI_D2)

                udelay(200);

         * Give firmware a chance to be called, such as ACPI _PRx, _PSx

         * Firmware method after native method ?

         */

        if (platform_pci_set_power_state)

                platform_pci_set_power_state(dev, state);

         * INTERFACE SPECIFICATION, REV. 1.2", a device transitioning

         * from D3hot to D0 _may_ perform an internal reset, thereby

         * going to "D0 Uninitialized" rather than "D0 Initialized".

         * For example, at least some versions of the 3c905B and the

         * 3c556B exhibit this behaviour.

         *

         * At least some laptop BIOSen (e.g. the Thinkpad T21) leave

         * devices in a D3hot state at boot.  Consequently, we need to

         * restore at least the BARs so that the device will be

         * accessible to its driver.

         */

        if (need_restore)

                pci_restore_bars(dev);

}

#endif

{

    u16_t cmd, old_cmd;

    int  idx;

    struct resource *r;

    old_cmd = cmd;

    for (idx = 0; idx < PCI_NUM_RESOURCES; idx++)

    {

        /* Only set up the requested stuff */

        if (!(mask & (1 << idx)))

                continue;

        if (!(r->flags & (IORESOURCE_IO | IORESOURCE_MEM)))

                continue;

        if ((idx == PCI_ROM_RESOURCE) &&

                        (!(r->flags & IORESOURCE_ROM_ENABLE)))

                continue;

        if (!r->start && r->end) {

                printk(KERN_ERR "PCI: Device %s not available "

                        "because of resource %d collisions\n",

                        pci_name(dev), idx);

                return -EINVAL;

        }

        if (r->flags & IORESOURCE_IO)

                cmd |= PCI_COMMAND_IO;

        if (r->flags & IORESOURCE_MEM)

                cmd |= PCI_COMMAND_MEMORY;

    }

    if (cmd != old_cmd) {

        printk("PCI: Enabling device %s (%04x -> %04x)\n",

                pci_name(dev), old_cmd, cmd);

        PciWrite16(dev->bus, dev->devfn, PCI_COMMAND, cmd);

    }

    return 0;

}

{

        int err;

                return err;

//                return pcibios_enable_irq(dev);

        return 0;

}

{

        int err;

//        if (err < 0 && err != -EIO)

//                return err;

        err = pcibios_enable_device(dev, bars);

//        if (err < 0)

//                return err;

//        pci_fixup_device(pci_fixup_enable, dev);

}

                                     resource_size_t flags)

{

        int err;

        int i, bars = 0;

//                return 0;               /* already enabled */

                if (dev->resource[i].flags & flags)

                        bars |= (1 << i);

//        if (err < 0)

//                atomic_dec(&dev->enable_cnt);

        return err;

}

 * pci_enable_device - Initialize device before it's used by a driver.

 * @dev: PCI device to be initialized

 *

 *  Initialize device before it's used by a driver. Ask low-level code

 *  to enable I/O and memory. Wake up the device if it was suspended.

 *  Beware, this function can fail.

 *

 *  Note we don't actually enable the device many times if we call

 *  this function repeatedly (we just increment the count).

 */

int pci_enable_device(struct pci_dev *dev)

{

        return __pci_enable_device_flags(dev, IORESOURCE_MEM | IORESOURCE_IO);

}

{

    dev_t *dev;

    struct pci_device_id *ent;

        &dev->link != &devices;

        dev = (dev_t*)dev->link.next)

    {

        if( dev->pci_dev.vendor != idlist->vendor )

            continue;

        {

            if(unlikely(ent->device == dev->pci_dev.device))

            {

                pdev->pci_dev = dev->pci_dev;

                return  ent;

            }

        };

    }

};

 * pci_map_rom - map a PCI ROM to kernel space

 * @pdev: pointer to pci device struct

 * @size: pointer to receive size of pci window over ROM

 * @return: kernel virtual pointer to image of ROM

 *

 * Map a PCI ROM into kernel space. If ROM is boot video ROM,

 * the shadow BIOS copy will be returned instead of the

 * actual ROM.

 */

#define OS_BASE   0x80000000

{

    struct resource *res = &pdev->resource[PCI_ROM_RESOURCE];

    u32_t start;

    void  *rom;

    /*

     * IORESOURCE_ROM_SHADOW set on x86, x86_64 and IA64 supports legacy

     * memory map if the VGA enable bit of the Bridge Control register is

     * set for embedded VGA.

     */

    if (res->flags & IORESOURCE_ROM_SHADOW) {

        /* primary video rom always starts here */

        start = (u32_t)0xC0000;

        *size = 0x20000; /* cover C000:0 through E000:0 */

    } else {

        if (res->flags & (IORESOURCE_ROM_COPY | IORESOURCE_ROM_BIOS_COPY)) {

            *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);

             return (void *)(unsigned long)

                     pci_resource_start(pdev, PCI_ROM_RESOURCE);

        } else {

                /* assign the ROM an address if it doesn't have one */

            //if (res->parent == NULL &&

            //     pci_assign_resource(pdev,PCI_ROM_RESOURCE))

            //         return NULL;

             start = pci_resource_start(pdev, PCI_ROM_RESOURCE);

             *size = pci_resource_len(pdev, PCI_ROM_RESOURCE);

             if (*size == 0)

                     return NULL;

             if (pci_enable_rom(pdev))

                     return NULL;

        }

    }

    if (!rom) {

            /* restore enable if ioremap fails */

            if (!(res->flags & (IORESOURCE_ROM_ENABLE |

                                IORESOURCE_ROM_SHADOW |

                                IORESOURCE_ROM_COPY)))

                    pci_disable_rom(pdev);

            return NULL;

    }

     * Try to find the true size of the ROM since sometimes the PCI window

     * size is much larger than the actual size of the ROM.

     * True size is important if the ROM is going to be copied.

     */

    *size = pci_get_rom_size(rom, *size);

    rom = NULL;

    memcpy(tmp,(char*)(OS_BASE+legacyBIOSLocation), 32);

    *size = tmp[2] * 512;

    if (*size > 0x10000 )

    {

        *size = 0;

        dbgprintf("Invalid BIOS length field\n");

    }

    else

        rom = (void*)( OS_BASE+legacyBIOSLocation);

}

pci_set_dma_mask(struct pci_dev *dev, u64 mask)

{

//        if (!pci_dma_supported(dev, mask))

//                return -EIO;

}