[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / powerpc / kernel / pci_dn.c

/*
 * pci_dn.c
 *
 * Copyright (C) 2001 Todd Inglett, IBM Corporation
 *
 * PCI manipulation via device_nodes.
 *
 * 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.  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., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
 */
#include <linux/kernel.h>
#include <linux/pci.h>
#include <linux/string.h>
#include <linux/init.h>
#include <linux/slab.h>
#include <linux/bootmem.h>

#include <asm/io.h>
#include <asm/prom.h>
#include <asm/pci-bridge.h>
#include <asm/pSeries_reconfig.h>
#include <asm/ppc-pci.h>
#include <asm/firmware.h>

/*
 * Traverse_func that inits the PCI fields of the device node.
 * NOTE: this *must* be done before read/write config to the device.
 */
static void * __devinit update_dn_pci_info(struct device_node *dn, void *data)
{
	struct pci_controller *phb = data;
	int *type = (int *)get_property(dn, "ibm,pci-config-space-type", NULL);
	u32 *regs;
	struct pci_dn *pdn;

	if (mem_init_done)
		pdn = kmalloc(sizeof(*pdn), GFP_KERNEL);
	else
		pdn = alloc_bootmem(sizeof(*pdn));
	if (pdn == NULL)
		return NULL;
	memset(pdn, 0, sizeof(*pdn));
	dn->data = pdn;
	pdn->node = dn;
	pdn->phb = phb;
	regs = (u32 *)get_property(dn, "reg", NULL);
	if (regs) {
		/* First register entry is addr (00BBSS00)  */
		pdn->busno = (regs[0] >> 16) & 0xff;
		pdn->devfn = (regs[0] >> 8) & 0xff;
	}
	if (firmware_has_feature(FW_FEATURE_ISERIES)) {
		u32 *busp = (u32 *)get_property(dn, "linux,subbus", NULL);
		if (busp)
			pdn->bussubno = *busp;
	}

	pdn->pci_ext_config_space = (type && *type == 1);
	return NULL;
}

/*
 * Traverse a device tree stopping each PCI device in the tree.
 * This is done depth first.  As each node is processed, a "pre"
 * function is called and the children are processed recursively.
 *
 * The "pre" func returns a value.  If non-zero is returned from
 * the "pre" func, the traversal stops and this value is returned.
 * This return value is useful when using traverse as a method of
 * finding a device.
 *
 * NOTE: we do not run the func for devices that do not appear to
 * be PCI except for the start node which we assume (this is good
 * because the start node is often a phb which may be missing PCI
 * properties).
 * We use the class-code as an indicator. If we run into
 * one of these nodes we also assume its siblings are non-pci for
 * performance.
 */
void *traverse_pci_devices(struct device_node *start, traverse_func pre,
		void *data)
{
	struct device_node *dn, *nextdn;
	void *ret;

	/* We started with a phb, iterate all childs */
	for (dn = start->child; dn; dn = nextdn) {
		u32 *classp, class;

		nextdn = NULL;
		classp = (u32 *)get_property(dn, "class-code", NULL);
		class = classp ? *classp : 0;

		if (pre && ((ret = pre(dn, data)) != NULL))
			return ret;

		/* If we are a PCI bridge, go down */
		if (dn->child && ((class >> 8) == PCI_CLASS_BRIDGE_PCI ||
				  (class >> 8) == PCI_CLASS_BRIDGE_CARDBUS))
			/* Depth first...do children */
			nextdn = dn->child;
		else if (dn->sibling)
			/* ok, try next sibling instead. */
			nextdn = dn->sibling;
		if (!nextdn) {
			/* Walk up to next valid sibling. */
			do {
				dn = dn->parent;
				if (dn == start)
					return NULL;
			} while (dn->sibling == NULL);
			nextdn = dn->sibling;
		}
	}
	return NULL;
}

/** 
 * pci_devs_phb_init_dynamic - setup pci devices under this PHB
 * phb: pci-to-host bridge (top-level bridge connecting to cpu)
 *
 * This routine is called both during boot, (before the memory
 * subsystem is set up, before kmalloc is valid) and during the 
 * dynamic lpar operation of adding a PHB to a running system.
 */
void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb)
{
	struct device_node * dn = (struct device_node *) phb->arch_data;
	struct pci_dn *pdn;

	/* PHB nodes themselves must not match */
	update_dn_pci_info(dn, phb);
	pdn = dn->data;
	if (pdn) {
		pdn->devfn = pdn->busno = -1;
		pdn->phb = phb;
	}

	/* Update dn->phb ptrs for new phb and children devices */
	traverse_pci_devices(dn, update_dn_pci_info, phb);
}

