[linux-block.git] / drivers / pci / hotplug / pciehprm_nonacpi.c

/*
 * 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>, <kristen.c.accardi@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;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* PCIEHPRM NONACPI: PHP Resource Manager for Non-ACPI/Legacy platform
	3	*
	4	* Copyright (C) 1995,2001 Compaq Computer Corporation
	5	* Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
	6	* Copyright (C) 2001 IBM Corp.
	7	* Copyright (C) 2003-2004 Intel Corporation
	8	*
	9	* All rights reserved.
	10	*
	11	* This program is free software; you can redistribute it and/or modify
	12	* it under the terms of the GNU General Public License as published by
	13	* the Free Software Foundation; either version 2 of the License, or (at
	14	* your option) any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful, but
	17	* WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or
	19	* NON INFRINGEMENT. See the GNU General Public License for more
	20	* details.
	21	*
	22	* You should have received a copy of the GNU General Public License
	23	* along with this program; if not, write to the Free Software
	24	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	25	*
8cf4c195	26	* Send feedback to <greg@kroah.com>, <kristen.c.accardi@intel.com>
1da177e4 LT	27	*
	28	*/
	29
	30	#include <linux/config.h>
	31	#include <linux/module.h>
	32	#include <linux/kernel.h>
	33	#include <linux/types.h>
	34	#include <linux/pci.h>
	35	#include <linux/init.h>
	36	#include <asm/uaccess.h>
	37	#ifdef CONFIG_IA64
	38	#include <asm/iosapic.h>
	39	#endif
	40	#include "pciehp.h"
	41	#include "pciehprm.h"
	42	#include "pciehprm_nonacpi.h"
	43
	44
	45	void pciehprm_cleanup(void)
	46	{
	47	return;
	48	}
	49
	50	int pciehprm_print_pirt(void)
	51	{
	52	return 0;
	53	}
	54
	55	int pciehprm_get_physical_slot_number(struct controller ctrl, u32 sun, u8 busnum, u8 devnum)
	56	{
	57
	58	*sun = (u8) (ctrl->first_slot);
	59	return 0;
	60	}
	61
	62
	63	static void print_pci_resource ( struct pci_resource *aprh)
	64	{
	65	struct pci_resource *res;
	66
	67	for (res = aprh; res; res = res->next)
	68	dbg(" base= 0x%x length= 0x%x\n", res->base, res->length);
	69	}
	70
	71
	72	static void phprm_dump_func_res( struct pci_func *fun)
	73	{
	74	struct pci_func *func = fun;
	75
	76	if (func->bus_head) {
	77	dbg(": BUS Resources:\n");
	78	print_pci_resource (func->bus_head);
	79	}
	80	if (func->io_head) {
	81	dbg(": IO Resources:\n");
	82	print_pci_resource (func->io_head);
	83	}
	84	if (func->mem_head) {
	85	dbg(": MEM Resources:\n");
	86	print_pci_resource (func->mem_head);
	87	}
	88	if (func->p_mem_head) {
	89	dbg(": PMEM Resources:\n");
	90	print_pci_resource (func->p_mem_head);
91	}
92	}
93
94	static int phprm_get_used_resources (
95	struct controller *ctrl,
96	struct pci_func *func
97	)
98	{
99	return pciehp_save_used_resources (ctrl, func, !DISABLE_CARD);
100	}
101
102	static int phprm_delete_resource(
103	struct pci_resource **aprh,
104	ulong base,
105	ulong size)
106	{
107	struct pci_resource *res;
108	struct pci_resource *prevnode;
109	struct pci_resource *split_node;
110	ulong tbase;
111
112	pciehp_resource_sort_and_combine(aprh);
113
114	for (res = *aprh; res; res = res->next) {
115	if (res->base > base)
116	continue;
117
118	if ((res->base + res->length) < (base + size))
119	continue;
120
121	if (res->base < base) {
122	tbase = base;
123
124	if ((res->length - (tbase - res->base)) < size)
125	continue;
126
127	split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
128	if (!split_node)
129	return -ENOMEM;
130
131	split_node->base = res->base;
132	split_node->length = tbase - res->base;
133	res->base = tbase;
134	res->length -= split_node->length;
135
136	split_node->next = res->next;
137	res->next = split_node;
138	}
139
140	if (res->length >= size) {
141	split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
142	if (!split_node)
143	return -ENOMEM;
144
145	split_node->base = res->base + size;
146	split_node->length = res->length - size;
147	res->length = size;
148
149	split_node->next = res->next;
150	res->next = split_node;
151	}
152
153	if (*aprh == res) {
154	*aprh = res->next;
155	} else {
156	prevnode = *aprh;
157	while (prevnode->next != res)
158	prevnode = prevnode->next;
159
160	prevnode->next = res->next;
161	}
162	res->next = NULL;
163	kfree(res);
164	break;
165	}
166
167	return 0;
168	}
169
170
171	static int phprm_delete_resources(
172	struct pci_resource **aprh,
173	struct pci_resource *this
174	)
175	{
176	struct pci_resource *res;
177
178	for (res = this; res; res = res->next)
179	phprm_delete_resource(aprh, res->base, res->length);
180
181	return 0;
182	}
183
184
185	static int configure_existing_function(
186	struct controller *ctrl,
187	struct pci_func *func
188	)
189	{
190	int rc;
191
192	/* see how much resources the func has used. */
193	rc = phprm_get_used_resources (ctrl, func);
194
195	if (!rc) {
196	/* subtract the resources used by the func from ctrl resources */
197	rc = phprm_delete_resources (&ctrl->bus_head, func->bus_head);
198	rc \|= phprm_delete_resources (&ctrl->io_head, func->io_head);
199	rc \|= phprm_delete_resources (&ctrl->mem_head, func->mem_head);
200	rc \|= phprm_delete_resources (&ctrl->p_mem_head, func->p_mem_head);
201	if (rc)
202	warn("aCEF: cannot del used resources\n");
203	} else
204	err("aCEF: cannot get used resources\n");
205
206	return rc;
207	}
208
209	static int pciehprm_delete_resource(
210	struct pci_resource **aprh,
211	ulong base,
212	ulong size)
213	{
214	struct pci_resource *res;
215	struct pci_resource *prevnode;
216	struct pci_resource *split_node;
217	ulong tbase;
218
219	pciehp_resource_sort_and_combine(aprh);
220
221	for (res = *aprh; res; res = res->next) {
222	if (res->base > base)
223	continue;
224
225	if ((res->base + res->length) < (base + size))
226	continue;
227
228	if (res->base < base) {
229	tbase = base;
230
231	if ((res->length - (tbase - res->base)) < size)
232	continue;
233
234	split_node = (struct pci_resource *) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
235	if (!split_node)
236	return -ENOMEM;
237
238	split_node->base = res->base;
239	split_node->length = tbase - res->base;
240	res->base = tbase;
241	res->length -= split_node->length;
242
243	split_node->next = res->next;
244	res->next = split_node;
245	}
246
247	if (res->length >= size) {
248	split_node = (struct pci_resource*) kmalloc(sizeof(struct pci_resource), GFP_KERNEL);
249	if (!split_node)
250	return -ENOMEM;
251
252	split_node->base = res->base + size;
253	split_node->length = res->length - size;
254	res->length = size;
255
256	split_node->next = res->next;
257	res->next = split_node;
258	}
259
260	if (*aprh == res) {
261	*aprh = res->next;
262	} else {
263	prevnode = *aprh;
264	while (prevnode->next != res)
265	prevnode = prevnode->next;
266
267	prevnode->next = res->next;
268	}
269	res->next = NULL;
270	kfree(res);
271	break;
272	}
273
274	return 0;
275	}
276
277	static int bind_pci_resources_to_slots ( struct controller *ctrl)
278	{
279	struct pci_func *func, new_func;
280	int busn = ctrl->slot_bus;
281	int devn, funn;
282	u32 vid;
283
284	for (devn = 0; devn < 32; devn++) {
285	for (funn = 0; funn < 8; funn++) {
286	/*
287	if (devn == ctrl->device && funn == ctrl->function)
288	continue;
289	*/
290	/* find out if this entry is for an occupied slot */
291	vid = 0xFFFFFFFF;
292
293	pci_bus_read_config_dword(ctrl->pci_dev->subordinate, PCI_DEVFN(devn, funn), PCI_VENDOR_ID, &vid);
294
295	if (vid != 0xFFFFFFFF) {
296	dbg("%s: vid = %x bus %x dev %x fun %x\n", __FUNCTION__,
297	vid, busn, devn, funn);
298	func = pciehp_slot_find(busn, devn, funn);
299	dbg("%s: func = %p\n", __FUNCTION__,func);
300	if (!func) {
301	memset(&new_func, 0, sizeof(struct pci_func));
302	new_func.bus = busn;
303	new_func.device = devn;
304	new_func.function = funn;
305	new_func.is_a_board = 1;
306	configure_existing_function(ctrl, &new_func);
307	phprm_dump_func_res(&new_func);
308	} else {
309	configure_existing_function(ctrl, func);
310	phprm_dump_func_res(func);
311	}
312	dbg("aCCF:existing PCI 0x%x Func ResourceDump\n", ctrl->bus);
313	}
314	}
315	}
316
317	return 0;
318	}
319
320	static void phprm_dump_ctrl_res( struct controller *ctlr)
321	{
322	struct controller *ctrl = ctlr;
323
324	if (ctrl->bus_head) {
325	dbg(": BUS Resources:\n");
326	print_pci_resource (ctrl->bus_head);
327	}
328	if (ctrl->io_head) {
329	dbg(": IO Resources:\n");
330	print_pci_resource (ctrl->io_head);
331	}
332	if (ctrl->mem_head) {
333	dbg(": MEM Resources:\n");
334	print_pci_resource (ctrl->mem_head);
335	}
336	if (ctrl->p_mem_head) {
337	dbg(": PMEM Resources:\n");
338	print_pci_resource (ctrl->p_mem_head);
339	}
340	}
341
342	/*
343	* phprm_find_available_resources
344	*
345	* Finds available memory, IO, and IRQ resources for programming
346	* devices which may be added to the system
347	* this function is for hot plug ADD!
348	*
349	* returns 0 if success
350	*/
351	int pciehprm_find_available_resources(struct controller *ctrl)
352	{
353	struct pci_func func;
354	u32 rc;
355
356	memset(&func, 0, sizeof(struct pci_func));
357
358	func.bus = ctrl->bus;
359	func.device = ctrl->device;
360	func.function = ctrl->function;
361	func.is_a_board = 1;
362
363	/* Get resources for this PCI bridge */
364	rc = pciehp_save_used_resources (ctrl, &func, !DISABLE_CARD);
365	dbg("%s: pciehp_save_used_resources rc = %d\n", __FUNCTION__, rc);
366
367	if (func.mem_head)
368	func.mem_head->next = ctrl->mem_head;
369	ctrl->mem_head = func.mem_head;
370
371	if (func.p_mem_head)
372	func.p_mem_head->next = ctrl->p_mem_head;
373	ctrl->p_mem_head = func.p_mem_head;
374
375	if (func.io_head)
376	func.io_head->next = ctrl->io_head;
377	ctrl->io_head = func.io_head;
378
379	if(func.bus_head)
380	func.bus_head->next = ctrl->bus_head;
381	ctrl->bus_head = func.bus_head;
382
383	if (ctrl->bus_head)
384	pciehprm_delete_resource(&ctrl->bus_head, ctrl->pci_dev->subordinate->number, 1);
385
386	dbg("%s:pre-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
387	phprm_dump_ctrl_res(ctrl);
388
389	dbg("%s: before bind_pci_resources_to slots\n", __FUNCTION__);
390
391	bind_pci_resources_to_slots (ctrl);
392
393	dbg("%s:post-Bind PCI 0x%x Ctrl Resource Dump\n", __FUNCTION__, ctrl->bus);
394	phprm_dump_ctrl_res(ctrl);
395
396	return (rc);
397	}
398
399	int pciehprm_set_hpp(
400	struct controller *ctrl,
401	struct pci_func *func,
402	u8 card_type)
403	{
404	u32 rc;
405	u8 temp_byte;
406	struct pci_bus lpci_bus, *pci_bus;
407	unsigned int devfn;
408	memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
409	pci_bus = &lpci_bus;
410	pci_bus->number = func->bus;
411	devfn = PCI_DEVFN(func->device, func->function);
412
413	temp_byte = 0x40; /* hard coded value for LT */
414	if (card_type == PCI_HEADER_TYPE_BRIDGE) {
415	/* set subordinate Latency Timer */
416	rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_SEC_LATENCY_TIMER, temp_byte);
417
418	if (rc) {
419	dbg("%s: set secondary LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__,
420	func->bus, func->device, func->function);
421	return rc;
422	}
423	}
424
425	/* set base Latency Timer */
426	rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_LATENCY_TIMER, temp_byte);
427
428	if (rc) {
429	dbg("%s: set LT error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
430	return rc;
431	}
432
433	/* set Cache Line size */
434	temp_byte = 0x08; /* hard coded value for CLS */
435
436	rc = pci_bus_write_config_byte(pci_bus, devfn, PCI_CACHE_LINE_SIZE, temp_byte);
437
438	if (rc) {
439	dbg("%s: set CLS error. b:d:f(%02x:%02x:%02x)\n", __FUNCTION__, func->bus, func->device, func->function);
440	}
441
442	/* set enable_perr */
443	/* set enable_serr */
444
445	return rc;
446	}
447
448	void pciehprm_enable_card(
449	struct controller *ctrl,
450	struct pci_func *func,
451	u8 card_type)
452	{
453	u16 command, bcommand;
454	struct pci_bus lpci_bus, *pci_bus;
455	unsigned int devfn;
456	int rc;
457
458	memcpy(&lpci_bus, ctrl->pci_bus, sizeof(lpci_bus));
459	pci_bus = &lpci_bus;
460	pci_bus->number = func->bus;
461	devfn = PCI_DEVFN(func->device, func->function);
462
463	rc = pci_bus_read_config_word(pci_bus, devfn, PCI_COMMAND, &command);
464
465	command \|= PCI_COMMAND_PARITY \| PCI_COMMAND_SERR
466	\| PCI_COMMAND_MASTER \| PCI_COMMAND_INVALIDATE
467	\| PCI_COMMAND_IO \| PCI_COMMAND_MEMORY;
468
469	rc = pci_bus_write_config_word(pci_bus, devfn, PCI_COMMAND, command);
470
471	if (card_type == PCI_HEADER_TYPE_BRIDGE) {
472
473	rc = pci_bus_read_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, &bcommand);
474
475	bcommand \|= PCI_BRIDGE_CTL_PARITY \| PCI_BRIDGE_CTL_SERR
476	\| PCI_BRIDGE_CTL_NO_ISA;
477
478	rc = pci_bus_write_config_word(pci_bus, devfn, PCI_BRIDGE_CONTROL, bcommand);
479	}
480	}
481
482	static int legacy_pciehprm_init_pci(void)
483	{
484	return 0;
485	}
486
487	int pciehprm_init(enum php_ctlr_type ctrl_type)
488	{
489	int retval;
490
491	switch (ctrl_type) {
492	case PCI:
493	retval = legacy_pciehprm_init_pci();
494	break;
495	default:
496	retval = -ENODEV;
497	break;
498	}
499
500	return retval;
501	}