flashrom.c 53.2 KB
Newer Older
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
1
/*
2
 * This file is part of the flashrom project.
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
3
 *
4 5
 * Copyright (C) 2000 Silicon Integrated System Corporation
 * Copyright (C) 2004 Tyan Corp <yhlu@tyan.com>
6
 * Copyright (C) 2005-2008 coresystems GmbH
7
 * Copyright (C) 2008,2009 Carl-Daniel Hailfinger
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
8
 *
9 10 11 12
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
13
 *
14 15 16 17
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
18
 *
19 20 21
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA  02110-1301 USA
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
22 23
 */

24
#include <stdio.h>
25
#include <sys/types.h>
26 27
#ifndef __LIBPAYLOAD__
#include <fcntl.h>
28
#include <sys/stat.h>
29
#endif
Ronald G. Minnich's avatar
Ronald G. Minnich committed
30
#include <string.h>
Ronald G. Minnich's avatar
Ronald G. Minnich committed
31
#include <stdlib.h>
32
#include <ctype.h>
33
#include <getopt.h>
34 35 36
#if HAVE_UTSNAME == 1
#include <sys/utsname.h>
#endif
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
37
#include "flash.h"
38
#include "flashchips.h"
39
#include "programmer.h"
40
#include "hwaccess.h"
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
41

42
const char flashrom_version[] = FLASHROM_VERSION;
Nico Huber's avatar
Nico Huber committed
43
const char *chip_to_probe = NULL;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
44 45
int verbose_screen = MSG_INFO;
int verbose_logfile = MSG_DEBUG2;
46

47
static enum programmer programmer = PROGRAMMER_INVALID;
48

Nico Huber's avatar
Nico Huber committed
49
static const char *programmer_param = NULL;
50

51
/*
52 53 54
 * Programmers supporting multiple buses can have differing size limits on
 * each bus. Store the limits for each bus in a common struct.
 */
55 56 57 58
struct decode_sizes max_rom_decode;

/* If nonzero, used as the start address of bottom-aligned flash. */
unsigned long flashbase;
59

60 61 62
/* Is writing allowed with this programmer? */
int programmer_may_write;