/*
 * Traversal func that looks for a <busno,devfcn> value.
 * If found, the pci_dn is returned (thus terminating the traversal).
 */
static void *is_devfn_node(struct device_node *dn, void *data)
{
	int busno = ((unsigned long)data >> 8) & 0xff;
	int devfn = ((unsigned long)data) & 0xff;
	struct pci_dn *pci = dn->data;

	if (pci && (devfn == pci->devfn) && (busno == pci->busno))
		return dn;
	return NULL;
}

/*
 * This is the "slow" path for looking up a device_node from a
 * pci_dev.  It will hunt for the device under its parent's
 * phb and then update sysdata for a future fastpath.
 *
 * It may also do fixups on the actual device since this happens
 * on the first read/write.
 *
 * Note that it also must deal with devices that don't exist.
 * In this case it may probe for real hardware ("just in case")
 * and add a device_node to the device tree if necessary.
 *
 */
struct device_node *fetch_dev_dn(struct pci_dev *dev)
{
	struct device_node *orig_dn = dev->sysdata;
	struct device_node *dn;
	unsigned long searchval = (dev->bus->number << 8) | dev->devfn;

	dn = traverse_pci_devices(orig_dn, is_devfn_node, (void *)searchval);
	if (dn)
		dev->sysdata = dn;
	return dn;
}
EXPORT_SYMBOL(fetch_dev_dn);

static int pci_dn_reconfig_notifier(struct notifier_block *nb, unsigned long action, void *node)
{
	struct device_node *np = node;
	struct pci_dn *pci = NULL;
	int err = NOTIFY_OK;

	switch (action) {
	case PSERIES_RECONFIG_ADD:
		pci = np->parent->data;
		if (pci)
			update_dn_pci_info(np, pci->phb);
		break;
	default:
		err = NOTIFY_DONE;
		break;
	}
	return err;
}

static struct notifier_block pci_dn_reconfig_nb = {
	.notifier_call = pci_dn_reconfig_notifier,
};

/** 
 * pci_devs_phb_init - Initialize phbs and pci devs under them.
 * 
 * This routine walks over all phb's (pci-host bridges) on the
 * system, and sets up assorted pci-related structures 
 * (including pci info in the device node structs) for each
 * pci device found underneath.  This routine runs once,
 * early in the boot sequence.
 */
