244 lines
4.9 KiB
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);
|
||
|
}
|