| Songmao Tian | 42d226c | 2007-06-06 14:52:38 +0800 | [diff] [blame] | 1 | /* | 
 | 2 |  * fixup-lm2e.c | 
 | 3 |  * | 
 | 4 |  * Copyright (C) 2004 ICT CAS | 
 | 5 |  * Author: Li xiaoyu, ICT CAS | 
 | 6 |  *   lixy@ict.ac.cn | 
 | 7 |  * | 
 | 8 |  * Copyright (C) 2007 Lemote, Inc. & Institute of Computing Technology | 
 | 9 |  * Author: Fuxin Zhang, zhangfx@lemote.com | 
 | 10 |  * | 
 | 11 |  *  This program is free software; you can redistribute  it and/or modify it | 
 | 12 |  *  under  the terms of  the GNU General  Public License as published by the | 
 | 13 |  *  Free Software Foundation;  either version 2 of the  License, or (at your | 
 | 14 |  *  option) any later version. | 
 | 15 |  * | 
 | 16 |  *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED | 
 | 17 |  *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF | 
 | 18 |  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN | 
 | 19 |  *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT, | 
 | 20 |  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT | 
 | 21 |  *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF | 
 | 22 |  *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON | 
 | 23 |  *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT | 
 | 24 |  *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF | 
 | 25 |  *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. | 
 | 26 |  * | 
 | 27 |  *  You should have received a copy of the  GNU General Public License along | 
 | 28 |  *  with this program; if not, write  to the Free Software Foundation, Inc., | 
 | 29 |  *  675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 30 |  * | 
 | 31 |  */ | 
 | 32 | #include <linux/init.h> | 
 | 33 | #include <linux/pci.h> | 
 | 34 | #include <asm/mips-boards/bonito64.h> | 
 | 35 |  | 
 | 36 | /* South bridge slot number is set by the pci probe process */ | 
 | 37 | static u8 sb_slot = 5; | 
 | 38 |  | 
 | 39 | int __init pcibios_map_irq(const struct pci_dev *dev, u8 slot, u8 pin) | 
 | 40 | { | 
 | 41 | 	int irq = 0; | 
 | 42 |  | 
 | 43 | 	if (slot == sb_slot) { | 
 | 44 | 		switch (PCI_FUNC(dev->devfn)) { | 
 | 45 | 		case 2: | 
 | 46 | 			irq = 10; | 
 | 47 | 			break; | 
 | 48 | 		case 3: | 
 | 49 | 			irq = 11; | 
 | 50 | 			break; | 
 | 51 | 		case 5: | 
 | 52 | 			irq = 9; | 
 | 53 | 			break; | 
 | 54 | 		} | 
 | 55 | 	} else { | 
 | 56 | 		irq = BONITO_IRQ_BASE + 25 + pin; | 
 | 57 | 	} | 
 | 58 | 	return irq; | 
 | 59 |  | 
 | 60 | } | 
 | 61 |  | 
 | 62 | /* Do platform specific device initialization at pci_enable_device() time */ | 
 | 63 | int pcibios_plat_dev_init(struct pci_dev *dev) | 
 | 64 | { | 
 | 65 | 	return 0; | 
 | 66 | } | 
 | 67 |  | 
 | 68 | static void __init loongson2e_nec_fixup(struct pci_dev *pdev) | 
 | 69 | { | 
 | 70 | 	unsigned int val; | 
 | 71 |  | 
 | 72 | 	/* Configues port 1, 2, 3, 4 to be validate*/ | 
 | 73 | 	pci_read_config_dword(pdev, 0xe0, &val); | 
 | 74 | 	pci_write_config_dword(pdev, 0xe0, (val & ~7) | 0x4); | 
 | 75 |  | 
 | 76 | 	/* System clock is 48-MHz Oscillator. */ | 
 | 77 | 	pci_write_config_dword(pdev, 0xe4, 1 << 5); | 
 | 78 | } | 
 | 79 |  | 
 | 80 | static void __init loongson2e_686b_func0_fixup(struct pci_dev *pdev) | 
 | 81 | { | 
 | 82 | 	unsigned char c; | 
 | 83 |  | 
 | 84 | 	sb_slot = PCI_SLOT(pdev->devfn); | 
 | 85 |  | 
 | 86 | 	printk(KERN_INFO "via686b fix: ISA bridge\n"); | 
 | 87 |  | 
 | 88 | 	/*  Enable I/O Recovery time */ | 
 | 89 | 	pci_write_config_byte(pdev, 0x40, 0x08); | 
 | 90 |  | 
 | 91 | 	/*  Enable ISA refresh */ | 
 | 92 | 	pci_write_config_byte(pdev, 0x41, 0x01); | 
 | 93 |  | 
 | 94 | 	/*  disable ISA line buffer */ | 
 | 95 | 	pci_write_config_byte(pdev, 0x45, 0x00); | 
 | 96 |  | 
 | 97 | 	/*  Gate INTR, and flush line buffer */ | 
 | 98 | 	pci_write_config_byte(pdev, 0x46, 0xe0); | 
 | 99 |  | 
 | 100 | 	/*  Disable PCI Delay Transaction, Enable EISA ports 4D0/4D1. */ | 
 | 101 | 	/* pci_write_config_byte(pdev, 0x47, 0x20); */ | 
 | 102 |  | 
 | 103 | 	/* | 
 | 104 | 	 *  enable PCI Delay Transaction, Enable EISA ports 4D0/4D1. | 
 | 105 | 	 *  enable time-out timer | 
 | 106 | 	 */ | 
 | 107 | 	pci_write_config_byte(pdev, 0x47, 0xe6); | 
 | 108 |  | 
 | 109 | 	/* | 
 | 110 | 	 * enable level trigger on pci irqs: 9,10,11,13 | 
 | 111 | 	 * important! without this PCI interrupts won't work | 
 | 112 | 	 */ | 
 | 113 | 	outb(0x2e, 0x4d1); | 
 | 114 |  | 
 | 115 | 	/*  512 K PCI Decode */ | 
 | 116 | 	pci_write_config_byte(pdev, 0x48, 0x01); | 
 | 117 |  | 
 | 118 | 	/*  Wait for PGNT before grant to ISA Master/DMA */ | 
 | 119 | 	pci_write_config_byte(pdev, 0x4a, 0x84); | 
 | 120 |  | 
 | 121 | 	/* | 
 | 122 | 	 * Plug'n'Play | 
 | 123 | 	 * | 
 | 124 | 	 *  Parallel DRQ 3, Floppy DRQ 2 (default) | 
 | 125 | 	 */ | 
 | 126 | 	pci_write_config_byte(pdev, 0x50, 0x0e); | 
 | 127 |  | 
 | 128 | 	/* | 
 | 129 | 	 * IRQ Routing for Floppy and Parallel port | 
 | 130 | 	 * | 
 | 131 | 	 *  IRQ 6 for floppy, IRQ 7 for parallel port | 
 | 132 | 	 */ | 
 | 133 | 	pci_write_config_byte(pdev, 0x51, 0x76); | 
 | 134 |  | 
 | 135 | 	/* IRQ Routing for serial ports (take IRQ 3 and 4) */ | 
 | 136 | 	pci_write_config_byte(pdev, 0x52, 0x34); | 
 | 137 |  | 
 | 138 | 	/*  All IRQ's level triggered. */ | 
 | 139 | 	pci_write_config_byte(pdev, 0x54, 0x00); | 
 | 140 |  | 
 | 141 | 	/* route PIRQA-D irq */ | 
 | 142 | 	pci_write_config_byte(pdev, 0x55, 0x90);	/* bit 7-4, PIRQA */ | 
 | 143 | 	pci_write_config_byte(pdev, 0x56, 0xba);	/* bit 7-4, PIRQC; */ | 
 | 144 | 							/* 3-0, PIRQB */ | 
 | 145 | 	pci_write_config_byte(pdev, 0x57, 0xd0);	/* bit 7-4, PIRQD */ | 
 | 146 |  | 
 | 147 | 	/* enable function 5/6, audio/modem */ | 
 | 148 | 	pci_read_config_byte(pdev, 0x85, &c); | 
 | 149 | 	c &= ~(0x3 << 2); | 
 | 150 | 	pci_write_config_byte(pdev, 0x85, c); | 
 | 151 |  | 
 | 152 | 	printk(KERN_INFO"via686b fix: ISA bridge done\n"); | 
 | 153 | } | 
 | 154 |  | 
 | 155 | static void __init loongson2e_686b_func1_fixup(struct pci_dev *pdev) | 
 | 156 | { | 
 | 157 | 	printk(KERN_INFO"via686b fix: IDE\n"); | 
 | 158 |  | 
 | 159 | 	/* Modify IDE controller setup */ | 
 | 160 | 	pci_write_config_byte(pdev, PCI_LATENCY_TIMER, 48); | 
 | 161 | 	pci_write_config_byte(pdev, PCI_COMMAND, | 
 | 162 | 			      PCI_COMMAND_IO | PCI_COMMAND_MEMORY | | 
 | 163 | 			      PCI_COMMAND_MASTER); | 
 | 164 | 	pci_write_config_byte(pdev, 0x40, 0x0b); | 
 | 165 | 	/* legacy mode */ | 
 | 166 | 	pci_write_config_byte(pdev, 0x42, 0x09); | 
 | 167 |  | 
 | 168 | #if 1/* play safe, otherwise we may see notebook's usb keyboard lockup */ | 
 | 169 | 	/* disable read prefetch/write post buffers */ | 
 | 170 | 	pci_write_config_byte(pdev, 0x41, 0x02); | 
 | 171 |  | 
 | 172 | 	/* use 3/4 as fifo thresh hold  */ | 
 | 173 | 	pci_write_config_byte(pdev, 0x43, 0x0a); | 
 | 174 | 	pci_write_config_byte(pdev, 0x44, 0x00); | 
 | 175 |  | 
 | 176 | 	pci_write_config_byte(pdev, 0x45, 0x00); | 
 | 177 | #else | 
 | 178 | 	pci_write_config_byte(pdev, 0x41, 0xc2); | 
 | 179 | 	pci_write_config_byte(pdev, 0x43, 0x35); | 
 | 180 | 	pci_write_config_byte(pdev, 0x44, 0x1c); | 
 | 181 |  | 
 | 182 | 	pci_write_config_byte(pdev, 0x45, 0x10); | 
 | 183 | #endif | 
 | 184 |  | 
 | 185 | 	printk(KERN_INFO"via686b fix: IDE done\n"); | 
 | 186 | } | 
 | 187 |  | 
 | 188 | static void __init loongson2e_686b_func2_fixup(struct pci_dev *pdev) | 
 | 189 | { | 
 | 190 | 	/* irq routing */ | 
 | 191 | 	pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, 10); | 
 | 192 | } | 
 | 193 |  | 
 | 194 | static void __init loongson2e_686b_func3_fixup(struct pci_dev *pdev) | 
 | 195 | { | 
 | 196 | 	/* irq routing */ | 
 | 197 | 	pci_write_config_byte(pdev, PCI_INTERRUPT_LINE, 11); | 
 | 198 | } | 
 | 199 |  | 
 | 200 | static void __init loongson2e_686b_func5_fixup(struct pci_dev *pdev) | 
 | 201 | { | 
 | 202 | 	unsigned int val; | 
 | 203 | 	unsigned char c; | 
 | 204 |  | 
 | 205 | 	/* enable IO */ | 
 | 206 | 	pci_write_config_byte(pdev, PCI_COMMAND, | 
 | 207 | 			      PCI_COMMAND_IO | PCI_COMMAND_MEMORY | | 
 | 208 | 			      PCI_COMMAND_MASTER); | 
 | 209 | 	pci_read_config_dword(pdev, 0x4, &val); | 
 | 210 | 	pci_write_config_dword(pdev, 0x4, val | 1); | 
 | 211 |  | 
 | 212 | 	/* route ac97 IRQ */ | 
 | 213 | 	pci_write_config_byte(pdev, 0x3c, 9); | 
 | 214 |  | 
 | 215 | 	pci_read_config_byte(pdev, 0x8, &c); | 
 | 216 |  | 
 | 217 | 	/* link control: enable link & SGD PCM output */ | 
 | 218 | 	pci_write_config_byte(pdev, 0x41, 0xcc); | 
 | 219 |  | 
 | 220 | 	/* disable game port, FM, midi, sb, enable write to reg2c-2f */ | 
 | 221 | 	pci_write_config_byte(pdev, 0x42, 0x20); | 
 | 222 |  | 
 | 223 | 	/* we are using Avance logic codec */ | 
 | 224 | 	pci_write_config_word(pdev, 0x2c, 0x1005); | 
 | 225 | 	pci_write_config_word(pdev, 0x2e, 0x4710); | 
 | 226 | 	pci_read_config_dword(pdev, 0x2c, &val); | 
 | 227 |  | 
 | 228 | 	pci_write_config_byte(pdev, 0x42, 0x0); | 
 | 229 | } | 
 | 230 |  | 
 | 231 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686, | 
 | 232 | 			 loongson2e_686b_func0_fixup); | 
 | 233 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_1, | 
 | 234 | 			 loongson2e_686b_func1_fixup); | 
 | 235 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_2, | 
 | 236 | 			 loongson2e_686b_func2_fixup); | 
 | 237 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C586_3, | 
 | 238 | 			 loongson2e_686b_func3_fixup); | 
 | 239 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_VIA, PCI_DEVICE_ID_VIA_82C686_5, | 
 | 240 | 			 loongson2e_686b_func5_fixup); | 
 | 241 | DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_NEC, PCI_DEVICE_ID_NEC_USB, | 
 | 242 | 			 loongson2e_nec_fixup); |