blob: dc6d8bc180d93926f552b1c0a44672d3b4485031 [file] [log] [blame]
Ollie Lho184a4042005-11-26 21:55:36 +00001/*
Uwe Hermannd1107642007-08-29 17:52:32 +00002 * This file is part of the flashrom project.
Ollie Lho184a4042005-11-26 21:55:36 +00003 *
Uwe Hermannd1107642007-08-29 17:52:32 +00004 * Copyright (C) 2000 Silicon Integrated System Corporation
5 * Copyright (C) 2005-2007 coresystems GmbH <stepan@coresystems.de>
6 * Copyright (C) 2006 Uwe Hermann <uwe@hermann-uwe.de>
Ollie Lho184a4042005-11-26 21:55:36 +00007 *
Uwe Hermannd1107642007-08-29 17:52:32 +00008 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; version 2 of the License.
Ollie Lho184a4042005-11-26 21:55:36 +000011 *
Uwe Hermannd1107642007-08-29 17:52:32 +000012 * 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., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
20 */
21
22/*
23 * Contains the chipset specific flash enables.
Ollie Lho184a4042005-11-26 21:55:36 +000024 */
25
Lane Brooksd54958a2007-11-13 16:45:22 +000026#define _LARGEFILE64_SOURCE
27
Ollie Lhocbbf1252004-03-17 22:22:08 +000028#include <stdio.h>
29#include <pci/pci.h>
30#include <stdlib.h>
Lane Brooksd54958a2007-11-13 16:45:22 +000031#include <sys/types.h>
32#include <sys/stat.h>
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +000033#include <sys/mman.h>
Lane Brooksd54958a2007-11-13 16:45:22 +000034#include <fcntl.h>
35#include <unistd.h>
Luc Verhaegen8e3a6002007-04-04 22:45:58 +000036#include "flash.h"
Stefan Reinauer86de2832006-03-31 11:26:55 +000037
Uwe Hermann372eeb52007-12-04 21:49:06 +000038static int enable_flash_ali_m1533(struct pci_dev *dev, const char *name)
Luc Verhaegen6b141752007-05-20 16:16:13 +000039{
40 uint8_t tmp;
41
Uwe Hermann372eeb52007-12-04 21:49:06 +000042 /*
43 * ROM Write enable, 0xFFFC0000-0xFFFDFFFF and
44 * 0xFFFE0000-0xFFFFFFFF ROM select enable.
45 */
Luc Verhaegen6b141752007-05-20 16:16:13 +000046 tmp = pci_read_byte(dev, 0x47);
47 tmp |= 0x46;
48 pci_write_byte(dev, 0x47, tmp);
49
50 return 0;
51}
52
Uwe Hermann372eeb52007-12-04 21:49:06 +000053static int enable_flash_sis630(struct pci_dev *dev, const char *name)
Ollie Lhocbbf1252004-03-17 22:22:08 +000054{
Uwe Hermann372eeb52007-12-04 21:49:06 +000055 uint8_t b;
Ollie Lhocbbf1252004-03-17 22:22:08 +000056
Uwe Hermann372eeb52007-12-04 21:49:06 +000057 /* Enable 0xFFF8000~0xFFFF0000 decoding on SiS 540/630. */
Alex Beregszaszic9fb5d92007-09-11 15:58:18 +000058 b = pci_read_byte(dev, 0x40);
59 pci_write_byte(dev, 0x40, b | 0xb);
Uwe Hermann372eeb52007-12-04 21:49:06 +000060
61 /* Flash write enable on SiS 540/630. */
Alex Beregszaszic9fb5d92007-09-11 15:58:18 +000062 b = pci_read_byte(dev, 0x45);
63 pci_write_byte(dev, 0x45, b | 0x40);
Ollie Lhocbbf1252004-03-17 22:22:08 +000064
Uwe Hermann372eeb52007-12-04 21:49:06 +000065 /* The same thing on SiS 950 Super I/O side... */
66
67 /* First probe for Super I/O on config port 0x2e. */
Andriy Gapon65c1b862008-05-22 13:22:45 +000068 OUTB(0x87, 0x2e);
69 OUTB(0x01, 0x2e);
70 OUTB(0x55, 0x2e);
71 OUTB(0x55, 0x2e);
Ollie Lhocbbf1252004-03-17 22:22:08 +000072
Andriy Gapon65c1b862008-05-22 13:22:45 +000073 if (INB(0x2f) != 0x87) {
Uwe Hermann372eeb52007-12-04 21:49:06 +000074 /* If that failed, try config port 0x4e. */
Andriy Gapon65c1b862008-05-22 13:22:45 +000075 OUTB(0x87, 0x4e);
76 OUTB(0x01, 0x4e);
77 OUTB(0x55, 0x4e);
78 OUTB(0xaa, 0x4e);
79 if (INB(0x4f) != 0x87) {
Ollie Lhocbbf1252004-03-17 22:22:08 +000080 printf("Can not access SiS 950\n");
81 return -1;
82 }
Andriy Gapon65c1b862008-05-22 13:22:45 +000083 OUTB(0x24, 0x4e);
84 b = INB(0x4f) | 0xfc;
85 OUTB(0x24, 0x4e);
86 OUTB(b, 0x4f);
87 OUTB(0x02, 0x4e);
88 OUTB(0x02, 0x4f);
Ollie Lhocbbf1252004-03-17 22:22:08 +000089 }
90
Andriy Gapon65c1b862008-05-22 13:22:45 +000091 OUTB(0x24, 0x2e);
92 printf("2f is %#x\n", INB(0x2f));
93 b = INB(0x2f) | 0xfc;
94 OUTB(0x24, 0x2e);
95 OUTB(b, 0x2f);
Ollie Lhocbbf1252004-03-17 22:22:08 +000096
Andriy Gapon65c1b862008-05-22 13:22:45 +000097 OUTB(0x02, 0x2e);
98 OUTB(0x02, 0x2f);
Ollie Lhocbbf1252004-03-17 22:22:08 +000099
100 return 0;
101}
102
Uwe Hermann987942d2006-11-07 11:16:21 +0000103/* Datasheet:
104 * - Name: 82371AB PCI-TO-ISA / IDE XCELERATOR (PIIX4)
105 * - URL: http://www.intel.com/design/intarch/datashts/290562.htm
106 * - PDF: http://www.intel.com/design/intarch/datashts/29056201.pdf
107 * - Order Number: 290562-001
108 */
Uwe Hermann372eeb52007-12-04 21:49:06 +0000109static int enable_flash_piix4(struct pci_dev *dev, const char *name)
Uwe Hermannea2c66d2006-11-05 18:26:08 +0000110{
111 uint16_t old, new;
Uwe Hermanna7e05482007-05-09 10:17:44 +0000112 uint16_t xbcs = 0x4e; /* X-Bus Chip Select register. */
Uwe Hermannea2c66d2006-11-05 18:26:08 +0000113
114 old = pci_read_word(dev, xbcs);
115
116 /* Set bit 9: 1-Meg Extended BIOS Enable (PCI master accesses to
Uwe Hermanna7e05482007-05-09 10:17:44 +0000117 * FFF00000-FFF7FFFF are forwarded to ISA).
118 * Set bit 7: Extended BIOS Enable (PCI master accesses to
119 * FFF80000-FFFDFFFF are forwarded to ISA).
120 * Set bit 6: Lower BIOS Enable (PCI master, or ISA master accesses to
121 * the lower 64-Kbyte BIOS block (E0000-EFFFF) at the top
122 * of 1 Mbyte, or the aliases at the top of 4 Gbyte
123 * (FFFE0000-FFFEFFFF) result in the generation of BIOSCS#.
124 * Note: Accesses to FFFF0000-FFFFFFFF are always forwarded to ISA.
125 * Set bit 2: BIOSCS# Write Enable (1=enable, 0=disable).
126 */
Uwe Hermannea2c66d2006-11-05 18:26:08 +0000127 new = old | 0x2c4;
128
129 if (new == old)
130 return 0;
131
132 pci_write_word(dev, xbcs, new);
133
134 if (pci_read_word(dev, xbcs) != new) {
135 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", xbcs, new, name);
136 return -1;
137 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000138
Uwe Hermannea2c66d2006-11-05 18:26:08 +0000139 return 0;
140}
141
Uwe Hermann372eeb52007-12-04 21:49:06 +0000142/*
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000143 * See ie. page 375 of "Intel I/O Controller Hub 7 (ICH7) Family Datasheet"
144 * http://download.intel.com/design/chipsets/datashts/30701303.pdf
Uwe Hermann372eeb52007-12-04 21:49:06 +0000145 */
146static int enable_flash_ich(struct pci_dev *dev, const char *name,
147 int bios_cntl)
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000148{
Ollie Lho184a4042005-11-26 21:55:36 +0000149 uint8_t old, new;
Stefan Reinauereb366472006-09-06 15:48:48 +0000150
Uwe Hermann372eeb52007-12-04 21:49:06 +0000151 /*
152 * Note: the ICH0-ICH5 BIOS_CNTL register is actually 16 bit wide, but
Uwe Hermanna7e05482007-05-09 10:17:44 +0000153 * just treating it as 8 bit wide seems to work fine in practice.
Stefan Reinauereb366472006-09-06 15:48:48 +0000154 */
Stefan Reinauer86de2832006-03-31 11:26:55 +0000155 old = pci_read_byte(dev, bios_cntl);
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000156
Uwe Hermann793bdcd2008-05-22 22:47:04 +0000157 printf_debug("\nBIOS Lock Enable: %sabled, ",
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000158 (old & (1 << 1)) ? "en" : "dis");
159 printf_debug("BIOS Write Enable: %sabled, ",
160 (old & (1 << 0)) ? "en" : "dis");
161 printf_debug("BIOS_CNTL is 0x%x\n", old);
162
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000163 new = old | 1;
164
165 if (new == old)
166 return 0;
167
Stefan Reinauer86de2832006-03-31 11:26:55 +0000168 pci_write_byte(dev, bios_cntl, new);
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000169
Stefan Reinauer86de2832006-03-31 11:26:55 +0000170 if (pci_read_byte(dev, bios_cntl) != new) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000171 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", bios_cntl, new, name);
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000172 return -1;
173 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000174
Ronald G. Minnich6a967412004-09-28 20:09:06 +0000175 return 0;
176}
177
Uwe Hermann372eeb52007-12-04 21:49:06 +0000178static int enable_flash_ich_4e(struct pci_dev *dev, const char *name)
Stefan Reinauer86de2832006-03-31 11:26:55 +0000179{
Stefan Reinauereb366472006-09-06 15:48:48 +0000180 return enable_flash_ich(dev, name, 0x4e);
Stefan Reinauer86de2832006-03-31 11:26:55 +0000181}
182
Uwe Hermann372eeb52007-12-04 21:49:06 +0000183static int enable_flash_ich_dc(struct pci_dev *dev, const char *name)
Stefan Reinauer86de2832006-03-31 11:26:55 +0000184{
Stefan Reinauereb366472006-09-06 15:48:48 +0000185 return enable_flash_ich(dev, name, 0xdc);
Stefan Reinauer86de2832006-03-31 11:26:55 +0000186}
187
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000188void *ich_spibar = NULL;
189
190static int enable_flash_ich_dc_spi(struct pci_dev *dev, const char *name, unsigned long spibar)
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000191{
Stefan Reinauera9424d52008-06-27 16:28:34 +0000192 uint8_t old, new, bbs, buc;
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000193 uint32_t tmp, gcs;
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000194 void *rcrb;
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000195
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000196 /* Read the Root Complex Base Address Register (RCBA) */
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000197 tmp = pci_read_long(dev, 0xf0);
Stefan Reinauera9424d52008-06-27 16:28:34 +0000198
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000199 /* Calculate the Root Complex Register Block address */
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000200 tmp &= 0xffffc000;
Stefan Reinauera9424d52008-06-27 16:28:34 +0000201 printf_debug("\nRoot Complex Register Block address = 0x%x\n", tmp);
Dominik Geyerb46acba2008-05-16 12:55:55 +0000202 rcrb = mmap(0, 0x4000, PROT_READ | PROT_WRITE, MAP_SHARED, fd_mem, (off_t)tmp);
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000203 if (rcrb == MAP_FAILED) {
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000204 perror("Can't mmap memory using " MEM_DEV);
205 exit(1);
206 }
207 printf_debug("GCS address = 0x%x\n", tmp + 0x3410);
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000208 gcs = *(volatile uint32_t *)(rcrb + 0x3410);
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000209 printf_debug("GCS = 0x%x: ", gcs);
210 printf_debug("BIOS Interface Lock-Down: %sabled, ",
211 (gcs & 0x1) ? "en" : "dis");
212 bbs = (gcs >> 10) & 0x3;
213 printf_debug("BOOT BIOS Straps: 0x%x (%s)\n", bbs,
214 (bbs == 0x3) ? "LPC" : ((bbs == 0x2) ? "PCI" : "SPI"));
Peter Stuge7e2c0792008-06-29 01:30:41 +0000215 if (bbs >= 2)
216 ich7_detected = 0;
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000217
Stefan Reinauera9424d52008-06-27 16:28:34 +0000218 buc = *(volatile uint8_t *)(rcrb + 0x3414);
219 printf_debug("Top Swap : %s\n", (buc & 1)?"enabled (A16 inverted)":"not enabled");
220
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000221 /* SPIBAR is at RCRB+0x3020 for ICH[78] and RCRB+0x3800 for ICH9. */
Stefan Reinauera9424d52008-06-27 16:28:34 +0000222 printf_debug("SPIBAR = 0x%x + 0x%04x\n", tmp, (uint16_t)spibar);
223
224 // Assign Virtual Address
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000225 ich_spibar = rcrb + spibar;
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000226
Stefan Reinauera9424d52008-06-27 16:28:34 +0000227 if (ich7_detected) {
228 int i;
229 printf_debug("0x00: 0x%04x (SPIS)\n", *(uint16_t *)(ich_spibar + 0));
230 printf_debug("0x02: 0x%04x (SPIC)\n", *(uint16_t *)(ich_spibar + 2));
231 printf_debug("0x04: 0x%08x (SPIA)\n", *(uint32_t *)(ich_spibar + 4));
232 for (i=0; i < 8; i++) {
233 int offs;
234 offs = 8 + (i * 8);
235 printf_debug("0x%02x: 0x%08x (SPID%d)\n", offs, *(uint32_t *)(ich_spibar + offs), i);
236 printf_debug("0x%02x: 0x%08x (SPID%d+4)\n", offs+4, *(uint32_t *)(ich_spibar + offs +4), i);
237 }
238 printf_debug("0x50: 0x%08x (BBAR)\n", *(uint32_t *)(ich_spibar + 0x50));
239 printf_debug("0x54: 0x%04x (PREOP)\n", *(uint16_t *)(ich_spibar + 0x54));
240 printf_debug("0x56: 0x%04x (OPTYPE)\n", *(uint16_t *)(ich_spibar + 0x56));
241 printf_debug("0x58: 0x%08x (OPMENU)\n", *(uint32_t *)(ich_spibar + 0x58));
242 printf_debug("0x5c: 0x%08x (OPMENU+4)\n", *(uint32_t *)(ich_spibar + 0x5c));
243 for (i=0; i < 4; i++) {
244 int offs;
245 offs = 0x60 + (i * 4);
246 printf_debug("0x%02x: 0x%08x (PBR%d)\n", offs, *(uint32_t *)(ich_spibar + offs), i);
247 }
248 printf_debug("\n");
249 if ( (*(uint16_t *)ich_spibar) & (1 << 15)) {
250 printf("WARNING: SPI Configuration Lockdown activated.\n");
251 }
252 }
253
Carl-Daniel Hailfinger67f9ea32008-03-14 17:20:59 +0000254 old = pci_read_byte(dev, 0xdc);
255 printf_debug("SPI Read Configuration: ");
256 new = (old >> 2) & 0x3;
257 switch (new) {
258 case 0:
259 case 1:
260 case 2:
261 printf_debug("prefetching %sabled, caching %sabled, ",
262 (new & 0x2) ? "en" : "dis", (new & 0x1) ? "dis" : "en");
263 break;
264 default:
265 printf_debug("invalid prefetching/caching settings, ");
266 break;
267 }
268 return enable_flash_ich_dc(dev, name);
269}
270
Stefan Reinauera9424d52008-06-27 16:28:34 +0000271/* Flag for ICH7 SPI register block */
272int ich7_detected = 0;
273
Carl-Daniel Hailfinger1b18b3c2008-05-16 14:39:39 +0000274static int enable_flash_ich7(struct pci_dev *dev, const char *name)
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000275{
Stefan Reinauera9424d52008-06-27 16:28:34 +0000276 ich7_detected = 1;
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000277 return enable_flash_ich_dc_spi(dev, name, 0x3020);
278}
279
Stefan Reinauera9424d52008-06-27 16:28:34 +0000280/* Flag for ICH8/ICH9 SPI register block */
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000281int ich9_detected = 0;
282
Carl-Daniel Hailfinger1b18b3c2008-05-16 14:39:39 +0000283static int enable_flash_ich8(struct pci_dev *dev, const char *name)
284{
285 ich9_detected = 1;
286 return enable_flash_ich_dc_spi(dev, name, 0x3020);
287}
288
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000289static int enable_flash_ich9(struct pci_dev *dev, const char *name)
290{
291 ich9_detected = 1;
292 return enable_flash_ich_dc_spi(dev, name, 0x3800);
293}
294
Uwe Hermann372eeb52007-12-04 21:49:06 +0000295static int enable_flash_vt823x(struct pci_dev *dev, const char *name)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000296{
Ollie Lho184a4042005-11-26 21:55:36 +0000297 uint8_t val;
Ollie Lho761bf1b2004-03-20 16:46:10 +0000298
Bari Ari9477c4e2008-04-29 13:46:38 +0000299 /* enable ROM decode range (1MB) FFC00000 - FFFFFFFF*/
300 pci_write_byte(dev, 0x41, 0x7f);
301
Uwe Hermannffec5f32007-08-23 16:08:21 +0000302 /* ROM write enable */
Ollie Lhocbbf1252004-03-17 22:22:08 +0000303 val = pci_read_byte(dev, 0x40);
304 val |= 0x10;
305 pci_write_byte(dev, 0x40, val);
306
307 if (pci_read_byte(dev, 0x40) != val) {
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000308 printf("\nWARNING: Failed to enable ROM Write on \"%s\"\n",
Uwe Hermanna7e05482007-05-09 10:17:44 +0000309 name);
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000310 return -1;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000311 }
Luc Verhaegen6382b442007-03-02 22:16:38 +0000312
Uwe Hermanna7e05482007-05-09 10:17:44 +0000313 return 0;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000314}
315
Uwe Hermann372eeb52007-12-04 21:49:06 +0000316static int enable_flash_cs5530(struct pci_dev *dev, const char *name)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000317{
Uwe Hermannf4a673b2007-06-06 21:35:45 +0000318 uint8_t reg8;
Ollie Lho761bf1b2004-03-20 16:46:10 +0000319
Uwe Hermannf4a673b2007-06-06 21:35:45 +0000320 #define DECODE_CONTROL_REG2 0x5b /* F0 index 0x5b */
321 #define ROM_AT_LOGIC_CONTROL_REG 0x52 /* F0 index 0x52 */
Ollie Lhocbbf1252004-03-17 22:22:08 +0000322
Uwe Hermannf4a673b2007-06-06 21:35:45 +0000323 #define LOWER_ROM_ADDRESS_RANGE (1 << 0)
324 #define ROM_WRITE_ENABLE (1 << 1)
325 #define UPPER_ROM_ADDRESS_RANGE (1 << 2)
326 #define BIOS_ROM_POSITIVE_DECODE (1 << 5)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000327
Uwe Hermannf4a673b2007-06-06 21:35:45 +0000328 /* Decode 0x000E0000-0x000FFFFF (128 KB), not just 64 KB, and
329 * decode 0xFF000000-0xFFFFFFFF (16 MB), not just 256 KB.
330 * Make the configured ROM areas writable.
331 */
332 reg8 = pci_read_byte(dev, ROM_AT_LOGIC_CONTROL_REG);
333 reg8 |= LOWER_ROM_ADDRESS_RANGE;
334 reg8 |= UPPER_ROM_ADDRESS_RANGE;
335 reg8 |= ROM_WRITE_ENABLE;
336 pci_write_byte(dev, ROM_AT_LOGIC_CONTROL_REG, reg8);
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000337
Uwe Hermannf4a673b2007-06-06 21:35:45 +0000338 /* Set positive decode on ROM. */
339 reg8 = pci_read_byte(dev, DECODE_CONTROL_REG2);
340 reg8 |= BIOS_ROM_POSITIVE_DECODE;
341 pci_write_byte(dev, DECODE_CONTROL_REG2, reg8);
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000342
Ollie Lhocbbf1252004-03-17 22:22:08 +0000343 return 0;
344}
345
Mart Raudseppe1344da2008-02-08 10:10:57 +0000346/**
347 * Geode systems write protect the BIOS via RCONFs (cache settings similar
348 * to MTRRs). To unlock, change MSR 0x1808 top byte to 0x22. Reading and
349 * writing to MSRs, however requires instructions rdmsr/wrmsr, which are
350 * ring0 privileged instructions so only the kernel can do the read/write.
351 * This function, therefore, requires that the msr kernel module be loaded
352 * to access these instructions from user space using device /dev/cpu/0/msr.
353 *
354 * This hard-coded location could have potential problems on SMP machines
355 * since it assumes cpu0, but it is safe on the Geode which is not SMP.
356 *
357 * Geode systems also write protect the NOR flash chip itself via MSR_NORF_CTL.
358 * To enable write to NOR Boot flash for the benefit of systems that have such
359 * a setup, raise MSR 0x51400018 WE_CS3 (write enable Boot Flash Chip Select).
360 *
361 * This is probably not portable beyond Linux.
362 */
Uwe Hermann372eeb52007-12-04 21:49:06 +0000363static int enable_flash_cs5536(struct pci_dev *dev, const char *name)
Lane Brooksd54958a2007-11-13 16:45:22 +0000364{
Mart Raudseppe1344da2008-02-08 10:10:57 +0000365 #define MSR_RCONF_DEFAULT 0x1808
366 #define MSR_NORF_CTL 0x51400018
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000367
Lane Brooksd54958a2007-11-13 16:45:22 +0000368 int fd_msr;
369 unsigned char buf[8];
Lane Brooksd54958a2007-11-13 16:45:22 +0000370
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000371 fd_msr = open("/dev/cpu/0/msr", O_RDWR);
Lane Brooksd54958a2007-11-13 16:45:22 +0000372 if (!fd_msr) {
373 perror("open msr");
374 return -1;
375 }
Mart Raudseppe1344da2008-02-08 10:10:57 +0000376
377 if (lseek64(fd_msr, (off64_t) MSR_RCONF_DEFAULT, SEEK_SET) == -1) {
378 perror("lseek64");
Mart Raudsepp3697ac72008-02-11 14:32:45 +0000379 printf("Cannot operate on MSR. Did you run 'modprobe msr'?\n");
Mart Raudseppe1344da2008-02-08 10:10:57 +0000380 close(fd_msr);
381 return -1;
382 }
383
384 if (read(fd_msr, buf, 8) != 8) {
Mart Raudsepp3697ac72008-02-11 14:32:45 +0000385 perror("read msr");
Mart Raudseppe1344da2008-02-08 10:10:57 +0000386 close(fd_msr);
387 return -1;
388 }
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000389
Lane Brooksd54958a2007-11-13 16:45:22 +0000390 if (buf[7] != 0x22) {
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000391 buf[7] &= 0xfb;
Mart Raudseppe1344da2008-02-08 10:10:57 +0000392 if (lseek64(fd_msr, (off64_t) MSR_RCONF_DEFAULT, SEEK_SET) == -1) {
393 perror("lseek64");
394 close(fd_msr);
395 return -1;
396 }
397
Lane Brooksd54958a2007-11-13 16:45:22 +0000398 if (write(fd_msr, buf, 8) < 0) {
399 perror("msr write");
Mart Raudseppe1344da2008-02-08 10:10:57 +0000400 close(fd_msr);
Lane Brooksd54958a2007-11-13 16:45:22 +0000401 return -1;
402 }
Lane Brooksd54958a2007-11-13 16:45:22 +0000403 }
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000404
Mart Raudseppe1344da2008-02-08 10:10:57 +0000405 if (lseek64(fd_msr, (off64_t) MSR_NORF_CTL, SEEK_SET) == -1) {
406 perror("lseek64");
407 close(fd_msr);
408 return -1;
409 }
410
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000411 if (read(fd_msr, buf, 8) != 8) {
412 perror("read msr");
Mart Raudseppe1344da2008-02-08 10:10:57 +0000413 close(fd_msr);
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000414 return -1;
415 }
416
417 /* Raise WE_CS3 bit. */
418 buf[0] |= 0x08;
419
Mart Raudseppe1344da2008-02-08 10:10:57 +0000420 if (lseek64(fd_msr, (off64_t) MSR_NORF_CTL, SEEK_SET) == -1) {
421 perror("lseek64");
422 close(fd_msr);
423 return -1;
424 }
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000425 if (write(fd_msr, buf, 8) < 0) {
426 perror("msr write");
Mart Raudseppe1344da2008-02-08 10:10:57 +0000427 close(fd_msr);
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000428 return -1;
429 }
430
431 close(fd_msr);
432
Mart Raudseppe1344da2008-02-08 10:10:57 +0000433 #undef MSR_RCONF_DEFAULT
Mart Raudsepp0514a5f2008-02-08 09:59:58 +0000434 #undef MSR_NORF_CTL
Lane Brooksd54958a2007-11-13 16:45:22 +0000435 return 0;
436}
437
Uwe Hermann372eeb52007-12-04 21:49:06 +0000438static int enable_flash_sc1100(struct pci_dev *dev, const char *name)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000439{
Ollie Lho184a4042005-11-26 21:55:36 +0000440 uint8_t new;
Ollie Lho761bf1b2004-03-20 16:46:10 +0000441
Ollie Lhocbbf1252004-03-17 22:22:08 +0000442 pci_write_byte(dev, 0x52, 0xee);
443
444 new = pci_read_byte(dev, 0x52);
445
446 if (new != 0xee) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000447 printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x52, new, name);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000448 return -1;
449 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000450
Ollie Lhocbbf1252004-03-17 22:22:08 +0000451 return 0;
452}
453
Uwe Hermann372eeb52007-12-04 21:49:06 +0000454static int enable_flash_sis5595(struct pci_dev *dev, const char *name)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000455{
Ollie Lho184a4042005-11-26 21:55:36 +0000456 uint8_t new, newer;
Ollie Lho761bf1b2004-03-20 16:46:10 +0000457
Ollie Lhocbbf1252004-03-17 22:22:08 +0000458 new = pci_read_byte(dev, 0x45);
459
Uwe Hermann372eeb52007-12-04 21:49:06 +0000460 new &= (~0x20); /* Clear bit 5. */
461 new |= 0x4; /* Set bit 2. */
Ollie Lhocbbf1252004-03-17 22:22:08 +0000462
463 pci_write_byte(dev, 0x45, new);
464
465 newer = pci_read_byte(dev, 0x45);
466 if (newer != new) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000467 printf("tried to set register 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x45, new, name);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000468 printf("Stuck at 0x%x\n", newer);
469 return -1;
470 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000471
Ollie Lhocbbf1252004-03-17 22:22:08 +0000472 return 0;
473}
474
Uwe Hermann372eeb52007-12-04 21:49:06 +0000475static int enable_flash_amd8111(struct pci_dev *dev, const char *name)
Ollie Lho761bf1b2004-03-20 16:46:10 +0000476{
Ollie Lho184a4042005-11-26 21:55:36 +0000477 uint8_t old, new;
Uwe Hermanna7e05482007-05-09 10:17:44 +0000478
Uwe Hermann372eeb52007-12-04 21:49:06 +0000479 /* Enable decoding at 0xffb00000 to 0xffffffff. */
Ollie Lhocbbf1252004-03-17 22:22:08 +0000480 old = pci_read_byte(dev, 0x43);
Ollie Lhod11f3612004-12-07 17:19:04 +0000481 new = old | 0xC0;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000482 if (new != old) {
483 pci_write_byte(dev, 0x43, new);
484 if (pci_read_byte(dev, 0x43) != new) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000485 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x43, new, name);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000486 }
487 }
488
Ollie Lho761bf1b2004-03-20 16:46:10 +0000489 old = pci_read_byte(dev, 0x40);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000490 new = old | 0x01;
491 if (new == old)
492 return 0;
493 pci_write_byte(dev, 0x40, new);
494
495 if (pci_read_byte(dev, 0x40) != new) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000496 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x40, new, name);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000497 return -1;
498 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000499
Ollie Lhocbbf1252004-03-17 22:22:08 +0000500 return 0;
501}
502
Uwe Hermann372eeb52007-12-04 21:49:06 +0000503static int enable_flash_ck804(struct pci_dev *dev, const char *name)
Yinghai Lu952dfce2005-07-06 17:13:46 +0000504{
Uwe Hermanna7e05482007-05-09 10:17:44 +0000505 uint8_t old, new;
Yinghai Lu952dfce2005-07-06 17:13:46 +0000506
Uwe Hermanna7e05482007-05-09 10:17:44 +0000507 old = pci_read_byte(dev, 0x88);
508 new = old | 0xc0;
509 if (new != old) {
510 pci_write_byte(dev, 0x88, new);
511 if (pci_read_byte(dev, 0x88) != new) {
512 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x88, new, name);
513 }
514 }
Yinghai Lu952dfce2005-07-06 17:13:46 +0000515
Uwe Hermanna7e05482007-05-09 10:17:44 +0000516 old = pci_read_byte(dev, 0x6d);
517 new = old | 0x01;
518 if (new == old)
519 return 0;
520 pci_write_byte(dev, 0x6d, new);
521
522 if (pci_read_byte(dev, 0x6d) != new) {
523 printf("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n", 0x6d, new, name);
524 return -1;
525 }
Uwe Hermannffec5f32007-08-23 16:08:21 +0000526
Uwe Hermanna7e05482007-05-09 10:17:44 +0000527 return 0;
Yinghai Lu952dfce2005-07-06 17:13:46 +0000528}
529
Uwe Hermann372eeb52007-12-04 21:49:06 +0000530/* ATI Technologies Inc IXP SB400 PCI-ISA Bridge (rev 80) */
531static int enable_flash_sb400(struct pci_dev *dev, const char *name)
Stefan Reinauer86de2832006-03-31 11:26:55 +0000532{
Uwe Hermanna7e05482007-05-09 10:17:44 +0000533 uint8_t tmp;
Stefan Reinauer86de2832006-03-31 11:26:55 +0000534 struct pci_filter f;
535 struct pci_dev *smbusdev;
536
Uwe Hermann372eeb52007-12-04 21:49:06 +0000537 /* Look for the SMBus device. */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000538 pci_filter_init((struct pci_access *)0, &f);
Stefan Reinauer86de2832006-03-31 11:26:55 +0000539 f.vendor = 0x1002;
540 f.device = 0x4372;
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000541
Stefan Reinauer86de2832006-03-31 11:26:55 +0000542 for (smbusdev = pacc->devices; smbusdev; smbusdev = smbusdev->next) {
543 if (pci_filter_match(&f, smbusdev)) {
544 break;
545 }
546 }
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000547
Uwe Hermanna7e05482007-05-09 10:17:44 +0000548 if (!smbusdev) {
Uwe Hermann372eeb52007-12-04 21:49:06 +0000549 fprintf(stderr, "ERROR: SMBus device not found. Aborting.\n");
Stefan Reinauer86de2832006-03-31 11:26:55 +0000550 exit(1);
551 }
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000552
Uwe Hermann372eeb52007-12-04 21:49:06 +0000553 /* Enable some SMBus stuff. */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000554 tmp = pci_read_byte(smbusdev, 0x79);
555 tmp |= 0x01;
Stefan Reinauer86de2832006-03-31 11:26:55 +0000556 pci_write_byte(smbusdev, 0x79, tmp);
557
Uwe Hermann372eeb52007-12-04 21:49:06 +0000558 /* Change southbridge. */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000559 tmp = pci_read_byte(dev, 0x48);
560 tmp |= 0x21;
Stefan Reinauer86de2832006-03-31 11:26:55 +0000561 pci_write_byte(dev, 0x48, tmp);
562
Uwe Hermann372eeb52007-12-04 21:49:06 +0000563 /* Now become a bit silly. */
Andriy Gapon65c1b862008-05-22 13:22:45 +0000564 tmp = INB(0xc6f);
565 OUTB(tmp, 0xeb);
566 OUTB(tmp, 0xeb);
Uwe Hermanna7e05482007-05-09 10:17:44 +0000567 tmp |= 0x40;
Andriy Gapon65c1b862008-05-22 13:22:45 +0000568 OUTB(tmp, 0xc6f);
569 OUTB(tmp, 0xeb);
570 OUTB(tmp, 0xeb);
Stefan Reinauer86de2832006-03-31 11:26:55 +0000571
572 return 0;
573}
574
Uwe Hermann372eeb52007-12-04 21:49:06 +0000575static int enable_flash_mcp55(struct pci_dev *dev, const char *name)
Yinghai Luca782972007-01-22 20:21:17 +0000576{
Uwe Hermann372eeb52007-12-04 21:49:06 +0000577 uint8_t old, new, byte;
578 uint16_t word;
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000579
Uwe Hermann372eeb52007-12-04 21:49:06 +0000580 /* Set the 0-16 MB enable bits. */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000581 byte = pci_read_byte(dev, 0x88);
582 byte |= 0xff; /* 256K */
583 pci_write_byte(dev, 0x88, byte);
584 byte = pci_read_byte(dev, 0x8c);
585 byte |= 0xff; /* 1M */
586 pci_write_byte(dev, 0x8c, byte);
587 word = pci_read_word(dev, 0x90);
Carl-Daniel Hailfingerdca0ab12007-10-17 22:30:07 +0000588 word |= 0x7fff; /* 16M */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000589 pci_write_word(dev, 0x90, word);
Luc Verhaegen8e3a6002007-04-04 22:45:58 +0000590
Uwe Hermanna7e05482007-05-09 10:17:44 +0000591 old = pci_read_byte(dev, 0x6d);
592 new = old | 0x01;
593 if (new == old)
594 return 0;
595 pci_write_byte(dev, 0x6d, new);
Yinghai Luca782972007-01-22 20:21:17 +0000596
Uwe Hermanna7e05482007-05-09 10:17:44 +0000597 if (pci_read_byte(dev, 0x6d) != new) {
598 printf
599 ("tried to set 0x%x to 0x%x on %s failed (WARNING ONLY)\n",
600 0x6d, new, name);
601 return -1;
602 }
Yinghai Luca782972007-01-22 20:21:17 +0000603
604 return 0;
Yinghai Luca782972007-01-22 20:21:17 +0000605}
606
Uwe Hermann372eeb52007-12-04 21:49:06 +0000607static int enable_flash_ht1000(struct pci_dev *dev, const char *name)
Stefan Reinauerc868b9e2007-06-05 10:28:39 +0000608{
Uwe Hermanne823ee02007-06-05 15:02:18 +0000609 uint8_t byte;
Stefan Reinauerc868b9e2007-06-05 10:28:39 +0000610
Uwe Hermanne823ee02007-06-05 15:02:18 +0000611 /* Set the 4MB enable bit. */
Stefan Reinauerc868b9e2007-06-05 10:28:39 +0000612 byte = pci_read_byte(dev, 0x41);
613 byte |= 0x0e;
614 pci_write_byte(dev, 0x41, byte);
615
616 byte = pci_read_byte(dev, 0x43);
Uwe Hermannffec5f32007-08-23 16:08:21 +0000617 byte |= (1 << 4);
Stefan Reinauerc868b9e2007-06-05 10:28:39 +0000618 pci_write_byte(dev, 0x43, byte);
619
Stefan Reinauerc868b9e2007-06-05 10:28:39 +0000620 return 0;
621}
622
Ollie Lhocbbf1252004-03-17 22:22:08 +0000623typedef struct penable {
Uwe Hermann372eeb52007-12-04 21:49:06 +0000624 uint16_t vendor, device;
625 const char *name;
626 int (*doit) (struct pci_dev *dev, const char *name);
Ollie Lhocbbf1252004-03-17 22:22:08 +0000627} FLASH_ENABLE;
628
Uwe Hermann372eeb52007-12-04 21:49:06 +0000629static const FLASH_ENABLE enables[] = {
Uwe Hermanneac10162008-03-13 18:52:51 +0000630 {0x1039, 0x0630, "SiS630", enable_flash_sis630},
631 {0x8086, 0x7110, "Intel PIIX4/4E/4M", enable_flash_piix4},
632 {0x8086, 0x7198, "Intel 440MX", enable_flash_piix4},
633 {0x8086, 0x2410, "Intel ICH", enable_flash_ich_4e},
634 {0x8086, 0x2420, "Intel ICH0", enable_flash_ich_4e},
635 {0x8086, 0x2440, "Intel ICH2", enable_flash_ich_4e},
636 {0x8086, 0x244c, "Intel ICH2-M", enable_flash_ich_4e},
637 {0x8086, 0x2480, "Intel ICH3-S", enable_flash_ich_4e},
638 {0x8086, 0x248c, "Intel ICH3-M", enable_flash_ich_4e},
639 {0x8086, 0x24c0, "Intel ICH4/ICH4-L", enable_flash_ich_4e},
640 {0x8086, 0x24cc, "Intel ICH4-M", enable_flash_ich_4e},
641 {0x8086, 0x24d0, "Intel ICH5/ICH5R", enable_flash_ich_4e},
Claus Gindharta00e2a02008-05-14 12:22:38 +0000642 {0x8086, 0x25a1, "Intel 6300ESB", enable_flash_ich_4e},
Uwe Hermanneac10162008-03-13 18:52:51 +0000643 {0x8086, 0x2640, "Intel ICH6/ICH6R", enable_flash_ich_dc},
644 {0x8086, 0x2641, "Intel ICH6-M", enable_flash_ich_dc},
Carl-Daniel Hailfinger1b18b3c2008-05-16 14:39:39 +0000645 {0x8086, 0x27b0, "Intel ICH7DH", enable_flash_ich7},
646 {0x8086, 0x27b8, "Intel ICH7/ICH7R", enable_flash_ich7},
647 {0x8086, 0x27b9, "Intel ICH7M", enable_flash_ich7},
648 {0x8086, 0x27bd, "Intel ICH7MDH", enable_flash_ich7},
649 {0x8086, 0x2810, "Intel ICH8/ICH8R", enable_flash_ich8},
650 {0x8086, 0x2811, "Intel ICH8M-E", enable_flash_ich8},
651 {0x8086, 0x2812, "Intel ICH8DH", enable_flash_ich8},
652 {0x8086, 0x2814, "Intel ICH8DO", enable_flash_ich8},
653 {0x8086, 0x2815, "Intel ICH8M", enable_flash_ich8},
Carl-Daniel Hailfinger6dc1d3b2008-05-14 14:51:22 +0000654 {0x8086, 0x2912, "Intel ICH9DH", enable_flash_ich9},
655 {0x8086, 0x2914, "Intel ICH9DO", enable_flash_ich9},
656 {0x8086, 0x2916, "Intel ICH9R", enable_flash_ich9},
657 {0x8086, 0x2917, "Intel ICH9M-E", enable_flash_ich9},
658 {0x8086, 0x2918, "Intel ICH9", enable_flash_ich9},
659 {0x8086, 0x2919, "Intel ICH9M", enable_flash_ich9},
Uwe Hermanneac10162008-03-13 18:52:51 +0000660 {0x1106, 0x8231, "VIA VT8231", enable_flash_vt823x},
661 {0x1106, 0x3177, "VIA VT8235", enable_flash_vt823x},
662 {0x1106, 0x3227, "VIA VT8237", enable_flash_vt823x},
663 {0x1106, 0x8324, "VIA CX700", enable_flash_vt823x},
664 {0x1106, 0x0686, "VIA VT82C686", enable_flash_amd8111},
665 {0x1078, 0x0100, "AMD CS5530(A)", enable_flash_cs5530},
666 {0x100b, 0x0510, "AMD SC1100", enable_flash_sc1100},
667 {0x1039, 0x0008, "SiS5595", enable_flash_sis5595},
668 {0x1022, 0x2080, "AMD CS5536", enable_flash_cs5536},
669 {0x1022, 0x7468, "AMD8111", enable_flash_amd8111},
670 {0x10B9, 0x1533, "ALi M1533", enable_flash_ali_m1533},
671 {0x10de, 0x0050, "NVIDIA CK804", enable_flash_ck804}, /* LPC */
672 {0x10de, 0x0051, "NVIDIA CK804", enable_flash_ck804}, /* Pro */
673 /* Slave, should not be here, to fix known bug for A01. */
674 {0x10de, 0x00d3, "NVIDIA CK804", enable_flash_ck804},
675 {0x10de, 0x0260, "NVIDIA MCP51", enable_flash_ck804},
676 {0x10de, 0x0261, "NVIDIA MCP51", enable_flash_ck804},
677 {0x10de, 0x0262, "NVIDIA MCP51", enable_flash_ck804},
678 {0x10de, 0x0263, "NVIDIA MCP51", enable_flash_ck804},
679 {0x10de, 0x0360, "NVIDIA MCP55", enable_flash_mcp55}, /* M57SLI*/
680 {0x10de, 0x0361, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
681 {0x10de, 0x0362, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
682 {0x10de, 0x0363, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
683 {0x10de, 0x0364, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
684 {0x10de, 0x0365, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
685 {0x10de, 0x0366, "NVIDIA MCP55", enable_flash_mcp55}, /* LPC */
686 {0x10de, 0x0367, "NVIDIA MCP55", enable_flash_mcp55}, /* Pro */
687 {0x1002, 0x4377, "ATI SB400", enable_flash_sb400},
688 {0x1166, 0x0205, "Broadcom HT-1000", enable_flash_ht1000},
Ollie Lhocbbf1252004-03-17 22:22:08 +0000689};
Ollie Lho761bf1b2004-03-20 16:46:10 +0000690
Uwe Hermanne5ac1642008-03-12 11:54:51 +0000691void print_supported_chipsets(void)
692{
693 int i;
694
695 printf("\nSupported chipsets:\n\n");
696
697 for (i = 0; i < ARRAY_SIZE(enables); i++)
698 printf("%s (%04x:%04x)\n", enables[i].name,
699 enables[i].vendor, enables[i].device);
700}
701
Uwe Hermanna7e05482007-05-09 10:17:44 +0000702int chipset_flash_enable(void)
Ollie Lhocbbf1252004-03-17 22:22:08 +0000703{
Uwe Hermanna7e05482007-05-09 10:17:44 +0000704 struct pci_dev *dev = 0;
Uwe Hermann372eeb52007-12-04 21:49:06 +0000705 int ret = -2; /* Nothing! */
Uwe Hermanna7e05482007-05-09 10:17:44 +0000706 int i;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000707
Uwe Hermann372eeb52007-12-04 21:49:06 +0000708 /* Now let's try to find the chipset we have... */
Uwe Hermanne5ac1642008-03-12 11:54:51 +0000709 for (i = 0; i < ARRAY_SIZE(enables); i++) {
Uwe Hermanna7e05482007-05-09 10:17:44 +0000710 dev = pci_dev_find(enables[i].vendor, enables[i].device);
711 if (dev)
712 break;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000713 }
714
Uwe Hermanna7e05482007-05-09 10:17:44 +0000715 if (dev) {
Uwe Hermanna502dce2007-10-17 23:55:15 +0000716 printf("Found chipset \"%s\", enabling flash write... ",
Uwe Hermanna7e05482007-05-09 10:17:44 +0000717 enables[i].name);
718
719 ret = enables[i].doit(dev, enables[i].name);
720 if (ret)
Uwe Hermanna502dce2007-10-17 23:55:15 +0000721 printf("FAILED!\n");
Uwe Hermanna7e05482007-05-09 10:17:44 +0000722 else
Uwe Hermannac309342007-10-10 17:42:20 +0000723 printf("OK.\n");
Uwe Hermanna7e05482007-05-09 10:17:44 +0000724 }
725
726 return ret;
Ollie Lhocbbf1252004-03-17 22:22:08 +0000727}