1 /* 2 * Copyright 2004 Freescale Semiconductor. 3 * 4 * See file CREDITS for list of people who contributed to this 5 * project. 6 * 7 * This program is free software; you can redistribute it and/or 8 * modify it under the terms of the GNU General Public License as 9 * published by the Free Software Foundation; either version 2 of 10 * the License, or (at your option) any later version. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 * You should have received a copy of the GNU General Public License 18 * along with this program; if not, write to the Free Software 19 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 20 * MA 02111-1307 USA 21 */ 22 23 #include <common.h> 24 #include <libfdt.h> 25 #include <fdt_support.h> 26 #include "cadmus.h" 27 28 #if defined(CONFIG_OF_BOARD_SETUP) 29 static void cds_pci_fixup(void *blob) 30 { 31 int node; 32 const char *path; 33 int len, slot, i; 34 u32 *map = NULL, *piccells = NULL; 35 int off, cells; 36 37 node = fdt_path_offset(blob, "/aliases"); 38 if (node >= 0) { 39 path = fdt_getprop(blob, node, "pci0", NULL); 40 if (path) { 41 node = fdt_path_offset(blob, path); 42 if (node >= 0) { 43 map = fdt_getprop_w(blob, node, "interrupt-map", &len); 44 } 45 /* Each item in "interrupt-map" property is translated with 46 * following cells: 47 * PCI #address-cells, PCI #interrupt-cells, 48 * PIC address, PIC #address-cells, PIC #interrupt-cells. 49 */ 50 cells = fdt_getprop_u32_default(blob, path, "#address-cells", 1); 51 cells += fdt_getprop_u32_default(blob, path, "#interrupt-cells", 1); 52 off = fdt_node_offset_by_phandle(blob, fdt32_to_cpu(*(map+cells))); 53 if (off <= 0) 54 return; 55 cells += 1; 56 piccells = (u32 *)fdt_getprop(blob, off, "#address-cells", NULL); 57 if (piccells == NULL) 58 return; 59 cells += *piccells; 60 piccells = (u32 *)fdt_getprop(blob, off, "#interrupt-cells", NULL); 61 if (piccells == NULL) 62 return; 63 cells += *piccells; 64 } 65 } 66 67 if (map) { 68 len /= sizeof(u32); 69 70 slot = get_pci_slot(); 71 72 for (i=0;i<len;i+=cells) { 73 /* We rotate the interrupt pins so that the mapping 74 * changes depending on the slot the carrier card is in. 75 */ 76 map[3] = ((map[3] + slot - 2) % 4) + 1; 77 map+=cells; 78 } 79 } 80 } 81 82 void 83 ft_board_setup(void *blob, bd_t *bd) 84 { 85 ft_cpu_setup(blob, bd); 86 #ifdef CONFIG_PCI 87 ft_pci_setup(blob, bd); 88 cds_pci_fixup(blob); 89 #endif 90 } 91 #endif 92