123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316 |
- /*
- * This file is part of the flashrom project.
- *
- * Copyright (C) 2005-2008 coresystems GmbH
- * (Written by Stefan Reinauer <stepan@coresystems.de> for coresystems GmbH)
- * Copyright (C) 2011-2013 Stefan Tauner
- *
- * 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; version 2 of the License.
- *
- * 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.
- *
- * 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
- */
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <limits.h>
- #include "flash.h"
- #include "programmer.h"
- #define MAX_ROMLAYOUT 32
- typedef struct {
- chipoff_t start;
- chipoff_t end;
- unsigned int included;
- char name[256];
- } romentry_t;
- /* rom_entries store the entries specified in a layout file and associated run-time data */
- static romentry_t rom_entries[MAX_ROMLAYOUT];
- static int num_rom_entries = 0; /* the number of successfully parsed rom_entries */
- /* include_args holds the arguments specified at the command line with -i. They must be processed at some point
- * so that desired regions are marked as "included" in the rom_entries list. */
- static char *include_args[MAX_ROMLAYOUT];
- static int num_include_args = 0; /* the number of valid include_args. */
- #ifndef __LIBPAYLOAD__
- int read_romlayout(const char *name)
- {
- FILE *romlayout;
- char tempstr[256];
- int i;
- romlayout = fopen(name, "r");
- if (!romlayout) {
- msg_gerr("ERROR: Could not open ROM layout (%s).\n",
- name);
- return -1;
- }
- while (!feof(romlayout)) {
- char *tstr1, *tstr2;
- if (num_rom_entries >= MAX_ROMLAYOUT) {
- msg_gerr("Maximum number of ROM images (%i) in layout "
- "file reached.\n", MAX_ROMLAYOUT);
- (void)fclose(romlayout);
- return 1;
- }
- if (2 != fscanf(romlayout, "%255s %255s\n", tempstr, rom_entries[num_rom_entries].name))
- continue;
- #if 0
- // fscanf does not like arbitrary comments like that :( later
- if (tempstr[0] == '#') {
- continue;
- }
- #endif
- tstr1 = strtok(tempstr, ":");
- tstr2 = strtok(NULL, ":");
- if (!tstr1 || !tstr2) {
- msg_gerr("Error parsing layout file. Offending string: \"%s\"\n", tempstr);
- (void)fclose(romlayout);
- return 1;
- }
- rom_entries[num_rom_entries].start = strtol(tstr1, (char **)NULL, 16);
- rom_entries[num_rom_entries].end = strtol(tstr2, (char **)NULL, 16);
- rom_entries[num_rom_entries].included = 0;
- num_rom_entries++;
- }
- for (i = 0; i < num_rom_entries; i++) {
- msg_gdbg("romlayout %08x - %08x named %s\n",
- rom_entries[i].start,
- rom_entries[i].end, rom_entries[i].name);
- }
- (void)fclose(romlayout);
- return 0;
- }
- #endif
- /* returns the index of the entry (or a negative value if it is not found) */
- static int find_include_arg(const char *const name)
- {
- unsigned int i;
- for (i = 0; i < num_include_args; i++) {
- if (!strcmp(include_args[i], name))
- return i;
- }
- return -1;
- }
- /* register an include argument (-i) for later processing */
- int register_include_arg(char *name)
- {
- if (num_include_args >= MAX_ROMLAYOUT) {
- msg_gerr("Too many regions included (%i).\n", num_include_args);
- return 1;
- }
- if (name == NULL) {
- msg_gerr("<NULL> is a bad region name.\n");
- return 1;
- }
- if (find_include_arg(name) != -1) {
- msg_gerr("Duplicate region name: \"%s\".\n", name);
- return 1;
- }
- include_args[num_include_args] = name;
- num_include_args++;
- return 0;
- }
- /* returns the index of the entry (or a negative value if it is not found) */
- static int find_romentry(char *name)
- {
- int i;
- if (num_rom_entries == 0)
- return -1;
- msg_gspew("Looking for region \"%s\"... ", name);
- for (i = 0; i < num_rom_entries; i++) {
- if (!strcmp(rom_entries[i].name, name)) {
- rom_entries[i].included = 1;
- msg_gspew("found.\n");
- return i;
- }
- }
- msg_gspew("not found.\n");
- return -1;
- }
- /* process -i arguments
- * returns 0 to indicate success, >0 to indicate failure
- */
- int process_include_args(void)
- {
- int i;
- unsigned int found = 0;
- if (num_include_args == 0)
- return 0;
- /* User has specified an area, but no layout file is loaded. */
- if (num_rom_entries == 0) {
- msg_gerr("Region requested (with -i \"%s\"), "
- "but no layout data is available.\n",
- include_args[0]);
- return 1;
- }
- for (i = 0; i < num_include_args; i++) {
- if (find_romentry(include_args[i]) < 0) {
- msg_gerr("Invalid region specified: \"%s\".\n",
- include_args[i]);
- return 1;
- }
- found++;
- }
- msg_ginfo("Using region%s: \"%s\"", num_include_args > 1 ? "s" : "",
- include_args[0]);
- for (i = 1; i < num_include_args; i++)
- msg_ginfo(", \"%s\"", include_args[i]);
- msg_ginfo(".\n");
- return 0;
- }
- void layout_cleanup(void)
- {
- int i;
- for (i = 0; i < num_include_args; i++) {
- free(include_args[i]);
- include_args[i] = NULL;
- }
- num_include_args = 0;
- for (i = 0; i < num_rom_entries; i++) {
- rom_entries[i].included = 0;
- }
- num_rom_entries = 0;
- }
- romentry_t *get_next_included_romentry(unsigned int start)
- {
- int i;
- unsigned int best_start = UINT_MAX;
- romentry_t *best_entry = NULL;
- romentry_t *cur;
- /* First come, first serve for overlapping regions. */
- for (i = 0; i < num_rom_entries; i++) {
- cur = &rom_entries[i];
- if (!cur->included)
- continue;
- /* Already past the current entry? */
- if (start > cur->end)
- continue;
- /* Inside the current entry? */
- if (start >= cur->start)
- return cur;
- /* Entry begins after start. */
- if (best_start > cur->start) {
- best_start = cur->start;
- best_entry = cur;
- }
- }
- return best_entry;
- }
- /* Validate and - if needed - normalize layout entries. */
- int normalize_romentries(const struct flashctx *flash)
- {
- chipsize_t total_size = flash->chip->total_size * 1024;
- int ret = 0;
- int i;
- for (i = 0; i < num_rom_entries; i++) {
- if (rom_entries[i].start >= total_size || rom_entries[i].end >= total_size) {
- msg_gwarn("Warning: Address range of region \"%s\" exceeds the current chip's "
- "address space.\n", rom_entries[i].name);
- if (rom_entries[i].included)
- ret = 1;
- }
- if (rom_entries[i].start > rom_entries[i].end) {
- msg_gerr("Error: Size of the address range of region \"%s\" is not positive.\n",
- rom_entries[i].name);
- ret = 1;
- }
- }
- return ret;
- }
- static int copy_old_content(struct flashctx *flash, int oldcontents_valid, uint8_t *oldcontents, uint8_t *newcontents, unsigned int start, unsigned int size)
- {
- if (!oldcontents_valid) {
- /* oldcontents is a zero-filled buffer. By reading the current data into oldcontents here, we
- * avoid a rewrite of identical regions even if an initial full chip read didn't happen. */
- msg_gdbg2("Read a chunk starting at 0x%06x (len=0x%06x).\n", start, size);
- int ret = flash->chip->read(flash, oldcontents + start, start, size);
- if (ret != 0) {
- msg_gerr("Failed to read chunk 0x%06x-0x%06x.\n", start, start + size - 1);
- return 1;
- }
- }
- memcpy(newcontents + start, oldcontents + start, size);
- return 0;
- }
- /**
- * Modify @newcontents so that it contains the data that should be on the chip eventually. In the case the user
- * wants to update only parts of it, copy the chunks to be preserved from @oldcontents to @newcontents. If
- * @oldcontents is not valid, we need to fetch the current data from the chip first.
- */
- int build_new_image(struct flashctx *flash, bool oldcontents_valid, uint8_t *oldcontents, uint8_t *newcontents)
- {
- unsigned int start = 0;
- romentry_t *entry;
- unsigned int size = flash->chip->total_size * 1024;
- /* If no regions were specified for inclusion, assume
- * that the user wants to write the complete new image.
- */
- if (num_include_args == 0)
- return 0;
- /* Non-included romentries are ignored.
- * The union of all included romentries is used from the new image.
- */
- while (start < size) {
- entry = get_next_included_romentry(start);
- /* No more romentries for remaining region? */
- if (!entry) {
- copy_old_content(flash, oldcontents_valid, oldcontents, newcontents, start,
- size - start);
- break;
- }
- /* For non-included region, copy from old content. */
- if (entry->start > start)
- copy_old_content(flash, oldcontents_valid, oldcontents, newcontents, start,
- entry->start - start);
- /* Skip to location after current romentry. */
- start = entry->end + 1;
- /* Catch overflow. */
- if (!start)
- break;
- }
- return 0;
- }
|