mspdebug/ui/flatfile.c

244 lines
4.9 KiB
C

/* MSPDebug - debugging tool for MSP430 MCUs
* Copyright (C) 2009-2012 Daniel Beer
* Copyright (C) 2012 Ingo van Lil
*
* 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.
*
* 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 "flatfile.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <ctype.h>
#include <unistd.h>
#include "device.h"
#include "expr.h"
#include "output_util.h"
enum operation {
LOAD,
SAVE,
VERIFY
};
static int read_flatfile(const char *path, uint8_t **buf, address_t *len)
{
FILE *in;
char *fullpath = expand_tilde(path);
size_t count;
if (!fullpath)
return -1;
in = fopen(fullpath, "rb");
free(fullpath);
if (!in) {
printc_err("%s: %s\n", path, last_error());
return -1;
}
if (fseek(in, 0, SEEK_END) < 0) {
printc_err("%s: can't seek to end: %s\n", path, last_error());
fclose(in);
return -1;
}
*len = ftell(in);
rewind(in);
*buf = malloc(*len);
if (!*buf) {
printc_err("flatfile: can't allocate memory\n");
fclose(in);
return -1;
}
count = fread(*buf, *len, 1, in);
fclose(in);
if (count != 1) {
printc_err("%s: failed to read: %s\n", path, last_error());
free(*buf);
*buf = NULL;
return -1;
}
return 0;
}
static int write_flatfile(const char *path, uint8_t *buf, address_t len)
{
FILE *out;
char *fullpath = expand_tilde(path);
const char *errmsg = NULL;
if (!fullpath)
return -1;
out = fopen(fullpath, "wb");
free(fullpath);
if (!out) {
printc_err("%s: %s\n", path, last_error());
return -1;
}
if (fwrite(buf, len, 1, out) != 1)
errmsg = last_error();
if (fclose(out) != 0 && !errmsg)
errmsg = last_error();
if (errmsg) {
printc_err("%s: failed to write: %s\n", path, errmsg);
return -1;
}
return 0;
}
static int do_flatfile(enum operation op, const char *path, address_t addr, address_t len)
{
uint8_t *in_buf = NULL;
uint8_t *out_buf = NULL;
int ret = -1;
if (op == LOAD || op == VERIFY) {
ret = read_flatfile(path, &in_buf, &len);
if (ret != 0)
goto out;
}
if (device_ctl(DEVICE_CTL_HALT) < 0)
goto out;
if (op == LOAD) {
if (device_writemem(addr, in_buf, len) != 0)
goto out;
} else {
out_buf = malloc(len);
if (!out_buf) {
printc_err("flatfile: can't allocate memory\n");
goto out;
}
if (device_readmem(addr, out_buf, len) != 0)
goto out;
}
if (device_ctl(DEVICE_CTL_RESET) < 0)
printc_err("warning: flatfile: "
"failed to reset after programming\n");
if (op == VERIFY) {
int i;
for (i = 0; i < len; i++) {
if (out_buf[i] != in_buf[i]) {
printc("\x1b[1mERROR:\x1b[0m "
"mismatch at %04x (read %02x, "
"expected %02x)\n",
addr + i,
out_buf[i], in_buf[i]);
goto out;
}
}
ret = 0;
} else if (op == SAVE) {
ret = write_flatfile(path, out_buf, len);
}
if (ret == 0)
printc("Done, %d bytes total\n", len);
out:
free(in_buf);
free(out_buf);
return ret;
}
int cmd_load_raw(char **arg)
{
const char *path, *addr_text;
address_t addr;
path = get_arg(arg);
if (!path) {
printc_err("load_raw: need file name argument\n");
return -1;
}
addr_text = get_arg(arg);
if (!addr_text) {
printc_err("load_raw: need flash address argument\n");
return -1;
} else if (expr_eval(addr_text, &addr) < 0) {
return -1;
}
return do_flatfile(LOAD, path, addr, 0);
}
int cmd_verify_raw(char **arg)
{
const char *path, *addr_text;
address_t addr;
path = get_arg(arg);
if (!path) {
printc_err("verify_raw: need file name argument\n");
return -1;
}
addr_text = get_arg(arg);
if (!addr_text) {
printc_err("verify_raw: need flash address argument\n");
return -1;
} else if (expr_eval(addr_text, &addr) < 0) {
return -1;
}
return do_flatfile(VERIFY, path, addr, 0);
}
int cmd_save_raw(char **arg)
{
const char *addr_text, *len_text, *path;
address_t addr, len;
addr_text = get_arg(arg);
if (!addr_text) {
printc_err("save_raw: need flash address argument\n");
return -1;
} else if (expr_eval(addr_text, &addr) < 0) {
return -1;
}
len_text = get_arg(arg);
if (!len_text) {
printc_err("save_raw: need length argument\n");
return -1;
} else if (expr_eval(len_text, &len) < 0)
return -1;
path = get_arg(arg);
if (!path) {
printc_err("save_raw: need file name argument\n");
return -1;
}
return do_flatfile(SAVE, path, addr, len);
}