| Andres Salomon | 3ef0e1f | 2008-04-29 00:59:53 -0700 | [diff] [blame] | 1 | /* | 
|  | 2 | * Low-level PCI config space access for OLPC systems who lack the VSA | 
|  | 3 | * PCI virtualization software. | 
|  | 4 | * | 
|  | 5 | * Copyright © 2006  Advanced Micro Devices, Inc. | 
|  | 6 | * | 
|  | 7 | * This program is free software; you can redistribute it and/or modify | 
|  | 8 | * it under the terms of the GNU General Public License as published by | 
|  | 9 | * the Free Software Foundation; either version 2 of the License, or | 
|  | 10 | * (at your option) any later version. | 
|  | 11 | * | 
|  | 12 | * The AMD Geode chipset (ie: GX2 processor, cs5536 I/O companion device) | 
|  | 13 | * has some I/O functions (display, southbridge, sound, USB HCIs, etc) | 
|  | 14 | * that more or less behave like PCI devices, but the hardware doesn't | 
|  | 15 | * directly implement the PCI configuration space headers.  AMD provides | 
|  | 16 | * "VSA" (Virtual System Architecture) software that emulates PCI config | 
|  | 17 | * space for these devices, by trapping I/O accesses to PCI config register | 
|  | 18 | * (CF8/CFC) and running some code in System Management Mode interrupt state. | 
|  | 19 | * On the OLPC platform, we don't want to use that VSA code because | 
|  | 20 | * (a) it slows down suspend/resume, and (b) recompiling it requires special | 
|  | 21 | * compilers that are hard to get.  So instead of letting the complex VSA | 
|  | 22 | * code simulate the PCI config registers for the on-chip devices, we | 
|  | 23 | * just simulate them the easy way, by inserting the code into the | 
|  | 24 | * pci_write_config and pci_read_config path.  Most of the config registers | 
|  | 25 | * are read-only anyway, so the bulk of the simulation is just table lookup. | 
|  | 26 | */ | 
|  | 27 |  | 
|  | 28 | #include <linux/pci.h> | 
|  | 29 | #include <linux/init.h> | 
|  | 30 | #include <asm/olpc.h> | 
|  | 31 | #include <asm/geode.h> | 
| Jaswinder Singh Rajput | 8248771 | 2008-12-27 18:32:28 +0530 | [diff] [blame] | 32 | #include <asm/pci_x86.h> | 
| Andres Salomon | 3ef0e1f | 2008-04-29 00:59:53 -0700 | [diff] [blame] | 33 |  | 
|  | 34 | /* | 
|  | 35 | * In the tables below, the first two line (8 longwords) are the | 
|  | 36 | * size masks that are used when the higher level PCI code determines | 
|  | 37 | * the size of the region by writing ~0 to a base address register | 
|  | 38 | * and reading back the result. | 
|  | 39 | * | 
|  | 40 | * The following lines are the values that are read during normal | 
|  | 41 | * PCI config access cycles, i.e. not after just having written | 
|  | 42 | * ~0 to a base address register. | 
|  | 43 | */ | 
|  | 44 |  | 
|  | 45 | static const uint32_t lxnb_hdr[] = {  /* dev 1 function 0 - devfn = 8 */ | 
|  | 46 | 0x0,	0x0,	0x0,	0x0, | 
|  | 47 | 0x0,	0x0,	0x0,	0x0, | 
|  | 48 |  | 
|  | 49 | 0x281022, 0x2200005, 0x6000021, 0x80f808,	/* AMD Vendor ID */ | 
|  | 50 | 0x0,	0x0,	0x0,	0x0,   /* No virtual registers, hence no BAR */ | 
|  | 51 | 0x0,	0x0,	0x0,	0x28100b, | 
|  | 52 | 0x0,	0x0,	0x0,	0x0, | 
|  | 53 | 0x0,	0x0,	0x0,	0x0, | 
|  | 54 | 0x0,	0x0,	0x0,	0x0, | 
|  | 55 | 0x0,	0x0,	0x0,	0x0, | 
|  | 56 | }; | 
|  | 57 |  | 
|  | 58 | static const uint32_t gxnb_hdr[] = {  /* dev 1 function 0 - devfn = 8 */ | 
|  | 59 | 0xfffffffd, 0x0, 0x0,	0x0, | 
|  | 60 | 0x0,	0x0,	0x0,	0x0, | 
|  | 61 |  | 
|  | 62 | 0x28100b, 0x2200005, 0x6000021, 0x80f808,	/* NSC Vendor ID */ | 
|  | 63 | 0xac1d,	0x0,	0x0,	0x0,  /* I/O BAR - base of virtual registers */ | 
|  | 64 | 0x0,	0x0,	0x0,	0x28100b, | 
|  | 65 | 0x0,	0x0,	0x0,	0x0, | 
|  | 66 | 0x0,	0x0,	0x0,	0x0, | 
|  | 67 | 0x0,	0x0,	0x0,	0x0, | 
|  | 68 | 0x0,	0x0,	0x0,	0x0, | 
|  | 69 | }; | 
|  | 70 |  | 
|  | 71 | static const uint32_t lxfb_hdr[] = {  /* dev 1 function 1 - devfn = 9 */ | 
|  | 72 | 0xff000008, 0xffffc000, 0xffffc000, 0xffffc000, | 
|  | 73 | 0xffffc000,	0x0,	0x0,	0x0, | 
|  | 74 |  | 
|  | 75 | 0x20811022, 0x2200003, 0x3000000, 0x0,		/* AMD Vendor ID */ | 
|  | 76 | 0xfd000000, 0xfe000000, 0xfe004000, 0xfe008000, /* FB, GP, VG, DF */ | 
|  | 77 | 0xfe00c000, 0x0, 0x0,	0x30100b,		/* VIP */ | 
|  | 78 | 0x0,	0x0,	0x0,	0x10e,	   /* INTA, IRQ14 for graphics accel */ | 
|  | 79 | 0x0,	0x0,	0x0,	0x0, | 
|  | 80 | 0x3d0,	0x3c0,	0xa0000, 0x0,	    /* VG IO, VG IO, EGA FB, MONO FB */ | 
|  | 81 | 0x0,	0x0,	0x0,	0x0, | 
|  | 82 | }; | 
|  | 83 |  | 
|  | 84 | static const uint32_t gxfb_hdr[] = {  /* dev 1 function 1 - devfn = 9 */ | 
|  | 85 | 0xff800008, 0xffffc000, 0xffffc000, 0xffffc000, | 
|  | 86 | 0x0,	0x0,	0x0,	0x0, | 
|  | 87 |  | 
|  | 88 | 0x30100b, 0x2200003, 0x3000000, 0x0,		/* NSC Vendor ID */ | 
|  | 89 | 0xfd000000, 0xfe000000, 0xfe004000, 0xfe008000,	/* FB, GP, VG, DF */ | 
|  | 90 | 0x0,	0x0,	0x0,	0x30100b, | 
|  | 91 | 0x0,	0x0,	0x0,	0x0, | 
|  | 92 | 0x0,	0x0,	0x0,	0x0, | 
|  | 93 | 0x3d0,	0x3c0,	0xa0000, 0x0,  	    /* VG IO, VG IO, EGA FB, MONO FB */ | 
|  | 94 | 0x0,	0x0,	0x0,	0x0, | 
|  | 95 | }; | 
|  | 96 |  | 
|  | 97 | static const uint32_t aes_hdr[] = {	/* dev 1 function 2 - devfn = 0xa */ | 
|  | 98 | 0xffffc000, 0x0, 0x0,	0x0, | 
|  | 99 | 0x0,	0x0,	0x0,	0x0, | 
|  | 100 |  | 
|  | 101 | 0x20821022, 0x2a00006, 0x10100000, 0x8,		/* NSC Vendor ID */ | 
|  | 102 | 0xfe010000, 0x0, 0x0,	0x0,			/* AES registers */ | 
|  | 103 | 0x0,	0x0,	0x0,	0x20821022, | 
|  | 104 | 0x0,	0x0,	0x0,	0x0, | 
|  | 105 | 0x0,	0x0,	0x0,	0x0, | 
|  | 106 | 0x0,	0x0,	0x0,	0x0, | 
|  | 107 | 0x0,	0x0,	0x0,	0x0, | 
|  | 108 | }; | 
|  | 109 |  | 
|  | 110 |  | 
|  | 111 | static const uint32_t isa_hdr[] = {  /* dev f function 0 - devfn = 78 */ | 
|  | 112 | 0xfffffff9, 0xffffff01, 0xffffffc1, 0xffffffe1, | 
|  | 113 | 0xffffff81, 0xffffffc1, 0x0, 0x0, | 
|  | 114 |  | 
|  | 115 | 0x20901022, 0x2a00049, 0x6010003, 0x802000, | 
|  | 116 | 0x18b1,	0x1001,	0x1801,	0x1881,	/* SMB-8   GPIO-256 MFGPT-64  IRQ-32 */ | 
|  | 117 | 0x1401,	0x1841,	0x0,	0x20901022,		/* PMS-128 ACPI-64 */ | 
|  | 118 | 0x0,	0x0,	0x0,	0x0, | 
|  | 119 | 0x0,	0x0,	0x0,	0x0, | 
|  | 120 | 0x0,	0x0,	0x0,	0xaa5b,			/* IRQ steering */ | 
|  | 121 | 0x0,	0x0,	0x0,	0x0, | 
|  | 122 | }; | 
|  | 123 |  | 
|  | 124 | static const uint32_t ac97_hdr[] = {  /* dev f function 3 - devfn = 7b */ | 
|  | 125 | 0xffffff81, 0x0, 0x0,	0x0, | 
|  | 126 | 0x0,	0x0,	0x0,	0x0, | 
|  | 127 |  | 
|  | 128 | 0x20931022, 0x2a00041, 0x4010001, 0x0, | 
|  | 129 | 0x1481,	0x0,	0x0,	0x0,			/* I/O BAR-128 */ | 
|  | 130 | 0x0,	0x0,	0x0,	0x20931022, | 
|  | 131 | 0x0,	0x0,	0x0,	0x205,			/* IntB, IRQ5 */ | 
|  | 132 | 0x0,	0x0,	0x0,	0x0, | 
|  | 133 | 0x0,	0x0,	0x0,	0x0, | 
|  | 134 | 0x0,	0x0,	0x0,	0x0, | 
|  | 135 | }; | 
|  | 136 |  | 
|  | 137 | static const uint32_t ohci_hdr[] = {  /* dev f function 4 - devfn = 7c */ | 
|  | 138 | 0xfffff000, 0x0, 0x0,	0x0, | 
|  | 139 | 0x0,	0x0,	0x0,	0x0, | 
|  | 140 |  | 
|  | 141 | 0x20941022, 0x2300006, 0xc031002, 0x0, | 
|  | 142 | 0xfe01a000, 0x0, 0x0,	0x0,			/* MEMBAR-1000 */ | 
|  | 143 | 0x0,	0x0,	0x0,	0x20941022, | 
|  | 144 | 0x0,	0x40,	0x0,	0x40a,			/* CapPtr INT-D, IRQA */ | 
|  | 145 | 0xc8020001, 0x0, 0x0,	0x0,	/* Capabilities - 40 is R/O, | 
|  | 146 | 44 is mask 8103 (power control) */ | 
|  | 147 | 0x0,	0x0,	0x0,	0x0, | 
|  | 148 | 0x0,	0x0,	0x0,	0x0, | 
|  | 149 | }; | 
|  | 150 |  | 
|  | 151 | static const uint32_t ehci_hdr[] = {  /* dev f function 4 - devfn = 7d */ | 
|  | 152 | 0xfffff000, 0x0, 0x0,	0x0, | 
|  | 153 | 0x0,	0x0,	0x0,	0x0, | 
|  | 154 |  | 
|  | 155 | 0x20951022, 0x2300006, 0xc032002, 0x0, | 
|  | 156 | 0xfe01b000, 0x0, 0x0,	0x0,			/* MEMBAR-1000 */ | 
|  | 157 | 0x0,	0x0,	0x0,	0x20951022, | 
|  | 158 | 0x0,	0x40,	0x0,	0x40a,			/* CapPtr INT-D, IRQA */ | 
|  | 159 | 0xc8020001, 0x0, 0x0,	0x0,	/* Capabilities - 40 is R/O, 44 is | 
|  | 160 | mask 8103 (power control) */ | 
|  | 161 | #if 0 | 
|  | 162 | 0x1,	0x40080000, 0x0, 0x0,	/* EECP - see EHCI spec section 2.1.7 */ | 
|  | 163 | #endif | 
|  | 164 | 0x01000001, 0x0, 0x0,	0x0,	/* EECP - see EHCI spec section 2.1.7 */ | 
|  | 165 | 0x2020,	0x0,	0x0,	0x0,	/* (EHCI page 8) 60 SBRN (R/O), | 
|  | 166 | 61 FLADJ (R/W), PORTWAKECAP  */ | 
|  | 167 | }; | 
|  | 168 |  | 
|  | 169 | static uint32_t ff_loc = ~0; | 
|  | 170 | static uint32_t zero_loc; | 
|  | 171 | static int bar_probing;		/* Set after a write of ~0 to a BAR */ | 
|  | 172 | static int is_lx; | 
|  | 173 |  | 
|  | 174 | #define NB_SLOT 0x1	/* Northbridge - GX chip - Device 1 */ | 
|  | 175 | #define SB_SLOT 0xf	/* Southbridge - CS5536 chip - Device F */ | 
|  | 176 |  | 
|  | 177 | static int is_simulated(unsigned int bus, unsigned int devfn) | 
|  | 178 | { | 
|  | 179 | return (!bus && ((PCI_SLOT(devfn) == NB_SLOT) || | 
|  | 180 | (PCI_SLOT(devfn) == SB_SLOT))); | 
|  | 181 | } | 
|  | 182 |  | 
|  | 183 | static uint32_t *hdr_addr(const uint32_t *hdr, int reg) | 
|  | 184 | { | 
|  | 185 | uint32_t addr; | 
|  | 186 |  | 
|  | 187 | /* | 
|  | 188 | * This is a little bit tricky.  The header maps consist of | 
|  | 189 | * 0x20 bytes of size masks, followed by 0x70 bytes of header data. | 
|  | 190 | * In the normal case, when not probing a BAR's size, we want | 
|  | 191 | * to access the header data, so we add 0x20 to the reg offset, | 
|  | 192 | * thus skipping the size mask area. | 
|  | 193 | * In the BAR probing case, we want to access the size mask for | 
|  | 194 | * the BAR, so we subtract 0x10 (the config header offset for | 
|  | 195 | * BAR0), and don't skip the size mask area. | 
|  | 196 | */ | 
|  | 197 |  | 
|  | 198 | addr = (uint32_t)hdr + reg + (bar_probing ? -0x10 : 0x20); | 
|  | 199 |  | 
|  | 200 | bar_probing = 0; | 
|  | 201 | return (uint32_t *)addr; | 
|  | 202 | } | 
|  | 203 |  | 
|  | 204 | static int pci_olpc_read(unsigned int seg, unsigned int bus, | 
|  | 205 | unsigned int devfn, int reg, int len, uint32_t *value) | 
|  | 206 | { | 
|  | 207 | uint32_t *addr; | 
|  | 208 |  | 
|  | 209 | /* Use the hardware mechanism for non-simulated devices */ | 
|  | 210 | if (!is_simulated(bus, devfn)) | 
|  | 211 | return pci_direct_conf1.read(seg, bus, devfn, reg, len, value); | 
|  | 212 |  | 
|  | 213 | /* | 
|  | 214 | * No device has config registers past 0x70, so we save table space | 
|  | 215 | * by not storing entries for the nonexistent registers | 
|  | 216 | */ | 
|  | 217 | if (reg >= 0x70) | 
|  | 218 | addr = &zero_loc; | 
|  | 219 | else { | 
|  | 220 | switch (devfn) { | 
|  | 221 | case  0x8: | 
|  | 222 | addr = hdr_addr(is_lx ? lxnb_hdr : gxnb_hdr, reg); | 
|  | 223 | break; | 
|  | 224 | case  0x9: | 
|  | 225 | addr = hdr_addr(is_lx ? lxfb_hdr : gxfb_hdr, reg); | 
|  | 226 | break; | 
|  | 227 | case  0xa: | 
|  | 228 | addr = is_lx ? hdr_addr(aes_hdr, reg) : &ff_loc; | 
|  | 229 | break; | 
|  | 230 | case 0x78: | 
|  | 231 | addr = hdr_addr(isa_hdr, reg); | 
|  | 232 | break; | 
|  | 233 | case 0x7b: | 
|  | 234 | addr = hdr_addr(ac97_hdr, reg); | 
|  | 235 | break; | 
|  | 236 | case 0x7c: | 
|  | 237 | addr = hdr_addr(ohci_hdr, reg); | 
|  | 238 | break; | 
|  | 239 | case 0x7d: | 
|  | 240 | addr = hdr_addr(ehci_hdr, reg); | 
|  | 241 | break; | 
|  | 242 | default: | 
|  | 243 | addr = &ff_loc; | 
|  | 244 | break; | 
|  | 245 | } | 
|  | 246 | } | 
|  | 247 | switch (len) { | 
|  | 248 | case 1: | 
|  | 249 | *value = *(uint8_t *)addr; | 
|  | 250 | break; | 
|  | 251 | case 2: | 
|  | 252 | *value = *(uint16_t *)addr; | 
|  | 253 | break; | 
|  | 254 | case 4: | 
|  | 255 | *value = *addr; | 
|  | 256 | break; | 
|  | 257 | default: | 
|  | 258 | BUG(); | 
|  | 259 | } | 
|  | 260 |  | 
|  | 261 | return 0; | 
|  | 262 | } | 
|  | 263 |  | 
|  | 264 | static int pci_olpc_write(unsigned int seg, unsigned int bus, | 
|  | 265 | unsigned int devfn, int reg, int len, uint32_t value) | 
|  | 266 | { | 
|  | 267 | /* Use the hardware mechanism for non-simulated devices */ | 
|  | 268 | if (!is_simulated(bus, devfn)) | 
|  | 269 | return pci_direct_conf1.write(seg, bus, devfn, reg, len, value); | 
|  | 270 |  | 
|  | 271 | /* XXX we may want to extend this to simulate EHCI power management */ | 
|  | 272 |  | 
|  | 273 | /* | 
|  | 274 | * Mostly we just discard writes, but if the write is a size probe | 
|  | 275 | * (i.e. writing ~0 to a BAR), we remember it and arrange to return | 
|  | 276 | * the appropriate size mask on the next read.  This is cheating | 
|  | 277 | * to some extent, because it depends on the fact that the next | 
|  | 278 | * access after such a write will always be a read to the same BAR. | 
|  | 279 | */ | 
|  | 280 |  | 
|  | 281 | if ((reg >= 0x10) && (reg < 0x2c)) { | 
|  | 282 | /* write is to a BAR */ | 
|  | 283 | if (value == ~0) | 
|  | 284 | bar_probing = 1; | 
|  | 285 | } else { | 
|  | 286 | /* | 
|  | 287 | * No warning on writes to ROM BAR, CMD, LATENCY_TIMER, | 
|  | 288 | * CACHE_LINE_SIZE, or PM registers. | 
|  | 289 | */ | 
|  | 290 | if ((reg != PCI_ROM_ADDRESS) && (reg != PCI_COMMAND_MASTER) && | 
|  | 291 | (reg != PCI_LATENCY_TIMER) && | 
|  | 292 | (reg != PCI_CACHE_LINE_SIZE) && (reg != 0x44)) | 
|  | 293 | printk(KERN_WARNING "OLPC PCI: Config write to devfn" | 
|  | 294 | " %x reg %x value %x\n", devfn, reg, value); | 
|  | 295 | } | 
|  | 296 |  | 
|  | 297 | return 0; | 
|  | 298 | } | 
|  | 299 |  | 
|  | 300 | static struct pci_raw_ops pci_olpc_conf = { | 
|  | 301 | .read =	pci_olpc_read, | 
|  | 302 | .write = pci_olpc_write, | 
|  | 303 | }; | 
|  | 304 |  | 
| Andres Salomon | 2bdd1b0 | 2008-06-05 14:14:41 -0700 | [diff] [blame] | 305 | int __init pci_olpc_init(void) | 
| Andres Salomon | 3ef0e1f | 2008-04-29 00:59:53 -0700 | [diff] [blame] | 306 | { | 
|  | 307 | if (!machine_is_olpc() || olpc_has_vsa()) | 
| Andres Salomon | 2bdd1b0 | 2008-06-05 14:14:41 -0700 | [diff] [blame] | 308 | return -ENODEV; | 
| Andres Salomon | 3ef0e1f | 2008-04-29 00:59:53 -0700 | [diff] [blame] | 309 |  | 
|  | 310 | printk(KERN_INFO "PCI: Using configuration type OLPC\n"); | 
|  | 311 | raw_pci_ops = &pci_olpc_conf; | 
|  | 312 | is_lx = is_geode_lx(); | 
| Andres Salomon | 2bdd1b0 | 2008-06-05 14:14:41 -0700 | [diff] [blame] | 313 | return 0; | 
| Andres Salomon | 3ef0e1f | 2008-04-29 00:59:53 -0700 | [diff] [blame] | 314 | } |