void __init pci_devs_phb_init(void)
{
	struct pci_controller *phb, *tmp;

	/* This must be done first so the device nodes have valid pci info! */
	list_for_each_entry_safe(phb, tmp, &hose_list, list_node)
		pci_devs_phb_init_dynamic(phb);

	pSeries_reconfig_notifier_register(&pci_dn_reconfig_nb);
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* pci_dn.c
	3	*
	4	* Copyright (C) 2001 Todd Inglett, IBM Corporation
	5	*
	6	* PCI manipulation via device_nodes.
	7	*
	8	* This program is free software; you can redistribute it and/or modify
	9	* it under the terms of the GNU General Public License as published by
	10	* the Free Software Foundation; either version 2 of the License, or
	11	* (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	21	*/
	22	#include <linux/kernel.h>
	23	#include <linux/pci.h>
	24	#include <linux/string.h>
	25	#include <linux/init.h>
1635317f PM	26	#include <linux/slab.h>
1635317f PM	27	#include <linux/bootmem.h>
1da177e4 LT	28
	29	#include <asm/io.h>
	30	#include <asm/prom.h>
	31	#include <asm/pci-bridge.h>
	32	#include <asm/pSeries_reconfig.h>
d387899f	33	#include <asm/ppc-pci.h>
095eed4f	34	#include <asm/firmware.h>
1da177e4 LT	35
	36	/*
	37	* Traverse_func that inits the PCI fields of the device node.
	38	* NOTE: this must be done before read/write config to the device.
	39	*/
	40	static void * __devinit update_dn_pci_info(struct device_node dn, void data)
	41	{
	42	struct pci_controller *phb = data;
	43	int type = (int )get_property(dn, "ibm,pci-config-space-type", NULL);
	44	u32 *regs;
1635317f PM	45	struct pci_dn *pdn;
1635317f PM	46
18126f35	47	if (mem_init_done)
1635317f PM	48	pdn = kmalloc(sizeof(*pdn), GFP_KERNEL);
	49	else
	50	pdn = alloc_bootmem(sizeof(*pdn));
	51	if (pdn == NULL)
	52	return NULL;
	53	memset(pdn, 0, sizeof(*pdn));
	54	dn->data = pdn;
	55	pdn->node = dn;
	56	pdn->phb = phb;
1da177e4 LT	57	regs = (u32 *)get_property(dn, "reg", NULL);
	58	if (regs) {
	59	/* First register entry is addr (00BBSS00) */
1635317f PM	60	pdn->busno = (regs[0] >> 16) & 0xff;
1635317f PM	61	pdn->devfn = (regs[0] >> 8) & 0xff;
1da177e4	62	}
095eed4f SR	63	if (firmware_has_feature(FW_FEATURE_ISERIES)) {
	64	u32 busp = (u32 )get_property(dn, "linux,subbus", NULL);
	65	if (busp)
	66	pdn->bussubno = *busp;
	67	}
1da177e4	68
1635317f	69	pdn->pci_ext_config_space = (type && *type == 1);
1da177e4 LT	70	return NULL;
	71	}
	72
	73	/*
	74	* Traverse a device tree stopping each PCI device in the tree.
	75	* This is done depth first. As each node is processed, a "pre"
	76	* function is called and the children are processed recursively.
	77	*
	78	* The "pre" func returns a value. If non-zero is returned from
	79	* the "pre" func, the traversal stops and this value is returned.
	80	* This return value is useful when using traverse as a method of
	81	* finding a device.
	82	*
	83	* NOTE: we do not run the func for devices that do not appear to
	84	* be PCI except for the start node which we assume (this is good
	85	* because the start node is often a phb which may be missing PCI
	86	* properties).
	87	* We use the class-code as an indicator. If we run into
	88	* one of these nodes we also assume its siblings are non-pci for
	89	* performance.
	90	*/
	91	void traverse_pci_devices(struct device_node start, traverse_func pre,
	92	void *data)
	93	{
	94	struct device_node dn, nextdn;
	95	void *ret;
	96
	97	/* We started with a phb, iterate all childs */
	98	for (dn = start->child; dn; dn = nextdn) {
	99	u32 *classp, class;
	100
	101	nextdn = NULL;
	102	classp = (u32 *)get_property(dn, "class-code", NULL);
	103	class = classp ? *classp : 0;
	104
	105	if (pre && ((ret = pre(dn, data)) != NULL))
	106	return ret;
	107
	108	/* If we are a PCI bridge, go down */
	109	if (dn->child && ((class >> 8) == PCI_CLASS_BRIDGE_PCI \|\|
	110	(class >> 8) == PCI_CLASS_BRIDGE_CARDBUS))
	111	/* Depth first...do children */
	112	nextdn = dn->child;
	113	else if (dn->sibling)
	114	/* ok, try next sibling instead. */
	115	nextdn = dn->sibling;
	116	if (!nextdn) {
	117	/* Walk up to next valid sibling. */
	118	do {
	119	dn = dn->parent;
	120	if (dn == start)
	121	return NULL;
	122	} while (dn->sibling == NULL);
	123	nextdn = dn->sibling;
	124	}
	125	}
	126	return NULL;
	127	}
	128
18126f35 LV	129	/**
	130	* pci_devs_phb_init_dynamic - setup pci devices under this PHB
	131	* phb: pci-to-host bridge (top-level bridge connecting to cpu)
	132	*
	133	* This routine is called both during boot, (before the memory
	134	* subsystem is set up, before kmalloc is valid) and during the
	135	* dynamic lpar operation of adding a PHB to a running system.
	136	*/
1da177e4 LT	137	void __devinit pci_devs_phb_init_dynamic(struct pci_controller *phb)
	138	{
	139	struct device_node * dn = (struct device_node *) phb->arch_data;
1635317f	140	struct pci_dn *pdn;
1da177e4 LT	141
1da177e4 LT	142	/* PHB nodes themselves must not match */
1635317f PM	143	update_dn_pci_info(dn, phb);
	144	pdn = dn->data;
	145	if (pdn) {
	146	pdn->devfn = pdn->busno = -1;
	147	pdn->phb = phb;
	148	}
1da177e4 LT	149
	150	/* Update dn->phb ptrs for new phb and children devices */
	151	traverse_pci_devices(dn, update_dn_pci_info, phb);
	152	}
	153
	154	/*
	155	* Traversal func that looks for a <busno,devfcn> value.
1635317f	156	* If found, the pci_dn is returned (thus terminating the traversal).
1da177e4 LT	157	*/
	158	static void is_devfn_node(struct device_node dn, void *data)
	159	{
	160	int busno = ((unsigned long)data >> 8) & 0xff;
	161	int devfn = ((unsigned long)data) & 0xff;
1635317f	162	struct pci_dn *pci = dn->data;
1da177e4	163
1635317f PM	164	if (pci && (devfn == pci->devfn) && (busno == pci->busno))
	165	return dn;
	166	return NULL;
1da177e4 LT	167	}
	168
	169	/*
	170	* This is the "slow" path for looking up a device_node from a
	171	* pci_dev. It will hunt for the device under its parent's
	172	* phb and then update sysdata for a future fastpath.
	173	*
	174	* It may also do fixups on the actual device since this happens
	175	* on the first read/write.
	176	*
	177	* Note that it also must deal with devices that don't exist.
	178	* In this case it may probe for real hardware ("just in case")
	179	* and add a device_node to the device tree if necessary.
	180	*
	181	*/
	182	struct device_node fetch_dev_dn(struct pci_dev dev)
	183	{
	184	struct device_node *orig_dn = dev->sysdata;
1da177e4 LT	185	struct device_node *dn;
	186	unsigned long searchval = (dev->bus->number << 8) \| dev->devfn;
	187
1635317f	188	dn = traverse_pci_devices(orig_dn, is_devfn_node, (void *)searchval);
1da177e4 LT	189	if (dn)
	190	dev->sysdata = dn;
	191	return dn;
	192	}
	193	EXPORT_SYMBOL(fetch_dev_dn);
	194
	195	static int pci_dn_reconfig_notifier(struct notifier_block nb, unsigned long action, void node)
	196	{
	197	struct device_node *np = node;
8902e87f	198	struct pci_dn *pci = NULL;
1da177e4 LT	199	int err = NOTIFY_OK;
	200
	201	switch (action) {
	202	case PSERIES_RECONFIG_ADD:
1635317f	203	pci = np->parent->data;
8902e87f JR	204	if (pci)
8902e87f JR	205	update_dn_pci_info(np, pci->phb);
1da177e4 LT	206	break;
	207	default:
	208	err = NOTIFY_DONE;
	209	break;
	210	}
	211	return err;
	212	}
	213
	214	static struct notifier_block pci_dn_reconfig_nb = {
	215	.notifier_call = pci_dn_reconfig_notifier,
	216	};
	217
18126f35 LV	218	/**
	219	* pci_devs_phb_init - Initialize phbs and pci devs under them.
	220	*
	221	* This routine walks over all phb's (pci-host bridges) on the
	222	* system, and sets up assorted pci-related structures
	223	* (including pci info in the device node structs) for each
	224	* pci device found underneath. This routine runs once,
	225	* early in the boot sequence.
1da177e4 LT	226	*/
	227	void __init pci_devs_phb_init(void)
	228	{
	229	struct pci_controller phb, tmp;
	230
	231	/* This must be done first so the device nodes have valid pci info! */
	232	list_for_each_entry_safe(phb, tmp, &hose_list, list_node)
	233	pci_devs_phb_init_dynamic(phb);
	234
	235	pSeries_reconfig_notifier_register(&pci_dn_reconfig_nb);
	236	}