110 lines
		
	
	
	
		
			2.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
		
		
			
		
	
	
			110 lines
		
	
	
	
		
			2.7 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
|   | /*
 | ||
|  |  * linux/arch/mips/pci/pci-tx4939.c | ||
|  |  * | ||
|  |  * Based on linux/arch/mips/txx9/rbtx4939/setup.c, | ||
|  |  *	    and RBTX49xx patch from CELF patch archive. | ||
|  |  * | ||
|  |  * Copyright 2001, 2003-2005 MontaVista Software Inc. | ||
|  |  * Copyright (C) 2004 by Ralf Baechle (ralf@linux-mips.org) | ||
|  |  * (C) Copyright TOSHIBA CORPORATION 2000-2001, 2004-2007 | ||
|  |  * | ||
|  |  * This file is subject to the terms and conditions of the GNU General Public | ||
|  |  * License.  See the file "COPYING" in the main directory of this archive | ||
|  |  * for more details. | ||
|  |  */ | ||
|  | #include <linux/init.h>
 | ||
|  | #include <linux/pci.h>
 | ||
|  | #include <linux/kernel.h>
 | ||
|  | #include <linux/interrupt.h>
 | ||
|  | #include <asm/txx9/generic.h>
 | ||
|  | #include <asm/txx9/tx4939.h>
 | ||
|  | 
 | ||
|  | int __init tx4939_report_pciclk(void) | ||
|  | { | ||
|  | 	int pciclk = 0; | ||
|  | 
 | ||
|  | 	pr_info("PCIC --%s PCICLK:", | ||
|  | 		(__raw_readq(&tx4939_ccfgptr->ccfg) & TX4939_CCFG_PCI66) ? | ||
|  | 		" PCI66" : ""); | ||
|  | 	if (__raw_readq(&tx4939_ccfgptr->pcfg) & TX4939_PCFG_PCICLKEN_ALL) { | ||
|  | 		pciclk = txx9_master_clock * 20 / 6; | ||
|  | 		if (!(__raw_readq(&tx4939_ccfgptr->ccfg) & TX4939_CCFG_PCI66)) | ||
|  | 			pciclk /= 2; | ||
|  | 		printk(KERN_CONT "Internal(%u.%uMHz)", | ||
|  | 		       (pciclk + 50000) / 1000000, | ||
|  | 		       ((pciclk + 50000) / 100000) % 10); | ||
|  | 	} else { | ||
|  | 		printk(KERN_CONT "External"); | ||
|  | 		pciclk = -1; | ||
|  | 	} | ||
|  | 	printk(KERN_CONT "\n"); | ||
|  | 	return pciclk; | ||
|  | } | ||
|  | 
 | ||
|  | void __init tx4939_report_pci1clk(void) | ||
|  | { | ||
|  | 	unsigned int pciclk = txx9_master_clock * 20 / 6; | ||
|  | 
 | ||
|  | 	pr_info("PCIC1 -- PCICLK:%u.%uMHz\n", | ||
|  | 		(pciclk + 50000) / 1000000, | ||
|  | 		((pciclk + 50000) / 100000) % 10); | ||
|  | } | ||
|  | 
 | ||
|  | int __init tx4939_pcic1_map_irq(const struct pci_dev *dev, u8 slot) | ||
|  | { | ||
|  | 	if (get_tx4927_pcicptr(dev->bus->sysdata) == tx4939_pcic1ptr) { | ||
|  | 		switch (slot) { | ||
|  | 		case TX4927_PCIC_IDSEL_AD_TO_SLOT(31): | ||
|  | 			if (__raw_readq(&tx4939_ccfgptr->pcfg) & | ||
|  | 			    TX4939_PCFG_ET0MODE) | ||
|  | 				return TXX9_IRQ_BASE + TX4939_IR_ETH(0); | ||
|  | 			break; | ||
|  | 		case TX4927_PCIC_IDSEL_AD_TO_SLOT(30): | ||
|  | 			if (__raw_readq(&tx4939_ccfgptr->pcfg) & | ||
|  | 			    TX4939_PCFG_ET1MODE) | ||
|  | 				return TXX9_IRQ_BASE + TX4939_IR_ETH(1); | ||
|  | 			break; | ||
|  | 		} | ||
|  | 		return 0; | ||
|  | 	} | ||
|  | 	return -1; | ||
|  | } | ||
|  | 
 | ||
|  | int __init tx4939_pci_map_irq(const struct pci_dev *dev, u8 slot, u8 pin) | ||
|  | { | ||
|  | 	int irq = tx4939_pcic1_map_irq(dev, slot); | ||
|  | 
 | ||
|  | 	if (irq >= 0) | ||
|  | 		return irq; | ||
|  | 	irq = pin; | ||
|  | 	/* IRQ rotation */ | ||
|  | 	irq--;	/* 0-3 */ | ||
|  | 	irq = (irq + 33 - slot) % 4; | ||
|  | 	irq++;	/* 1-4 */ | ||
|  | 
 | ||
|  | 	switch (irq) { | ||
|  | 	case 1: | ||
|  | 		irq = TXX9_IRQ_BASE + TX4939_IR_INTA; | ||
|  | 		break; | ||
|  | 	case 2: | ||
|  | 		irq = TXX9_IRQ_BASE + TX4939_IR_INTB; | ||
|  | 		break; | ||
|  | 	case 3: | ||
|  | 		irq = TXX9_IRQ_BASE + TX4939_IR_INTC; | ||
|  | 		break; | ||
|  | 	case 4: | ||
|  | 		irq = TXX9_IRQ_BASE + TX4939_IR_INTD; | ||
|  | 		break; | ||
|  | 	} | ||
|  | 	return irq; | ||
|  | } | ||
|  | 
 | ||
|  | void __init tx4939_setup_pcierr_irq(void) | ||
|  | { | ||
|  | 	if (request_irq(TXX9_IRQ_BASE + TX4939_IR_PCIERR, | ||
|  | 			tx4927_pcierr_interrupt, | ||
|  | 			IRQF_DISABLED, "PCI error", | ||
|  | 			(void *)TX4939_PCIC_REG)) | ||
|  | 		pr_warning("Failed to request irq for PCIERR\n"); | ||
|  | } |