1/*
   2 * IBM Hot Plug Controller Driver
   3 *
   4 * Written By: Irene Zubarev, IBM Corporation
   5 *
   6 * Copyright (C) 2001 Greg Kroah-Hartman (greg@kroah.com)
   7 * Copyright (C) 2001,2002 IBM Corp.
   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 *
  26 * Send feedback to <gregkh@us.ibm.com>
  27 *
  28 */
  29
  30#include <linux/module.h>
  31#include <linux/slab.h>
  32#include <linux/pci.h>
  33#include <linux/list.h>
  34#include <linux/init.h>
  35#include "ibmphp.h"
  36
  37static int flags = 0;		/* for testing */
  38
  39static void update_resources (struct bus_node *bus_cur, int type, int rangeno);
  40static int once_over (void);
  41static int remove_ranges (struct bus_node *, struct bus_node *);
  42static int update_bridge_ranges (struct bus_node **);
  43static int add_bus_range (int type, struct range_node *, struct bus_node *);
  44static void fix_resources (struct bus_node *);
  45static struct bus_node *find_bus_wprev (u8, struct bus_node **, u8);
  46
  47static LIST_HEAD(gbuses);
  48
  49static struct bus_node * __init alloc_error_bus (struct ebda_pci_rsrc * curr, u8 busno, int flag)
  50{
  51	struct bus_node * newbus;
  52
  53	if (!(curr) && !(flag)) {
  54		err ("NULL pointer passed\n");
  55		return NULL;
  56	}
  57
  58	newbus = kzalloc(sizeof(struct bus_node), GFP_KERNEL);
  59	if (!newbus) {
  60		err ("out of system memory\n");
  61		return NULL;
  62	}
  63
  64	if (flag)
  65		newbus->busno = busno;
  66	else
  67		newbus->busno = curr->bus_num;
  68	list_add_tail (&newbus->bus_list, &gbuses);
  69	return newbus;
  70}
  71
  72static struct resource_node * __init alloc_resources (struct ebda_pci_rsrc * curr)
  73{
  74	struct resource_node *rs;
  75	
  76	if (!curr) {
  77		err ("NULL passed to allocate\n");
  78		return NULL;
  79	}
  80
  81	rs = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
  82	if (!rs) {
  83		err ("out of system memory\n");
  84		return NULL;
  85	}
  86	rs->busno = curr->bus_num;
  87	rs->devfunc = curr->dev_fun;
  88	rs->start = curr->start_addr;
  89	rs->end = curr->end_addr;
  90	rs->len = curr->end_addr - curr->start_addr + 1;
  91	return rs;
  92}
  93
  94static int __init alloc_bus_range (struct bus_node **new_bus, struct range_node **new_range, struct ebda_pci_rsrc *curr, int flag, u8 first_bus)
  95{
  96	struct bus_node * newbus;
  97	struct range_node *newrange;
  98	u8 num_ranges = 0;
  99
 100	if (first_bus) {
 101		newbus = kzalloc(sizeof(struct bus_node), GFP_KERNEL);
 102		if (!newbus) {
 103			err ("out of system memory.\n");
 104			return -ENOMEM;
 105		}
 106		newbus->busno = curr->bus_num;
 107	} else {
 108		newbus = *new_bus;
 109		switch (flag) {
 110			case MEM:
 111				num_ranges = newbus->noMemRanges;
 112				break;
 113			case PFMEM:
 114				num_ranges = newbus->noPFMemRanges;
 115				break;
 116			case IO:
 117				num_ranges = newbus->noIORanges;
 118				break;
 119		}
 120	}
 121
 122	newrange = kzalloc(sizeof(struct range_node), GFP_KERNEL);
 123	if (!newrange) {
 124		if (first_bus)
 125			kfree (newbus);
 126		err ("out of system memory\n");
 127		return -ENOMEM;
 128	}
 129	newrange->start = curr->start_addr;
 130	newrange->end = curr->end_addr;
 131		
 132	if (first_bus || (!num_ranges))
 133		newrange->rangeno = 1;
 134	else {
 135		/* need to insert our range */
 136		add_bus_range (flag, newrange, newbus);
 137		debug ("%d resource Primary Bus inserted on bus %x [%x - %x]\n", flag, newbus->busno, newrange->start, newrange->end);
 138	}
 139
 140	switch (flag) {
 141		case MEM:
 142			newbus->rangeMem = newrange;
 143			if (first_bus)
 144				newbus->noMemRanges = 1;
 145			else {
 146				debug ("First Memory Primary on bus %x, [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 147				++newbus->noMemRanges;
 148				fix_resources (newbus);
 149			}
 150			break;
 151		case IO:
 152			newbus->rangeIO = newrange;
 153			if (first_bus)
 154				newbus->noIORanges = 1;
 155			else {
 156				debug ("First IO Primary on bus %x, [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 157				++newbus->noIORanges;
 158				fix_resources (newbus);
 159			}
 160			break;
 161		case PFMEM:
 162			newbus->rangePFMem = newrange;
 163			if (first_bus)
 164				newbus->noPFMemRanges = 1;
 165			else {	
 166				debug ("1st PFMemory Primary on Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 167				++newbus->noPFMemRanges;
 168				fix_resources (newbus);
 169			}
 170
 171			break;
 172	}
 173
 174	*new_bus = newbus;
 175	*new_range = newrange;
 176	return 0;
 177}
 178
 179
 180/* Notes:
 181 * 1. The ranges are ordered.  The buses are not ordered.  (First come)
 182 *
 183 * 2. If cannot allocate out of PFMem range, allocate from Mem ranges.  PFmemFromMem
 184 * are not sorted. (no need since use mem node). To not change the entire code, we
 185 * also add mem node whenever this case happens so as not to change
 186 * ibmphp_check_mem_resource etc (and since it really is taking Mem resource)
 187 */
 188
 189/*****************************************************************************
 190 * This is the Resource Management initialization function.  It will go through
 191 * the Resource list taken from EBDA and fill in this module's data structures
 192 *
 193 * THIS IS NOT TAKING INTO CONSIDERATION IO RESTRICTIONS OF PRIMARY BUSES, 
 194 * SINCE WE'RE GOING TO ASSUME FOR NOW WE DON'T HAVE THOSE ON OUR BUSES FOR NOW
 195 *
 196 * Input: ptr to the head of the resource list from EBDA
 197 * Output: 0, -1 or error codes
 198 ***************************************************************************/
 199int __init ibmphp_rsrc_init (void)
 200{
 201	struct ebda_pci_rsrc *curr;
 202	struct range_node *newrange = NULL;
 203	struct bus_node *newbus = NULL;
 204	struct bus_node *bus_cur;
 205	struct bus_node *bus_prev;
 206	struct list_head *tmp;
 207	struct resource_node *new_io = NULL;
 208	struct resource_node *new_mem = NULL;
 209	struct resource_node *new_pfmem = NULL;
 210	int rc;
 211	struct list_head *tmp_ebda;
 212
 213	list_for_each (tmp_ebda, &ibmphp_ebda_pci_rsrc_head) {
 214		curr = list_entry (tmp_ebda, struct ebda_pci_rsrc, ebda_pci_rsrc_list);
 215		if (!(curr->rsrc_type & PCIDEVMASK)) {
 216			/* EBDA still lists non PCI devices, so ignore... */
 217			debug ("this is not a PCI DEVICE in rsrc_init, please take care\n");
 218			// continue;
 219		}
 220
 221		/* this is a primary bus resource */
 222		if (curr->rsrc_type & PRIMARYBUSMASK) {
 223			/* memory */
 224			if ((curr->rsrc_type & RESTYPE) == MMASK) {
 225				/* no bus structure exists in place yet */
 226				if (list_empty (&gbuses)) {
 227					if ((rc = alloc_bus_range (&newbus, &newrange, curr, MEM, 1)))
 
 228						return rc;
 229					list_add_tail (&newbus->bus_list, &gbuses);
 230					debug ("gbuses = NULL, Memory Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 231				} else {
 232					bus_cur = find_bus_wprev (curr->bus_num, &bus_prev, 1);
 233					/* found our bus */
 234					if (bus_cur) {
 235						rc = alloc_bus_range (&bus_cur, &newrange, curr, MEM, 0);
 236						if (rc)
 237							return rc;
 238					} else {
 239						/* went through all the buses and didn't find ours, need to create a new bus node */
 240						if ((rc = alloc_bus_range (&newbus, &newrange, curr, MEM, 1)))
 
 241							return rc;
 242
 243						list_add_tail (&newbus->bus_list, &gbuses);
 244						debug ("New Bus, Memory Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 245					}
 246				}
 247			} else if ((curr->rsrc_type & RESTYPE) == PFMASK) {
 248				/* prefetchable memory */
 249				if (list_empty (&gbuses)) {
 250					/* no bus structure exists in place yet */
 251					if ((rc = alloc_bus_range (&newbus, &newrange, curr, PFMEM, 1)))
 
 252						return rc;
 253					list_add_tail (&newbus->bus_list, &gbuses);
 254					debug ("gbuses = NULL, PFMemory Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 255				} else {
 256					bus_cur = find_bus_wprev (curr->bus_num, &bus_prev, 1);
 257					if (bus_cur) {
 258						/* found our bus */
 259						rc = alloc_bus_range (&bus_cur, &newrange, curr, PFMEM, 0);
 260						if (rc)
 261							return rc;
 262					} else {
 263						/* went through all the buses and didn't find ours, need to create a new bus node */
 264						if ((rc = alloc_bus_range (&newbus, &newrange, curr, PFMEM, 1)))
 
 265							return rc;
 266						list_add_tail (&newbus->bus_list, &gbuses);
 267						debug ("1st Bus, PFMemory Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 268					}
 269				}
 270			} else if ((curr->rsrc_type & RESTYPE) == IOMASK) {
 271				/* IO */
 272				if (list_empty (&gbuses)) {
 273					/* no bus structure exists in place yet */
 274					if ((rc = alloc_bus_range (&newbus, &newrange, curr, IO, 1)))
 
 275						return rc;
 276					list_add_tail (&newbus->bus_list, &gbuses);
 277					debug ("gbuses = NULL, IO Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 278				} else {
 279					bus_cur = find_bus_wprev (curr->bus_num, &bus_prev, 1);
 280					if (bus_cur) {
 281						rc = alloc_bus_range (&bus_cur, &newrange, curr, IO, 0);
 282						if (rc)
 283							return rc;
 284					} else {
 285						/* went through all the buses and didn't find ours, need to create a new bus node */
 286						if ((rc = alloc_bus_range (&newbus, &newrange, curr, IO, 1)))
 
 287							return rc;
 288						list_add_tail (&newbus->bus_list, &gbuses);
 289						debug ("1st Bus, IO Primary Bus %x [%x - %x]\n", newbus->busno, newrange->start, newrange->end);
 290					}
 291				}
 292
 293			} else {
 294				;	/* type is reserved  WHAT TO DO IN THIS CASE???
 295					   NOTHING TO DO??? */
 296			}
 297		} else {
 298			/* regular pci device resource */
 299			if ((curr->rsrc_type & RESTYPE) == MMASK) {
 300				/* Memory resource */
 301				new_mem = alloc_resources (curr);
 302				if (!new_mem)
 303					return -ENOMEM;
 304				new_mem->type = MEM;
 305				/*
 306				 * if it didn't find the bus, means PCI dev
 307				 * came b4 the Primary Bus info, so need to
 308				 * create a bus rangeno becomes a problem...
 309				 * assign a -1 and then update once the range
 310				 * actually appears...
 311				 */
 312				if (ibmphp_add_resource (new_mem) < 0) {
 313					newbus = alloc_error_bus (curr, 0, 0);
 314					if (!newbus)
 315						return -ENOMEM;
 316					newbus->firstMem = new_mem;
 317					++newbus->needMemUpdate;
 318					new_mem->rangeno = -1;
 319				}
 320				debug ("Memory resource for device %x, bus %x, [%x - %x]\n", new_mem->devfunc, new_mem->busno, new_mem->start, new_mem->end);
 321
 322			} else if ((curr->rsrc_type & RESTYPE) == PFMASK) {
 323				/* PFMemory resource */
 324				new_pfmem = alloc_resources (curr);
 325				if (!new_pfmem)
 326					return -ENOMEM;
 327				new_pfmem->type = PFMEM;
 328				new_pfmem->fromMem = 0;
 329				if (ibmphp_add_resource (new_pfmem) < 0) {
 330					newbus = alloc_error_bus (curr, 0, 0);
 331					if (!newbus)
 332						return -ENOMEM;
 333					newbus->firstPFMem = new_pfmem;
 334					++newbus->needPFMemUpdate;
 335					new_pfmem->rangeno = -1;
 336				}
 337
 338				debug ("PFMemory resource for device %x, bus %x, [%x - %x]\n", new_pfmem->devfunc, new_pfmem->busno, new_pfmem->start, new_pfmem->end);
 339			} else if ((curr->rsrc_type & RESTYPE) == IOMASK) {
 340				/* IO resource */
 341				new_io = alloc_resources (curr);
 342				if (!new_io)
 343					return -ENOMEM;
 344				new_io->type = IO;
 345
 346				/*
 347				 * if it didn't find the bus, means PCI dev
 348				 * came b4 the Primary Bus info, so need to
 349				 * create a bus rangeno becomes a problem...
 350				 * Can assign a -1 and then update once the
 351				 * range actually appears...
 352				 */
 353				if (ibmphp_add_resource (new_io) < 0) {
 354					newbus = alloc_error_bus (curr, 0, 0);
 355					if (!newbus)
 356						return -ENOMEM;
 357					newbus->firstIO = new_io;
 358					++newbus->needIOUpdate;
 359					new_io->rangeno = -1;
 360				}
 361				debug ("IO resource for device %x, bus %x, [%x - %x]\n", new_io->devfunc, new_io->busno, new_io->start, new_io->end);
 362			}
 363		}
 364	}
 365
 366	list_for_each (tmp, &gbuses) {
 367		bus_cur = list_entry (tmp, struct bus_node, bus_list);
 368		/* This is to get info about PPB resources, since EBDA doesn't put this info into the primary bus info */
 369		rc = update_bridge_ranges (&bus_cur);
 370		if (rc)
 371			return rc;
 372	}
 373	rc = once_over ();  /* This is to align ranges (so no -1) */
 374	if (rc)
 375		return rc;
 376	return 0;
 377}
 378
 379/********************************************************************************
 380 * This function adds a range into a sorted list of ranges per bus for a particular
 381 * range type, it then calls another routine to update the range numbers on the
 382 * pci devices' resources for the appropriate resource
 383 *
 384 * Input: type of the resource, range to add, current bus
 385 * Output: 0 or -1, bus and range ptrs 
 386 ********************************************************************************/
 387static int add_bus_range (int type, struct range_node *range, struct bus_node *bus_cur)
 388{
 389	struct range_node *range_cur = NULL;
 390	struct range_node *range_prev;
 391	int count = 0, i_init;
 392	int noRanges = 0;
 393
 394	switch (type) {
 395		case MEM:
 396			range_cur = bus_cur->rangeMem;
 397			noRanges = bus_cur->noMemRanges;
 398			break;
 399		case PFMEM:
 400			range_cur = bus_cur->rangePFMem;
 401			noRanges = bus_cur->noPFMemRanges;
 402			break;
 403		case IO:
 404			range_cur = bus_cur->rangeIO;
 405			noRanges = bus_cur->noIORanges;
 406			break;
 407	}
 408
 409	range_prev = NULL;
 410	while (range_cur) {
 411		if (range->start < range_cur->start)
 412			break;
 413		range_prev = range_cur;
 414		range_cur = range_cur->next;
 415		count = count + 1;
 416	}
 417	if (!count) {
 418		/* our range will go at the beginning of the list */
 419		switch (type) {
 420			case MEM:
 421				bus_cur->rangeMem = range;
 422				break;
 423			case PFMEM:
 424				bus_cur->rangePFMem = range;
 425				break;
 426			case IO:
 427				bus_cur->rangeIO = range;
 428				break;
 429		}
 430		range->next = range_cur;
 431		range->rangeno = 1;
 432		i_init = 0;
 433	} else if (!range_cur) {
 434		/* our range will go at the end of the list */
 435		range->next = NULL;
 436		range_prev->next = range;
 437		range->rangeno = range_prev->rangeno + 1;
 438		return 0;
 439	} else {
 440		/* the range is in the middle */
 441		range_prev->next = range;
 442		range->next = range_cur;
 443		range->rangeno = range_cur->rangeno;
 444		i_init = range_prev->rangeno;
 445	}
 446
 447	for (count = i_init; count < noRanges; ++count) {
 448		++range_cur->rangeno;
 449		range_cur = range_cur->next;
 450	}
 451
 452	update_resources (bus_cur, type, i_init + 1);
 453	return 0;
 454}
 455
 456/*******************************************************************************
 457 * This routine goes through the list of resources of type 'type' and updates
 458 * the range numbers that they correspond to.  It was called from add_bus_range fnc
 459 *
 460 * Input: bus, type of the resource, the rangeno starting from which to update
 461 ******************************************************************************/
 462static void update_resources (struct bus_node *bus_cur, int type, int rangeno)
 463{
 464	struct resource_node *res = NULL;
 465	u8 eol = 0;	/* end of list indicator */
 466
 467	switch (type) {
 468		case MEM:
 469			if (bus_cur->firstMem) 
 470				res = bus_cur->firstMem;
 471			break;
 472		case PFMEM:
 473			if (bus_cur->firstPFMem)
 474				res = bus_cur->firstPFMem;
 475			break;
 476		case IO:
 477			if (bus_cur->firstIO)
 478				res = bus_cur->firstIO;
 479			break;
 480	}
 481
 482	if (res) {
 483		while (res) {
 484			if (res->rangeno == rangeno)
 485				break;
 486			if (res->next)
 487				res = res->next;
 488			else if (res->nextRange)
 489				res = res->nextRange;
 490			else {
 491				eol = 1;
 492				break;
 493			}
 494		}
 495
 496		if (!eol) {
 497			/* found the range */
 498			while (res) {
 499				++res->rangeno;
 500				res = res->next;
 501			}
 502		}
 503	}
 504}
 505
 506static void fix_me (struct resource_node *res, struct bus_node *bus_cur, struct range_node *range)
 507{
 508	char * str = "";
 509	switch (res->type) {
 510		case IO:
 511			str = "io";
 512			break;
 513		case MEM:
 514			str = "mem";
 515			break;
 516		case PFMEM:
 517			str = "pfmem";
 518			break;
 519	}
 520
 521	while (res) {
 522		if (res->rangeno == -1) {
 523			while (range) {
 524				if ((res->start >= range->start) && (res->end <= range->end)) {
 525					res->rangeno = range->rangeno;
 526					debug ("%s->rangeno in fix_resources is %d\n", str, res->rangeno);
 527					switch (res->type) {
 528						case IO:
 529							--bus_cur->needIOUpdate;
 530							break;
 531						case MEM:
 532							--bus_cur->needMemUpdate;
 533							break;
 534						case PFMEM:
 535							--bus_cur->needPFMemUpdate;
 536							break;
 537					}
 538					break;
 539				}
 540				range = range->next;
 541			}
 542		}
 543		if (res->next)
 544			res = res->next;
 545		else
 546			res = res->nextRange;
 547	}
 548
 549}
 550
 551/*****************************************************************************
 552 * This routine reassigns the range numbers to the resources that had a -1
 553 * This case can happen only if upon initialization, resources taken by pci dev
 554 * appear in EBDA before the resources allocated for that bus, since we don't
 555 * know the range, we assign -1, and this routine is called after a new range
 556 * is assigned to see the resources with unknown range belong to the added range
 557 *
 558 * Input: current bus
 559 * Output: none, list of resources for that bus are fixed if can be
 560 *******************************************************************************/
 561static void fix_resources (struct bus_node *bus_cur)
 562{
 563	struct range_node *range;
 564	struct resource_node *res;
 565
 566	debug ("%s - bus_cur->busno = %d\n", __func__, bus_cur->busno);
 567
 568	if (bus_cur->needIOUpdate) {
 569		res = bus_cur->firstIO;
 570		range = bus_cur->rangeIO;
 571		fix_me (res, bus_cur, range);
 572	}
 573	if (bus_cur->needMemUpdate) {
 574		res = bus_cur->firstMem;
 575		range = bus_cur->rangeMem;
 576		fix_me (res, bus_cur, range);
 577	}
 578	if (bus_cur->needPFMemUpdate) {
 579		res = bus_cur->firstPFMem;
 580		range = bus_cur->rangePFMem;
 581		fix_me (res, bus_cur, range);
 582	}
 583}
 584
 585/*******************************************************************************
 586 * This routine adds a resource to the list of resources to the appropriate bus 
 587 * based on their resource type and sorted by their starting addresses.  It assigns
 588 * the ptrs to next and nextRange if needed.
 589 *
 590 * Input: resource ptr
 591 * Output: ptrs assigned (to the node)
 592 * 0 or -1
 593 *******************************************************************************/
 594int ibmphp_add_resource (struct resource_node *res)
 595{
 596	struct resource_node *res_cur;
 597	struct resource_node *res_prev;
 598	struct bus_node *bus_cur;
 599	struct range_node *range_cur = NULL;
 600	struct resource_node *res_start = NULL;
 601
 602	debug ("%s - enter\n", __func__);
 603
 604	if (!res) {
 605		err ("NULL passed to add\n");
 606		return -ENODEV;
 607	}
 608	
 609	bus_cur = find_bus_wprev (res->busno, NULL, 0);
 610	
 611	if (!bus_cur) {
 612		/* didn't find a bus, smth's wrong!!! */
 613		debug ("no bus in the system, either pci_dev's wrong or allocation failed\n");
 614		return -ENODEV;
 615	}
 616
 617	/* Normal case */
 618	switch (res->type) {
 619		case IO:
 620			range_cur = bus_cur->rangeIO;
 621			res_start = bus_cur->firstIO;
 622			break;
 623		case MEM:
 624			range_cur = bus_cur->rangeMem;
 625			res_start = bus_cur->firstMem;
 626			break;
 627		case PFMEM:
 628			range_cur = bus_cur->rangePFMem;
 629			res_start = bus_cur->firstPFMem;
 630			break;
 631		default:
 632			err ("cannot read the type of the resource to add... problem\n");
 633			return -EINVAL;
 634	}
 635	while (range_cur) {
 636		if ((res->start >= range_cur->start) && (res->end <= range_cur->end)) {
 637			res->rangeno = range_cur->rangeno;
 638			break;
 639		}
 640		range_cur = range_cur->next;
 641	}
 642
 643	/* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
 644	 * this is again the case of rangeno = -1
 645	 * !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
 646	 */
 647
 648	if (!range_cur) {
 649		switch (res->type) {
 650			case IO:
 651				++bus_cur->needIOUpdate;					
 652				break;
 653			case MEM:
 654				++bus_cur->needMemUpdate;
 655				break;
 656			case PFMEM:
 657				++bus_cur->needPFMemUpdate;
 658				break;
 659		}
 660		res->rangeno = -1;
 661	}
 662	
 663	debug ("The range is %d\n", res->rangeno);
 664	if (!res_start) {
 665		/* no first{IO,Mem,Pfmem} on the bus, 1st IO/Mem/Pfmem resource ever */
 666		switch (res->type) {
 667			case IO:
 668				bus_cur->firstIO = res;					
 669				break;
 670			case MEM:
 671				bus_cur->firstMem = res;
 672				break;
 673			case PFMEM:
 674				bus_cur->firstPFMem = res;
 675				break;
 676		}	
 677		res->next = NULL;
 678		res->nextRange = NULL;
 679	} else {
 680		res_cur = res_start;
 681		res_prev = NULL;
 682
 683		debug ("res_cur->rangeno is %d\n", res_cur->rangeno);
 684
 685		while (res_cur) {
 686			if (res_cur->rangeno >= res->rangeno)
 687				break;
 688			res_prev = res_cur;
 689			if (res_cur->next)
 690				res_cur = res_cur->next;
 691			else
 692				res_cur = res_cur->nextRange;
 693		}
 694
 695		if (!res_cur) {
 696			/* at the end of the resource list */
 697			debug ("i should be here, [%x - %x]\n", res->start, res->end);
 698			res_prev->nextRange = res;
 699			res->next = NULL;
 700			res->nextRange = NULL;
 701		} else if (res_cur->rangeno == res->rangeno) {
 702			/* in the same range */
 703			while (res_cur) {
 704				if (res->start < res_cur->start)
 705					break;
 706				res_prev = res_cur;
 707				res_cur = res_cur->next;
 708			}
 709			if (!res_cur) {
 710				/* the last resource in this range */
 711				res_prev->next = res;
 712				res->next = NULL;
 713				res->nextRange = res_prev->nextRange;
 714				res_prev->nextRange = NULL;
 715			} else if (res->start < res_cur->start) {
 716				/* at the beginning or middle of the range */
 717				if (!res_prev)	{
 718					switch (res->type) {
 719						case IO:
 720							bus_cur->firstIO = res;
 721							break;
 722						case MEM:
 723							bus_cur->firstMem = res;
 724							break;
 725						case PFMEM:
 726							bus_cur->firstPFMem = res;
 727							break;
 728					}
 729				} else if (res_prev->rangeno == res_cur->rangeno)
 730					res_prev->next = res;
 731				else
 732					res_prev->nextRange = res;
 733
 734				res->next = res_cur;
 735				res->nextRange = NULL;
 736			}
 737		} else {
 738			/* this is the case where it is 1st occurrence of the range */
 739			if (!res_prev) {
 740				/* at the beginning of the resource list */
 741				res->next = NULL;
 742				switch (res->type) {
 743					case IO:
 744						res->nextRange = bus_cur->firstIO;
 745						bus_cur->firstIO = res;
 746						break;
 747					case MEM:
 748						res->nextRange = bus_cur->firstMem;
 749						bus_cur->firstMem = res;
 750						break;
 751					case PFMEM:
 752						res->nextRange = bus_cur->firstPFMem;
 753						bus_cur->firstPFMem = res;
 754						break;
 755				}
 756			} else if (res_cur->rangeno > res->rangeno) {
 757				/* in the middle of the resource list */
 758				res_prev->nextRange = res;
 759				res->next = NULL;
 760				res->nextRange = res_cur;
 761			}
 762		}
 763	}
 764
 765	debug ("%s - exit\n", __func__);
 766	return 0;
 767}
 768
 769/****************************************************************************
 770 * This routine will remove the resource from the list of resources
 771 *
 772 * Input: io, mem, and/or pfmem resource to be deleted
 773 * Ouput: modified resource list
 774 *        0 or error code
 775 ****************************************************************************/
 776int ibmphp_remove_resource (struct resource_node *res)
 777{
 778	struct bus_node *bus_cur;
 779	struct resource_node *res_cur = NULL;
 780	struct resource_node *res_prev;
 781	struct resource_node *mem_cur;
 782	char * type = "";
 783
 784	if (!res)  {
 785		err ("resource to remove is NULL\n");
 786		return -ENODEV;
 787	}
 788
 789	bus_cur = find_bus_wprev (res->busno, NULL, 0);
 790
 791	if (!bus_cur) {
 792		err ("cannot find corresponding bus of the io resource to remove  "
 793			"bailing out...\n");
 794		return -ENODEV;
 795	}
 796
 797	switch (res->type) {
 798		case IO:
 799			res_cur = bus_cur->firstIO;
 800			type = "io";
 801			break;
 802		case MEM:
 803			res_cur = bus_cur->firstMem;
 804			type = "mem";
 805			break;
 806		case PFMEM:
 807			res_cur = bus_cur->firstPFMem;
 808			type = "pfmem";
 809			break;
 810		default:
 811			err ("unknown type for resource to remove\n");
 812			return -EINVAL;
 813	}
 814	res_prev = NULL;
 815
 816	while (res_cur) {
 817		if ((res_cur->start == res->start) && (res_cur->end == res->end))
 818			break;
 819		res_prev = res_cur;
 820		if (res_cur->next)
 821			res_cur = res_cur->next;
 822		else
 823			res_cur = res_cur->nextRange;
 824	}
 825
 826	if (!res_cur) {
 827		if (res->type == PFMEM) {
 828			/* 
 829			 * case where pfmem might be in the PFMemFromMem list
 830			 * so will also need to remove the corresponding mem
 831			 * entry
 832			 */
 833			res_cur = bus_cur->firstPFMemFromMem;
 834			res_prev = NULL;
 835
 836			while (res_cur) {
 837				if ((res_cur->start == res->start) && (res_cur->end == res->end)) {
 838					mem_cur = bus_cur->firstMem;
 839					while (mem_cur) {
 840						if ((mem_cur->start == res_cur->start)
 841						    && (mem_cur->end == res_cur->end))
 842							break;
 843						if (mem_cur->next)
 844							mem_cur = mem_cur->next;
 845						else
 846							mem_cur = mem_cur->nextRange;
 847					}
 848					if (!mem_cur) {
 849						err ("cannot find corresponding mem node for pfmem...\n");
 850						return -EINVAL;
 851					}
 852
 853					ibmphp_remove_resource (mem_cur);
 854					if (!res_prev)
 855						bus_cur->firstPFMemFromMem = res_cur->next;
 856					else
 857						res_prev->next = res_cur->next;
 858					kfree (res_cur);
 859					return 0;
 860				}
 861				res_prev = res_cur;
 862				if (res_cur->next)
 863					res_cur = res_cur->next;
 864				else
 865					res_cur = res_cur->nextRange;
 866			}
 867			if (!res_cur) {
 868				err ("cannot find pfmem to delete...\n");
 869				return -EINVAL;
 870			}
 871		} else {
 872			err ("the %s resource is not in the list to be deleted...\n", type);
 873			return -EINVAL;
 874		}
 875	}
 876	if (!res_prev) {
 877		/* first device to be deleted */
 878		if (res_cur->next) {
 879			switch (res->type) {
 880				case IO:
 881					bus_cur->firstIO = res_cur->next;
 882					break;
 883				case MEM:
 884					bus_cur->firstMem = res_cur->next;
 885					break;
 886				case PFMEM:
 887					bus_cur->firstPFMem = res_cur->next;
 888					break;
 889			}
 890		} else if (res_cur->nextRange) {
 891			switch (res->type) {
 892				case IO:
 893					bus_cur->firstIO = res_cur->nextRange;
 894					break;
 895				case MEM:
 896					bus_cur->firstMem = res_cur->nextRange;
 897					break;
 898				case PFMEM:
 899					bus_cur->firstPFMem = res_cur->nextRange;
 900					break;
 901			}
 902		} else {
 903			switch (res->type) {
 904				case IO:
 905					bus_cur->firstIO = NULL;
 906					break;
 907				case MEM:
 908					bus_cur->firstMem = NULL;
 909					break;
 910				case PFMEM:
 911					bus_cur->firstPFMem = NULL;
 912					break;
 913			}
 914		}
 915		kfree (res_cur);
 916		return 0;
 917	} else {
 918		if (res_cur->next) {
 919			if (res_prev->rangeno == res_cur->rangeno)
 920				res_prev->next = res_cur->next;
 921			else
 922				res_prev->nextRange = res_cur->next;
 923		} else if (res_cur->nextRange) {
 924			res_prev->next = NULL;
 925			res_prev->nextRange = res_cur->nextRange;
 926		} else {
 927			res_prev->next = NULL;
 928			res_prev->nextRange = NULL;
 929		}
 930		kfree (res_cur);
 931		return 0;
 932	}
 933
 934	return 0;
 935}
 936
 937static struct range_node * find_range (struct bus_node *bus_cur, struct resource_node * res)
 938{
 939	struct range_node * range = NULL;
 940
 941	switch (res->type) {
 942		case IO:
 943			range = bus_cur->rangeIO;
 944			break;
 945		case MEM:
 946			range = bus_cur->rangeMem;
 947			break;
 948		case PFMEM:
 949			range = bus_cur->rangePFMem;
 950			break;
 951		default:
 952			err ("cannot read resource type in find_range\n");
 953	}
 954
 955	while (range) {
 956		if (res->rangeno == range->rangeno)
 957			break;
 958		range = range->next;
 959	}
 960	return range;
 961}
 962
 963/*****************************************************************************
 964 * This routine will check to make sure the io/mem/pfmem->len that the device asked for 
 965 * can fit w/i our list of available IO/MEM/PFMEM resources.  If cannot, returns -EINVAL,
 966 * otherwise, returns 0
 967 *
 968 * Input: resource
 969 * Ouput: the correct start and end address are inputted into the resource node,
 970 *        0 or -EINVAL
 971 *****************************************************************************/
 972int ibmphp_check_resource (struct resource_node *res, u8 bridge)
 973{
 974	struct bus_node *bus_cur;
 975	struct range_node *range = NULL;
 976	struct resource_node *res_prev;
 977	struct resource_node *res_cur = NULL;
 978	u32 len_cur = 0, start_cur = 0, len_tmp = 0;
 979	int noranges = 0;
 980	u32 tmp_start;		/* this is to make sure start address is divisible by the length needed */
 981	u32 tmp_divide;
 982	u8 flag = 0;
 983
 984	if (!res)
 985		return -EINVAL;
 986
 987	if (bridge) {
 988		/* The rules for bridges are different, 4K divisible for IO, 1M for (pf)mem*/
 989		if (res->type == IO)
 990			tmp_divide = IOBRIDGE;
 991		else
 992			tmp_divide = MEMBRIDGE;
 993	} else
 994		tmp_divide = res->len;
 995
 996	bus_cur = find_bus_wprev (res->busno, NULL, 0);
 997
 998	if (!bus_cur) {
 999		/* didn't find a bus, smth's wrong!!! */
1000		debug ("no bus in the system, either pci_dev's wrong or allocation failed\n");
1001		return -EINVAL;
1002	}
1003
1004	debug ("%s - enter\n", __func__);
1005	debug ("bus_cur->busno is %d\n", bus_cur->busno);
1006
1007	/* This is a quick fix to not mess up with the code very much.  i.e.,
1008	 * 2000-2fff, len = 1000, but when we compare, we need it to be fff */
1009	res->len -= 1;
1010
1011	switch (res->type) {
1012		case IO:
1013			res_cur = bus_cur->firstIO;
1014			noranges = bus_cur->noIORanges;
1015			break;
1016		case MEM:
1017			res_cur = bus_cur->firstMem;
1018			noranges = bus_cur->noMemRanges;
1019			break;
1020		case PFMEM:
1021			res_cur = bus_cur->firstPFMem;
1022			noranges = bus_cur->noPFMemRanges;
1023			break;
1024		default:
1025			err ("wrong type of resource to check\n");
1026			return -EINVAL;
1027	}
1028	res_prev = NULL;
1029
1030	while (res_cur) {
1031		range = find_range (bus_cur, res_cur);
1032		debug ("%s - rangeno = %d\n", __func__, res_cur->rangeno);
1033
1034		if (!range) {
1035			err ("no range for the device exists... bailing out...\n");
1036			return -EINVAL;
1037		}
1038
1039		/* found our range */
1040		if (!res_prev) {
1041			/* first time in the loop */
1042			if ((res_cur->start != range->start) && ((len_tmp = res_cur->start - 1 - range->start) >= res->len)) {
1043				debug ("len_tmp = %x\n", len_tmp);
 
 
1044
1045				if ((len_tmp < len_cur) || (len_cur == 0)) {
1046
1047					if ((range->start % tmp_divide) == 0) {
1048						/* just perfect, starting address is divisible by length */
1049						flag = 1;
1050						len_cur = len_tmp;
1051						start_cur = range->start;
1052					} else {
1053						/* Needs adjusting */
1054						tmp_start = range->start;
1055						flag = 0;
1056
1057						while ((len_tmp = res_cur->start - 1 - tmp_start) >= res->len) {
1058							if ((tmp_start % tmp_divide) == 0) {
1059								flag = 1;
1060								len_cur = len_tmp;
1061								start_cur = tmp_start;
1062								break;
1063							}
1064							tmp_start += tmp_divide - tmp_start % tmp_divide;
1065							if (tmp_start >= res_cur->start - 1)
1066								break;
1067						}
1068					}
1069			
1070					if (flag && len_cur == res->len) {
1071						debug ("but we are not here, right?\n");
1072						res->start = start_cur;
1073						res->len += 1; /* To restore the balance */
1074						res->end = res->start + res->len - 1;
1075						return 0;
1076					}
1077				}
1078			}
1079		}
1080		if (!res_cur->next) {
1081			/* last device on the range */
1082			if ((range->end != res_cur->end) && ((len_tmp = range->end - (res_cur->end + 1)) >= res->len)) {
1083				debug ("len_tmp = %x\n", len_tmp);
 
 
1084				if ((len_tmp < len_cur) || (len_cur == 0)) {
1085
1086					if (((res_cur->end + 1) % tmp_divide) == 0) {
1087						/* just perfect, starting address is divisible by length */
1088						flag = 1;
1089						len_cur = len_tmp;
1090						start_cur = res_cur->end + 1;
1091					} else {
1092						/* Needs adjusting */
1093						tmp_start = res_cur->end + 1;
1094						flag = 0;
1095
1096						while ((len_tmp = range->end - tmp_start) >= res->len) {
1097							if ((tmp_start % tmp_divide) == 0) {
1098								flag = 1;
1099								len_cur = len_tmp;
1100								start_cur = tmp_start;
1101								break;
1102							}
1103							tmp_start += tmp_divide - tmp_start % tmp_divide;
1104							if (tmp_start >= range->end)
1105								break;
1106						}
1107					}
1108					if (flag && len_cur == res->len) {
1109						res->start = start_cur;
1110						res->len += 1; /* To restore the balance */
1111						res->end = res->start + res->len - 1;
1112						return 0;
1113					}
1114				}
1115			}
1116		}
1117
1118		if (res_prev) {
1119			if (res_prev->rangeno != res_cur->rangeno) {
1120				/* 1st device on this range */
1121				if ((res_cur->start != range->start) && 
1122					((len_tmp = res_cur->start - 1 - range->start) >= res->len)) {
 
1123					if ((len_tmp < len_cur) || (len_cur == 0)) {
1124						if ((range->start % tmp_divide) == 0) {	
1125							/* just perfect, starting address is divisible by length */
1126							flag = 1;
1127							len_cur = len_tmp;
1128							start_cur = range->start;
1129						} else {
1130							/* Needs adjusting */
1131							tmp_start = range->start;
1132							flag = 0;
1133
1134							while ((len_tmp = res_cur->start - 1 - tmp_start) >= res->len) {
1135								if ((tmp_start % tmp_divide) == 0) {
1136									flag = 1;
1137									len_cur = len_tmp;
1138									start_cur = tmp_start;
1139									break;
1140								}
1141								tmp_start += tmp_divide - tmp_start % tmp_divide;
1142								if (tmp_start >= res_cur->start - 1)
1143									break;
1144							}
1145						}
1146
1147						if (flag && len_cur == res->len) {
1148							res->start = start_cur;
1149							res->len += 1; /* To restore the balance */
1150							res->end = res->start + res->len - 1;
1151							return 0;
1152						}
1153					}
1154				}
1155			} else {
1156				/* in the same range */
1157				if ((len_tmp = res_cur->start - 1 - res_prev->end - 1) >= res->len) {
 
 
1158					if ((len_tmp < len_cur) || (len_cur == 0)) {
1159						if (((res_prev->end + 1) % tmp_divide) == 0) {
1160							/* just perfect, starting address's divisible by length */
1161							flag = 1;
1162							len_cur = len_tmp;
1163							start_cur = res_prev->end + 1;
1164						} else {
1165							/* Needs adjusting */
1166							tmp_start = res_prev->end + 1;
1167							flag = 0;
1168
1169							while ((len_tmp = res_cur->start - 1 - tmp_start) >= res->len) {
1170								if ((tmp_start % tmp_divide) == 0) {
1171									flag = 1;
1172									len_cur = len_tmp;
1173									start_cur = tmp_start;
1174									break;
1175								}
1176								tmp_start += tmp_divide - tmp_start % tmp_divide;
1177								if (tmp_start >= res_cur->start - 1)
1178									break;
1179							}
1180						}
1181
1182						if (flag && len_cur == res->len) {
1183							res->start = start_cur;
1184							res->len += 1; /* To restore the balance */
1185							res->end = res->start + res->len - 1;
1186							return 0;
1187						}
1188					}
1189				}
1190			}
1191		}
1192		/* end if (res_prev) */
1193		res_prev = res_cur;
1194		if (res_cur->next)
1195			res_cur = res_cur->next;
1196		else
1197			res_cur = res_cur->nextRange;
1198	}	/* end of while */
1199
1200
1201	if (!res_prev) {
1202		/* 1st device ever */
1203		/* need to find appropriate range */
1204		switch (res->type) {
1205			case IO:
1206				range = bus_cur->rangeIO;
1207				break;
1208			case MEM:
1209				range = bus_cur->rangeMem;
1210				break;
1211			case PFMEM:
1212				range = bus_cur->rangePFMem;
1213				break;
1214		}
1215		while (range) {
1216			if ((len_tmp = range->end - range->start) >= res->len) {
 
 
1217				if ((len_tmp < len_cur) || (len_cur == 0)) {
1218					if ((range->start % tmp_divide) == 0) {
1219						/* just perfect, starting address's divisible by length */
1220						flag = 1;
1221						len_cur = len_tmp;
1222						start_cur = range->start;
1223					} else {
1224						/* Needs adjusting */
1225						tmp_start = range->start;
1226						flag = 0;
1227
1228						while ((len_tmp = range->end - tmp_start) >= res->len) {
1229							if ((tmp_start % tmp_divide) == 0) {
1230								flag = 1;
1231								len_cur = len_tmp;
1232								start_cur = tmp_start;
1233								break;
1234							}
1235							tmp_start += tmp_divide - tmp_start % tmp_divide;
1236							if (tmp_start >= range->end)
1237								break;
1238						}
1239					}
1240
1241					if (flag && len_cur == res->len) {
1242						res->start = start_cur;
1243						res->len += 1; /* To restore the balance */
1244						res->end = res->start + res->len - 1;
1245						return 0;
1246					}
1247				}
1248			}
1249			range = range->next;
1250		}		/* end of while */
1251
1252		if ((!range) && (len_cur == 0)) {
1253			/* have gone through the list of devices and ranges and haven't found n.e.thing */
1254			err ("no appropriate range.. bailing out...\n");
1255			return -EINVAL;
1256		} else if (len_cur) {
1257			res->start = start_cur;
1258			res->len += 1; /* To restore the balance */
1259			res->end = res->start + res->len - 1;
1260			return 0;
1261		}
1262	}
1263
1264	if (!res_cur) {
1265		debug ("prev->rangeno = %d, noranges = %d\n", res_prev->rangeno, noranges);
1266		if (res_prev->rangeno < noranges) {
1267			/* if there're more ranges out there to check */
1268			switch (res->type) {
1269				case IO:
1270					range = bus_cur->rangeIO;
1271					break;
1272				case MEM:
1273					range = bus_cur->rangeMem;
1274					break;
1275				case PFMEM:
1276					range = bus_cur->rangePFMem;
1277					break;
1278			}
1279			while (range) {
1280				if ((len_tmp = range->end - range->start) >= res->len) {
 
 
1281					if ((len_tmp < len_cur) || (len_cur == 0)) {
1282						if ((range->start % tmp_divide) == 0) {
1283							/* just perfect, starting address's divisible by length */
1284							flag = 1;
1285							len_cur = len_tmp;
1286							start_cur = range->start;
1287						} else {
1288							/* Needs adjusting */
1289							tmp_start = range->start;
1290							flag = 0;
1291
1292							while ((len_tmp = range->end - tmp_start) >= res->len) {
1293								if ((tmp_start % tmp_divide) == 0) {
1294									flag = 1;
1295									len_cur = len_tmp;
1296									start_cur = tmp_start;
1297									break;
1298								}
1299								tmp_start += tmp_divide - tmp_start % tmp_divide;
1300								if (tmp_start >= range->end)
1301									break;
1302							}
1303						}
1304
1305						if (flag && len_cur == res->len) {
1306							res->start = start_cur;
1307							res->len += 1; /* To restore the balance */
1308							res->end = res->start + res->len - 1;
1309							return 0;
1310						}
1311					}
1312				}
1313				range = range->next;
1314			}	/* end of while */
1315
1316			if ((!range) && (len_cur == 0)) {
1317				/* have gone through the list of devices and ranges and haven't found n.e.thing */
1318				err ("no appropriate range.. bailing out...\n");
1319				return -EINVAL;
1320			} else if (len_cur) {
1321				res->start = start_cur;
1322				res->len += 1; /* To restore the balance */
1323				res->end = res->start + res->len - 1;
1324				return 0;
1325			}
1326		} else {
1327			/* no more ranges to check on */
1328			if (len_cur) {
1329				res->start = start_cur;
1330				res->len += 1; /* To restore the balance */
1331				res->end = res->start + res->len - 1;
1332				return 0;
1333			} else {
1334				/* have gone through the list of devices and haven't found n.e.thing */
1335				err ("no appropriate range.. bailing out...\n");
1336				return -EINVAL;
1337			}
1338		}
1339	}	/* end if(!res_cur) */
1340	return -EINVAL;
1341}
1342
1343/********************************************************************************
1344 * This routine is called from remove_card if the card contained PPB.
1345 * It will remove all the resources on the bus as well as the bus itself
1346 * Input: Bus
1347 * Ouput: 0, -ENODEV
1348 ********************************************************************************/
1349int ibmphp_remove_bus (struct bus_node *bus, u8 parent_busno)
1350{
1351	struct resource_node *res_cur;
1352	struct resource_node *res_tmp;
1353	struct bus_node *prev_bus;
1354	int rc;
1355
1356	prev_bus = find_bus_wprev (parent_busno, NULL, 0);	
1357
1358	if (!prev_bus) {
1359		debug ("something terribly wrong. Cannot find parent bus to the one to remove\n");
1360		return -ENODEV;
1361	}
1362
1363	debug ("In ibmphp_remove_bus... prev_bus->busno is %x\n", prev_bus->busno);
1364
1365	rc = remove_ranges (bus, prev_bus);
1366	if (rc)
1367		return rc;
1368
1369	if (bus->firstIO) {
1370		res_cur = bus->firstIO;
1371		while (res_cur) {
1372			res_tmp = res_cur;
1373			if (res_cur->next)
1374				res_cur = res_cur->next;
1375			else
1376				res_cur = res_cur->nextRange;
1377			kfree (res_tmp);
1378			res_tmp = NULL;
1379		}
1380		bus->firstIO = NULL;
1381	}
1382	if (bus->firstMem) {
1383		res_cur = bus->firstMem;
1384		while (res_cur) {
1385			res_tmp = res_cur;
1386			if (res_cur->next)
1387				res_cur = res_cur->next;
1388			else
1389				res_cur = res_cur->nextRange;
1390			kfree (res_tmp);
1391			res_tmp = NULL;
1392		}
1393		bus->firstMem = NULL;
1394	}
1395	if (bus->firstPFMem) {
1396		res_cur = bus->firstPFMem;
1397		while (res_cur) {
1398			res_tmp = res_cur;
1399			if (res_cur->next)
1400				res_cur = res_cur->next;
1401			else
1402				res_cur = res_cur->nextRange;
1403			kfree (res_tmp);
1404			res_tmp = NULL;
1405		}
1406		bus->firstPFMem = NULL;
1407	}
1408
1409	if (bus->firstPFMemFromMem) {
1410		res_cur = bus->firstPFMemFromMem;
1411		while (res_cur) {
1412			res_tmp = res_cur;
1413			res_cur = res_cur->next;
1414
1415			kfree (res_tmp);
1416			res_tmp = NULL;
1417		}
1418		bus->firstPFMemFromMem = NULL;
1419	}
1420
1421	list_del (&bus->bus_list);
1422	kfree (bus);
1423	return 0;
1424}
1425
1426/******************************************************************************
1427 * This routine deletes the ranges from a given bus, and the entries from the 
1428 * parent's bus in the resources
1429 * Input: current bus, previous bus
1430 * Output: 0, -EINVAL
1431 ******************************************************************************/
1432static int remove_ranges (struct bus_node *bus_cur, struct bus_node *bus_prev)
1433{
1434	struct range_node *range_cur;
1435	struct range_node *range_tmp;
1436	int i;
1437	struct resource_node *res = NULL;
1438
1439	if (bus_cur->noIORanges) {
1440		range_cur = bus_cur->rangeIO;
1441		for (i = 0; i < bus_cur->noIORanges; i++) {
1442			if (ibmphp_find_resource (bus_prev, range_cur->start, &res, IO) < 0)
1443				return -EINVAL;
1444			ibmphp_remove_resource (res);
1445
1446			range_tmp = range_cur;
1447			range_cur = range_cur->next;
1448			kfree (range_tmp);
1449			range_tmp = NULL;
1450		}
1451		bus_cur->rangeIO = NULL;
1452	}
1453	if (bus_cur->noMemRanges) {
1454		range_cur = bus_cur->rangeMem;
1455		for (i = 0; i < bus_cur->noMemRanges; i++) {
1456			if (ibmphp_find_resource (bus_prev, range_cur->start, &res, MEM) < 0) 
1457				return -EINVAL;
1458
1459			ibmphp_remove_resource (res);
1460			range_tmp = range_cur;
1461			range_cur = range_cur->next;
1462			kfree (range_tmp);
1463			range_tmp = NULL;
1464		}
1465		bus_cur->rangeMem = NULL;
1466	}
1467	if (bus_cur->noPFMemRanges) {
1468		range_cur = bus_cur->rangePFMem;
1469		for (i = 0; i < bus_cur->noPFMemRanges; i++) {
1470			if (ibmphp_find_resource (bus_prev, range_cur->start, &res, PFMEM) < 0) 
1471				return -EINVAL;
1472
1473			ibmphp_remove_resource (res);
1474			range_tmp = range_cur;
1475			range_cur = range_cur->next;
1476			kfree (range_tmp);
1477			range_tmp = NULL;
1478		}
1479		bus_cur->rangePFMem = NULL;
1480	}
1481	return 0;
1482}
1483
1484/*
1485 * find the resource node in the bus 
1486 * Input: Resource needed, start address of the resource, type of resource
1487 */
1488int ibmphp_find_resource (struct bus_node *bus, u32 start_address, struct resource_node **res, int flag)
1489{
1490	struct resource_node *res_cur = NULL;
1491	char * type = "";
1492
1493	if (!bus) {
1494		err ("The bus passed in NULL to find resource\n");
1495		return -ENODEV;
1496	}
1497
1498	switch (flag) {
1499		case IO:
1500			res_cur = bus->firstIO;
1501			type = "io";
1502			break;
1503		case MEM:
1504			res_cur = bus->firstMem;
1505			type = "mem";
1506			break;
1507		case PFMEM:
1508			res_cur = bus->firstPFMem;
1509			type = "pfmem";
1510			break;
1511		default:
1512			err ("wrong type of flag\n");
1513			return -EINVAL;
1514	}
1515	
1516	while (res_cur) {
1517		if (res_cur->start == start_address) {
1518			*res = res_cur;
1519			break;
1520		}
1521		if (res_cur->next)
1522			res_cur = res_cur->next;
1523		else
1524			res_cur = res_cur->nextRange;
1525	}
1526
1527	if (!res_cur) {
1528		if (flag == PFMEM) {
1529			res_cur = bus->firstPFMemFromMem;
1530			while (res_cur) {
1531				if (res_cur->start == start_address) {
1532					*res = res_cur;
1533					break;
1534				}
1535				res_cur = res_cur->next;
1536			}
1537			if (!res_cur) {
1538				debug ("SOS...cannot find %s resource in the bus.\n", type);
1539				return -EINVAL;
1540			}
1541		} else {
1542			debug ("SOS... cannot find %s resource in the bus.\n", type);
1543			return -EINVAL;
1544		}
1545	}
1546
1547	if (*res)
1548		debug ("*res->start = %x\n", (*res)->start);
1549
1550	return 0;
1551}
1552
1553/***********************************************************************
1554 * This routine will free the resource structures used by the
1555 * system.  It is called from cleanup routine for the module
1556 * Parameters: none
1557 * Returns: none
1558 ***********************************************************************/
1559void ibmphp_free_resources (void)
1560{
1561	struct bus_node *bus_cur = NULL;
1562	struct bus_node *bus_tmp;
1563	struct range_node *range_cur;
1564	struct range_node *range_tmp;
1565	struct resource_node *res_cur;
1566	struct resource_node *res_tmp;
1567	struct list_head *tmp;
1568	struct list_head *next;
1569	int i = 0;
1570	flags = 1;
1571
1572	list_for_each_safe (tmp, next, &gbuses) {
1573		bus_cur = list_entry (tmp, struct bus_node, bus_list);
1574		if (bus_cur->noIORanges) {
1575			range_cur = bus_cur->rangeIO;
1576			for (i = 0; i < bus_cur->noIORanges; i++) {
1577				if (!range_cur)
1578					break;
1579				range_tmp = range_cur;
1580				range_cur = range_cur->next;
1581				kfree (range_tmp);
1582				range_tmp = NULL;
1583			}
1584		}
1585		if (bus_cur->noMemRanges) {
1586			range_cur = bus_cur->rangeMem;
1587			for (i = 0; i < bus_cur->noMemRanges; i++) {
1588				if (!range_cur)
1589					break;
1590				range_tmp = range_cur;
1591				range_cur = range_cur->next;
1592				kfree (range_tmp);
1593				range_tmp = NULL;
1594			}
1595		}
1596		if (bus_cur->noPFMemRanges) {
1597			range_cur = bus_cur->rangePFMem;
1598			for (i = 0; i < bus_cur->noPFMemRanges; i++) {
1599				if (!range_cur)
1600					break;
1601				range_tmp = range_cur;
1602				range_cur = range_cur->next;
1603				kfree (range_tmp);
1604				range_tmp = NULL;
1605			}
1606		}
1607
1608		if (bus_cur->firstIO) {
1609			res_cur = bus_cur->firstIO;
1610			while (res_cur) {
1611				res_tmp = res_cur;
1612				if (res_cur->next)
1613					res_cur = res_cur->next;
1614				else
1615					res_cur = res_cur->nextRange;
1616				kfree (res_tmp);
1617				res_tmp = NULL;
1618			}
1619			bus_cur->firstIO = NULL;
1620		}
1621		if (bus_cur->firstMem) {
1622			res_cur = bus_cur->firstMem;
1623			while (res_cur) {
1624				res_tmp = res_cur;
1625				if (res_cur->next)
1626					res_cur = res_cur->next;
1627				else
1628					res_cur = res_cur->nextRange;
1629				kfree (res_tmp);
1630				res_tmp = NULL;
1631			}
1632			bus_cur->firstMem = NULL;
1633		}
1634		if (bus_cur->firstPFMem) {
1635			res_cur = bus_cur->firstPFMem;
1636			while (res_cur) {
1637				res_tmp = res_cur;
1638				if (res_cur->next)
1639					res_cur = res_cur->next;
1640				else
1641					res_cur = res_cur->nextRange;
1642				kfree (res_tmp);
1643				res_tmp = NULL;
1644			}
1645			bus_cur->firstPFMem = NULL;
1646		}
1647
1648		if (bus_cur->firstPFMemFromMem) {
1649			res_cur = bus_cur->firstPFMemFromMem;
1650			while (res_cur) {
1651				res_tmp = res_cur;
1652				res_cur = res_cur->next;
1653
1654				kfree (res_tmp);
1655				res_tmp = NULL;
1656			}
1657			bus_cur->firstPFMemFromMem = NULL;
1658		}
1659
1660		bus_tmp = bus_cur;
1661		list_del (&bus_cur->bus_list);
1662		kfree (bus_tmp);
1663		bus_tmp = NULL;
1664	}
1665}
1666
1667/*********************************************************************************
1668 * This function will go over the PFmem resources to check if the EBDA allocated
1669 * pfmem out of memory buckets of the bus.  If so, it will change the range numbers
1670 * and a flag to indicate that this resource is out of memory. It will also move the
1671 * Pfmem out of the pfmem resource list to the PFMemFromMem list, and will create
1672 * a new Mem node
1673 * This routine is called right after initialization
1674 *******************************************************************************/
1675static int __init once_over (void)
1676{
1677	struct resource_node *pfmem_cur;
1678	struct resource_node *pfmem_prev;
1679	struct resource_node *mem;
1680	struct bus_node *bus_cur;
1681	struct list_head *tmp;
1682
1683	list_for_each (tmp, &gbuses) {
1684		bus_cur = list_entry (tmp, struct bus_node, bus_list);
1685		if ((!bus_cur->rangePFMem) && (bus_cur->firstPFMem)) {
1686			for (pfmem_cur = bus_cur->firstPFMem, pfmem_prev = NULL; pfmem_cur; pfmem_prev = pfmem_cur, pfmem_cur = pfmem_cur->next) {
1687				pfmem_cur->fromMem = 1;
1688				if (pfmem_prev)
1689					pfmem_prev->next = pfmem_cur->next;
1690				else
1691					bus_cur->firstPFMem = pfmem_cur->next;
1692
1693				if (!bus_cur->firstPFMemFromMem)
1694					pfmem_cur->next = NULL;
1695				else
1696					/* we don't need to sort PFMemFromMem since we're using mem node for
1697					   all the real work anyways, so just insert at the beginning of the
1698					   list
1699					 */
1700					pfmem_cur->next = bus_cur->firstPFMemFromMem;
1701
1702				bus_cur->firstPFMemFromMem = pfmem_cur;
1703
1704				mem = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
1705				if (!mem) {
1706					err ("out of system memory\n");
1707					return -ENOMEM;
1708				}
1709				mem->type = MEM;
1710				mem->busno = pfmem_cur->busno;
1711				mem->devfunc = pfmem_cur->devfunc;
1712				mem->start = pfmem_cur->start;
1713				mem->end = pfmem_cur->end;
1714				mem->len = pfmem_cur->len;
1715				if (ibmphp_add_resource (mem) < 0)
1716					err ("Trouble...trouble... EBDA allocated pfmem from mem, but system doesn't display it has this space... unless not PCI device...\n");
1717				pfmem_cur->rangeno = mem->rangeno;
1718			}	/* end for pfmem */
1719		}	/* end if */
1720	}	/* end list_for_each bus */
1721	return 0; 
1722}
1723
1724int ibmphp_add_pfmem_from_mem (struct resource_node *pfmem)
1725{
1726	struct bus_node *bus_cur = find_bus_wprev (pfmem->busno, NULL, 0);
1727
1728	if (!bus_cur) {
1729		err ("cannot find bus of pfmem to add...\n");
1730		return -ENODEV;
1731	}
1732
1733	if (bus_cur->firstPFMemFromMem)
1734		pfmem->next = bus_cur->firstPFMemFromMem;
1735	else
1736		pfmem->next = NULL;
1737
1738	bus_cur->firstPFMemFromMem = pfmem;
1739
1740	return 0;
1741}
1742
1743/* This routine just goes through the buses to see if the bus already exists.
1744 * It is called from ibmphp_find_sec_number, to find out a secondary bus number for
1745 * bridged cards
1746 * Parameters: bus_number
1747 * Returns: Bus pointer or NULL
1748 */
1749struct bus_node *ibmphp_find_res_bus (u8 bus_number)
1750{
1751	return find_bus_wprev (bus_number, NULL, 0);
1752}
1753
1754static struct bus_node *find_bus_wprev (u8 bus_number, struct bus_node **prev, u8 flag)
1755{
1756	struct bus_node *bus_cur;
1757	struct list_head *tmp;
1758	struct list_head *tmp_prev;
1759
1760	list_for_each (tmp, &gbuses) {
1761		tmp_prev = tmp->prev;
1762		bus_cur = list_entry (tmp, struct bus_node, bus_list);
1763		if (flag) 
1764			*prev = list_entry (tmp_prev, struct bus_node, bus_list);
1765		if (bus_cur->busno == bus_number) 
1766			return bus_cur;
1767	}
1768
1769	return NULL;
1770}
1771
1772void ibmphp_print_test (void)
1773{
1774	int i = 0;
1775	struct bus_node *bus_cur = NULL;
1776	struct range_node *range;
1777	struct resource_node *res;
1778	struct list_head *tmp;
1779	
1780	debug_pci ("*****************START**********************\n");
1781
1782	if ((!list_empty(&gbuses)) && flags) {
1783		err ("The GBUSES is not NULL?!?!?!?!?\n");
1784		return;
1785	}
1786
1787	list_for_each (tmp, &gbuses) {
1788		bus_cur = list_entry (tmp, struct bus_node, bus_list);
1789		debug_pci ("This is bus # %d.  There are\n", bus_cur->busno);
1790		debug_pci ("IORanges = %d\t", bus_cur->noIORanges);
1791		debug_pci ("MemRanges = %d\t", bus_cur->noMemRanges);
1792		debug_pci ("PFMemRanges = %d\n", bus_cur->noPFMemRanges);
1793		debug_pci ("The IO Ranges are as follows:\n");
1794		if (bus_cur->rangeIO) {
1795			range = bus_cur->rangeIO;
1796			for (i = 0; i < bus_cur->noIORanges; i++) {
1797				debug_pci ("rangeno is %d\n", range->rangeno);
1798				debug_pci ("[%x - %x]\n", range->start, range->end);
1799				range = range->next;
1800			}
1801		}
1802
1803		debug_pci ("The Mem Ranges are as follows:\n");
1804		if (bus_cur->rangeMem) {
1805			range = bus_cur->rangeMem;
1806			for (i = 0; i < bus_cur->noMemRanges; i++) {
1807				debug_pci ("rangeno is %d\n", range->rangeno);
1808				debug_pci ("[%x - %x]\n", range->start, range->end);
1809				range = range->next;
1810			}
1811		}
1812
1813		debug_pci ("The PFMem Ranges are as follows:\n");
1814
1815		if (bus_cur->rangePFMem) {
1816			range = bus_cur->rangePFMem;
1817			for (i = 0; i < bus_cur->noPFMemRanges; i++) {
1818				debug_pci ("rangeno is %d\n", range->rangeno);
1819				debug_pci ("[%x - %x]\n", range->start, range->end);
1820				range = range->next;
1821			}
1822		}
1823
1824		debug_pci ("The resources on this bus are as follows\n");
1825
1826		debug_pci ("IO...\n");
1827		if (bus_cur->firstIO) {
1828			res = bus_cur->firstIO;
1829			while (res) {
1830				debug_pci ("The range # is %d\n", res->rangeno);
1831				debug_pci ("The bus, devfnc is %d, %x\n", res->busno, res->devfunc);
1832				debug_pci ("[%x - %x], len=%x\n", res->start, res->end, res->len);
1833				if (res->next)
1834					res = res->next;
1835				else if (res->nextRange)
1836					res = res->nextRange;
1837				else
1838					break;
1839			}
1840		}
1841		debug_pci ("Mem...\n");
1842		if (bus_cur->firstMem) {
1843			res = bus_cur->firstMem;
1844			while (res) {
1845				debug_pci ("The range # is %d\n", res->rangeno);
1846				debug_pci ("The bus, devfnc is %d, %x\n", res->busno, res->devfunc);
1847				debug_pci ("[%x - %x], len=%x\n", res->start, res->end, res->len);
1848				if (res->next)
1849					res = res->next;
1850				else if (res->nextRange)
1851					res = res->nextRange;
1852				else
1853					break;
1854			}
1855		}
1856		debug_pci ("PFMem...\n");
1857		if (bus_cur->firstPFMem) {
1858			res = bus_cur->firstPFMem;
1859			while (res) {
1860				debug_pci ("The range # is %d\n", res->rangeno);
1861				debug_pci ("The bus, devfnc is %d, %x\n", res->busno, res->devfunc);
1862				debug_pci ("[%x - %x], len=%x\n", res->start, res->end, res->len);
1863				if (res->next)
1864					res = res->next;
1865				else if (res->nextRange)
1866					res = res->nextRange;
1867				else
1868					break;
1869			}
1870		}
1871
1872		debug_pci ("PFMemFromMem...\n");
1873		if (bus_cur->firstPFMemFromMem) {
1874			res = bus_cur->firstPFMemFromMem;
1875			while (res) {
1876				debug_pci ("The range # is %d\n", res->rangeno);
1877				debug_pci ("The bus, devfnc is %d, %x\n", res->busno, res->devfunc);
1878				debug_pci ("[%x - %x], len=%x\n", res->start, res->end, res->len);
1879				res = res->next;
1880			}
1881		}
1882	}
1883	debug_pci ("***********************END***********************\n");
1884}
1885
1886static int range_exists_already (struct range_node * range, struct bus_node * bus_cur, u8 type)
1887{
1888	struct range_node * range_cur = NULL;
1889	switch (type) {
1890		case IO:
1891			range_cur = bus_cur->rangeIO;
1892			break;
1893		case MEM:
1894			range_cur = bus_cur->rangeMem;
1895			break;
1896		case PFMEM:
1897			range_cur = bus_cur->rangePFMem;
1898			break;
1899		default:
1900			err ("wrong type passed to find out if range already exists\n");
1901			return -ENODEV;
1902	}
1903
1904	while (range_cur) {
1905		if ((range_cur->start == range->start) && (range_cur->end == range->end))
1906			return 1;
1907		range_cur = range_cur->next;
1908	}
1909	
1910	return 0;
1911}
1912
1913/* This routine will read the windows for any PPB we have and update the
1914 * range info for the secondary bus, and will also input this info into
1915 * primary bus, since BIOS doesn't. This is for PPB that are in the system
1916 * on bootup.  For bridged cards that were added during previous load of the
1917 * driver, only the ranges and the bus structure are added, the devices are
1918 * added from NVRAM
1919 * Input: primary busno
1920 * Returns: none
1921 * Note: this function doesn't take into account IO restrictions etc,
1922 *	 so will only work for bridges with no video/ISA devices behind them It
1923 *	 also will not work for onboard PPB's that can have more than 1 *bus
1924 *	 behind them All these are TO DO.
1925 *	 Also need to add more error checkings... (from fnc returns etc)
1926 */
1927static int __init update_bridge_ranges (struct bus_node **bus)
1928{
1929	u8 sec_busno, device, function, hdr_type, start_io_address, end_io_address;
1930	u16 vendor_id, upper_io_start, upper_io_end, start_mem_address, end_mem_address;
1931	u32 start_address, end_address, upper_start, upper_end;
1932	struct bus_node *bus_sec;
1933	struct bus_node *bus_cur;
1934	struct resource_node *io;
1935	struct resource_node *mem;
1936	struct resource_node *pfmem;
1937	struct range_node *range;
1938	unsigned int devfn;
1939
1940	bus_cur = *bus;
1941	if (!bus_cur)
1942		return -ENODEV;
1943	ibmphp_pci_bus->number = bus_cur->busno;
1944
1945	debug ("inside %s\n", __func__);
1946	debug ("bus_cur->busno = %x\n", bus_cur->busno);
1947
1948	for (device = 0; device < 32; device++) {
1949		for (function = 0x00; function < 0x08; function++) {
1950			devfn = PCI_DEVFN(device, function);
1951			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_VENDOR_ID, &vendor_id);
1952
1953			if (vendor_id != PCI_VENDOR_ID_NOTVALID) {
1954				/* found correct device!!! */
1955				pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_HEADER_TYPE, &hdr_type);
1956
1957				switch (hdr_type) {
1958					case PCI_HEADER_TYPE_NORMAL:
1959						function = 0x8;
1960						break;
1961					case PCI_HEADER_TYPE_MULTIDEVICE:
1962						break;
1963					case PCI_HEADER_TYPE_BRIDGE:
1964						function = 0x8;
 
1965					case PCI_HEADER_TYPE_MULTIBRIDGE:
1966						/* We assume here that only 1 bus behind the bridge 
1967						   TO DO: add functionality for several:
1968						   temp = secondary;
1969						   while (temp < subordinate) {
1970						   ...
1971						   temp++;
1972						   }
1973						 */
1974						pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, &sec_busno);
1975						bus_sec = find_bus_wprev (sec_busno, NULL, 0); 
1976						/* this bus structure doesn't exist yet, PPB was configured during previous loading of ibmphp */
1977						if (!bus_sec) {
1978							bus_sec = alloc_error_bus (NULL, sec_busno, 1);
1979							/* the rest will be populated during NVRAM call */
1980							return 0;
1981						}
1982						pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_IO_BASE, &start_io_address);
1983						pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_IO_LIMIT, &end_io_address);
1984						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_IO_BASE_UPPER16, &upper_io_start);
1985						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_IO_LIMIT_UPPER16, &upper_io_end);
1986						start_address = (start_io_address & PCI_IO_RANGE_MASK) << 8;
1987						start_address |= (upper_io_start << 16);
1988						end_address = (end_io_address & PCI_IO_RANGE_MASK) << 8;
1989						end_address |= (upper_io_end << 16);
1990
1991						if ((start_address) && (start_address <= end_address)) {
1992							range = kzalloc(sizeof(struct range_node), GFP_KERNEL);
1993							if (!range) {
1994								err ("out of system memory\n");
1995								return -ENOMEM;
1996							}
1997							range->start = start_address;
1998							range->end = end_address + 0xfff;
1999
2000							if (bus_sec->noIORanges > 0) {
2001								if (!range_exists_already (range, bus_sec, IO)) {
2002									add_bus_range (IO, range, bus_sec);
2003									++bus_sec->noIORanges;
2004								} else {
2005									kfree (range);
2006									range = NULL;
2007								}
2008							} else {
2009								/* 1st IO Range on the bus */
2010								range->rangeno = 1;
2011								bus_sec->rangeIO = range;
2012								++bus_sec->noIORanges;
2013							}
2014							fix_resources (bus_sec);
2015
2016							if (ibmphp_find_resource (bus_cur, start_address, &io, IO)) {
2017								io = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
2018								if (!io) {
2019									kfree (range);
2020									err ("out of system memory\n");
2021									return -ENOMEM;
2022								}
2023								io->type = IO;
2024								io->busno = bus_cur->busno;
2025								io->devfunc = ((device << 3) | (function & 0x7));
2026								io->start = start_address;
2027								io->end = end_address + 0xfff;
2028								io->len = io->end - io->start + 1;
2029								ibmphp_add_resource (io);
2030							}
2031						}	
2032
2033						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_BASE, &start_mem_address);
2034						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_LIMIT, &end_mem_address);
2035
2036						start_address = 0x00000000 | (start_mem_address & PCI_MEMORY_RANGE_MASK) << 16;
2037						end_address = 0x00000000 | (end_mem_address & PCI_MEMORY_RANGE_MASK) << 16;
2038
2039						if ((start_address) && (start_address <= end_address)) {
2040
2041							range = kzalloc(sizeof(struct range_node), GFP_KERNEL);
2042							if (!range) {
2043								err ("out of system memory\n");
2044								return -ENOMEM;
2045							}
2046							range->start = start_address;
2047							range->end = end_address + 0xfffff;
2048
2049							if (bus_sec->noMemRanges > 0) {
2050								if (!range_exists_already (range, bus_sec, MEM)) {
2051									add_bus_range (MEM, range, bus_sec);
2052									++bus_sec->noMemRanges;
2053								} else {
2054									kfree (range);
2055									range = NULL;
2056								}
2057							} else {
2058								/* 1st Mem Range on the bus */
2059								range->rangeno = 1;
2060								bus_sec->rangeMem = range;
2061								++bus_sec->noMemRanges;
2062							}
2063
2064							fix_resources (bus_sec);
2065
2066							if (ibmphp_find_resource (bus_cur, start_address, &mem, MEM)) {
2067								mem = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
2068								if (!mem) {
2069									kfree (range);
2070									err ("out of system memory\n");
2071									return -ENOMEM;
2072								}
2073								mem->type = MEM;
2074								mem->busno = bus_cur->busno;
2075								mem->devfunc = ((device << 3) | (function & 0x7));
2076								mem->start = start_address;
2077								mem->end = end_address + 0xfffff;
2078								mem->len = mem->end - mem->start + 1;
2079								ibmphp_add_resource (mem);
2080							}
2081						}
2082						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_BASE, &start_mem_address);
2083						pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_LIMIT, &end_mem_address);
2084						pci_bus_read_config_dword (ibmphp_pci_bus, devfn, PCI_PREF_BASE_UPPER32, &upper_start);
2085						pci_bus_read_config_dword (ibmphp_pci_bus, devfn, PCI_PREF_LIMIT_UPPER32, &upper_end);
2086						start_address = 0x00000000 | (start_mem_address & PCI_MEMORY_RANGE_MASK) << 16;
2087						end_address = 0x00000000 | (end_mem_address & PCI_MEMORY_RANGE_MASK) << 16;
2088#if BITS_PER_LONG == 64
2089						start_address |= ((long) upper_start) << 32;
2090						end_address |= ((long) upper_end) << 32;
2091#endif
2092
2093						if ((start_address) && (start_address <= end_address)) {
2094
2095							range = kzalloc(sizeof(struct range_node), GFP_KERNEL);
2096							if (!range) {
2097								err ("out of system memory\n");
2098								return -ENOMEM;
2099							}
2100							range->start = start_address;
2101							range->end = end_address + 0xfffff;
2102
2103							if (bus_sec->noPFMemRanges > 0) {
2104								if (!range_exists_already (range, bus_sec, PFMEM)) {
2105									add_bus_range (PFMEM, range, bus_sec);
2106									++bus_sec->noPFMemRanges;
2107								} else {
2108									kfree (range);
2109									range = NULL;
2110								}
2111							} else {
2112								/* 1st PFMem Range on the bus */
2113								range->rangeno = 1;
2114								bus_sec->rangePFMem = range;
2115								++bus_sec->noPFMemRanges;
2116							}
2117
2118							fix_resources (bus_sec);
2119							if (ibmphp_find_resource (bus_cur, start_address, &pfmem, PFMEM)) {
2120								pfmem = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
2121								if (!pfmem) {
2122									kfree (range);
2123									err ("out of system memory\n");
2124									return -ENOMEM;
2125								}
2126								pfmem->type = PFMEM;
2127								pfmem->busno = bus_cur->busno;
2128								pfmem->devfunc = ((device << 3) | (function & 0x7));
2129								pfmem->start = start_address;
2130								pfmem->end = end_address + 0xfffff;
2131								pfmem->len = pfmem->end - pfmem->start + 1;
2132								pfmem->fromMem = 0;
2133
2134								ibmphp_add_resource (pfmem);
2135							}
2136						}
2137						break;
2138				}	/* end of switch */
2139			}	/* end if vendor */
2140		}	/* end for function */
2141	}	/* end for device */
2142
2143	bus = &bus_cur;
2144	return 0;
2145}