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 "ibmphp.h"
35
36
37static int configure_device(struct pci_func *);
38static int configure_bridge(struct pci_func **, u8);
39static struct res_needed *scan_behind_bridge(struct pci_func *, u8);
40static int add_new_bus (struct bus_node *, struct resource_node *, struct resource_node *, struct resource_node *, u8);
41static u8 find_sec_number (u8 primary_busno, u8 slotno);
42
43/*
44 * NOTE..... If BIOS doesn't provide default routing, we assign:
45 * 9 for SCSI, 10 for LAN adapters, and 11 for everything else.
46 * If adapter is bridged, then we assign 11 to it and devices behind it.
47 * We also assign the same irq numbers for multi function devices.
48 * These are PIC mode, so shouldn't matter n.e.ways (hopefully)
49 */
50static void assign_alt_irq (struct pci_func * cur_func, u8 class_code)
51{
52	int j;
53	for (j = 0; j < 4; j++) {
54		if (cur_func->irq[j] == 0xff) {
55			switch (class_code) {
56				case PCI_BASE_CLASS_STORAGE:
57					cur_func->irq[j] = SCSI_IRQ;
58					break;
59				case PCI_BASE_CLASS_NETWORK:
60					cur_func->irq[j] = LAN_IRQ;
61					break;
62				default:
63					cur_func->irq[j] = OTHER_IRQ;
64					break;
65			}
66		}
67	}
68}
69
70/*
71 * Configures the device to be added (will allocate needed resources if it
72 * can), the device can be a bridge or a regular pci device, can also be
73 * multi-functional
74 *
75 * Input: function to be added
76 *
77 * TO DO:  The error case with Multifunction device or multi function bridge,
78 * if there is an error, will need to go through all previous functions and
79 * unconfigure....or can add some code into unconfigure_card....
80 */
81int ibmphp_configure_card (struct pci_func *func, u8 slotno)
82{
83	u16 vendor_id;
84	u32 class;
85	u8 class_code;
86	u8 hdr_type, device, sec_number;
87	u8 function;
88	struct pci_func *newfunc;	/* for multi devices */
89	struct pci_func *cur_func, *prev_func;
90	int rc, i, j;
91	int cleanup_count;
92	u8 flag;
93	u8 valid_device = 0x00; /* to see if we are able to read from card any device info at all */
94
95	debug ("inside configure_card, func->busno = %x\n", func->busno);
96
97	device = func->device;
98	cur_func = func;
99
100	/* We only get bus and device from IRQ routing table.  So at this point,
101	 * func->busno is correct, and func->device contains only device (at the 5
102	 * highest bits)
103	 */
104
105	/* For every function on the card */
106	for (function = 0x00; function < 0x08; function++) {
107		unsigned int devfn = PCI_DEVFN(device, function);
108		ibmphp_pci_bus->number = cur_func->busno;
109
110		cur_func->function = function;
111
112		debug ("inside the loop, cur_func->busno = %x, cur_func->device = %x, cur_func->funcion = %x\n",
113			cur_func->busno, cur_func->device, cur_func->function);
114
115		pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_VENDOR_ID, &vendor_id);
116
117		debug ("vendor_id is %x\n", vendor_id);
118		if (vendor_id != PCI_VENDOR_ID_NOTVALID) {
119			/* found correct device!!! */
120			debug ("found valid device, vendor_id = %x\n", vendor_id);
121
122			++valid_device;
123
124			/* header: x x x x x x x x
125			 *         | |___________|=> 1=PPB bridge, 0=normal device, 2=CardBus Bridge
126			 *         |_=> 0 = single function device, 1 = multi-function device
127			 */
128
129			pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_HEADER_TYPE, &hdr_type);
130			pci_bus_read_config_dword (ibmphp_pci_bus, devfn, PCI_CLASS_REVISION, &class);
131
132			class_code = class >> 24;
133			debug ("hrd_type = %x, class = %x, class_code %x\n", hdr_type, class, class_code);
134			class >>= 8;	/* to take revision out, class = class.subclass.prog i/f */
135			if (class == PCI_CLASS_NOT_DEFINED_VGA) {
136				err ("The device %x is VGA compatible and as is not supported for hot plugging. "
137				     "Please choose another device.\n", cur_func->device);
138				return -ENODEV;
139			} else if (class == PCI_CLASS_DISPLAY_VGA) {
140				err ("The device %x is not supported for hot plugging. "
141				     "Please choose another device.\n", cur_func->device);
142				return -ENODEV;
143			}
144			switch (hdr_type) {
145				case PCI_HEADER_TYPE_NORMAL:
146					debug ("single device case.... vendor id = %x, hdr_type = %x, class = %x\n", vendor_id, hdr_type, class);
147					assign_alt_irq (cur_func, class_code);
148					if ((rc = configure_device (cur_func)) < 0) {
149						/* We need to do this in case some other BARs were properly inserted */
150						err ("was not able to configure devfunc %x on bus %x.\n",
151						     cur_func->device, cur_func->busno);
152						cleanup_count = 6;
153						goto error;
154					}
155					cur_func->next = NULL;
156					function = 0x8;
157					break;
158				case PCI_HEADER_TYPE_MULTIDEVICE:
159					assign_alt_irq (cur_func, class_code);
160					if ((rc = configure_device (cur_func)) < 0) {
161						/* We need to do this in case some other BARs were properly inserted */
162						err ("was not able to configure devfunc %x on bus %x...bailing out\n",
163						     cur_func->device, cur_func->busno);
164						cleanup_count = 6;
165						goto error;
166					}
167					newfunc = kzalloc(sizeof(*newfunc), GFP_KERNEL);
168					if (!newfunc) {
169						err ("out of system memory\n");
170						return -ENOMEM;
171					}
172					newfunc->busno = cur_func->busno;
173					newfunc->device = device;
174					cur_func->next = newfunc;
175					cur_func = newfunc;
176					for (j = 0; j < 4; j++)
177						newfunc->irq[j] = cur_func->irq[j];
178					break;
179				case PCI_HEADER_TYPE_MULTIBRIDGE:
180					class >>= 8;
181					if (class != PCI_CLASS_BRIDGE_PCI) {
182						err ("This %x is not PCI-to-PCI bridge, and as is not supported for hot-plugging. "
183						     "Please insert another card.\n", cur_func->device);
184						return -ENODEV;
185					}
186					assign_alt_irq (cur_func, class_code);
187					rc = configure_bridge (&cur_func, slotno);
188					if (rc == -ENODEV) {
189						err ("You chose to insert Single Bridge, or nested bridges, this is not supported...\n");
190						err ("Bus %x, devfunc %x\n", cur_func->busno, cur_func->device);
191						return rc;
192					}
193					if (rc) {
194						/* We need to do this in case some other BARs were properly inserted */
195						err ("was not able to hot-add PPB properly.\n");
196						func->bus = 1; /* To indicate to the unconfigure function that this is a PPB */
197						cleanup_count = 2;
198						goto error;
199					}
200
201					pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, &sec_number);
202					flag = 0;
203					for (i = 0; i < 32; i++) {
204						if (func->devices[i]) {
205							newfunc = kzalloc(sizeof(*newfunc), GFP_KERNEL);
206							if (!newfunc) {
207								err ("out of system memory\n");
208								return -ENOMEM;
209							}
210							newfunc->busno = sec_number;
211							newfunc->device = (u8) i;
212							for (j = 0; j < 4; j++)
213								newfunc->irq[j] = cur_func->irq[j];
214
215							if (flag) {
216								for (prev_func = cur_func; prev_func->next; prev_func = prev_func->next) ;
217								prev_func->next = newfunc;
218							} else
219								cur_func->next = newfunc;
220
221							rc = ibmphp_configure_card (newfunc, slotno);
222							/* This could only happen if kmalloc failed */
223							if (rc) {
224								/* We need to do this in case bridge itself got configured properly, but devices behind it failed */
225								func->bus = 1; /* To indicate to the unconfigure function that this is a PPB */
226								cleanup_count = 2;
227								goto error;
228							}
229							flag = 1;
230						}
231					}
232
233					newfunc = kzalloc(sizeof(*newfunc), GFP_KERNEL);
234					if (!newfunc) {
235						err ("out of system memory\n");
236						return -ENOMEM;
237					}
238					newfunc->busno = cur_func->busno;
239					newfunc->device = device;
240					for (j = 0; j < 4; j++)
241						newfunc->irq[j] = cur_func->irq[j];
242					for (prev_func = cur_func; prev_func->next; prev_func = prev_func->next) ;
243					prev_func->next = newfunc;
244					cur_func = newfunc;
245					break;
246				case PCI_HEADER_TYPE_BRIDGE:
247					class >>= 8;
248					debug ("class now is %x\n", class);
249					if (class != PCI_CLASS_BRIDGE_PCI) {
250						err ("This %x is not PCI-to-PCI bridge, and as is not supported for hot-plugging. "
251						     "Please insert another card.\n", cur_func->device);
252						return -ENODEV;
253					}
254
255					assign_alt_irq (cur_func, class_code);
256
257					debug ("cur_func->busno b4 configure_bridge is %x\n", cur_func->busno);
258					rc = configure_bridge (&cur_func, slotno);
259					if (rc == -ENODEV) {
260						err ("You chose to insert Single Bridge, or nested bridges, this is not supported...\n");
261						err ("Bus %x, devfunc %x\n", cur_func->busno, cur_func->device);
262						return rc;
263					}
264					if (rc) {
265						/* We need to do this in case some other BARs were properly inserted */
266						func->bus = 1; /* To indicate to the unconfigure function that this is a PPB */
267						err ("was not able to hot-add PPB properly.\n");
268						cleanup_count = 2;
269						goto error;
270					}
271					debug ("cur_func->busno = %x, device = %x, function = %x\n",
272						cur_func->busno, device, function);
273					pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, &sec_number);
274					debug ("after configuring bridge..., sec_number = %x\n", sec_number);
275					flag = 0;
276					for (i = 0; i < 32; i++) {
277						if (func->devices[i]) {
278							debug ("inside for loop, device is %x\n", i);
279							newfunc = kzalloc(sizeof(*newfunc), GFP_KERNEL);
280							if (!newfunc) {
281								err (" out of system memory\n");
282								return -ENOMEM;
283							}
284							newfunc->busno = sec_number;
285							newfunc->device = (u8) i;
286							for (j = 0; j < 4; j++)
287								newfunc->irq[j] = cur_func->irq[j];
288
289							if (flag) {
290								for (prev_func = cur_func; prev_func->next; prev_func = prev_func->next) ;
291								prev_func->next = newfunc;
292							} else
293								cur_func->next = newfunc;
294
295							rc = ibmphp_configure_card (newfunc, slotno);
296
297							/* Again, this case should not happen... For complete paranoia, will need to call remove_bus */
298							if (rc) {
299								/* We need to do this in case some other BARs were properly inserted */
300								func->bus = 1; /* To indicate to the unconfigure function that this is a PPB */
301								cleanup_count = 2;
302								goto error;
303							}
304							flag = 1;
305						}
306					}
307
308					function = 0x8;
309					break;
310				default:
311					err ("MAJOR PROBLEM!!!!, header type not supported? %x\n", hdr_type);
312					return -ENXIO;
313					break;
314			}	/* end of switch */
315		}	/* end of valid device */
316	}	/* end of for */
317
318	if (!valid_device) {
319		err ("Cannot find any valid devices on the card.  Or unable to read from card.\n");
320		return -ENODEV;
321	}
322
323	return 0;
324
325error:
326	for (i = 0; i < cleanup_count; i++) {
327		if (cur_func->io[i]) {
328			ibmphp_remove_resource (cur_func->io[i]);
329			cur_func->io[i] = NULL;
330		} else if (cur_func->pfmem[i]) {
331			ibmphp_remove_resource (cur_func->pfmem[i]);
332			cur_func->pfmem[i] = NULL;
333		} else if (cur_func->mem[i]) {
334			ibmphp_remove_resource (cur_func->mem[i]);
335			cur_func->mem[i] = NULL;
336		}
337	}
338	return rc;
339}
340
341/*
342 * This function configures the pci BARs of a single device.
343 * Input: pointer to the pci_func
344 * Output: configured PCI, 0, or error
345 */
346static int configure_device (struct pci_func *func)
347{
348	u32 bar[6];
349	u32 address[] = {
350		PCI_BASE_ADDRESS_0,
351		PCI_BASE_ADDRESS_1,
352		PCI_BASE_ADDRESS_2,
353		PCI_BASE_ADDRESS_3,
354		PCI_BASE_ADDRESS_4,
355		PCI_BASE_ADDRESS_5,
356		0
357	};
358	u8 irq;
359	int count;
360	int len[6];
361	struct resource_node *io[6];
362	struct resource_node *mem[6];
363	struct resource_node *mem_tmp;
364	struct resource_node *pfmem[6];
365	unsigned int devfn;
366
367	debug ("%s - inside\n", __func__);
368
369	devfn = PCI_DEVFN(func->device, func->function);
370	ibmphp_pci_bus->number = func->busno;
371
372	for (count = 0; address[count]; count++) {	/* for 6 BARs */
373
374		/* not sure if i need this.  per scott, said maybe need smth like this
375		   if devices don't adhere 100% to the spec, so don't want to write
376		   to the reserved bits
377
378		pcibios_read_config_byte(cur_func->busno, cur_func->device,
379		PCI_BASE_ADDRESS_0 + 4 * count, &tmp);
380		if (tmp & 0x01) // IO
381			pcibios_write_config_dword(cur_func->busno, cur_func->device,
382			PCI_BASE_ADDRESS_0 + 4 * count, 0xFFFFFFFD);
383		else  // Memory
384			pcibios_write_config_dword(cur_func->busno, cur_func->device,
385			PCI_BASE_ADDRESS_0 + 4 * count, 0xFFFFFFFF);
386		 */
387		pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFF);
388		pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
389
390		if (!bar[count])	/* This BAR is not implemented */
391			continue;
392
393		debug ("Device %x BAR %d wants %x\n", func->device, count, bar[count]);
394
395		if (bar[count] & PCI_BASE_ADDRESS_SPACE_IO) {
396			/* This is IO */
397			debug ("inside IO SPACE\n");
398
399			len[count] = bar[count] & 0xFFFFFFFC;
400			len[count] = ~len[count] + 1;
401
402			debug ("len[count] in IO %x, count %d\n", len[count], count);
403
404			io[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
405
406			if (!io[count]) {
407				err ("out of system memory\n");
408				return -ENOMEM;
409			}
410			io[count]->type = IO;
411			io[count]->busno = func->busno;
412			io[count]->devfunc = PCI_DEVFN(func->device, func->function);
413			io[count]->len = len[count];
414			if (ibmphp_check_resource(io[count], 0) == 0) {
415				ibmphp_add_resource (io[count]);
416				func->io[count] = io[count];
417			} else {
418				err ("cannot allocate requested io for bus %x device %x function %x len %x\n",
419				     func->busno, func->device, func->function, len[count]);
420				kfree (io[count]);
421				return -EIO;
422			}
423			pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->io[count]->start);
424
425			/* _______________This is for debugging purposes only_____________________ */
426			debug ("b4 writing, the IO address is %x\n", func->io[count]->start);
427			pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
428			debug ("after writing.... the start address is %x\n", bar[count]);
429			/* _________________________________________________________________________*/
430
431		} else {
432			/* This is Memory */
433			if (bar[count] & PCI_BASE_ADDRESS_MEM_PREFETCH) {
434				/* pfmem */
435				debug ("PFMEM SPACE\n");
436
437				len[count] = bar[count] & 0xFFFFFFF0;
438				len[count] = ~len[count] + 1;
439
440				debug ("len[count] in PFMEM %x, count %d\n", len[count], count);
441
442				pfmem[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
443				if (!pfmem[count]) {
444					err ("out of system memory\n");
445					return -ENOMEM;
446				}
447				pfmem[count]->type = PFMEM;
448				pfmem[count]->busno = func->busno;
449				pfmem[count]->devfunc = PCI_DEVFN(func->device,
450							func->function);
451				pfmem[count]->len = len[count];
452				pfmem[count]->fromMem = 0;
453				if (ibmphp_check_resource (pfmem[count], 0) == 0) {
454					ibmphp_add_resource (pfmem[count]);
455					func->pfmem[count] = pfmem[count];
456				} else {
457					mem_tmp = kzalloc(sizeof(*mem_tmp), GFP_KERNEL);
458					if (!mem_tmp) {
459						err ("out of system memory\n");
460						kfree (pfmem[count]);
461						return -ENOMEM;
462					}
463					mem_tmp->type = MEM;
464					mem_tmp->busno = pfmem[count]->busno;
465					mem_tmp->devfunc = pfmem[count]->devfunc;
466					mem_tmp->len = pfmem[count]->len;
467					debug ("there's no pfmem... going into mem.\n");
468					if (ibmphp_check_resource (mem_tmp, 0) == 0) {
469						ibmphp_add_resource (mem_tmp);
470						pfmem[count]->fromMem = 1;
471						pfmem[count]->rangeno = mem_tmp->rangeno;
472						pfmem[count]->start = mem_tmp->start;
473						pfmem[count]->end = mem_tmp->end;
474						ibmphp_add_pfmem_from_mem (pfmem[count]);
475						func->pfmem[count] = pfmem[count];
476					} else {
477						err ("cannot allocate requested pfmem for bus %x, device %x, len %x\n",
478						     func->busno, func->device, len[count]);
479						kfree (mem_tmp);
480						kfree (pfmem[count]);
481						return -EIO;
482					}
483				}
484
485				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->pfmem[count]->start);
486
487				/*_______________This is for debugging purposes only______________________________*/
488				debug ("b4 writing, start address is %x\n", func->pfmem[count]->start);
489				pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
490				debug ("after writing, start address is %x\n", bar[count]);
491				/*_________________________________________________________________________________*/
492
493				if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64) {	/* takes up another dword */
494					debug ("inside the mem 64 case, count %d\n", count);
495					count += 1;
496					/* on the 2nd dword, write all 0s, since we can't handle them n.e.ways */
497					pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0x00000000);
498				}
499			} else {
500				/* regular memory */
501				debug ("REGULAR MEM SPACE\n");
502
503				len[count] = bar[count] & 0xFFFFFFF0;
504				len[count] = ~len[count] + 1;
505
506				debug ("len[count] in Mem %x, count %d\n", len[count], count);
507
508				mem[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
509				if (!mem[count]) {
510					err ("out of system memory\n");
511					return -ENOMEM;
512				}
513				mem[count]->type = MEM;
514				mem[count]->busno = func->busno;
515				mem[count]->devfunc = PCI_DEVFN(func->device,
516							func->function);
517				mem[count]->len = len[count];
518				if (ibmphp_check_resource (mem[count], 0) == 0) {
519					ibmphp_add_resource (mem[count]);
520					func->mem[count] = mem[count];
521				} else {
522					err ("cannot allocate requested mem for bus %x, device %x, len %x\n",
523					     func->busno, func->device, len[count]);
524					kfree (mem[count]);
525					return -EIO;
526				}
527				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->mem[count]->start);
528				/* _______________________This is for debugging purposes only _______________________*/
529				debug ("b4 writing, start address is %x\n", func->mem[count]->start);
530				pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
531				debug ("after writing, the address is %x\n", bar[count]);
532				/* __________________________________________________________________________________*/
533
534				if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64) {
535					/* takes up another dword */
536					debug ("inside mem 64 case, reg. mem, count %d\n", count);
537					count += 1;
538					/* on the 2nd dword, write all 0s, since we can't handle them n.e.ways */
539					pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0x00000000);
540				}
541			}
542		}		/* end of mem */
543	}			/* end of for */
544
545	func->bus = 0;		/* To indicate that this is not a PPB */
546	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_INTERRUPT_PIN, &irq);
547	if ((irq > 0x00) && (irq < 0x05))
548		pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_INTERRUPT_LINE, func->irq[irq - 1]);
549
550	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_CACHE_LINE_SIZE, CACHE);
551	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_LATENCY_TIMER, LATENCY);
552
553	pci_bus_write_config_dword (ibmphp_pci_bus, devfn, PCI_ROM_ADDRESS, 0x00L);
554	pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_COMMAND, DEVICEENABLE);
555
556	return 0;
557}
558
559/******************************************************************************
560 * This routine configures a PCI-2-PCI bridge and the functions behind it
561 * Parameters: pci_func
562 * Returns:
563 ******************************************************************************/
564static int configure_bridge (struct pci_func **func_passed, u8 slotno)
565{
566	int count;
567	int i;
568	int rc;
569	u8 sec_number;
570	u8 io_base;
571	u16 pfmem_base;
572	u32 bar[2];
573	u32 len[2];
574	u8 flag_io = 0;
575	u8 flag_mem = 0;
576	u8 flag_pfmem = 0;
577	u8 need_io_upper = 0;
578	u8 need_pfmem_upper = 0;
579	struct res_needed *amount_needed = NULL;
580	struct resource_node *io = NULL;
581	struct resource_node *bus_io[2] = {NULL, NULL};
582	struct resource_node *mem = NULL;
583	struct resource_node *bus_mem[2] = {NULL, NULL};
584	struct resource_node *mem_tmp = NULL;
585	struct resource_node *pfmem = NULL;
586	struct resource_node *bus_pfmem[2] = {NULL, NULL};
587	struct bus_node *bus;
588	u32 address[] = {
589		PCI_BASE_ADDRESS_0,
590		PCI_BASE_ADDRESS_1,
591		0
592	};
593	struct pci_func *func = *func_passed;
594	unsigned int devfn;
595	u8 irq;
596	int retval;
597
598	debug ("%s - enter\n", __func__);
599
600	devfn = PCI_DEVFN(func->function, func->device);
601	ibmphp_pci_bus->number = func->busno;
602
603	/* Configuring necessary info for the bridge so that we could see the devices
604	 * behind it
605	 */
606
607	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_PRIMARY_BUS, func->busno);
608
609	/* _____________________For debugging purposes only __________________________
610	pci_bus_config_byte (ibmphp_pci_bus, devfn, PCI_PRIMARY_BUS, &pri_number);
611	debug ("primary # written into the bridge is %x\n", pri_number);
612	 ___________________________________________________________________________*/
613
614	/* in EBDA, only get allocated 1 additional bus # per slot */
615	sec_number = find_sec_number (func->busno, slotno);
616	if (sec_number == 0xff) {
617		err ("cannot allocate secondary bus number for the bridged device\n");
618		return -EINVAL;
619	}
620
621	debug ("after find_sec_number, the number we got is %x\n", sec_number);
622	debug ("AFTER FIND_SEC_NUMBER, func->busno IS %x\n", func->busno);
623
624	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, sec_number);
625
626	/* __________________For debugging purposes only __________________________________
627	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, &sec_number);
628	debug ("sec_number after write/read is %x\n", sec_number);
629	 ________________________________________________________________________________*/
630
631	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_SUBORDINATE_BUS, sec_number);
632
633	/* __________________For debugging purposes only ____________________________________
634	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SUBORDINATE_BUS, &sec_number);
635	debug ("subordinate number after write/read is %x\n", sec_number);
636	 __________________________________________________________________________________*/
637
638	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_CACHE_LINE_SIZE, CACHE);
639	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_LATENCY_TIMER, LATENCY);
640	pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_SEC_LATENCY_TIMER, LATENCY);
641
642	debug ("func->busno is %x\n", func->busno);
643	debug ("sec_number after writing is %x\n", sec_number);
644
645
646	/* !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
647	   !!!!!!!!!!!!!!!NEED TO ADD!!!  FAST BACK-TO-BACK ENABLE!!!!!!!!!!!!!!!!!!!!
648	   !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!*/
649
650
651	/* First we need to allocate mem/io for the bridge itself in case it needs it */
652	for (count = 0; address[count]; count++) {	/* for 2 BARs */
653		pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFF);
654		pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
655
656		if (!bar[count]) {
657			/* This BAR is not implemented */
658			debug ("so we come here then, eh?, count = %d\n", count);
659			continue;
660		}
661		//  tmp_bar = bar[count];
662
663		debug ("Bar %d wants %x\n", count, bar[count]);
664
665		if (bar[count] & PCI_BASE_ADDRESS_SPACE_IO) {
666			/* This is IO */
667			len[count] = bar[count] & 0xFFFFFFFC;
668			len[count] = ~len[count] + 1;
669
670			debug ("len[count] in IO = %x\n", len[count]);
671
672			bus_io[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
673
674			if (!bus_io[count]) {
675				err ("out of system memory\n");
676				retval = -ENOMEM;
677				goto error;
678			}
679			bus_io[count]->type = IO;
680			bus_io[count]->busno = func->busno;
681			bus_io[count]->devfunc = PCI_DEVFN(func->device,
682							func->function);
683			bus_io[count]->len = len[count];
684			if (ibmphp_check_resource (bus_io[count], 0) == 0) {
685				ibmphp_add_resource (bus_io[count]);
686				func->io[count] = bus_io[count];
687			} else {
688				err ("cannot allocate requested io for bus %x, device %x, len %x\n",
689				     func->busno, func->device, len[count]);
690				kfree (bus_io[count]);
691				return -EIO;
692			}
693
694			pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->io[count]->start);
695
696		} else {
697			/* This is Memory */
698			if (bar[count] & PCI_BASE_ADDRESS_MEM_PREFETCH) {
699				/* pfmem */
700				len[count] = bar[count] & 0xFFFFFFF0;
701				len[count] = ~len[count] + 1;
702
703				debug ("len[count] in PFMEM = %x\n", len[count]);
704
705				bus_pfmem[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
706				if (!bus_pfmem[count]) {
707					err ("out of system memory\n");
708					retval = -ENOMEM;
709					goto error;
710				}
711				bus_pfmem[count]->type = PFMEM;
712				bus_pfmem[count]->busno = func->busno;
713				bus_pfmem[count]->devfunc = PCI_DEVFN(func->device,
714							func->function);
715				bus_pfmem[count]->len = len[count];
716				bus_pfmem[count]->fromMem = 0;
717				if (ibmphp_check_resource (bus_pfmem[count], 0) == 0) {
718					ibmphp_add_resource (bus_pfmem[count]);
719					func->pfmem[count] = bus_pfmem[count];
720				} else {
721					mem_tmp = kzalloc(sizeof(*mem_tmp), GFP_KERNEL);
722					if (!mem_tmp) {
723						err ("out of system memory\n");
724						retval = -ENOMEM;
725						goto error;
726					}
727					mem_tmp->type = MEM;
728					mem_tmp->busno = bus_pfmem[count]->busno;
729					mem_tmp->devfunc = bus_pfmem[count]->devfunc;
730					mem_tmp->len = bus_pfmem[count]->len;
731					if (ibmphp_check_resource (mem_tmp, 0) == 0) {
732						ibmphp_add_resource (mem_tmp);
733						bus_pfmem[count]->fromMem = 1;
734						bus_pfmem[count]->rangeno = mem_tmp->rangeno;
735						ibmphp_add_pfmem_from_mem (bus_pfmem[count]);
736						func->pfmem[count] = bus_pfmem[count];
737					} else {
738						err ("cannot allocate requested pfmem for bus %x, device %x, len %x\n",
739						     func->busno, func->device, len[count]);
740						kfree (mem_tmp);
741						kfree (bus_pfmem[count]);
742						return -EIO;
743					}
744				}
745
746				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->pfmem[count]->start);
747
748				if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64) {
749					/* takes up another dword */
750					count += 1;
751					/* on the 2nd dword, write all 0s, since we can't handle them n.e.ways */
752					pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0x00000000);
753
754				}
755			} else {
756				/* regular memory */
757				len[count] = bar[count] & 0xFFFFFFF0;
758				len[count] = ~len[count] + 1;
759
760				debug ("len[count] in Memory is %x\n", len[count]);
761
762				bus_mem[count] = kzalloc(sizeof(struct resource_node), GFP_KERNEL);
763				if (!bus_mem[count]) {
764					err ("out of system memory\n");
765					retval = -ENOMEM;
766					goto error;
767				}
768				bus_mem[count]->type = MEM;
769				bus_mem[count]->busno = func->busno;
770				bus_mem[count]->devfunc = PCI_DEVFN(func->device,
771							func->function);
772				bus_mem[count]->len = len[count];
773				if (ibmphp_check_resource (bus_mem[count], 0) == 0) {
774					ibmphp_add_resource (bus_mem[count]);
775					func->mem[count] = bus_mem[count];
776				} else {
777					err ("cannot allocate requested mem for bus %x, device %x, len %x\n",
778					     func->busno, func->device, len[count]);
779					kfree (bus_mem[count]);
780					return -EIO;
781				}
782
783				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], func->mem[count]->start);
784
785				if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64) {
786					/* takes up another dword */
787					count += 1;
788					/* on the 2nd dword, write all 0s, since we can't handle them n.e.ways */
789					pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0x00000000);
790
791				}
792			}
793		}		/* end of mem */
794	}			/* end of for  */
795
796	/* Now need to see how much space the devices behind the bridge needed */
797	amount_needed = scan_behind_bridge (func, sec_number);
798	if (amount_needed == NULL)
799		return -ENOMEM;
800
801	ibmphp_pci_bus->number = func->busno;
802	debug ("after coming back from scan_behind_bridge\n");
803	debug ("amount_needed->not_correct = %x\n", amount_needed->not_correct);
804	debug ("amount_needed->io = %x\n", amount_needed->io);
805	debug ("amount_needed->mem = %x\n", amount_needed->mem);
806	debug ("amount_needed->pfmem =  %x\n", amount_needed->pfmem);
807
808	if (amount_needed->not_correct) {
809		debug ("amount_needed is not correct\n");
810		for (count = 0; address[count]; count++) {
811			/* for 2 BARs */
812			if (bus_io[count]) {
813				ibmphp_remove_resource (bus_io[count]);
814				func->io[count] = NULL;
815			} else if (bus_pfmem[count]) {
816				ibmphp_remove_resource (bus_pfmem[count]);
817				func->pfmem[count] = NULL;
818			} else if (bus_mem[count]) {
819				ibmphp_remove_resource (bus_mem[count]);
820				func->mem[count] = NULL;
821			}
822		}
823		kfree (amount_needed);
824		return -ENODEV;
825	}
826
827	if (!amount_needed->io) {
828		debug ("it doesn't want IO?\n");
829		flag_io = 1;
830	} else {
831		debug ("it wants %x IO behind the bridge\n", amount_needed->io);
832		io = kzalloc(sizeof(*io), GFP_KERNEL);
833
834		if (!io) {
835			err ("out of system memory\n");
836			retval = -ENOMEM;
837			goto error;
838		}
839		io->type = IO;
840		io->busno = func->busno;
841		io->devfunc = PCI_DEVFN(func->device, func->function);
842		io->len = amount_needed->io;
843		if (ibmphp_check_resource (io, 1) == 0) {
844			debug ("were we able to add io\n");
845			ibmphp_add_resource (io);
846			flag_io = 1;
847		}
848	}
849
850	if (!amount_needed->mem) {
851		debug ("it doesn't want n.e.memory?\n");
852		flag_mem = 1;
853	} else {
854		debug ("it wants %x memory behind the bridge\n", amount_needed->mem);
855		mem = kzalloc(sizeof(*mem), GFP_KERNEL);
856		if (!mem) {
857			err ("out of system memory\n");
858			retval = -ENOMEM;
859			goto error;
860		}
861		mem->type = MEM;
862		mem->busno = func->busno;
863		mem->devfunc = PCI_DEVFN(func->device, func->function);
864		mem->len = amount_needed->mem;
865		if (ibmphp_check_resource (mem, 1) == 0) {
866			ibmphp_add_resource (mem);
867			flag_mem = 1;
868			debug ("were we able to add mem\n");
869		}
870	}
871
872	if (!amount_needed->pfmem) {
873		debug ("it doesn't want n.e.pfmem mem?\n");
874		flag_pfmem = 1;
875	} else {
876		debug ("it wants %x pfmemory behind the bridge\n", amount_needed->pfmem);
877		pfmem = kzalloc(sizeof(*pfmem), GFP_KERNEL);
878		if (!pfmem) {
879			err ("out of system memory\n");
880			retval = -ENOMEM;
881			goto error;
882		}
883		pfmem->type = PFMEM;
884		pfmem->busno = func->busno;
885		pfmem->devfunc = PCI_DEVFN(func->device, func->function);
886		pfmem->len = amount_needed->pfmem;
887		pfmem->fromMem = 0;
888		if (ibmphp_check_resource (pfmem, 1) == 0) {
889			ibmphp_add_resource (pfmem);
890			flag_pfmem = 1;
891		} else {
892			mem_tmp = kzalloc(sizeof(*mem_tmp), GFP_KERNEL);
893			if (!mem_tmp) {
894				err ("out of system memory\n");
895				retval = -ENOMEM;
896				goto error;
897			}
898			mem_tmp->type = MEM;
899			mem_tmp->busno = pfmem->busno;
900			mem_tmp->devfunc = pfmem->devfunc;
901			mem_tmp->len = pfmem->len;
902			if (ibmphp_check_resource (mem_tmp, 1) == 0) {
903				ibmphp_add_resource (mem_tmp);
904				pfmem->fromMem = 1;
905				pfmem->rangeno = mem_tmp->rangeno;
906				ibmphp_add_pfmem_from_mem (pfmem);
907				flag_pfmem = 1;
908			}
909		}
910	}
911
912	debug ("b4 if (flag_io && flag_mem && flag_pfmem)\n");
913	debug ("flag_io = %x, flag_mem = %x, flag_pfmem = %x\n", flag_io, flag_mem, flag_pfmem);
914
915	if (flag_io && flag_mem && flag_pfmem) {
916		/* If on bootup, there was a bridged card in this slot,
917		 * then card was removed and ibmphp got unloaded and loaded
918		 * back again, there's no way for us to remove the bus
919		 * struct, so no need to kmalloc, can use existing node
920		 */
921		bus = ibmphp_find_res_bus (sec_number);
922		if (!bus) {
923			bus = kzalloc(sizeof(*bus), GFP_KERNEL);
924			if (!bus) {
925				err ("out of system memory\n");
926				retval = -ENOMEM;
927				goto error;
928			}
929			bus->busno = sec_number;
930			debug ("b4 adding new bus\n");
931			rc = add_new_bus (bus, io, mem, pfmem, func->busno);
932		} else if (!(bus->rangeIO) && !(bus->rangeMem) && !(bus->rangePFMem))
933			rc = add_new_bus (bus, io, mem, pfmem, 0xFF);
934		else {
935			err ("expected bus structure not empty?\n");
936			retval = -EIO;
937			goto error;
938		}
939		if (rc) {
940			if (rc == -ENOMEM) {
941				ibmphp_remove_bus (bus, func->busno);
942				kfree (amount_needed);
943				return rc;
944			}
945			retval = rc;
946			goto error;
947		}
948		pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_IO_BASE, &io_base);
949		pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_BASE, &pfmem_base);
950
951		if ((io_base & PCI_IO_RANGE_TYPE_MASK) == PCI_IO_RANGE_TYPE_32) {
952			debug ("io 32\n");
953			need_io_upper = 1;
954		}
955		if ((pfmem_base & PCI_PREF_RANGE_TYPE_MASK) == PCI_PREF_RANGE_TYPE_64) {
956			debug ("pfmem 64\n");
957			need_pfmem_upper = 1;
958		}
959
960		if (bus->noIORanges) {
961			pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_IO_BASE, 0x00 | bus->rangeIO->start >> 8);
962			pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_IO_LIMIT, 0x00 | bus->rangeIO->end >> 8);
963
964			/* _______________This is for debugging purposes only ____________________
965			pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_IO_BASE, &temp);
966			debug ("io_base = %x\n", (temp & PCI_IO_RANGE_TYPE_MASK) << 8);
967			pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_IO_LIMIT, &temp);
968			debug ("io_limit = %x\n", (temp & PCI_IO_RANGE_TYPE_MASK) << 8);
969			 ________________________________________________________________________*/
970
971			if (need_io_upper) {	/* since can't support n.e.ways */
972				pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_IO_BASE_UPPER16, 0x0000);
973				pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_IO_LIMIT_UPPER16, 0x0000);
974			}
975		} else {
976			pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_IO_BASE, 0x00);
977			pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_IO_LIMIT, 0x00);
978		}
979
980		if (bus->noMemRanges) {
981			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_BASE, 0x0000 | bus->rangeMem->start >> 16);
982			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_LIMIT, 0x0000 | bus->rangeMem->end >> 16);
983
984			/* ____________________This is for debugging purposes only ________________________
985			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_BASE, &temp);
986			debug ("mem_base = %x\n", (temp & PCI_MEMORY_RANGE_TYPE_MASK) << 16);
987			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_LIMIT, &temp);
988			debug ("mem_limit = %x\n", (temp & PCI_MEMORY_RANGE_TYPE_MASK) << 16);
989			 __________________________________________________________________________________*/
990
991		} else {
992			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_BASE, 0xffff);
993			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_MEMORY_LIMIT, 0x0000);
994		}
995		if (bus->noPFMemRanges) {
996			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_BASE, 0x0000 | bus->rangePFMem->start >> 16);
997			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_LIMIT, 0x0000 | bus->rangePFMem->end >> 16);
998
999			/* __________________________This is for debugging purposes only _______________________
1000			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_BASE, &temp);
1001			debug ("pfmem_base = %x", (temp & PCI_MEMORY_RANGE_TYPE_MASK) << 16);
1002			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_LIMIT, &temp);
1003			debug ("pfmem_limit = %x\n", (temp & PCI_MEMORY_RANGE_TYPE_MASK) << 16);
1004			 ______________________________________________________________________________________*/
1005
1006			if (need_pfmem_upper) {	/* since can't support n.e.ways */
1007				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, PCI_PREF_BASE_UPPER32, 0x00000000);
1008				pci_bus_write_config_dword (ibmphp_pci_bus, devfn, PCI_PREF_LIMIT_UPPER32, 0x00000000);
1009			}
1010		} else {
1011			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_BASE, 0xffff);
1012			pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_PREF_MEMORY_LIMIT, 0x0000);
1013		}
1014
1015		debug ("b4 writing control information\n");
1016
1017		pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_INTERRUPT_PIN, &irq);
1018		if ((irq > 0x00) && (irq < 0x05))
1019			pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_INTERRUPT_LINE, func->irq[irq - 1]);
1020		/*
1021		pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_BRIDGE_CONTROL, ctrl);
1022		pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_BRIDGE_CONTROL, PCI_BRIDGE_CTL_PARITY);
1023		pci_bus_write_config_byte (ibmphp_pci_bus, devfn, PCI_BRIDGE_CONTROL, PCI_BRIDGE_CTL_SERR);
1024		 */
1025
1026		pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_COMMAND, DEVICEENABLE);
1027		pci_bus_write_config_word (ibmphp_pci_bus, devfn, PCI_BRIDGE_CONTROL, 0x07);
1028		for (i = 0; i < 32; i++) {
1029			if (amount_needed->devices[i]) {
1030				debug ("device where devices[i] is 1 = %x\n", i);
1031				func->devices[i] = 1;
1032			}
1033		}
1034		func->bus = 1;	/* For unconfiguring, to indicate it's PPB */
1035		func_passed = &func;
1036		debug ("func->busno b4 returning is %x\n", func->busno);
1037		debug ("func->busno b4 returning in the other structure is %x\n", (*func_passed)->busno);
1038		kfree (amount_needed);
1039		return 0;
1040	} else {
1041		err ("Configuring bridge was unsuccessful...\n");
1042		mem_tmp = NULL;
1043		retval = -EIO;
1044		goto error;
1045	}
1046
1047error:
1048	kfree(amount_needed);
1049	if (pfmem)
1050		ibmphp_remove_resource (pfmem);
1051	if (io)
1052		ibmphp_remove_resource (io);
1053	if (mem)
1054		ibmphp_remove_resource (mem);
1055	for (i = 0; i < 2; i++) {	/* for 2 BARs */
1056		if (bus_io[i]) {
1057			ibmphp_remove_resource (bus_io[i]);
1058			func->io[i] = NULL;
1059		} else if (bus_pfmem[i]) {
1060			ibmphp_remove_resource (bus_pfmem[i]);
1061			func->pfmem[i] = NULL;
1062		} else if (bus_mem[i]) {
1063			ibmphp_remove_resource (bus_mem[i]);
1064			func->mem[i] = NULL;
1065		}
1066	}
1067	return retval;
1068}
1069
1070/*****************************************************************************
1071 * This function adds up the amount of resources needed behind the PPB bridge
1072 * and passes it to the configure_bridge function
1073 * Input: bridge function
1074 * Ouput: amount of resources needed
1075 *****************************************************************************/
1076static struct res_needed *scan_behind_bridge (struct pci_func * func, u8 busno)
1077{
1078	int count, len[6];
1079	u16 vendor_id;
1080	u8 hdr_type;
1081	u8 device, function;
1082	unsigned int devfn;
1083	int howmany = 0;	/*this is to see if there are any devices behind the bridge */
1084
1085	u32 bar[6], class;
1086	u32 address[] = {
1087		PCI_BASE_ADDRESS_0,
1088		PCI_BASE_ADDRESS_1,
1089		PCI_BASE_ADDRESS_2,
1090		PCI_BASE_ADDRESS_3,
1091		PCI_BASE_ADDRESS_4,
1092		PCI_BASE_ADDRESS_5,
1093		0
1094	};
1095	struct res_needed *amount;
1096
1097	amount = kzalloc(sizeof(*amount), GFP_KERNEL);
1098	if (amount == NULL)
1099		return NULL;
1100
1101	ibmphp_pci_bus->number = busno;
1102
1103	debug ("the bus_no behind the bridge is %x\n", busno);
1104	debug ("scanning devices behind the bridge...\n");
1105	for (device = 0; device < 32; device++) {
1106		amount->devices[device] = 0;
1107		for (function = 0; function < 8; function++) {
1108			devfn = PCI_DEVFN(device, function);
1109
1110			pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_VENDOR_ID, &vendor_id);
1111
1112			if (vendor_id != PCI_VENDOR_ID_NOTVALID) {
1113				/* found correct device!!! */
1114				howmany++;
1115
1116				pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_HEADER_TYPE, &hdr_type);
1117				pci_bus_read_config_dword (ibmphp_pci_bus, devfn, PCI_CLASS_REVISION, &class);
1118
1119				debug ("hdr_type behind the bridge is %x\n", hdr_type);
1120				if (hdr_type & PCI_HEADER_TYPE_BRIDGE) {
1121					err ("embedded bridges not supported for hot-plugging.\n");
1122					amount->not_correct = 1;
1123					return amount;
1124				}
1125
1126				class >>= 8;	/* to take revision out, class = class.subclass.prog i/f */
1127				if (class == PCI_CLASS_NOT_DEFINED_VGA) {
1128					err ("The device %x is VGA compatible and as is not supported for hot plugging. "
1129					     "Please choose another device.\n", device);
1130					amount->not_correct = 1;
1131					return amount;
1132				} else if (class == PCI_CLASS_DISPLAY_VGA) {
1133					err ("The device %x is not supported for hot plugging. "
1134					     "Please choose another device.\n", device);
1135					amount->not_correct = 1;
1136					return amount;
1137				}
1138
1139				amount->devices[device] = 1;
1140
1141				for (count = 0; address[count]; count++) {
1142					/* for 6 BARs */
1143					/*
1144					pci_bus_read_config_byte (ibmphp_pci_bus, devfn, address[count], &tmp);
1145					if (tmp & 0x01) // IO
1146						pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFD);
1147					else // MEMORY
1148						pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFF);
1149					*/
1150					pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFF);
1151					pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &bar[count]);
1152
1153					debug ("what is bar[count]? %x, count = %d\n", bar[count], count);
1154
1155					if (!bar[count])	/* This BAR is not implemented */
1156						continue;
1157
1158					//tmp_bar = bar[count];
1159
1160					debug ("count %d device %x function %x wants %x resources\n", count, device, function, bar[count]);
1161
1162					if (bar[count] & PCI_BASE_ADDRESS_SPACE_IO) {
1163						/* This is IO */
1164						len[count] = bar[count] & 0xFFFFFFFC;
1165						len[count] = ~len[count] + 1;
1166						amount->io += len[count];
1167					} else {
1168						/* This is Memory */
1169						if (bar[count] & PCI_BASE_ADDRESS_MEM_PREFETCH) {
1170							/* pfmem */
1171							len[count] = bar[count] & 0xFFFFFFF0;
1172							len[count] = ~len[count] + 1;
1173							amount->pfmem += len[count];
1174							if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64)
1175								/* takes up another dword */
1176								count += 1;
1177
1178						} else {
1179							/* regular memory */
1180							len[count] = bar[count] & 0xFFFFFFF0;
1181							len[count] = ~len[count] + 1;
1182							amount->mem += len[count];
1183							if (bar[count] & PCI_BASE_ADDRESS_MEM_TYPE_64) {
1184								/* takes up another dword */
1185								count += 1;
1186							}
1187						}
1188					}
1189				}	/* end for */
1190			}	/* end if (valid) */
1191		}	/* end for */
1192	}	/* end for */
1193
1194	if (!howmany)
1195		amount->not_correct = 1;
1196	else
1197		amount->not_correct = 0;
1198	if ((amount->io) && (amount->io < IOBRIDGE))
1199		amount->io = IOBRIDGE;
1200	if ((amount->mem) && (amount->mem < MEMBRIDGE))
1201		amount->mem = MEMBRIDGE;
1202	if ((amount->pfmem) && (amount->pfmem < MEMBRIDGE))
1203		amount->pfmem = MEMBRIDGE;
1204	return amount;
1205}
1206
1207/* The following 3 unconfigure_boot_ routines deal with the case when we had the card
1208 * upon bootup in the system, since we don't allocate func to such case, we need to read
1209 * the start addresses from pci config space and then find the corresponding entries in
1210 * our resource lists.  The functions return either 0, -ENODEV, or -1 (general failure)
1211 * Change: we also call these functions even if we configured the card ourselves (i.e., not
1212 * the bootup case), since it should work same way
1213 */
1214static int unconfigure_boot_device (u8 busno, u8 device, u8 function)
1215{
1216	u32 start_address;
1217	u32 address[] = {
1218		PCI_BASE_ADDRESS_0,
1219		PCI_BASE_ADDRESS_1,
1220		PCI_BASE_ADDRESS_2,
1221		PCI_BASE_ADDRESS_3,
1222		PCI_BASE_ADDRESS_4,
1223		PCI_BASE_ADDRESS_5,
1224		0
1225	};
1226	int count;
1227	struct resource_node *io;
1228	struct resource_node *mem;
1229	struct resource_node *pfmem;
1230	struct bus_node *bus;
1231	u32 end_address;
1232	u32 temp_end;
1233	u32 size;
1234	u32 tmp_address;
1235	unsigned int devfn;
1236
1237	debug ("%s - enter\n", __func__);
1238
1239	bus = ibmphp_find_res_bus (busno);
1240	if (!bus) {
1241		debug ("cannot find corresponding bus.\n");
1242		return -EINVAL;
1243	}
1244
1245	devfn = PCI_DEVFN(device, function);
1246	ibmphp_pci_bus->number = busno;
1247	for (count = 0; address[count]; count++) {	/* for 6 BARs */
1248		pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &start_address);
1249
1250		/* We can do this here, b/c by that time the device driver of the card has been stopped */
1251
1252		pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], 0xFFFFFFFF);
1253		pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &size);
1254		pci_bus_write_config_dword (ibmphp_pci_bus, devfn, address[count], start_address);
1255
1256		debug ("start_address is %x\n", start_address);
1257		debug ("busno, device, function %x %x %x\n", busno, device, function);
1258		if (!size) {
1259			/* This BAR is not implemented */
1260			debug ("is this bar no implemented?, count = %d\n", count);
1261			continue;
1262		}
1263		tmp_address = start_address;
1264		if (start_address & PCI_BASE_ADDRESS_SPACE_IO) {
1265			/* This is IO */
1266			start_address &= PCI_BASE_ADDRESS_IO_MASK;
1267			size = size & 0xFFFFFFFC;
1268			size = ~size + 1;
1269			end_address = start_address + size - 1;
1270			if (ibmphp_find_resource (bus, start_address, &io, IO) < 0) {
1271				err ("cannot find corresponding IO resource to remove\n");
1272				return -EIO;
1273			}
1274			debug ("io->start = %x\n", io->start);
1275			temp_end = io->end;
1276			start_address = io->end + 1;
1277			ibmphp_remove_resource (io);
1278			/* This is needed b/c of the old I/O restrictions in the BIOS */
1279			while (temp_end < end_address) {
1280				if (ibmphp_find_resource (bus, start_address, &io, IO) < 0) {
1281					err ("cannot find corresponding IO resource to remove\n");
1282					return -EIO;
1283				}
1284				debug ("io->start = %x\n", io->start);
1285				temp_end = io->end;
1286				start_address = io->end + 1;
1287				ibmphp_remove_resource (io);
1288			}
1289
1290			/* ????????? DO WE NEED TO WRITE ANYTHING INTO THE PCI CONFIG SPACE BACK ?????????? */
1291		} else {
1292			/* This is Memory */
1293			if (start_address & PCI_BASE_ADDRESS_MEM_PREFETCH) {
1294				/* pfmem */
1295				debug ("start address of pfmem is %x\n", start_address);
1296				start_address &= PCI_BASE_ADDRESS_MEM_MASK;
1297
1298				if (ibmphp_find_resource (bus, start_address, &pfmem, PFMEM) < 0) {
1299					err ("cannot find corresponding PFMEM resource to remove\n");
1300					return -EIO;
1301				}
1302				if (pfmem) {
1303					debug ("pfmem->start = %x\n", pfmem->start);
1304
1305					ibmphp_remove_resource(pfmem);
1306				}
1307			} else {
1308				/* regular memory */
1309				debug ("start address of mem is %x\n", start_address);
1310				start_address &= PCI_BASE_ADDRESS_MEM_MASK;
1311
1312				if (ibmphp_find_resource (bus, start_address, &mem, MEM) < 0) {
1313					err ("cannot find corresponding MEM resource to remove\n");
1314					return -EIO;
1315				}
1316				if (mem) {
1317					debug ("mem->start = %x\n", mem->start);
1318
1319					ibmphp_remove_resource(mem);
1320				}
1321			}
1322			if (tmp_address & PCI_BASE_ADDRESS_MEM_TYPE_64) {
1323				/* takes up another dword */
1324				count += 1;
1325			}
1326		}	/* end of mem */
1327	}	/* end of for */
1328
1329	return 0;
1330}
1331
1332static int unconfigure_boot_bridge (u8 busno, u8 device, u8 function)
1333{
1334	int count;
1335	int bus_no, pri_no, sub_no, sec_no = 0;
1336	u32 start_address, tmp_address;
1337	u8 sec_number, sub_number, pri_number;
1338	struct resource_node *io = NULL;
1339	struct resource_node *mem = NULL;
1340	struct resource_node *pfmem = NULL;
1341	struct bus_node *bus;
1342	u32 address[] = {
1343		PCI_BASE_ADDRESS_0,
1344		PCI_BASE_ADDRESS_1,
1345		0
1346	};
1347	unsigned int devfn;
1348
1349	devfn = PCI_DEVFN(device, function);
1350	ibmphp_pci_bus->number = busno;
1351	bus_no = (int) busno;
1352	debug ("busno is %x\n", busno);
1353	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_PRIMARY_BUS, &pri_number);
1354	debug ("%s - busno = %x, primary_number = %x\n", __func__, busno, pri_number);
1355
1356	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SECONDARY_BUS, &sec_number);
1357	debug ("sec_number is %x\n", sec_number);
1358	sec_no = (int) sec_number;
1359	pri_no = (int) pri_number;
1360	if (pri_no != bus_no) {
1361		err ("primary numbers in our structures and pci config space don't match.\n");
1362		return -EINVAL;
1363	}
1364
1365	pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_SUBORDINATE_BUS, &sub_number);
1366	sub_no = (int) sub_number;
1367	debug ("sub_no is %d, sec_no is %d\n", sub_no, sec_no);
1368	if (sec_no != sub_number) {
1369		err ("there're more buses behind this bridge.  Hot removal is not supported.  Please choose another card\n");
1370		return -ENODEV;
1371	}
1372
1373	bus = ibmphp_find_res_bus (sec_number);
1374	if (!bus) {
1375		err ("cannot find Bus structure for the bridged device\n");
1376		return -EINVAL;
1377	}
1378	debug("bus->busno is %x\n", bus->busno);
1379	debug("sec_number is %x\n", sec_number);
1380
1381	ibmphp_remove_bus (bus, busno);
1382
1383	for (count = 0; address[count]; count++) {
1384		/* for 2 BARs */
1385		pci_bus_read_config_dword (ibmphp_pci_bus, devfn, address[count], &start_address);
1386
1387		if (!start_address) {
1388			/* This BAR is not implemented */
1389			continue;
1390		}
1391
1392		tmp_address = start_address;
1393
1394		if (start_address & PCI_BASE_ADDRESS_SPACE_IO) {
1395			/* This is IO */
1396			start_address &= PCI_BASE_ADDRESS_IO_MASK;
1397			if (ibmphp_find_resource (bus, start_address, &io, IO) < 0) {
1398				err ("cannot find corresponding IO resource to remove\n");
1399				return -EIO;
1400			}
1401			if (io)
1402				debug ("io->start = %x\n", io->start);
1403
1404			ibmphp_remove_resource (io);
1405
1406			/* ????????? DO WE NEED TO WRITE ANYTHING INTO THE PCI CONFIG SPACE BACK ?????????? */
1407		} else {
1408			/* This is Memory */
1409			if (start_address & PCI_BASE_ADDRESS_MEM_PREFETCH) {
1410				/* pfmem */
1411				start_address &= PCI_BASE_ADDRESS_MEM_MASK;
1412				if (ibmphp_find_resource (bus, start_address, &pfmem, PFMEM) < 0) {
1413					err ("cannot find corresponding PFMEM resource to remove\n");
1414					return -EINVAL;
1415				}
1416				if (pfmem) {
1417					debug ("pfmem->start = %x\n", pfmem->start);
1418
1419					ibmphp_remove_resource(pfmem);
1420				}
1421			} else {
1422				/* regular memory */
1423				start_address &= PCI_BASE_ADDRESS_MEM_MASK;
1424				if (ibmphp_find_resource (bus, start_address, &mem, MEM) < 0) {
1425					err ("cannot find corresponding MEM resource to remove\n");
1426					return -EINVAL;
1427				}
1428				if (mem) {
1429					debug ("mem->start = %x\n", mem->start);
1430
1431					ibmphp_remove_resource(mem);
1432				}
1433			}
1434			if (tmp_address & PCI_BASE_ADDRESS_MEM_TYPE_64) {
1435				/* takes up another dword */
1436				count += 1;
1437			}
1438		}	/* end of mem */
1439	}	/* end of for */
1440	debug ("%s - exiting, returning success\n", __func__);
1441	return 0;
1442}
1443
1444static int unconfigure_boot_card (struct slot *slot_cur)
1445{
1446	u16 vendor_id;
1447	u32 class;
1448	u8 hdr_type;
1449	u8 device;
1450	u8 busno;
1451	u8 function;
1452	int rc;
1453	unsigned int devfn;
1454	u8 valid_device = 0x00; /* To see if we are ever able to find valid device and read it */
1455
1456	debug ("%s - enter\n", __func__);
1457
1458	device = slot_cur->device;
1459	busno = slot_cur->bus;
1460
1461	debug ("b4 for loop, device is %x\n", device);
1462	/* For every function on the card */
1463	for (function = 0x0; function < 0x08; function++) {
1464		devfn = PCI_DEVFN(device, function);
1465		ibmphp_pci_bus->number = busno;
1466
1467		pci_bus_read_config_word (ibmphp_pci_bus, devfn, PCI_VENDOR_ID, &vendor_id);
1468
1469		if (vendor_id != PCI_VENDOR_ID_NOTVALID) {
1470			/* found correct device!!! */
1471			++valid_device;
1472
1473			debug ("%s - found correct device\n", __func__);
1474
1475			/* header: x x x x x x x x
1476			 *         | |___________|=> 1=PPB bridge, 0=normal device, 2=CardBus Bridge
1477			 *         |_=> 0 = single function device, 1 = multi-function device
1478			 */
1479
1480			pci_bus_read_config_byte (ibmphp_pci_bus, devfn, PCI_HEADER_TYPE, &hdr_type);
1481			pci_bus_read_config_dword (ibmphp_pci_bus, devfn, PCI_CLASS_REVISION, &class);
1482
1483			debug ("hdr_type %x, class %x\n", hdr_type, class);
1484			class >>= 8;	/* to take revision out, class = class.subclass.prog i/f */
1485			if (class == PCI_CLASS_NOT_DEFINED_VGA) {
1486				err ("The device %x function %x is VGA compatible and is not supported for hot removing. "
1487				     "Please choose another device.\n", device, function);
1488				return -ENODEV;
1489			} else if (class == PCI_CLASS_DISPLAY_VGA) {
1490				err ("The device %x function %x is not supported for hot removing. "
1491				     "Please choose another device.\n", device, function);
1492				return -ENODEV;
1493			}
1494
1495			switch (hdr_type) {
1496				case PCI_HEADER_TYPE_NORMAL:
1497					rc = unconfigure_boot_device (busno, device, function);
1498					if (rc) {
1499						err ("was not able to unconfigure device %x func %x on bus %x. bailing out...\n",
1500						     device, function, busno);
1501						return rc;
1502					}
1503					function = 0x8;
1504					break;
1505				case PCI_HEADER_TYPE_MULTIDEVICE:
1506					rc = unconfigure_boot_device (busno, device, function);
1507					if (rc) {
1508						err ("was not able to unconfigure device %x func %x on bus %x. bailing out...\n",
1509						     device, function, busno);
1510						return rc;
1511					}
1512					break;
1513				case PCI_HEADER_TYPE_BRIDGE:
1514					class >>= 8;
1515					if (class != PCI_CLASS_BRIDGE_PCI) {
1516						err ("This device %x function %x is not PCI-to-PCI bridge, "
1517						     "and is not supported for hot-removing. "
1518						     "Please try another card.\n", device, function);
1519						return -ENODEV;
1520					}
1521					rc = unconfigure_boot_bridge (busno, device, function);
1522					if (rc != 0) {
1523						err ("was not able to hot-remove PPB properly.\n");
1524						return rc;
1525					}
1526
1527					function = 0x8;
1528					break;
1529				case PCI_HEADER_TYPE_MULTIBRIDGE:
1530					class >>= 8;
1531					if (class != PCI_CLASS_BRIDGE_PCI) {
1532						err ("This device %x function %x is not PCI-to-PCI bridge, "
1533						     "and is not supported for hot-removing. "
1534						     "Please try another card.\n", device, function);
1535						return -ENODEV;
1536					}
1537					rc = unconfigure_boot_bridge (busno, device, function);
1538					if (rc != 0) {
1539						err ("was not able to hot-remove PPB properly.\n");
1540						return rc;
1541					}
1542					break;
1543				default:
1544					err ("MAJOR PROBLEM!!!! Cannot read device's header\n");
1545					return -1;
1546					break;
1547			}	/* end of switch */
1548		}	/* end of valid device */
1549	}	/* end of for */
1550
1551	if (!valid_device) {
1552		err ("Could not find device to unconfigure.  Or could not read the card.\n");
1553		return -1;
1554	}
1555	return 0;
1556}
1557
1558/*
1559 * free the resources of the card (multi, single, or bridged)
1560 * Parameters: slot, flag to say if this is for removing entire module or just
1561 * unconfiguring the device
1562 * TO DO:  will probably need to add some code in case there was some resource,
1563 * to remove it... this is from when we have errors in the configure_card...
1564 * 			!!!!!!!!!!!!!!!!!!!!!!!!!FOR BUSES!!!!!!!!!!!!
1565 * Returns: 0, -1, -ENODEV
1566 */
1567int ibmphp_unconfigure_card (struct slot **slot_cur, int the_end)
1568{
1569	int i;
1570	int count;
1571	int rc;
1572	struct slot *sl = *slot_cur;
1573	struct pci_func *cur_func = NULL;
1574	struct pci_func *temp_func;
1575
1576	debug ("%s - enter\n", __func__);
1577
1578	if (!the_end) {
1579		/* Need to unconfigure the card */
1580		rc = unconfigure_boot_card (sl);
1581		if ((rc == -ENODEV) || (rc == -EIO) || (rc == -EINVAL)) {
1582			/* In all other cases, will still need to get rid of func structure if it exists */
1583			return rc;
1584		}
1585	}
1586
1587	if (sl->func) {
1588		cur_func = sl->func;
1589		while (cur_func) {
1590			/* TO DO: WILL MOST LIKELY NEED TO GET RID OF THE BUS STRUCTURE FROM RESOURCES AS WELL */
1591			if (cur_func->bus) {
1592				/* in other words, it's a PPB */
1593				count = 2;
1594			} else {
1595				count = 6;
1596			}
1597
1598			for (i = 0; i < count; i++) {
1599				if (cur_func->io[i]) {
1600					debug ("io[%d] exists\n", i);
1601					if (the_end > 0)
1602						ibmphp_remove_resource (cur_func->io[i]);
1603					cur_func->io[i] = NULL;
1604				}
1605				if (cur_func->mem[i]) {
1606					debug ("mem[%d] exists\n", i);
1607					if (the_end > 0)
1608						ibmphp_remove_resource (cur_func->mem[i]);
1609					cur_func->mem[i] = NULL;
1610				}
1611				if (cur_func->pfmem[i]) {
1612					debug ("pfmem[%d] exists\n", i);
1613					if (the_end > 0)
1614						ibmphp_remove_resource (cur_func->pfmem[i]);
1615					cur_func->pfmem[i] = NULL;
1616				}
1617			}
1618
1619			temp_func = cur_func->next;
1620			kfree (cur_func);
1621			cur_func = temp_func;
1622		}
1623	}
1624
1625	sl->func = NULL;
1626	*slot_cur = sl;
1627	debug ("%s - exit\n", __func__);
1628	return 0;
1629}
1630
1631/*
1632 * add a new bus resulting from hot-plugging a PPB bridge with devices
1633 *
1634 * Input: bus and the amount of resources needed (we know we can assign those,
1635 *        since they've been checked already
1636 * Output: bus added to the correct spot
1637 *         0, -1, error
1638 */
1639static int add_new_bus (struct bus_node *bus, struct resource_node *io, struct resource_node *mem, struct resource_node *pfmem, u8 parent_busno)
1640{
1641	struct range_node *io_range = NULL;
1642	struct range_node *mem_range = NULL;
1643	struct range_node *pfmem_range = NULL;
1644	struct bus_node *cur_bus = NULL;
1645
1646	/* Trying to find the parent bus number */
1647	if (parent_busno != 0xFF) {
1648		cur_bus	= ibmphp_find_res_bus (parent_busno);
1649		if (!cur_bus) {
1650			err ("strange, cannot find bus which is supposed to be at the system... something is terribly wrong...\n");
1651			return -ENODEV;
1652		}
1653
1654		list_add (&bus->bus_list, &cur_bus->bus_list);
1655	}
1656	if (io) {
1657		io_range = kzalloc(sizeof(*io_range), GFP_KERNEL);
1658		if (!io_range) {
1659			err ("out of system memory\n");
1660			return -ENOMEM;
1661		}
1662		io_range->start = io->start;
1663		io_range->end = io->end;
1664		io_range->rangeno = 1;
1665		bus->noIORanges = 1;
1666		bus->rangeIO = io_range;
1667	}
1668	if (mem) {
1669		mem_range = kzalloc(sizeof(*mem_range), GFP_KERNEL);
1670		if (!mem_range) {
1671			err ("out of system memory\n");
1672			return -ENOMEM;
1673		}
1674		mem_range->start = mem->start;
1675		mem_range->end = mem->end;
1676		mem_range->rangeno = 1;
1677		bus->noMemRanges = 1;
1678		bus->rangeMem = mem_range;
1679	}
1680	if (pfmem) {
1681		pfmem_range = kzalloc(sizeof(*pfmem_range), GFP_KERNEL);
1682		if (!pfmem_range) {
1683			err ("out of system memory\n");
1684			return -ENOMEM;
1685		}
1686		pfmem_range->start = pfmem->start;
1687		pfmem_range->end = pfmem->end;
1688		pfmem_range->rangeno = 1;
1689		bus->noPFMemRanges = 1;
1690		bus->rangePFMem = pfmem_range;
1691	}
1692	return 0;
1693}
1694
1695/*
1696 * find the 1st available bus number for PPB to set as its secondary bus
1697 * Parameters: bus_number of the primary bus
1698 * Returns: bus_number of the secondary bus or 0xff in case of failure
1699 */
1700static u8 find_sec_number (u8 primary_busno, u8 slotno)
1701{
1702	int min, max;
1703	u8 busno;
1704	struct bus_info *bus;
1705	struct bus_node *bus_cur;
1706
1707	bus = ibmphp_find_same_bus_num (primary_busno);
1708	if (!bus) {
1709		err ("cannot get slot range of the bus from the BIOS\n");
1710		return 0xff;
1711	}
1712	max = bus->slot_max;
1713	min = bus->slot_min;
1714	if ((slotno > max) || (slotno < min)) {
1715		err ("got the wrong range\n");
1716		return 0xff;
1717	}
1718	busno = (u8) (slotno - (u8) min);
1719	busno += primary_busno + 0x01;
1720	bus_cur = ibmphp_find_res_bus (busno);
1721	/* either there is no such bus number, or there are no ranges, which
1722	 * can only happen if we removed the bridged device in previous load
1723	 * of the driver, and now only have the skeleton bus struct
1724	 */
1725	if ((!bus_cur) || (!(bus_cur->rangeIO) && !(bus_cur->rangeMem) && !(bus_cur->rangePFMem)))
1726		return busno;
1727	return 0xff;
1728}
1729
1730