63
const struct programmer_entry programmer_table[] = {
64
#if CONFIG_INTERNAL == 1
65
	{
66
		.name			= "internal",
67 68
		.type			= OTHER,
		.devs.note		= NULL,
69
		.init			= internal_init,
70 71
		.map_flash_region	= physmap,
		.unmap_flash_region	= physunmap,
72
		.delay			= internal_delay,
73
	},
74
#endif
75

76
#if CONFIG_DUMMY == 1
77
	{
78
		.name			= "dummy",
79 80 81
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "Dummy device, does nothing and logs all accesses\n",
82
		.init			= dummy_init,
83 84
		.map_flash_region	= dummy_map,
		.unmap_flash_region	= dummy_unmap,
85
		.delay			= internal_delay,
86
	},
87
#endif
88

89
#if CONFIG_NIC3COM == 1
90
	{
91
		.name			= "nic3com",
92
		.type			= PCI,
93
		.devs.dev		= nics_3com,
94
		.init			= nic3com_init,
95 96
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
97
		.delay			= internal_delay,
98
	},
99
#endif
100

101
#if CONFIG_NICREALTEK == 1
102
	{
103
		/* This programmer works for Realtek RTL8139 and SMC 1211. */
104
		.name			= "nicrealtek",
105
		.type			= PCI,
106
		.devs.dev		= nics_realtek,
107 108 109 110
		.init			= nicrealtek_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
111 112 113
	},
#endif

114 115
#if CONFIG_NICNATSEMI == 1
	{
116
		.name			= "nicnatsemi",
117
		.type			= PCI,
118
		.devs.dev		= nics_natsemi,
119 120 121 122
		.init			= nicnatsemi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
123 124
	},
#endif
125

126
#if CONFIG_GFXNVIDIA == 1
127 128
	{
		.name			= "gfxnvidia",
129
		.type			= PCI,
130
		.devs.dev		= gfx_nvidia,
131 132 133 134 135 136 137
		.init			= gfxnvidia_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

138
#if CONFIG_DRKAISER == 1
139 140
	{
		.name			= "drkaiser",
141
		.type			= PCI,
142
		.devs.dev		= drkaiser_pcidev,
143 144 145 146 147
		.init			= drkaiser_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
148
#endif
149

150
#if CONFIG_SATASII == 1
151
	{
152
		.name			= "satasii",
153
		.type			= PCI,
154
		.devs.dev		= satas_sii,
155
		.init			= satasii_init,
156 157
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
158
		.delay			= internal_delay,
159
	},
160
#endif
161

162
#if CONFIG_ATAHPT == 1
163 164
	{
		.name			= "atahpt",
165
		.type			= PCI,
166
		.devs.dev		= ata_hpt,
167 168 169 170 171 172 173
		.init			= atahpt_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

174
#if CONFIG_FT2232_SPI == 1
175
	{
176
		.name			= "ft2232_spi",
177
		.type			= USB,
178
		.devs.dev		= devs_ft2232spi,
179
		.init			= ft2232_spi_init,
180 181
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
182 183
		.delay			= internal_delay,
	},
184
#endif
185

186
#if CONFIG_SERPROG == 1
187
	{
188
		.name			= "serprog",
189 190 191
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "All programmer devices speaking the serprog protocol\n",
192 193 194 195 196
		.init			= serprog_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= serprog_delay,
	},
197
#endif
198

199
#if CONFIG_BUSPIRATE_SPI == 1
200
	{
201
		.name			= "buspirate_spi",
202 203 204
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "Dangerous Prototypes Bus Pirate\n",
205 206 207 208 209 210 211
		.init			= buspirate_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

212
#if CONFIG_DEDIPROG == 1
213 214
	{
		.name			= "dediprog",
215 216 217
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "Dediprog SF100\n",
218 219 220 221 222 223 224
		.init			= dediprog_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

225 226 227
#if CONFIG_RAYER_SPI == 1
	{
		.name			= "rayer_spi",
228 229 230
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "RayeR parallel port programmer\n",
231 232 233 234 235 236 237
		.init			= rayer_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

238 239 240
#if CONFIG_PONY_SPI == 1
	{
		.name			= "pony_spi",
241 242 243
		.type			= OTHER,
					/* FIXME */
		.devs.note		= "Programmers compatible with SI-Prog, serbang or AJAWe\n",
244 245 246 247
		.init			= pony_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
248
	},
249 250
#endif

251 252 253
#if CONFIG_NICINTEL == 1
	{
		.name			= "nicintel",
254
		.type			= PCI,
255
		.devs.dev		= nics_intel,
256 257 258 259 260 261 262
		.init			= nicintel_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

263 264
#if CONFIG_NICINTEL_SPI == 1
	{
265
		.name			= "nicintel_spi",
266
		.type			= PCI,
267
		.devs.dev		= nics_intel_spi,
268 269 270 271
		.init			= nicintel_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
272 273 274
	},
#endif

275 276
#if CONFIG_OGP_SPI == 1
	{
277
		.name			= "ogp_spi",
278
		.type			= PCI,
279
		.devs.dev		= ogp_spi,
280 281 282 283
		.init			= ogp_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
284 285 286
	},
#endif

287 288 289
#if CONFIG_SATAMV == 1
	{
		.name			= "satamv",
290
		.type			= PCI,
291
		.devs.dev		= satas_mv,
292 293 294 295 296 297 298
		.init			= satamv_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

299 300 301
#if CONFIG_LINUX_SPI == 1
	{
		.name			= "linux_spi",
302 303
		.type			= OTHER,
		.devs.note		= "Device files /dev/spidev*.*\n",
304 305 306 307 308 309 310
		.init			= linux_spi_init,
		.map_flash_region	= fallback_map,
		.unmap_flash_region	= fallback_unmap,
		.delay			= internal_delay,
	},
#endif

Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
311
	{0}, /* This entry corresponds to PROGRAMMER_INVALID. */
312
};
313

314
#define SHUTDOWN_MAXFN 32
315 316
static int shutdown_fn_count = 0;
struct shutdown_func_data {
317
	int (*func) (void *data);
318
	void *data;
319 320 321 322 323
} static shutdown_fn[SHUTDOWN_MAXFN];
/* Initialize to 0 to make sure nobody registers a shutdown function before
 * programmer init.
 */
static int may_register_shutdown = 0;
324

325
static int check_block_eraser(const struct flashctx *flash, int k, int log);
326

327 328 329 330 331 332 333 334
/* Register a function to be executed on programmer shutdown.
 * The advantage over atexit() is that you can supply a void pointer which will
 * be used as parameter to the registered function upon programmer shutdown.
 * This pointer can point to arbitrary data used by said function, e.g. undo
 * information for GPIO settings etc. If unneeded, set data=NULL.
 * Please note that the first (void *data) belongs to the function signature of
 * the function passed as first parameter.
 */
335
int register_shutdown(int (*function) (void *data), void *data)
336 337
{
	if (shutdown_fn_count >= SHUTDOWN_MAXFN) {
338
		msg_perr("Tried to register more than %i shutdown functions.\n",
339 340 341
			 SHUTDOWN_MAXFN);
		return 1;
	}
342 343 344 345 346
	if (!may_register_shutdown) {
		msg_perr("Tried to register a shutdown function before "
			 "programmer init.\n");
		return 1;
	}
347 348 349 350 351 352 353
	shutdown_fn[shutdown_fn_count].func = function;
	shutdown_fn[shutdown_fn_count].data = data;
	shutdown_fn_count++;

	return 0;
}

Nico Huber's avatar
Nico Huber committed
354
int programmer_init(enum programmer prog, const char *param)
355
{
356
	int ret;
357 358 359 360 361 362

	if (prog >= PROGRAMMER_INVALID) {
		msg_perr("Invalid programmer specified!\n");
		return -1;
	}
	programmer = prog;
363 364 365 366 367 368
	/* Initialize all programmer specific data. */
	/* Default to unlimited decode sizes. */
	max_rom_decode = (const struct decode_sizes) {
		.parallel	= 0xffffffff,
		.lpc		= 0xffffffff,
		.fwh		= 0xffffffff,
369
		.spi		= 0xffffffff,
370 371 372 373 374
	};
	/* Default to top aligned flash at 4 GB. */
	flashbase = 0;
	/* Registering shutdown functions is now allowed. */
	may_register_shutdown = 1;
375 376
	/* Default to allowing writes. Broken programmers set this to 0. */
	programmer_may_write = 1;
377 378 379 380

	programmer_param = param;
	msg_pdbg("Initializing %s programmer\n",
		 programmer_table[programmer].name);
381 382 383 384 385 386 387
	ret = programmer_table[programmer].init();
	if (programmer_param && strlen(programmer_param)) {
		msg_perr("Unhandled programmer parameters: %s\n",
			 programmer_param);
		/* Do not error out here, the init itself was successful. */
	}
	return ret;
388 389 390 391
}

int programmer_shutdown(void)
{
392 393
	int ret = 0;

394 395 396 397
	/* Registering shutdown functions is no longer allowed. */
	may_register_shutdown = 0;
	while (shutdown_fn_count > 0) {
		int i = --shutdown_fn_count;
398
		ret |= shutdown_fn[i].func(shutdown_fn[i].data);
399
	}
400

Stefan Tauner's avatar
Stefan Tauner committed
401
	programmer_param = NULL;
402 403
	registered_programmer_count = 0;

404
	return ret;
405 406 407 408 409 410 411 412 413 414 415 416 417 418
}

void *programmer_map_flash_region(const char *descr, unsigned long phys_addr,
				  size_t len)
{
	return programmer_table[programmer].map_flash_region(descr,
							     phys_addr, len);
}

void programmer_unmap_flash_region(void *virt_addr, size_t len)
{
	programmer_table[programmer].unmap_flash_region(virt_addr, len);
}

419
void chip_writeb(const struct flashctx *flash, uint8_t val, chipaddr addr)
420
{
421
	flash->pgm->par.chip_writeb(flash, val, addr);
422 423
}

424
void chip_writew(const struct flashctx *flash, uint16_t val, chipaddr addr)
425
{
426
	flash->pgm->par.chip_writew(flash, val, addr);
427 428
}

429
void chip_writel(const struct flashctx *flash, uint32_t val, chipaddr addr)
430
{
431
	flash->pgm->par.chip_writel(flash, val, addr);
432 433
}

434 435
void chip_writen(const struct flashctx *flash, uint8_t *buf, chipaddr addr,
		 size_t len)
436
{
437
	flash->pgm->par.chip_writen(flash, buf, addr, len);
438 439
}

440
uint8_t chip_readb(const struct flashctx *flash, const chipaddr addr)
441
{
442
	return flash->pgm->par.chip_readb(flash, addr);
443 444
}

445
uint16_t chip_readw(const struct flashctx *flash, const chipaddr addr)
446
{
447
	return flash->pgm->par.chip_readw(flash, addr);
448 449
}

450
uint32_t chip_readl(const struct flashctx *flash, const chipaddr addr)
451
{
452
	return flash->pgm->par.chip_readl(flash, addr);
453 454
}

455 456
void chip_readn(const struct flashctx *flash, uint8_t *buf, chipaddr addr,
		size_t len)
457
{
458
	flash->pgm->par.chip_readn(flash, buf, addr, len);
459 460
}

461 462 463 464 465
void programmer_delay(int usecs)
{
	programmer_table[programmer].delay(usecs);
}

466
void map_flash_registers(struct flashctx *flash)
467
{
468
	size_t size = flash->chip->total_size * 1024;
469
	/* Flash registers live 4 MByte below the flash. */
470
	/* FIXME: This is incorrect for nonstandard flashbase. */
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
471
	flash->virtual_registers = (chipaddr)programmer_map_flash_region("flash chip registers", (0xFFFFFFFF - 0x400000 - size + 1), size);
472 473
}

474 475
int read_memmapped(struct flashctx *flash, uint8_t *buf, unsigned int start,
		   int unsigned len)
476
{
477
	chip_readn(flash, buf, flash->virtual_memory + start, len);
478

479 480 481
	return 0;
}

482 483 484 485 486
int min(int a, int b)
{
	return (a < b) ? a : b;
}

487 488 489 490 491
int max(int a, int b)
{
	return (a > b) ? a : b;
}

492 493 494 495 496 497 498 499 500
int bitcount(unsigned long a)
{
	int i = 0;
	for (; a != 0; a >>= 1)
		if (a & 1)
			i++;
	return i;
}

501 502 503 504 505 506
void tolower_string(char *str)
{
	for (; *str != '\0'; str++)
		*str = (char)tolower((unsigned char)*str);
}

507 508 509
char *strcat_realloc(char *dest, const char *src)
{
	dest = realloc(dest, strlen(dest) + strlen(src) + 1);
510 511
	if (!dest) {
		msg_gerr("Out of memory!\n");
512
		return NULL;
513
	}
514 515 516 517
	strcat(dest, src);
	return dest;
}

518
/* This is a somewhat hacked function similar in some ways to strtok().
519 520 521
 * It will look for needle with a subsequent '=' in haystack, return a copy of
 * needle and remove everything from the first occurrence of needle to the next
 * delimiter from haystack.
522
 */
Nico Huber's avatar
Nico Huber committed
523
char *extract_param(const char *const *haystack, const char *needle, const char *delim)
524
{
525 526 527
	char *param_pos, *opt_pos, *rest;
	char *opt = NULL;
	int optlen;
528
	int needlelen;
529

530 531 532 533 534 535 536 537 538
	needlelen = strlen(needle);
	if (!needlelen) {
		msg_gerr("%s: empty needle! Please report a bug at "
			 "flashrom@flashrom.org\n", __func__);
		return NULL;
	}
	/* No programmer parameters given. */
	if (*haystack == NULL)
		return NULL;
539 540 541 542
	param_pos = strstr(*haystack, needle);
	do {
		if (!param_pos)
			return NULL;
543 544 545 546 547 548 549 550 551 552
		/* Needle followed by '='? */
		if (param_pos[needlelen] == '=') {
			
			/* Beginning of the string? */
			if (param_pos == *haystack)
				break;
			/* After a delimiter? */
			if (strchr(delim, *(param_pos - 1)))
				break;
		}
553 554 555 556
		/* Continue searching. */
		param_pos++;
		param_pos = strstr(param_pos, needle);
	} while (1);
557

558
	if (param_pos) {
559 560 561 562 563 564
		/* Get the string after needle and '='. */
		opt_pos = param_pos + needlelen + 1;
		optlen = strcspn(opt_pos, delim);
		/* Return an empty string if the parameter was empty. */
		opt = malloc(optlen + 1);
		if (!opt) {
565
			msg_gerr("Out of memory!\n");
566 567
			exit(1);
		}
568 569 570 571 572 573 574
		strncpy(opt, opt_pos, optlen);
		opt[optlen] = '\0';
		rest = opt_pos + optlen;
		/* Skip all delimiters after the current parameter. */
		rest += strspn(rest, delim);
		memmove(param_pos, rest, strlen(rest) + 1);
		/* We could shrink haystack, but the effort is not worth it. */
575 576
	}

577
	return opt;
578 579
}

580
char *extract_programmer_param(const char *param_name)
581 582 583 584
{
	return extract_param(&programmer_param, param_name, ",");
}

585
/* Returns the number of well-defined erasers for a chip. */
586
static unsigned int count_usable_erasers(const struct flashctx *flash)
587 588 589 590 591 592 593 594 595 596
{
	unsigned int usable_erasefunctions = 0;
	int k;
	for (k = 0; k < NUM_ERASEFUNCTIONS; k++) {
		if (!check_block_eraser(flash, k, 0))
			usable_erasefunctions++;
	}
	return usable_erasefunctions;
}

597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616
int compare_range(uint8_t *wantbuf, uint8_t *havebuf, unsigned int start, unsigned int len)
{
	int ret = 0, failcount = 0;
	unsigned int i;
	for (i = 0; i < len; i++) {
		if (wantbuf[i] != havebuf[i]) {
			/* Only print the first failure. */
			if (!failcount++)
				msg_cerr("FAILED at 0x%08x! Expected=0x%02x, Found=0x%02x,",
					 start + i, wantbuf[i], havebuf[i]);
		}
	}
	if (failcount) {
		msg_cerr(" failed byte count from 0x%08x-0x%08x: 0x%x\n",
			 start, start + len - 1, failcount);
		ret = -1;
	}
	return ret;
}

617
/* start is an offset to the base address of the flash chip */
618 619
int check_erased_range(struct flashctx *flash, unsigned int start,
		       unsigned int len)
620 621 622 623 624
{
	int ret;
	uint8_t *cmpbuf = malloc(len);

	if (!cmpbuf) {
625
		msg_gerr("Could not allocate memory!\n");
626 627 628
		exit(1);
	}
	memset(cmpbuf, 0xff, len);
629
	ret = verify_range(flash, cmpbuf, start, len);
630 631 632 633
	free(cmpbuf);
	return ret;
}

634
/*
635
 * @cmpbuf	buffer to compare against, cmpbuf[0] is expected to match the
636
 *		flash content at location start
637 638 639 640
 * @start	offset to the base address of the flash chip
 * @len		length of the verified area
 * @return	0 for success, -1 for failure
 */
641
int verify_range(struct flashctx *flash, uint8_t *cmpbuf, unsigned int start, unsigned int len)
642
{
643
	uint8_t *readbuf = malloc(len);
644
	int ret = 0;
645 646 647 648

	if (!len)
		goto out_free;

649
	if (!flash->chip->read) {
650
		msg_cerr("ERROR: flashrom has no read function for this flash chip.\n");
651 652
		return 1;
	}
653
	if (!readbuf) {
654
		msg_gerr("Could not allocate memory!\n");
655 656 657
		exit(1);
	}

658
	if (start + len > flash->chip->total_size * 1024) {
659
		msg_gerr("Error: %s called with start 0x%x + len 0x%x >"
660
			" total_size 0x%x\n", __func__, start, len,
661
			flash->chip->total_size * 1024);
662 663 664
		ret = -1;
		goto out_free;
	}
665

666
	ret = flash->chip->read(flash, readbuf, start, len);
667 668 669 670 671 672
	if (ret) {
		msg_gerr("Verification impossible because read failed "
			 "at 0x%x (len 0x%x)\n", start, len);
		return ret;
	}

673
	ret = compare_range(cmpbuf, readbuf, start, len);
674 675 676 677 678
out_free:
	free(readbuf);
	return ret;
}

679
/*
680 681 682
 * Check if the buffer @have can be programmed to the content of @want without
 * erasing. This is only possible if all chunks of size @gran are either kept
 * as-is or changed from an all-ones state to any other state.
683 684 685
 *
 * Warning: This function assumes that @have and @want point to naturally
 * aligned regions.
686 687 688
 *
 * @have        buffer with current content
 * @want        buffer with desired content
689
 * @len		length of the checked area
690 691 692
 * @gran	write granularity (enum, not count)
 * @return      0 if no erase is needed, 1 otherwise
 */
693
int need_erase(uint8_t *have, uint8_t *want, unsigned int len, enum write_granularity gran)
694
{
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
695
	int result = 0;
696
	unsigned int i, j, limit;
697 698 699 700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715

	switch (gran) {
	case write_gran_1bit:
		for (i = 0; i < len; i++)
			if ((have[i] & want[i]) != want[i]) {
				result = 1;
				break;
			}
		break;
	case write_gran_1byte:
		for (i = 0; i < len; i++)
			if ((have[i] != want[i]) && (have[i] != 0xff)) {
				result = 1;
				break;
			}
		break;
	case write_gran_256bytes:
		for (j = 0; j < len / 256; j++) {
			limit = min (256, len - j * 256);
716
			/* Are 'have' and 'want' identical? */
717 718 719 720
			if (!memcmp(have + j * 256, want + j * 256, limit))
				continue;
			/* have needs to be in erased state. */
			for (i = 0; i < limit; i++)
721
				if (have[j * 256 + i] != 0xff) {
722 723 724 725 726 727 728
					result = 1;
					break;
				}
			if (result)
				break;
		}
		break;
729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748
	default:
		msg_cerr("%s: Unsupported granularity! Please report a bug at "
			 "flashrom@flashrom.org\n", __func__);
	}
	return result;
}

/**
 * Check if the buffer @have needs to be programmed to get the content of @want.
 * If yes, return 1 and fill in first_start with the start address of the
 * write operation and first_len with the length of the first to-be-written
 * chunk. If not, return 0 and leave first_start and first_len undefined.
 *
 * Warning: This function assumes that @have and @want point to naturally
 * aligned regions.
 *
 * @have	buffer with current content
 * @want	buffer with desired content
 * @len		length of the checked area
 * @gran	write granularity (enum, not count)
749 750 751 752 753
 * @first_start	offset of the first byte which needs to be written (passed in
 *		value is increased by the offset of the first needed write
 *		relative to have/want or unchanged if no write is needed)
 * @return	length of the first contiguous area which needs to be written
 *		0 if no write is needed
754 755 756 757 758
 *
 * FIXME: This function needs a parameter which tells it about coalescing
 * in relation to the max write length of the programmer and the max write
 * length of the chip.
 */
759 760 761
static unsigned int get_next_write(uint8_t *have, uint8_t *want, unsigned int len,
			  unsigned int *first_start,
			  enum write_granularity gran)
762
{
763 764 765
	int need_write = 0;
	unsigned int rel_start = 0, first_len = 0;
	unsigned int i, limit, stride;
766 767 768 769

	switch (gran) {
	case write_gran_1bit:
	case write_gran_1byte:
770
		stride = 1;
771 772
		break;
	case write_gran_256bytes:
773
		stride = 256;
774 775 776 777
		break;
	default:
		msg_cerr("%s: Unsupported granularity! Please report a bug at "
			 "flashrom@flashrom.org\n", __func__);
778 779 780 781
		/* Claim that no write was needed. A write with unknown
		 * granularity is too dangerous to try.
		 */
		return 0;
782
	}
783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800
	for (i = 0; i < len / stride; i++) {
		limit = min(stride, len - i * stride);
		/* Are 'have' and 'want' identical? */
		if (memcmp(have + i * stride, want + i * stride, limit)) {
			if (!need_write) {
				/* First location where have and want differ. */
				need_write = 1;
				rel_start = i * stride;
			}
		} else {
			if (need_write) {
				/* First location where have and want
				 * do not differ anymore.
				 */
				break;
			}
		}
	}
801
	if (need_write)
802
		first_len = min(i * stride - rel_start, len);
803
	*first_start += rel_start;
804
	return first_len;
805 806
}

807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860
/* This function generates various test patterns useful for testing controller
 * and chip communication as well as chip behaviour.
 *
 * If a byte can be written multiple times, each time keeping 0-bits at 0
 * and changing 1-bits to 0 if the new value for that bit is 0, the effect
 * is essentially an AND operation. That's also the reason why this function
 * provides the result of AND between various patterns.
 *
 * Below is a list of patterns (and their block length).
 * Pattern 0 is 05 15 25 35 45 55 65 75 85 95 a5 b5 c5 d5 e5 f5 (16 Bytes)
 * Pattern 1 is 0a 1a 2a 3a 4a 5a 6a 7a 8a 9a aa ba ca da ea fa (16 Bytes)
 * Pattern 2 is 50 51 52 53 54 55 56 57 58 59 5a 5b 5c 5d 5e 5f (16 Bytes)
 * Pattern 3 is a0 a1 a2 a3 a4 a5 a6 a7 a8 a9 aa ab ac ad ae af (16 Bytes)
 * Pattern 4 is 00 10 20 30 40 50 60 70 80 90 a0 b0 c0 d0 e0 f0 (16 Bytes)
 * Pattern 5 is 00 01 02 03 04 05 06 07 08 09 0a 0b 0c 0d 0e 0f (16 Bytes)
 * Pattern 6 is 00 (1 Byte)
 * Pattern 7 is ff (1 Byte)
 * Patterns 0-7 have a big-endian block number in the last 2 bytes of each 256
 * byte block.
 *
 * Pattern 8 is 00 01 02 03 04 05 06 07 08 09 0a 0b 0c 0d 0e 0f 10 11... (256 B)
 * Pattern 9 is ff fe fd fc fb fa f9 f8 f7 f6 f5 f4 f3 f2 f1 f0 ef ee... (256 B)
 * Pattern 10 is 00 00 00 01 00 02 00 03 00 04... (128 kB big-endian counter)
 * Pattern 11 is ff ff ff fe ff fd ff fc ff fb... (128 kB big-endian downwards)
 * Pattern 12 is 00 (1 Byte)
 * Pattern 13 is ff (1 Byte)
 * Patterns 8-13 have no block number.
 *
 * Patterns 0-3 are created to detect and efficiently diagnose communication
 * slips like missed bits or bytes and their repetitive nature gives good visual
 * cues to the person inspecting the results. In addition, the following holds:
 * AND Pattern 0/1 == Pattern 4
 * AND Pattern 2/3 == Pattern 5
 * AND Pattern 0/1/2/3 == AND Pattern 4/5 == Pattern 6
 * A weakness of pattern 0-5 is the inability to detect swaps/copies between
 * any two 16-byte blocks except for the last 16-byte block in a 256-byte bloc.
 * They work perfectly for detecting any swaps/aliasing of blocks >= 256 bytes.
 * 0x5 and 0xa were picked because they are 0101 and 1010 binary.
 * Patterns 8-9 are best for detecting swaps/aliasing of blocks < 256 bytes.
 * Besides that, they provide for bit testing of the last two bytes of every
 * 256 byte block which contains the block number for patterns 0-6.
 * Patterns 10-11 are special purpose for detecting subblock aliasing with
 * block sizes >256 bytes (some Dataflash chips etc.)
 * AND Pattern 8/9 == Pattern 12
 * AND Pattern 10/11 == Pattern 12
 * Pattern 13 is the completely erased state.
 * None of the patterns can detect aliasing at boundaries which are a multiple
 * of 16 MBytes (but such chips do not exist anyway for Parallel/LPC/FWH/SPI).
 */
int generate_testpattern(uint8_t *buf, uint32_t size, int variant)
{
	int i;

	if (!buf) {
861
		msg_gerr("Invalid buffer!\n");
862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942
		return 1;
	}

	switch (variant) {
	case 0:
		for (i = 0; i < size; i++)
			buf[i] = (i & 0xf) << 4 | 0x5;
		break;
	case 1:
		for (i = 0; i < size; i++)
			buf[i] = (i & 0xf) << 4 | 0xa;
		break;
	case 2:
		for (i = 0; i < size; i++)
			buf[i] = 0x50 | (i & 0xf);
		break;
	case 3:
		for (i = 0; i < size; i++)
			buf[i] = 0xa0 | (i & 0xf);
		break;
	case 4:
		for (i = 0; i < size; i++)
			buf[i] = (i & 0xf) << 4;
		break;
	case 5:
		for (i = 0; i < size; i++)
			buf[i] = i & 0xf;
		break;
	case 6:
		memset(buf, 0x00, size);
		break;
	case 7:
		memset(buf, 0xff, size);
		break;
	case 8:
		for (i = 0; i < size; i++)
			buf[i] = i & 0xff;
		break;
	case 9:
		for (i = 0; i < size; i++)
			buf[i] = ~(i & 0xff);
		break;
	case 10:
		for (i = 0; i < size % 2; i++) {
			buf[i * 2] = (i >> 8) & 0xff;
			buf[i * 2 + 1] = i & 0xff;
		}
		if (size & 0x1)
			buf[i * 2] = (i >> 8) & 0xff;
		break;
	case 11:
		for (i = 0; i < size % 2; i++) {
			buf[i * 2] = ~((i >> 8) & 0xff);
			buf[i * 2 + 1] = ~(i & 0xff);
		}
		if (size & 0x1)
			buf[i * 2] = ~((i >> 8) & 0xff);
		break;
	case 12:
		memset(buf, 0x00, size);
		break;
	case 13:
		memset(buf, 0xff, size);
		break;
	}

	if ((variant >= 0) && (variant <= 7)) {
		/* Write block number in the last two bytes of each 256-byte
		 * block, big endian for easier reading of the hexdump.
		 * Note that this wraps around for chips larger than 2^24 bytes
		 * (16 MB).
		 */
		for (i = 0; i < size / 256; i++) {
			buf[i * 256 + 254] = (i >> 8) & 0xff;
			buf[i * 256 + 255] = i & 0xff;
		}
	}

	return 0;
}

943 944 945
int check_max_decode(enum chipbustype buses, uint32_t size)
{
	int limitexceeded = 0;
946 947

	if ((buses & BUS_PARALLEL) && (max_rom_decode.parallel < size)) {
948
		limitexceeded++;
949
		msg_pdbg("Chip size %u kB is bigger than supported "
950 951 952 953
			 "size %u kB of chipset/board/programmer "
			 "for %s interface, "
			 "probe/read/erase/write may fail. ", size / 1024,
			 max_rom_decode.parallel / 1024, "Parallel");
954
	}
955
	if ((buses & BUS_LPC) && (max_rom_decode.lpc < size)) {
956
		limitexceeded++;
957
		msg_pdbg("Chip size %u kB is bigger than supported "
958 959 960 961
			 "size %u kB of chipset/board/programmer "
			 "for %s interface, "
			 "probe/read/erase/write may fail. ", size / 1024,
			 max_rom_decode.lpc / 1024, "LPC");
962
	}
963
	if ((buses & BUS_FWH) && (max_rom_decode.fwh < size)) {
964
		limitexceeded++;
965
		msg_pdbg("Chip size %u kB is bigger than supported "
966 967 968 969
			 "size %u kB of chipset/board/programmer "
			 "for %s interface, "
			 "probe/read/erase/write may fail. ", size / 1024,
			 max_rom_decode.fwh / 1024, "FWH");
970
	}
971
	if ((buses & BUS_SPI) && (max_rom_decode.spi < size)) {
972
		limitexceeded++;
973
		msg_pdbg("Chip size %u kB is bigger than supported "
974 975 976 977
			 "size %u kB of chipset/board/programmer "
			 "for %s interface, "
			 "probe/read/erase/write may fail. ", size / 1024,
			 max_rom_decode.spi / 1024, "SPI");
978 979 980 981 982 983 984
	}
	if (!limitexceeded)
		return 0;
	/* Sometimes chip and programmer have more than one bus in common,
	 * and the limit is not exceeded on all buses. Tell the user.
	 */
	if (bitcount(buses) > limitexceeded)
985
		/* FIXME: This message is designed towards CLI users. */
986
		msg_pdbg("There is at least one common chip/programmer "
987 988
			 "interface which can support a chip of this size. "
			 "You can try --force at your own risk.\n");
989 990 991
	return 1;
}

992
int probe_flash(struct registered_programmer *pgm, int startchip, struct flashctx *flash, int force)
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
993
{
994
	const struct flashchip *chip;
995
	unsigned long base = 0;
996
	char location[64];
997 998
	uint32_t size;
	enum chipbustype buses_common;
999
	char *tmp;
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
1000

1001 1002
	for (chip = flashchips + startchip; chip && chip->name; chip++) {
		if (chip_to_probe && strcmp(chip->name, chip_to_probe) != 0)
1003
			continue;
1004
		buses_common = pgm->buses_supported & chip->bustype;
1005
		if (!buses_common)
1006
			continue;
1007 1008 1009
		msg_gdbg("Probing for %s %s, %d kB: ", chip->vendor, chip->name, chip->total_size);
		if (!chip->probe && !force) {
			msg_gdbg("failed! flashrom has no probe function for this flash chip.\n");
1010 1011
			continue;
		}
Stefan Reinauer's avatar
Stefan Reinauer committed
1012

1013
		size = chip->total_size * 1024;
1014
		check_max_decode(buses_common, size);
Stefan Reinauer's avatar
Stefan Reinauer committed
1015

1016
		/* Start filling in the dynamic data. */
1017 1018 1019 1020 1021 1022 1023
		flash->chip = calloc(1, sizeof(struct flashchip));
		if (!flash->chip) {
			msg_gerr("Out of memory!\n");
			exit(1);
		}
		memcpy(flash->chip, chip, sizeof(struct flashchip));
		flash->pgm = pgm;
1024

1025
		base = flashbase ? flashbase : (0xffffffff - size + 1);
1026
		flash->virtual_memory = (chipaddr)programmer_map_flash_region("flash chip", base, size);
1027

1028 1029 1030
		/* We handle a forced match like a real match, we just avoid probing. Note that probe_flash()
		 * is only called with force=1 after normal probing failed.
		 */
1031 1032 1033
		if (force)
			break;

1034
		if (flash->chip->probe(flash) != 1)
1035 1036
			goto notfound;

1037 1038
		/* If this is the first chip found, accept it.
		 * If this is not the first chip found, accept it only if it is
Stefan Tauner's avatar
Stefan Tauner committed
1039 1040 1041 1042
		 * a non-generic match. SFDP and CFI are generic matches.
		 * startchip==0 means this call to probe_flash() is the first
		 * one for this programmer interface and thus no other chip has
		 * been found on this interface.
1043
		 */
1044
		if (startchip == 0 && flash->chip->model_id == SFDP_DEVICE_ID) {
Stefan Tauner's avatar
Stefan Tauner committed
1045 1046 1047
			msg_cinfo("===\n"
				  "SFDP has autodetected a flash chip which is "
				  "not natively supported by flashrom yet.\n");
1048
			if (count_usable_erasers(flash) == 0)
Stefan Tauner's avatar
Stefan Tauner committed
1049 1050 1051 1052 1053 1054 1055 1056 1057 1058
				msg_cinfo("The standard operations read and "
					  "verify should work, but to support "
					  "erase, write and all other "
					  "possible features");
			else
				msg_cinfo("All standard operations (read, "
					  "verify, erase and write) should "
					  "work, but to support all possible "
					  "features");

1059 1060 1061 1062 1063
			msg_cinfo(" we need to add them manually.\n"
				  "You can help us by mailing us the output of the following command to "
				  "flashrom@flashrom.org:\n"
				  "'flashrom -VV [plus the -p/--programmer parameter]'\n"
				  "Thanks for your help!\n"
Stefan Tauner's avatar
Stefan Tauner committed
1064 1065 1066
				  "===\n");
		}

1067 1068
		/* First flash chip detected on this bus. */
		if (startchip == 0)
1069
			break;
1070 1071 1072 1073
		/* Not the first flash chip detected on this bus, but not a generic match either. */
		if ((flash->chip->model_id != GENERIC_DEVICE_ID) && (flash->chip->model_id != SFDP_DEVICE_ID))
			break;
		/* Not the first flash chip detected on this bus, and it's just a generic match. Ignore it. */
1074
notfound:
1075 1076 1077 1078
		programmer_unmap_flash_region((void *)flash->virtual_memory, size);
		flash->virtual_memory = (chipaddr)NULL;
		free(flash->chip);
		flash->chip = NULL;
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
1079
	}
Uwe Hermann's avatar
Uwe Hermann committed
1080

1081
	if (!flash->chip)
1082
		return -1;
1083

1084 1085
#if CONFIG_INTERNAL == 1
	if (programmer_table[programmer].map_flash_region == physmap)
1086
		snprintf(location, sizeof(location), "at physical address 0x%lx", base);
1087 1088
	else
#endif
1089 1090
		snprintf(location, sizeof(location), "on %s", programmer_table[programmer].name);

1091 1092 1093
	tmp = flashbuses_to_text(flash->chip->bustype);
	msg_cinfo("%s %s flash chip \"%s\" (%d kB, %s) %s.\n", force ? "Assuming" : "Found",
		  flash->chip->vendor, flash->chip->name, flash->chip->total_size, tmp, location);
1094
	free(tmp);
1095

1096 1097 1098 1099
	/* Flash registers will not be mapped if the chip was forced. Lock info
	 * may be stored in registers, so avoid lock info printing.
	 */
	if (!force)
1100 1101
		if (flash->chip->printlock)
			flash->chip->printlock(flash);
1102

1103
	/* Return position of matching chip. */
1104
	return chip - flashchips;
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
1105 1106
}

1107 1108
int read_buf_from_file(unsigned char *buf, unsigned long size,
		       const char *filename)
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123
{
	unsigned long numbytes;
	FILE *image;
	struct stat image_stat;

	if ((image = fopen(filename, "rb")) == NULL) {
		perror(filename);
		return 1;
	}
	if (fstat(fileno(image), &image_stat) != 0) {
		perror(filename);
		fclose(image);
		return 1;
	}
	if (image_stat.st_size != size) {
Stefan Tauner's avatar
Stefan Tauner committed
1124 1125
		msg_gerr("Error: Image size (%jd B) doesn't match the flash chip's size (%ld B)!\n",
			 (intmax_t)image_stat.st_size, size);
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141
		fclose(image);
		return 1;
	}
	numbytes = fread(buf, 1, size, image);
	if (fclose(image)) {
		perror(filename);
		return 1;
	}
	if (numbytes != size) {
		msg_gerr("Error: Failed to read complete file. Got %ld bytes, "
			 "wanted %ld!\n", numbytes, size);
		return 1;
	}
	return 0;
}

1142 1143
int write_buf_to_file(unsigned char *buf, unsigned long size,
		      const char *filename)
1144 1145 1146
{
	unsigned long numbytes;
	FILE *image;
1147 1148

	if (!filename) {
1149
		msg_gerr("No filename specified.\n");
1150 1151
		return 1;
	}
1152
	if ((image = fopen(filename, "wb")) == NULL) {
1153
		perror(filename);
1154
		return 1;
1155
	}
1156 1157 1158

	numbytes = fwrite(buf, 1, size, image);
	fclose(image);
1159 1160 1161
	if (numbytes != size) {
		msg_gerr("File %s could not be written completely.\n",
			 filename);
1162
		return 1;
1163
	}
1164 1165 1166
	return 0;
}

1167
int read_flash_to_file(struct flashctx *flash, const char *filename)
1168
{
1169
	unsigned long size = flash->chip->total_size * 1024;
1170 1171 1172 1173 1174 1175 1176 1177 1178
	unsigned char *buf = calloc(size, sizeof(char));
	int ret = 0;

	msg_cinfo("Reading flash... ");
	if (!buf) {
		msg_gerr("Memory allocation failed!\n");
		msg_cinfo("FAILED.\n");
		return 1;
	}
1179
	if (!flash->chip->read) {
1180 1181 1182 1183
		msg_cerr("No read function available for this flash chip.\n");
		ret = 1;
		goto out_free;
	}
1184
	if (flash->chip->read(flash, buf, 0, size)) {
1185 1186 1187 1188 1189
		msg_cerr("Read operation failed!\n");
		ret = 1;
		goto out_free;
	}

Stefan Tauner's avatar
Stefan Tauner committed
1190
	ret = write_buf_to_file(buf, size, filename);
1191 1192 1193 1194 1195 1196
out_free:
	free(buf);
	msg_cinfo("%s.\n", ret ? "FAILED" : "done");
	return ret;
}

1197 1198
/* This function shares a lot of its structure with erase_and_write_flash() and
 * walk_eraseregions().
1199 1200
 * Even if an error is found, the function will keep going and check the rest.
 */
1201
static int selfcheck_eraseblocks(const struct flashchip *chip)
1202
{
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1203 1204
	int i, j, k;
	int ret = 0;
1205 1206 1207

	for (k = 0; k < NUM_ERASEFUNCTIONS; k++) {
		unsigned int done = 0;
1208
		struct block_eraser eraser = chip->block_erasers[k];
1209 1210 1211 1212 1213 1214 1215 1216

		for (i = 0; i < NUM_ERASEREGIONS; i++) {
			/* Blocks with zero size are bugs in flashchips.c. */
			if (eraser.eraseblocks[i].count &&
			    !eraser.eraseblocks[i].size) {
				msg_gerr("ERROR: Flash chip %s erase function "
					"%i region %i has size 0. Please report"
					" a bug at flashrom@flashrom.org\n",
1217
					chip->name, k, i);
1218
				ret = 1;
1219 1220 1221 1222 1223 1224 1225
			}
			/* Blocks with zero count are bugs in flashchips.c. */
			if (!eraser.eraseblocks[i].count &&
			    eraser.eraseblocks[i].size) {
				msg_gerr("ERROR: Flash chip %s erase function "
					"%i region %i has count 0. Please report"
					" a bug at flashrom@flashrom.org\n",
1226
					chip->name, k, i);
1227
				ret = 1;
1228 1229 1230 1231
			}
			done += eraser.eraseblocks[i].count *
				eraser.eraseblocks[i].size;
		}
1232 1233
		/* Empty eraseblock definition with erase function.  */
		if (!done && eraser.block_erase)
1234
			msg_gspew("Strange: Empty eraseblock definition with "
1235
				  "non-empty erase function. Not an error.\n");
1236 1237
		if (!done)
			continue;
1238
		if (done != chip->total_size * 1024) {
1239 1240 1241
			msg_gerr("ERROR: Flash chip %s erase function %i "
				"region walking resulted in 0x%06x bytes total,"
				" expected 0x%06x bytes. Please report a bug at"
1242 1243
				" flashrom@flashrom.org\n", chip->name, k,
				done, chip->total_size * 1024);
1244
			ret = 1;
1245
		}
1246 1247 1248 1249 1250 1251
		if (!eraser.block_erase)
			continue;
		/* Check if there are identical erase functions for different
		 * layouts. That would imply "magic" erase functions. The
		 * easiest way to check this is with function pointers.
		 */
1252
		for (j = k + 1; j < NUM_ERASEFUNCTIONS; j++) {
1253
			if (eraser.block_erase ==
1254
			    chip->block_erasers[j].block_erase) {
1255 1256 1257
				msg_gerr("ERROR: Flash chip %s erase function "
					"%i and %i are identical. Please report"
					" a bug at flashrom@flashrom.org\n",
1258
					chip->name, k, j);
1259 1260
				ret = 1;
			}
1261
		}
1262
	}
1263
	return ret;
1264 1265
}

1266
static int erase_and_write_block_helper(struct flashctx *flash,
1267
					unsigned int start, unsigned int len,
1268
					uint8_t *curcontents,
1269
					uint8_t *newcontents,
1270
					int (*erasefn) (struct flashctx *flash,
1271 1272 1273
							unsigned int addr,
							unsigned int len))
{
1274 1275
	unsigned int starthere = 0, lenhere = 0;
	int ret = 0, skip = 1, writecount = 0;
1276 1277
	enum write_granularity gran = write_gran_256bytes; /* FIXME */

1278
	/* curcontents and newcontents are opaque to walk_eraseregions, and
1279 1280
	 * need to be adjusted here to keep the impression of proper abstraction
	 */
1281
	curcontents += start;
1282 1283 1284
	newcontents += start;
	msg_cdbg(":");
	/* FIXME: Assume 256 byte granularity for now to play it safe. */
1285
	if (need_erase(curcontents, newcontents, len, gran)) {
1286 1287 1288 1289
		msg_cdbg("E");
		ret = erasefn(flash, start, len);
		if (ret)
			return ret;
1290 1291 1292 1293
		if (check_erased_range(flash, start, len)) {
			msg_cerr("ERASE FAILED!\n");
			return -1;
		}
1294 1295
		/* Erase was successful. Adjust curcontents. */
		memset(curcontents, 0xff, len);
1296 1297
		skip = 0;
	}
1298 1299 1300 1301
	/* get_next_write() sets starthere to a new value after the call. */
	while ((lenhere = get_next_write(curcontents + starthere,
					 newcontents + starthere,
					 len - starthere, &starthere, gran))) {
1302 1303 1304
		if (!writecount++)
			msg_cdbg("W");
		/* Needs the partial write function signature. */
1305
		ret = flash->chip->write(flash, newcontents + starthere,
1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
				   start + starthere, lenhere);
		if (ret)
			return ret;
		starthere += lenhere;
		skip = 0;
	}
	if (skip)
		msg_cdbg("S");
	return ret;
}

1317 1318
static int walk_eraseregions(struct flashctx *flash, int erasefunction,
			     int (*do_something) (struct flashctx *flash,
1319
						  unsigned int addr,
1320 1321 1322 1323
						  unsigned int len,
						  uint8_t *param1,
						  uint8_t *param2,
						  int (*erasefn) (
1324
							struct flashctx *flash,
1325 1326 1327
							unsigned int addr,
							unsigned int len)),
			     void *param1, void *param2)
1328 1329
{
	int i, j;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1330 1331
	unsigned int start = 0;
	unsigned int len;
1332
	struct block_eraser eraser = flash->chip->block_erasers[erasefunction];
1333

1334 1335 1336 1337 1338 1339
	for (i = 0; i < NUM_ERASEREGIONS; i++) {
		/* count==0 for all automatically initialized array
		 * members so the loop below won't be executed for them.
		 */
		len = eraser.eraseblocks[i].size;
		for (j = 0; j < eraser.eraseblocks[i].count; j++) {
1340 1341 1342 1343
			/* Print this for every block except the first one. */
			if (i || j)
				msg_cdbg(", ");
			msg_cdbg("0x%06x-0x%06x", start,
1344
				     start + len - 1);
1345 1346
			if (do_something(flash, start, len, param1, param2,
					 eraser.block_erase)) {
1347
				return 1;
1348
			}
1349 1350 1351
			start += len;
		}
	}
1352
	msg_cdbg("\n");
1353 1354 1355
	return 0;
}

1356
static int check_block_eraser(const struct flashctx *flash, int k, int log)
1357
{
1358
	struct block_eraser eraser = flash->chip->block_erasers[k];
1359 1360 1361 1362 1363 1364 1365 1366 1367

	if (!eraser.block_erase && !eraser.eraseblocks[0].count) {
		if (log)
			msg_cdbg("not defined. ");
		return 1;
	}
	if (!eraser.block_erase && eraser.eraseblocks[0].count) {
		if (log)
			msg_cdbg("eraseblock layout is known, but matching "
Stefan Tauner's avatar
Stefan Tauner committed
1368
				 "block erase function is not implemented. ");
1369 1370 1371 1372 1373
		return 1;
	}
	if (eraser.block_erase && !eraser.eraseblocks[0].count) {
		if (log)
			msg_cdbg("block erase function found, but "
Stefan Tauner's avatar
Stefan Tauner committed
1374
				 "eraseblock layout is not defined. ");
1375 1376
		return 1;
	}
1377
	// TODO: Once erase functions are annotated with allowed buses, check that as well.
1378 1379 1380
	return 0;
}

1381
int erase_and_write_flash(struct flashctx *flash, uint8_t *oldcontents,
1382
			  uint8_t *newcontents)
1383
{
1384
	int k, ret = 1;
1385
	uint8_t *curcontents;
1386
	unsigned long size = flash->chip->total_size * 1024;
1387
	unsigned int usable_erasefunctions = count_usable_erasers(flash);
1388 1389

	msg_cinfo("Erasing and writing flash chip... ");
1390 1391 1392 1393 1394
	curcontents = malloc(size);
	if (!curcontents) {
		msg_gerr("Out of memory!\n");
		exit(1);
	}
1395 1396
	/* Copy oldcontents to curcontents to avoid clobbering oldcontents. */
	memcpy(curcontents, oldcontents, size);
1397 1398

	for (k = 0; k < NUM_ERASEFUNCTIONS; k++) {
1399 1400
		if (k != 0)
			msg_cdbg("Looking for another erase function.\n");
1401 1402 1403 1404
		if (!usable_erasefunctions) {
			msg_cdbg("No usable erase functions left.\n");
			break;
		}
1405 1406
		msg_cdbg("Trying erase function %i... ", k);
		if (check_block_eraser(flash, k, 1))
1407
			continue;
1408
		usable_erasefunctions--;
1409 1410
		ret = walk_eraseregions(flash, k, &erase_and_write_block_helper,
					curcontents, newcontents);
1411 1412 1413
		/* If everything is OK, don't try another erase function. */
		if (!ret)
			break;
1414
		/* Write/erase failed, so try to find out what the current chip
1415 1416
		 * contents are. If no usable erase functions remain, we can
		 * skip this: the next iteration will break immediately anyway.
1417
		 */
1418 1419
		if (!usable_erasefunctions)
			continue;
1420 1421 1422 1423
		/* Reading the whole chip may take a while, inform the user even
		 * in non-verbose mode.
		 */
		msg_cinfo("Reading current flash chip contents... ");
1424
		if (flash->chip->read(flash, curcontents, 0, size)) {
1425
			/* Now we are truly screwed. Read failed as well. */
1426
			msg_cerr("Can't read anymore! Aborting.\n");
1427 1428 1429 1430 1431
			/* We have no idea about the flash chip contents, so
			 * retrying with another erase function is pointless.
			 */
			break;
		}
1432
		msg_cinfo("done. ");
1433
	}
1434 1435
	/* Free the scratchpad. */
	free(curcontents);
1436

1437
	if (ret) {
1438
		msg_cerr("FAILED!\n");
1439
	} else {
1440
		msg_cinfo("Erase/write done.\n");
1441 1442
	}
	return ret;
1443 1444
}

1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457
void nonfatal_help_message(void)
{
	msg_gerr("Writing to the flash chip apparently didn't do anything.\n"
		"This means we have to add special support for your board, "
		  "programmer or flash chip.\n"
		"Please report this on IRC at irc.freenode.net (channel "
		  "#flashrom) or\n"
		"mail flashrom@flashrom.org!\n"
		"-------------------------------------------------------------"
		  "------------------\n"
		"You may now reboot or simply leave the machine running.\n");
}

1458
void emergency_help_message(void)
1459
{
1460
	msg_gerr("Your flash chip is in an unknown state.\n"
1461
		"Get help on IRC at chat.freenode.net (channel #flashrom) or\n"
1462 1463
		"mail flashrom@flashrom.org with the subject \"FAILED: <your board name>\"!\n"
		"-------------------------------------------------------------------------------\n"
1464 1465 1466
		"DO NOT REBOOT OR POWEROFF!\n");
}

1467
/* The way to go if you want a delimited list of programmers */
1468
void list_programmers(const char *delim)
1469 1470 1471
{
	enum programmer p;
	for (p = 0; p < PROGRAMMER_INVALID; p++) {
1472
		msg_ginfo("%s", programmer_table[p].name);
1473
		if (p < PROGRAMMER_INVALID - 1)
1474
			msg_ginfo("%s", delim);
1475
	}
1476
	msg_ginfo("\n");	
1477 1478
}

1479 1480 1481
void list_programmers_linebreak(int startcol, int cols, int paren)
{
	const char *pname;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1482 1483
	int pnamelen;
	int remaining = 0, firstline = 1;
1484
	enum programmer p;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1485
	int i;
1486 1487 1488 1489 1490 1491 1492 1493

	for (p = 0; p < PROGRAMMER_INVALID; p++) {
		pname = programmer_table[p].name;
		pnamelen = strlen(pname);
		if (remaining - pnamelen - 2 < 0) {
			if (firstline)
				firstline = 0;
			else
1494
				msg_ginfo("\n");
1495
			for (i = 0; i < startcol; i++)
1496
				msg_ginfo(" ");
1497 1498
			remaining = cols - startcol;
		} else {
1499
			msg_ginfo(" ");
1500 1501 1502
			remaining--;
		}
		if (paren && (p == 0)) {
1503
			msg_ginfo("(");
1504 1505
			remaining--;
		}
1506
		msg_ginfo("%s", pname);
1507 1508
		remaining -= pnamelen;
		if (p < PROGRAMMER_INVALID - 1) {
1509
			msg_ginfo(",");
1510 1511 1512
			remaining--;
		} else {
			if (paren)
1513
				msg_ginfo(")");
1514 1515 1516 1517
		}
	}
}

1518 1519
void print_sysinfo(void)
{
1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545
#ifdef _WIN32
	SYSTEM_INFO si;
	OSVERSIONINFOEX osvi;

	memset(&si, 0, sizeof(SYSTEM_INFO));
	memset(&osvi, 0, sizeof(OSVERSIONINFOEX));
	msg_ginfo(" on Windows");
	/* Tell Windows which version of the structure we want. */
	osvi.dwOSVersionInfoSize = sizeof(OSVERSIONINFOEX);
	if (GetVersionEx((OSVERSIONINFO*) &osvi))
		msg_ginfo(" %lu.%lu", osvi.dwMajorVersion, osvi.dwMinorVersion);
	else
		msg_ginfo(" unknown version");
	GetSystemInfo(&si);
	switch (si.wProcessorArchitecture) {
	case PROCESSOR_ARCHITECTURE_AMD64:
		msg_ginfo(" (x86_64)");
		break;
	case PROCESSOR_ARCHITECTURE_INTEL:
		msg_ginfo(" (x86)");
		break;
	default:
		msg_ginfo(" (unknown arch)");
		break;
	}
#elif HAVE_UTSNAME == 1
1546 1547
	struct utsname osinfo;

1548
	uname(&osinfo);
1549 1550 1551 1552 1553
	msg_ginfo(" on %s %s (%s)", osinfo.sysname, osinfo.release,
		  osinfo.machine);
#else
	msg_ginfo(" on unknown machine");
#endif
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1554 1555 1556 1557 1558
}

void print_buildinfo(void)
{
	msg_gdbg("flashrom was built with");
1559 1560
#if NEED_PCI == 1
#ifdef PCILIB_VERSION
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1561
	msg_gdbg(" libpci %s,", PCILIB_VERSION);
1562
#else
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1563
	msg_gdbg(" unknown PCI library,");
1564 1565 1566
#endif
#endif
#ifdef __clang__
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1567
	msg_gdbg(" LLVM Clang");
1568
#ifdef __clang_version__
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1569
	msg_gdbg(" %s,", __clang_version__);
1570
#else
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1571
	msg_gdbg(" unknown version (before r102686),");
1572
#endif
1573
#elif defined(__GNUC__)
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1574
	msg_gdbg(" GCC");
1575
#ifdef __VERSION__
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1576
	msg_gdbg(" %s,", __VERSION__);
1577
#else
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1578
	msg_gdbg(" unknown version,");
1579
#endif
1580
#else
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1581
	msg_gdbg(" unknown compiler,");
1582
#endif
1583
#if defined (__FLASHROM_LITTLE_ENDIAN__)
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1584
	msg_gdbg(" little endian");
1585
#elif defined (__FLASHROM_BIG_ENDIAN__)
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1586
	msg_gdbg(" big endian");
1587 1588
#else
#error Endianness could not be determined
1589
#endif
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1590
	msg_gdbg("\n");
1591 1592
}

1593 1594
void print_version(void)
{
1595
	msg_ginfo("flashrom v%s", flashrom_version);
1596
	print_sysinfo();
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1597
	msg_ginfo("\n");
1598 1599
}

1600 1601 1602
void print_banner(void)
{
	msg_ginfo("flashrom is free software, get the source code at "
1603
		  "http://www.flashrom.org\n");
1604 1605 1606
	msg_ginfo("\n");
}

1607 1608
int selfcheck(void)
{
1609
	const struct flashchip *chip;
1610 1611
	int i;
	int ret = 0;
1612 1613 1614 1615

	/* Safety check. Instead of aborting after the first error, check
	 * if more errors exist.
	 */
1616
	if (ARRAY_SIZE(programmer_table) - 1 != PROGRAMMER_INVALID) {
1617
		msg_gerr("Programmer table miscompilation!\n");
1618
		ret = 1;
1619
	}
1620 1621 1622 1623 1624 1625 1626 1627 1628
	for (i = 0; i < PROGRAMMER_INVALID; i++) {
		const struct programmer_entry p = programmer_table[i];
		if (p.name == NULL) {
			msg_gerr("All programmers need a valid name, but the one with index %d does not!\n", i);
			ret = 1;
			/* This might hide other problems with this programmer, but allows for better error
			 * messages below without jumping through hoops. */
			continue;
		}
1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645
		switch (p.type) {
		case USB:
		case PCI:
		case OTHER:
			if (p.devs.note == NULL) {
				if (strcmp("internal", p.name) == 0)
					break; /* This one has its device list stored separately. */
				msg_gerr("Programmer %s has neither a device list nor a textual description!\n",
					 p.name);
				ret = 1;
			}
			break;
		default:
			msg_gerr("Programmer %s does not have a valid type set!\n", p.name);
			ret = 1;
			break;
		}
1646 1647 1648 1649 1650 1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662
		if (p.init == NULL) {
			msg_gerr("Programmer %s does not have a valid init function!\n", p.name);
			ret = 1;
		}
		if (p.delay == NULL) {
			msg_gerr("Programmer %s does not have a valid delay function!\n", p.name);
			ret = 1;
		}
		if (p.map_flash_region == NULL) {
			msg_gerr("Programmer %s does not have a valid map_flash_region function!\n", p.name);
			ret = 1;
		}
		if (p.unmap_flash_region == NULL) {
			msg_gerr("Programmer %s does not have a valid unmap_flash_region function!\n", p.name);
			ret = 1;
		}
	}
1663
	/* It would be favorable if we could also check for correct termination
1664
	 * of the following arrays, but we don't know their sizes in here...
1665 1666 1667 1668 1669 1670 1671
	 * For 'flashchips' we check the first element to be non-null. In the
	 * other cases there exist use cases where the first element can be
	 * null. */
	if (flashchips == NULL || flashchips[0].vendor == NULL) {
		msg_gerr("Flashchips table miscompilation!\n");
		ret = 1;
	}
1672 1673
	for (chip = flashchips; chip && chip->name; chip++)
		if (selfcheck_eraseblocks(chip))
1674
			ret = 1;
1675 1676 1677 1678 1679 1680

#if CONFIG_INTERNAL == 1
	if (chipset_enables == NULL) {
		msg_gerr("Chipset enables table does not exist!\n");
		ret = 1;
	}
1681
	if (board_matches == NULL) {
1682 1683 1684 1685 1686 1687 1688 1689 1690 1691 1692
		msg_gerr("Board enables table does not exist!\n");
		ret = 1;
	}
	if (boards_known == NULL) {
		msg_gerr("Known boards table does not exist!\n");
		ret = 1;
	}
	if (laptops_known == NULL) {
		msg_gerr("Known laptops table does not exist!\n");
		ret = 1;
	}
1693
#endif
1694
	return ret;
1695 1696
}

1697
void check_chip_supported(const struct flashchip *chip)
1698
{
1699
	if (chip->feature_bits & FEATURE_OTP) {
1700 1701 1702 1703 1704 1705
		msg_cdbg("This chip may contain one-time programmable memory. "
			 "flashrom cannot read\nand may never be able to write "
			 "it, hence it may not be able to completely\n"
			 "clone the contents of this chip (see man page for "
			 "details).\n");
	}
1706
	if (TEST_OK_MASK != (chip->tested & TEST_OK_MASK)) {
1707
		msg_cinfo("===\n");
1708
		if (chip->tested & TEST_BAD_MASK) {
1709
			msg_cinfo("This flash part has status NOT WORKING for operations:");
1710
			if (chip->tested & TEST_BAD_PROBE)
1711
				msg_cinfo(" PROBE");
1712
			if (chip->tested & TEST_BAD_READ)
1713
				msg_cinfo(" READ");
1714
			if (chip->tested & TEST_BAD_ERASE)
1715
				msg_cinfo(" ERASE");
1716
			if (chip->tested & TEST_BAD_WRITE)
1717 1718
				msg_cinfo(" WRITE");
			msg_cinfo("\n");
1719
		}
1720 1721 1722 1723
		if ((!(chip->tested & TEST_BAD_PROBE) && !(chip->tested & TEST_OK_PROBE)) ||
		    (!(chip->tested & TEST_BAD_READ) && !(chip->tested & TEST_OK_READ)) ||
		    (!(chip->tested & TEST_BAD_ERASE) && !(chip->tested & TEST_OK_ERASE)) ||
		    (!(chip->tested & TEST_BAD_WRITE) && !(chip->tested & TEST_OK_WRITE))) {
1724
			msg_cinfo("This flash part has status UNTESTED for operations:");
1725
			if (!(chip->tested & TEST_BAD_PROBE) && !(chip->tested & TEST_OK_PROBE))
1726
				msg_cinfo(" PROBE");
1727
			if (!(chip->tested & TEST_BAD_READ) && !(chip->tested & TEST_OK_READ))
1728
				msg_cinfo(" READ");
1729
			if (!(chip->tested & TEST_BAD_ERASE) && !(chip->tested & TEST_OK_ERASE))
1730
				msg_cinfo(" ERASE");
1731
			if (!(chip->tested & TEST_BAD_WRITE) && !(chip->tested & TEST_OK_WRITE))
1732 1733
				msg_cinfo(" WRITE");
			msg_cinfo("\n");
1734
		}
1735
		/* FIXME: This message is designed towards CLI users. */
1736 1737 1738 1739 1740 1741 1742 1743 1744 1745
		msg_cinfo("The test status of this chip may have been updated "
			    "in the latest development\n"
			  "version of flashrom. If you are running the latest "
			    "development version,\n"
			  "please email a report to flashrom@flashrom.org if "
			    "any of the above operations\n"
			  "work correctly for you with this flash part. Please "
			    "include the flashrom\n"
			  "output with the additional -V option for all "
			    "operations you tested (-V, -Vr,\n"
Paul Menzel's avatar
Paul Menzel committed
1746
			  "-VE, -Vw), and mention which mainboard or "
1747
			    "programmer you tested.\n"
1748 1749
			  "Please mention your board in the subject line. "
			    "Thanks for your help!\n");
1750 1751 1752
	}
}

Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1753 1754
/* FIXME: This function signature needs to be improved once doit() has a better
 * function signature.
1755
 */
1756 1757
int chip_safety_check(const struct flashctx *flash, int force, int read_it, int write_it, int erase_it,
		      int verify_it)
1758
{
1759 1760
	const struct flashchip *chip = flash->chip;

1761 1762 1763 1764 1765 1766
	if (!programmer_may_write && (write_it || erase_it)) {
		msg_perr("Write/erase is not working yet on your programmer in "
			 "its current configuration.\n");
		/* --force is the wrong approach, but it's the best we can do
		 * until the generic programmer parameter parser is merged.
		 */
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1767
		if (!force)
1768
			return 1;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1769
		msg_cerr("Continuing anyway.\n");
1770 1771
	}

Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1772 1773
	if (read_it || erase_it || write_it || verify_it) {
		/* Everything needs read. */
1774
		if (chip->tested & TEST_BAD_READ) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1775 1776
			msg_cerr("Read is not working on this chip. ");
			if (!force)
1777
				return 1;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1778
			msg_cerr("Continuing anyway.\n");
1779
		}
1780
		if (!chip->read) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1781 1782
			msg_cerr("flashrom has no read function for this "
				 "flash chip.\n");
1783
			return 1;
1784
		}
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1785 1786 1787
	}
	if (erase_it || write_it) {
		/* Write needs erase. */
1788
		if (chip->tested & TEST_BAD_ERASE) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1789 1790
			msg_cerr("Erase is not working on this chip. ");
			if (!force)
1791
				return 1;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1792
			msg_cerr("Continuing anyway.\n");
1793
		}
1794
		if(count_usable_erasers(flash) == 0) {
1795 1796 1797 1798
			msg_cerr("flashrom has no erase function for this "
				 "flash chip.\n");
			return 1;
		}
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1799 1800
	}
	if (write_it) {
1801
		if (chip->tested & TEST_BAD_WRITE) {
1802
			msg_cerr("Write is not working on this chip. ");
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1803
			if (!force)
1804
				return 1;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1805
			msg_cerr("Continuing anyway.\n");
1806
		}
1807
		if (!chip->write) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1808 1809
			msg_cerr("flashrom has no write function for this "
				 "flash chip.\n");
1810 1811
			return 1;
		}
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1812 1813 1814 1815 1816 1817 1818 1819
	}
	return 0;
}

/* This function signature is horrible. We need to design a better interface,
 * but right now it allows us to split off the CLI code.
 * Besides that, the function itself is a textbook example of abysmal code flow.
 */
1820 1821
int doit(struct flashctx *flash, int force, const char *filename, int read_it,
	 int write_it, int erase_it, int verify_it)
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1822
{
1823 1824
	uint8_t *oldcontents;
	uint8_t *newcontents;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1825
	int ret = 0;
1826
	unsigned long size = flash->chip->total_size * 1024;
1827

1828
	if (chip_safety_check(flash, force, read_it, write_it, erase_it, verify_it)) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1829
		msg_cerr("Aborting.\n");
1830 1831
		ret = 1;
		goto out_nofree;
1832 1833
	}

Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1834 1835 1836
	/* Given the existence of read locks, we want to unlock for read,
	 * erase and write.
	 */
1837 1838
	if (flash->chip->unlock)
		flash->chip->unlock(flash);
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1839 1840 1841

	if (read_it) {
		ret = read_flash_to_file(flash, filename);
1842
		goto out_nofree;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1843
	}
1844

1845 1846 1847 1848 1849
	oldcontents = malloc(size);
	if (!oldcontents) {
		msg_gerr("Out of memory!\n");
		exit(1);
	}
1850 1851
	/* Assume worst case: All bits are 0. */
	memset(oldcontents, 0x00, size);
1852 1853 1854 1855 1856
	newcontents = malloc(size);
	if (!newcontents) {
		msg_gerr("Out of memory!\n");
		exit(1);
	}
1857 1858 1859 1860 1861 1862 1863 1864
	/* Assume best case: All bits should be 1. */
	memset(newcontents, 0xff, size);
	/* Side effect of the assumptions above: Default write action is erase
	 * because newcontents looks like a completely erased chip, and
	 * oldcontents being completely 0x00 means we have to erase everything
	 * before we can write.
	 */

Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1865
	if (erase_it) {
1866 1867 1868 1869 1870 1871
		/* FIXME: Do we really want the scary warning if erase failed?
		 * After all, after erase the chip is either blank or partially
		 * blank or it has the old contents. A blank chip won't boot,
		 * so if the user wanted erase and reboots afterwards, the user
		 * knows very well that booting won't work.
		 */
1872
		if (erase_and_write_flash(flash, oldcontents, newcontents)) {
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1873
			emergency_help_message();
1874
			ret = 1;
1875
		}
1876
		goto out;
Carl-Daniel Hailfinger's avatar
Carl-Daniel Hailfinger committed
1877 1878 1879
	}

	if (write_it || verify_it) {
1880
		if (read_buf_from_file(newcontents, size, filename)) {
1881 1882
			ret = 1;
			goto out;
1883 1884
		}

1885
#if CONFIG_INTERNAL == 1
1886 1887 1888 1889 1890 1891
		if (programmer == PROGRAMMER_INTERNAL && cb_check_image(newcontents, size) < 0) {
			if (force_boardmismatch) {
				msg_pinfo("Proceeding anyway because user forced us to.\n");
			} else {
				msg_perr("Aborting. You can override this with "
					 "-p internal:boardmismatch=force.\n");
1892 1893 1894
				ret = 1;
				goto out;
			}
1895
		}
1896
#endif
1897
	}
Ronald G. Minnich's avatar
Ronald G. Minnich committed
1898

1899 1900 1901 1902 1903 1904
	/* Read the whole chip to be able to check whether regions need to be
	 * erased and to give better diagnostics in case write fails.
	 * The alternative would be to read only the regions which are to be
	 * preserved, but in that case we might perform unneeded erase which
	 * takes time as well.
	 */
1905
	msg_cinfo("Reading old flash chip contents... ");
1906
	if (flash->chip->read(flash, oldcontents, 0, size)) {
1907
		ret = 1;
1908
		msg_cinfo("FAILED.\n");
1909
		goto out;
1910
	}
1911
	msg_cinfo("done.\n");
1912

1913 1914
	// This should be moved into each flash part's code to do it 
	// cleanly. This does the job.
1915
	handle_romentries(flash, oldcontents, newcontents);
1916

1917
	// ////////////////////////////////////////////////////////////
1918

1919
	if (write_it) {
1920 1921 1922
		if (erase_and_write_flash(flash, oldcontents, newcontents)) {
			msg_cerr("Uh oh. Erase/write failed. Checking if "
				 "anything changed.\n");
1923
			if (!flash->chip->read(flash, newcontents, 0, size)) {
1924 1925 1926 1927
				if (!memcmp(oldcontents, newcontents, size)) {
					msg_cinfo("Good. It seems nothing was "
						  "changed.\n");
					nonfatal_help_message();
1928 1929
					ret = 1;
					goto out;
1930 1931
				}
			}
1932
			emergency_help_message();
1933 1934
			ret = 1;
			goto out;
1935 1936
		}
	}
1937

1938
	if (verify_it) {
1939 1940 1941 1942
		msg_cinfo("Verifying flash... ");

		if (write_it) {
			/* Work around chips which need some time to calm down. */
1943
			programmer_delay(1000*1000);
1944 1945 1946 1947 1948 1949 1950 1951 1952 1953 1954
			ret = verify_range(flash, newcontents, 0, size);
			/* If we tried to write, and verification now fails, we
			 * might have an emergency situation.
			 */
			if (ret)
				emergency_help_message();
		} else {
			ret = compare_range(newcontents, oldcontents, 0, size);
		}
		if (!ret)
			msg_cinfo("VERIFIED.\n");
1955
	}
1956

1957 1958 1959 1960
out:
	free(oldcontents);
	free(newcontents);
out_nofree:
1961
	programmer_shutdown();
Stefan Reinauer's avatar
Stefan Reinauer committed
1962
	return ret;
Ronald G. Minnich's avatar
Dammit  
Ronald G. Minnich committed
1963
}