1 files changed, 501 insertions, 0 deletions

diff --git a/drivers/pci/hotplug/pciehprm_nonacpi.c b/drivers/pci/hotplug/pciehprm_nonacpi.c
new file mode 100644
index 000000000000..79a0aa6238ef
--- /dev/null
+++ b/drivers/pci/hotplug/pciehprm_nonacpi.c
@@ -0,0 +1,501 @@
+/*
+ * PCIEHPRM NONACPI: PHP Resource Manager for Non-ACPI/Legacy platform
+ *
+ * Copyright (C) 1995,2001 Compaq Computer Corporation
+ * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
+ * Copyright (C) 2001 IBM Corp.
+ * Copyright (C) 2003-2004 Intel Corporation
+ *
+ * All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or (at
+ * your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
+ * NON INFRINGEMENT.  See the GNU General Public License for more
+ * details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+ *
+ * Send feedback to <greg@kroah.com>, <dely.l.sy@intel.com>
+ *
+ */
+
+#include <linux/config.h>
+#include <linux/module.h>
+#include <linux/kernel.h>
+#include <linux/types.h>
+#include <linux/pci.h>
+#include <linux/init.h>
+#include <asm/uaccess.h>
+#ifdef CONFIG_IA64
+#include <asm/iosapic.h>
+#endif
+#include "pciehp.h"
+#include "pciehprm.h"
+#include "pciehprm_nonacpi.h"
+
+
+void pciehprm_cleanup(void)
+{
+        return;
+}
+
+int pciehprm_print_pirt(void)
+{
+        return 0;
+}
+
+int pciehprm_get_physical_slot_number(struct controller *ctrl, u32 *sun, u8 busnum, u8 devnum)
+{
+
+        *sun = (u8) (ctrl->first_slot);
+        return 0;
+}
+
+
+static void print_pci_resource ( struct pci_resource    *aprh)
+{
+        struct pci_resource     *res;
+
+        for (res = aprh; res; res = res->next)
+                dbg("        base= 0x%x length= 0x%x\n", res->base, res->length);
+}
+
+
+static void phprm_dump_func_res( struct pci_func *fun)
+{
+        struct pci_func *func = fun;
+
+        if (func->bus_head) {
+                dbg(":    BUS Resources:\n");
+                print_pci_resource (func->bus_head);
+        }
+        if (func->io_head) {
+                dbg(":    IO Resources:\n");
+                print_pci_resource (func->io_head);
+        }
+        if (func->mem_head) {
+                dbg(":    MEM Resources:\n");
+                print_pci_resource (func->mem_head);
+        }
+        if (func->p_mem_head) {
+                dbg(":    PMEM Resources:\n");
+                print_pci_resource (func->p_mem_head);
+        }
+}
+
+static int phprm_get_used_resources (
+        struct controller *ctrl,
+        struct pci_func *func
+        )
+{
+        return pciehp_save_used_resources (ctrl, func, !DISABLE_CARD);
+}
+
+static int phprm_delete_resource(
+        struct pci_resource **aprh,
+        ulong base,
+        ulong size)
+{
+        struct pci_resource *res;
+        struct pci_resource *prevnode;
+        struct pci_resource *split_node;
+        ulong tbase;
+
+        pciehp_resource_sort_and_combine(aprh);
+
+        for (res = *aprh; res; res = res->next) {
+                if (res->base > base)
+                        continue;
+
+                if ((res->base + res->length) < (base + size))
+                        continue;
+
+                if (res->base < base) {
+                        tbase = base;
+
+                        if ((res->length - (tbase - res->base)) < size)
+                                continue;
+
+                        split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
+                        if (!split_node)
+                                return -ENOMEM;
+
+                        split_node->base = res->base;
+                        split_node->length = tbase - res->base;
+                        res->base = tbase;
+                        res->length -= split_node->length;
+
+                        split_node->next = res->next;
+                        res->next = split_node;
+                }
+
+                if (res->length >= size) {
+                        split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
+                        if (!split_node)
+                                return -ENOMEM;
+
+                        split_node->base = res->base + size;
+                        split_node->length = res->length - size;
+                        res->length = size;
+
+                        split_node->next = res->next;
+                        res->next = split_node;
+                }
+
+                if (*aprh == res) {
+                        *aprh = res->next;
+                } else {
+                        prevnode = *aprh;
+                        while (prevnode->next != res)
+                                prevnode = prevnode->next;
+
+                        prevnode->next = res->next;
+                }
+                res->next = NULL;
+                kfree(res);
+                break;
+        }
+
+        return 0;
+}
+
+
+static int phprm_delete_resources(
+        struct pci_resource **aprh,
+        struct pci_resource *this
+        )
+{
+        struct pci_resource *res;
+
+        for (res = this; res; res = res->next)
+                phprm_delete_resource(aprh, res->base, res->length);
+
+        return 0;
+}
+
+
+static int configure_existing_function(
+        struct controller *ctrl,
+        struct pci_func *func
+        )
+{
+        int rc;
+
+        /* see how much resources the func has used. */
+        rc = phprm_get_used_resources (ctrl, func);
+
+        if (!rc) {
+                /* subtract the resources used by the func from ctrl resources */
+                rc  = phprm_delete_resources (&ctrl->bus_head, func->bus_head);
+                rc |= phprm_delete_resources (&ctrl->io_head, func->io_head);
+                rc |= phprm_delete_resources (&ctrl->mem_head, func->mem_head);
+                rc |= phprm_delete_resources (&ctrl->p_mem_head, func->p_mem_head);
+                if (rc)
+                        warn("aCEF: cannot del used resources\n");
+        } else
+                err("aCEF: cannot get used resources\n");
+
+        return rc;
+}
+
+static int pciehprm_delete_resource(
+        struct pci_resource **aprh,
+        ulong base,
+        ulong size)
+{
+        struct pci_resource *res;
+        struct pci_resource *prevnode;
+        struct pci_resource *split_node;
+        ulong tbase;
+
+        pciehp_resource_sort_and_combine(aprh);
+
+        for (res = *aprh; res; res = res->next) {
+                if (res->base > base)
+                        continue;
+
+                if ((res->base + res->length) < (base + size))
+                        continue;
+
+                if (res->base < base) {
+                        tbase = base;
+
+                        if ((res->length - (tbase - res->base)) < size)
+                                continue;
+
+                        split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
+                        if (!split_node)
+                                return -ENOMEM;
+
+                        split_node->base = res->base;
+                        split_node->length = tbase - res->base;
+                        res->base = tbase;
+                        res->length -= split_node->length;
+
+                        split_node->next = res->next;
+                        res->next = split_node;
+                }
+
+                if (res->length >= size) {
+                        split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
+                        if (!split_node)
+                                return -ENOMEM;
+
+                        split_node->base = res->base + size;
+                        split_node->length = res->length - size;
+                        res->length = size;
+
+                        split_node->next = res->next;
+                        res->next = split_node;
+                }
+
+                if (*aprh == res) {
+                        *aprh = res->next;
+                } else {
+                        prevnode = *aprh;
+                        while (prevnode->next != res)
+                                prevnode = prevnode->next;
+
+                        prevnode->next = res->next;
+                }
+                res->next = NULL;
+                kfree(res);
+                break;
+        }
+
+        return 0;
+}
+
+static int bind_pci_resources_to_slots ( struct controller *ctrl)
+{
+        struct pci_func *func, new_func;
+        int busn = ctrl->slot_bus;
+        int devn, funn;
+        u32     vid;
+
+        for (devn = 0; devn < 32; devn++) {
+                for (funn = 0; funn < 8; funn++) {
+                        /*
+                        if (devn == ctrl->device && funn == ctrl->function)
+                                continue;
+                        */
+                        /* find out if this entry is for an occupied slot */
+                        vid = 0xFFFFFFFF;
+
+                        pci_bus_read_config_dword(ctrl->pci_dev->subordinate, PCI_DEVFN(devn, funn), PCI_VENDOR_ID, &vid);
+
+                        if (vid != 0xFFFFFFFF) {
+                                dbg("%s: vid = %x bus %x dev %x fun %x\n", __FUNCTION__,
+                                vid, busn, devn, funn);
+                                func = pciehp_slot_find(busn, devn, funn);
+                                dbg("%s: func = %p\n", __FUNCTION__,func);
+                                if (!func) {
+                                        memset(&new_func, 0, sizeof(struct pci_func));
+                                        new_func.bus = busn;
+                                        new_func.device = devn;
+                                        new_func.function = funn;
+                                        new_func.is_a_board = 1;
+                                        configure_existing_function(ctrl, &new_func);
+                                        phprm_dump_func_res(&new_func);
+                                } else {
+                                        configure_existing_function(ctrl, func);
+                                        phprm_dump_func_res(func);
+                                }
+                                dbg("aCCF:existing PCI 0x%x Func ResourceDump\n", ctrl->bus);
+                        }
+                }
+        }
+
+        return 0;
+}
+
+static void phprm_dump_ctrl_res( struct controller *ctlr)
+{
+        struct controller *ctrl = ctlr;
+
+        if (ctrl->bus_head) {
+                dbg(":    BUS Resources:\n");
+                print_pci_resource (ctrl->bus_head);
+        }
+        if (ctrl->io_head) {
+                dbg(":    IO Resources:\n");
+                print_pci_resource (ctrl->io_head);
+        }
+        if (ctrl->mem_head) {
+                dbg(":    MEM Resources:\n");
+                print_pci_resource (ctrl->mem_head);
+        }
+        if (ctrl->p_mem_head) {
+                dbg(":    PMEM Resources:\n");
+                print_pci_resource (ctrl->p_mem_head);
+        }
+}
+
+/*
+ * phprm_find_available_resources
+ *
+ *  Finds available memory, IO, and IRQ resources for programming
+ *  devices which may be added to the system
+ *  this function is for hot plug ADD!
+ *
+ * returns 0 if success
+ */
+int pciehprm_find_available_resources(struct controller *ctrl)
+{
+        struct pci_func func;
+        u32 rc;
+
+        memset(&func, 0, sizeof(struct pci_func));
+
+        func.bus = ctrl->bus;
+        func.device = ctrl->device;
+        func.function = ctrl->function;
+        func.is_a_board = 1;
+
+        /* Get resources for this PCI bridge */
+        rc = pciehp_save_used_resources (ctrl, &func, !DISABLE_CARD);
+        dbg("%s: pciehp_save_used_resources rc = %d\n", __FUNCTION__, rc);
+
+        if (func.mem_head)
+                func.mem_head->next = ctrl->mem_head;
+        ctrl->mem_head = func.mem_head;
+
+        if (func.p_mem_head)
+                func.p_mem_head->next = ctrl->p_mem_head;
+        ctrl->p_mem_head = func.p_mem_head;
+
+        if (func.io_head)
+                func.io_head->next = ctrl->io_head;
+        ctrl->io_head = func.io_head;
+
+        if(func.bus_head)
+                func.bus_head->next = ctrl->bus_head;
+        ctrl->bus_head = func.bus_head;
+
+        if (ctrl->bus_head)
+                pciehprm_delete_resource(&ctrl->bus_head, ctrl->pci_dev->subordinate->number, 1);
+        
+        dbg("%s:pre-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
+        phprm_dump_ctrl_res(ctrl);
+
+        dbg("%s: before bind_pci_resources_to slots\n", __FUNCTION__);
+
+        bind_pci_resources_to_slots (ctrl);
+
+        dbg("%s:post-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
+        phprm_dump_ctrl_res(ctrl);
+
+        return (rc);
+}
+
+int pciehprm_set_hpp(
+        struct controller *ctrl,
+        struct pci_func *func,
+        u8      card_type)
+{
+        u32 rc;
+        u8 temp_byte;
+        struct pci_bus lpci_bus, *pci_bus;
+        unsigned int    devfn;
+        memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
+        pci_bus = &lpci_bus;
+        pci_bus->number = func->bus;
+        devfn = PCI_DEVFN(func->device, func->function);
+
+        temp_byte = 0x40;       /* hard coded value for LT */
+        if (card_type == PCI_HEADER_TYPE_BRIDGE) {
+                /* set subordinate Latency Timer */
+                rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_SEC_LATENCY_TIMER, temp_byte);
+
+                if (rc) {
+                        dbg("%s: set secondary LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, 
+                                func->bus, func->device, func->function);
+                        return rc;
+                }
+        }
+
+        /* set base Latency Timer */
+        rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_LATENCY_TIMER, temp_byte);
+
+        if (rc) {
+                dbg("%s: set LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
+                return rc;
+        }
+
+        /* set Cache Line size */
+        temp_byte = 0x08;       /* hard coded value for CLS */
+
+        rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_CACHE_LINE_SIZE, temp_byte);
+
+        if (rc) {
+                dbg("%s: set CLS error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
+        }
+
+        /* set enable_perr */
+        /* set enable_serr */
+
+        return rc;
+}
+
+void pciehprm_enable_card(
+        struct controller *ctrl,
+        struct pci_func *func,
+        u8 card_type)
+{
+        u16 command, bcommand;
+        struct pci_bus lpci_bus, *pci_bus;
+        unsigned int devfn;
+        int rc;
+
+        memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
+        pci_bus = &lpci_bus;
+        pci_bus->number = func->bus;
+        devfn = PCI_DEVFN(func->device, func->function);
+
+        rc = pci_bus_read_config_word(pci_bus, devfn, PCI_COMMAND, &command);
+
+        command |= PCI_COMMAND_PARITY | PCI_COMMAND_SERR
+                | PCI_COMMAND_MASTER | PCI_COMMAND_INVALIDATE
+                | PCI_COMMAND_IO | PCI_COMMAND_MEMORY;
+
+        rc = pci_bus_write_config_word(pci_bus, devfn, PCI_COMMAND, command);
+
+        if (card_type == PCI_HEADER_TYPE_BRIDGE) {
+
+                rc = pci_bus_read_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, &bcommand);
+
+                bcommand |= PCI_BRIDGE_CTL_PARITY | PCI_BRIDGE_CTL_SERR
+                        | PCI_BRIDGE_CTL_NO_ISA;
+
+                rc = pci_bus_write_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, bcommand);
+        }
+}
+
+static int legacy_pciehprm_init_pci(void)
+{
+        return 0;
+}
+
+int pciehprm_init(enum php_ctlr_type ctrl_type)
+{
+        int retval;
+
+        switch (ctrl_type) {
+        case PCI:
+                retval = legacy_pciehprm_init_pci();
+                break;
+        default:
+                retval = -ENODEV;
+                break;
+        }
+
+        return retval;
+}