PCI SR-IOV: correct broken resource alignment calculations
[linux-2.6/mini2440.git] / arch / powerpc / sysdev / mv64x60_pci.c
blob1456015a22d88613c7fdca9c5e6e9948fde3c54d
1 /*
2 * PCI bus setup for Marvell mv64360/mv64460 host bridges (Discovery)
4 * Author: Dale Farnsworth <dale@farnsworth.org>
6 * 2007 (c) MontaVista, Software, Inc. This file is licensed under
7 * the terms of the GNU General Public License version 2. This program
8 * is licensed "as is" without any warranty of any kind, whether express
9 * or implied.
12 #include <linux/stddef.h>
13 #include <linux/kernel.h>
14 #include <linux/init.h>
15 #include <linux/pci.h>
17 #include <asm/prom.h>
18 #include <asm/pci-bridge.h>
20 #define PCI_HEADER_TYPE_INVALID 0x7f /* Invalid PCI header type */
22 #ifdef CONFIG_SYSFS
23 /* 32-bit hex or dec stringified number + '\n' */
24 #define MV64X60_VAL_LEN_MAX 11
25 #define MV64X60_PCICFG_CPCI_HOTSWAP 0x68
27 static ssize_t mv64x60_hs_reg_read(struct kobject *kobj,
28 struct bin_attribute *attr, char *buf,
29 loff_t off, size_t count)
31 struct pci_dev *phb;
32 u32 v;
34 if (off > 0)
35 return 0;
36 if (count < MV64X60_VAL_LEN_MAX)
37 return -EINVAL;
39 phb = pci_get_bus_and_slot(0, PCI_DEVFN(0, 0));
40 if (!phb)
41 return -ENODEV;
42 pci_read_config_dword(phb, MV64X60_PCICFG_CPCI_HOTSWAP, &v);
43 pci_dev_put(phb);
45 return sprintf(buf, "0x%08x\n", v);
48 static ssize_t mv64x60_hs_reg_write(struct kobject *kobj,
49 struct bin_attribute *attr, char *buf,
50 loff_t off, size_t count)
52 struct pci_dev *phb;
53 u32 v;
55 if (off > 0)
56 return 0;
57 if (count <= 0)
58 return -EINVAL;
60 if (sscanf(buf, "%i", &v) != 1)
61 return -EINVAL;
63 phb = pci_get_bus_and_slot(0, PCI_DEVFN(0, 0));
64 if (!phb)
65 return -ENODEV;
66 pci_write_config_dword(phb, MV64X60_PCICFG_CPCI_HOTSWAP, v);
67 pci_dev_put(phb);
69 return count;
72 static struct bin_attribute mv64x60_hs_reg_attr = { /* Hotswap register */
73 .attr = {
74 .name = "hs_reg",
75 .mode = S_IRUGO | S_IWUSR,
76 .owner = THIS_MODULE,
78 .size = MV64X60_VAL_LEN_MAX,
79 .read = mv64x60_hs_reg_read,
80 .write = mv64x60_hs_reg_write,
83 static int __init mv64x60_sysfs_init(void)
85 struct device_node *np;
86 struct platform_device *pdev;
87 const unsigned int *prop;
89 np = of_find_compatible_node(NULL, NULL, "marvell,mv64360");
90 if (!np)
91 return 0;
93 prop = of_get_property(np, "hs_reg_valid", NULL);
94 of_node_put(np);
96 pdev = platform_device_register_simple("marvell,mv64360", 0, NULL, 0);
97 if (IS_ERR(pdev))
98 return PTR_ERR(pdev);
100 return sysfs_create_bin_file(&pdev->dev.kobj, &mv64x60_hs_reg_attr);
103 subsys_initcall(mv64x60_sysfs_init);
105 #endif /* CONFIG_SYSFS */
107 static void __init mv64x60_pci_fixup_early(struct pci_dev *dev)
110 * Set the host bridge hdr_type to an invalid value so that
111 * pci_setup_device() will ignore the host bridge.
113 dev->hdr_type = PCI_HEADER_TYPE_INVALID;
115 DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_MARVELL, PCI_DEVICE_ID_MARVELL_MV64360,
116 mv64x60_pci_fixup_early);
117 DECLARE_PCI_FIXUP_EARLY(PCI_VENDOR_ID_MARVELL, PCI_DEVICE_ID_MARVELL_MV64460,
118 mv64x60_pci_fixup_early);
120 static int __init mv64x60_add_bridge(struct device_node *dev)
122 int len;
123 struct pci_controller *hose;
124 struct resource rsrc;
125 const int *bus_range;
126 int primary;
128 memset(&rsrc, 0, sizeof(rsrc));
130 /* Fetch host bridge registers address */
131 if (of_address_to_resource(dev, 0, &rsrc)) {
132 printk(KERN_ERR "No PCI reg property in device tree\n");
133 return -ENODEV;
136 /* Get bus range if any */
137 bus_range = of_get_property(dev, "bus-range", &len);
138 if (bus_range == NULL || len < 2 * sizeof(int))
139 printk(KERN_WARNING "Can't get bus-range for %s, assume"
140 " bus 0\n", dev->full_name);
142 hose = pcibios_alloc_controller(dev);
143 if (!hose)
144 return -ENOMEM;
146 hose->first_busno = bus_range ? bus_range[0] : 0;
147 hose->last_busno = bus_range ? bus_range[1] : 0xff;
149 setup_indirect_pci(hose, rsrc.start, rsrc.start + 4, 0);
150 hose->self_busno = hose->first_busno;
152 printk(KERN_INFO "Found MV64x60 PCI host bridge at 0x%016llx. "
153 "Firmware bus number: %d->%d\n",
154 (unsigned long long)rsrc.start, hose->first_busno,
155 hose->last_busno);
157 /* Interpret the "ranges" property */
158 /* This also maps the I/O region and sets isa_io/mem_base */
159 primary = (hose->first_busno == 0);
160 pci_process_bridge_OF_ranges(hose, dev, primary);
162 return 0;
165 void __init mv64x60_pci_init(void)
167 struct device_node *np;
169 for_each_compatible_node(np, "pci", "marvell,mv64360-pci")
170 mv64x60_add_bridge(np);