558 lines
11 KiB
C
558 lines
11 KiB
C
/*
|
|
* (C) Copyright 2000
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*
|
|
* See file CREDITS for list of people who contributed to this
|
|
* project.
|
|
*
|
|
* 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., 59 Temple Place, Suite 330, Boston,
|
|
* MA 02111-1307 USA
|
|
*/
|
|
|
|
/*
|
|
* Memory Functions
|
|
*
|
|
* Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
|
|
*/
|
|
|
|
#include <common.h>
|
|
#include <command.h>
|
|
#include <init.h>
|
|
#include <driver.h>
|
|
#include <malloc.h>
|
|
#include <errno.h>
|
|
#include <fs.h>
|
|
#include <fcntl.h>
|
|
#include <getopt.h>
|
|
#include <linux/stat.h>
|
|
#include <xfuncs.h>
|
|
|
|
#ifdef CMD_MEM_DEBUG
|
|
#define PRINTF(fmt,args...) printf (fmt ,##args)
|
|
#else
|
|
#define PRINTF(fmt,args...)
|
|
#endif
|
|
|
|
#define RW_BUF_SIZE (ulong)4096
|
|
static char *rw_buf;
|
|
|
|
static char *DEVMEM = "/dev/mem";
|
|
|
|
/* Memory Display
|
|
*
|
|
* Syntax:
|
|
* md{.b, .w, .l} {addr} {len}
|
|
*/
|
|
#define DISP_LINE_LEN 16
|
|
|
|
int memory_display(char *addr, ulong offs, ulong nbytes, int size)
|
|
{
|
|
ulong linebytes, i;
|
|
u_char *cp;
|
|
|
|
/* Print the lines.
|
|
*
|
|
* We buffer all read data, so we can make sure data is read only
|
|
* once, and all accesses are with the specified bus width.
|
|
*/
|
|
do {
|
|
char linebuf[DISP_LINE_LEN];
|
|
uint *uip = (uint *)linebuf;
|
|
ushort *usp = (ushort *)linebuf;
|
|
u_char *ucp = (u_char *)linebuf;
|
|
|
|
printf("%08lx:", offs);
|
|
linebytes = (nbytes>DISP_LINE_LEN)?DISP_LINE_LEN:nbytes;
|
|
|
|
for (i=0; i<linebytes; i+= size) {
|
|
if (size == 4) {
|
|
printf(" %08x", (*uip++ = *((uint *)addr)));
|
|
} else if (size == 2) {
|
|
printf(" %04x", (*usp++ = *((ushort *)addr)));
|
|
} else {
|
|
printf(" %02x", (*ucp++ = *((u_char *)addr)));
|
|
}
|
|
addr += size;
|
|
offs += size;
|
|
}
|
|
|
|
puts (" ");
|
|
cp = (u_char *)linebuf;
|
|
for (i=0; i<linebytes; i++) {
|
|
if ((*cp < 0x20) || (*cp > 0x7e))
|
|
putchar('.');
|
|
else
|
|
printf("%c", *cp);
|
|
cp++;
|
|
}
|
|
putchar('\n');
|
|
nbytes -= linebytes;
|
|
if (ctrlc()) {
|
|
return -EINTR;
|
|
}
|
|
} while (nbytes > 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
int open_and_lseek(const char *filename, int mode, ulong pos)
|
|
{
|
|
int fd, ret;
|
|
|
|
fd = open(filename, mode | O_RDONLY);
|
|
if (fd < 0) {
|
|
perror("open");
|
|
return fd;
|
|
}
|
|
|
|
ret = lseek(fd, pos, SEEK_SET);
|
|
if (ret < 0) {
|
|
perror("lseek");
|
|
close(fd);
|
|
return ret;
|
|
}
|
|
|
|
return fd;
|
|
}
|
|
|
|
static int mem_parse_options(int argc, char *argv[], char *optstr, int *mode,
|
|
char **sourcefile, char **destfile)
|
|
{
|
|
int opt;
|
|
|
|
getopt_reset();
|
|
|
|
while((opt = getopt(argc, argv, optstr)) > 0) {
|
|
switch(opt) {
|
|
case 'b':
|
|
*mode = O_RWSIZE_1;
|
|
break;
|
|
case 'w':
|
|
*mode = O_RWSIZE_2;
|
|
break;
|
|
case 'l':
|
|
*mode = O_RWSIZE_4;
|
|
break;
|
|
case 's':
|
|
*sourcefile = optarg;
|
|
break;
|
|
case 'd':
|
|
*destfile = optarg;
|
|
break;
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int do_mem_md(cmd_tbl_t *cmdtp, int argc, char *argv[])
|
|
{
|
|
ulong start = 0, size = 0x100;
|
|
int r, now;
|
|
int ret = 0;
|
|
int fd;
|
|
char *filename = DEVMEM;
|
|
int mode = O_RWSIZE_4;
|
|
|
|
errno = 0;
|
|
if (mem_parse_options(argc, argv, "bwls:", &mode, &filename, NULL) < 0)
|
|
return 1;
|
|
|
|
if (optind < argc) {
|
|
if (parse_area_spec(argv[optind], &start, &size)) {
|
|
printf("could not parse: %s\n", argv[optind]);
|
|
return 1;
|
|
}
|
|
if (size == ~0)
|
|
size = 0x100;
|
|
}
|
|
|
|
fd = open_and_lseek(filename, mode | O_RDONLY, start);
|
|
if (fd < 0)
|
|
return 1;
|
|
|
|
do {
|
|
now = min(size, RW_BUF_SIZE);
|
|
r = read(fd, rw_buf, now);
|
|
if (r < 0) {
|
|
perror("read");
|
|
goto out;
|
|
}
|
|
if (!r)
|
|
goto out;
|
|
|
|
if ((ret = memory_display(rw_buf, start, r, mode >> O_RWSIZE_SHIFT)))
|
|
goto out;
|
|
|
|
start += r;
|
|
size -= r;
|
|
} while (size);
|
|
|
|
out:
|
|
close(fd);
|
|
|
|
return errno;
|
|
}
|
|
|
|
static __maybe_unused char cmd_md_help[] =
|
|
"Usage md [OPTIONS] <region>\n"
|
|
"display (hexdump) a memory region.\n"
|
|
"options:\n"
|
|
" -s <file> display file (default /dev/mem)\n"
|
|
" -d <file> write file (default /dev/mem)\n"
|
|
" -b output in bytes\n"
|
|
" -w output in halfwords (16bit)\n"
|
|
" -l output in words (32bit)\n"
|
|
"\n"
|
|
"Memory regions:\n"
|
|
"Memory regions can be specified in two different forms: start+size\n"
|
|
"or start-end, If <start> is ommitted it defaults to 0. If end is ommited it\n"
|
|
"defaults to the end of the device, except for interactive commands like md\n"
|
|
"and mw for which it defaults to 0x100.\n"
|
|
"Sizes can be specified as decimal, or if prefixed with 0x as hexadecimal.\n"
|
|
"an optional suffix of k, M or G is for kibibytes, Megabytes or Gigabytes,\n"
|
|
"respectively\n";
|
|
|
|
|
|
U_BOOT_CMD_START(md)
|
|
.maxargs = CONFIG_MAXARGS,
|
|
.cmd = do_mem_md,
|
|
.usage = "memory display",
|
|
U_BOOT_CMD_HELP(cmd_md_help)
|
|
U_BOOT_CMD_END
|
|
|
|
static int do_mem_mw ( cmd_tbl_t *cmdtp, int argc, char *argv[])
|
|
{
|
|
int ret = 0;
|
|
int fd;
|
|
char *filename = DEVMEM;
|
|
int mode = O_RWSIZE_4;
|
|
ulong adr;
|
|
|
|
errno = 0;
|
|
|
|
if (mem_parse_options(argc, argv, "bwld:", &mode, NULL, &filename) < 0)
|
|
return 1;
|
|
|
|
if (optind + 1 >= argc) {
|
|
u_boot_cmd_usage(cmdtp);
|
|
return 1;
|
|
}
|
|
|
|
adr = strtoul_suffix(argv[optind++], NULL, 0);
|
|
|
|
fd = open_and_lseek(filename, mode | O_WRONLY, adr);
|
|
if (fd < 0)
|
|
return 1;
|
|
|
|
while (optind < argc) {
|
|
u8 val8;
|
|
u16 val16;
|
|
u32 val32;
|
|
switch (mode) {
|
|
case O_RWSIZE_1:
|
|
val8 = simple_strtoul(argv[optind], NULL, 0);
|
|
ret = write(fd, &val8, 1);
|
|
break;
|
|
case O_RWSIZE_2:
|
|
val16 = simple_strtoul(argv[optind], NULL, 0);
|
|
ret = write(fd, &val16, 2);
|
|
break;
|
|
case O_RWSIZE_4:
|
|
val32 = simple_strtoul(argv[optind], NULL, 0);
|
|
ret = write(fd, &val32, 4);
|
|
break;
|
|
}
|
|
if (ret < 0) {
|
|
perror("write");
|
|
break;
|
|
}
|
|
optind++;
|
|
}
|
|
|
|
return errno;
|
|
}
|
|
|
|
static __maybe_unused char cmd_mw_help[] =
|
|
"Usage: mw [OPTIONS] <region> <value(s)>\n"
|
|
"Write value(s) to the specifies region.\n"
|
|
"see 'help md' for supported options.\n";
|
|
|
|
U_BOOT_CMD_START(mw)
|
|
.maxargs = CONFIG_MAXARGS,
|
|
.cmd = do_mem_mw,
|
|
.usage = "memory write (fill)",
|
|
U_BOOT_CMD_HELP(cmd_mw_help)
|
|
U_BOOT_CMD_END
|
|
|
|
static int do_mem_cmp(cmd_tbl_t *cmdtp, int argc, char *argv[])
|
|
{
|
|
ulong addr1, addr2, count = ~0;
|
|
int mode = O_RWSIZE_1;
|
|
char *sourcefile = DEVMEM;
|
|
char *destfile = DEVMEM;
|
|
int sourcefd, destfd;
|
|
char *rw_buf1;
|
|
int ret = 1;
|
|
int offset = 0;
|
|
struct stat statbuf;
|
|
|
|
if (mem_parse_options(argc, argv, "bwls:d:", &mode, &sourcefile, &destfile) < 0)
|
|
return 1;
|
|
|
|
if (optind + 2 > argc) {
|
|
u_boot_cmd_usage(cmdtp);
|
|
return 1;
|
|
}
|
|
|
|
addr1 = simple_strtoul(argv[optind], NULL, 0);
|
|
addr2 = simple_strtoul(argv[optind + 1], NULL, 0);
|
|
|
|
if (optind + 2 == argc) {
|
|
if (sourcefile == DEVMEM) {
|
|
printf("source and count not given\n");
|
|
return 1;
|
|
}
|
|
if (stat(sourcefile, &statbuf)) {
|
|
perror("stat");
|
|
return 1;
|
|
}
|
|
count = statbuf.st_size - addr1;
|
|
} else {
|
|
count = simple_strtoul(argv[optind + 2], NULL, 0);
|
|
}
|
|
|
|
sourcefd = open_and_lseek(sourcefile, mode | O_RDONLY, addr1);
|
|
if (sourcefd < 0)
|
|
return 1;
|
|
|
|
destfd = open_and_lseek(destfile, mode | O_RDONLY, addr2);
|
|
if (destfd < 0) {
|
|
close(sourcefd);
|
|
return 1;
|
|
}
|
|
|
|
rw_buf1 = xmalloc(RW_BUF_SIZE);
|
|
|
|
while (count > 0) {
|
|
int now, r1, r2, i;
|
|
|
|
now = min(RW_BUF_SIZE, count);
|
|
|
|
r1 = read(sourcefd, rw_buf, now);
|
|
if (r1 < 0) {
|
|
perror("read");
|
|
goto out;
|
|
}
|
|
|
|
r2 = read(destfd, rw_buf1, now);
|
|
if (r2 < 0) {
|
|
perror("read");
|
|
goto out;
|
|
}
|
|
|
|
if (r1 != now || r2 != now) {
|
|
printf("regions differ in size\n");
|
|
goto out;
|
|
}
|
|
|
|
for (i = 0; i < now; i++) {
|
|
if (rw_buf[i] != rw_buf1[i]) {
|
|
printf("files differ at offset %d\n", offset);
|
|
goto out;
|
|
}
|
|
offset++;
|
|
}
|
|
|
|
count -= now;
|
|
}
|
|
|
|
printf("OK\n");
|
|
ret = 0;
|
|
out:
|
|
close(sourcefd);
|
|
close(destfd);
|
|
free(rw_buf1);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static __maybe_unused char cmd_memcmp_help[] =
|
|
"Usage: memcmp [OPTIONS] <addr1> <addr2> <count>\n"
|
|
"\n"
|
|
"options:\n"
|
|
" -b, -w, -l use byte, halfword, or word accesses\n"
|
|
" -s <file> source file (default /dev/mem)\n"
|
|
" -d <file> destination file (default /dev/mem)\n"
|
|
"\n"
|
|
"Compare memory regions specified with addr1 and addr2\n"
|
|
"of size <count> bytes. If source is a file count can\n"
|
|
"be left unspecified in which case the whole file is\n"
|
|
"compared\n";
|
|
|
|
U_BOOT_CMD_START(memcmp)
|
|
.maxargs = CONFIG_MAXARGS,
|
|
.cmd = do_mem_cmp,
|
|
.usage = "memory compare",
|
|
U_BOOT_CMD_HELP(cmd_memcmp_help)
|
|
U_BOOT_CMD_END
|
|
|
|
static int do_mem_cp(cmd_tbl_t *cmdtp, int argc, char *argv[])
|
|
{
|
|
ulong count;
|
|
ulong dest, src;
|
|
char *sourcefile = DEVMEM;
|
|
char *destfile = DEVMEM;
|
|
int sourcefd, destfd;
|
|
int mode = O_RWSIZE_1;
|
|
struct stat statbuf;
|
|
int ret = 0;
|
|
|
|
if (mem_parse_options(argc, argv, "bwls:d:", &mode, &sourcefile, &destfile) < 0)
|
|
return 1;
|
|
|
|
if (optind + 2 > argc) {
|
|
u_boot_cmd_usage(cmdtp);
|
|
return 1;
|
|
}
|
|
|
|
src = simple_strtoul(argv[optind], NULL, 0);
|
|
dest = simple_strtoul(argv[optind + 1], NULL, 0);
|
|
|
|
if (optind + 2 == argc) {
|
|
if (sourcefile == DEVMEM) {
|
|
printf("source and count not given\n");
|
|
return 1;
|
|
}
|
|
if (stat(sourcefile, &statbuf)) {
|
|
perror("stat");
|
|
return 1;
|
|
}
|
|
count = statbuf.st_size - src;
|
|
} else {
|
|
count = simple_strtoul(argv[optind + 2], NULL, 0);
|
|
}
|
|
|
|
sourcefd = open_and_lseek(sourcefile, mode | O_RDONLY, src);
|
|
if (sourcefd < 0)
|
|
return 1;
|
|
|
|
destfd = open_and_lseek(destfile, O_WRONLY | O_CREAT | mode, dest);
|
|
if (destfd < 0) {
|
|
close(sourcefd);
|
|
return 1;
|
|
}
|
|
|
|
while (count > 0) {
|
|
int now, r, w;
|
|
|
|
now = min(RW_BUF_SIZE, count);
|
|
|
|
if ((r = read(sourcefd, rw_buf, now)) < 0) {
|
|
perror("read");
|
|
goto out;
|
|
}
|
|
|
|
if ((w = write(destfd, rw_buf, r)) < 0) {
|
|
perror("write");
|
|
goto out;
|
|
}
|
|
|
|
if (r < now)
|
|
break;
|
|
|
|
if (w < r)
|
|
break;
|
|
|
|
count -= now;
|
|
}
|
|
|
|
if (count) {
|
|
printf("ran out of data\n");
|
|
ret = 1;
|
|
}
|
|
|
|
out:
|
|
close(sourcefd);
|
|
close(destfd);
|
|
|
|
return ret;
|
|
}
|
|
|
|
static __maybe_unused char cmd_memcpy_help[] =
|
|
"Usage: memcpy [OPTIONS] <src> <dst> <count>\n"
|
|
"\n"
|
|
"options:\n"
|
|
" -b, -w, -l use byte, halfword, or word accesses\n"
|
|
" -s <file> source file (default /dev/mem)\n"
|
|
" -d <file> destination file (default /dev/mem)\n"
|
|
"\n"
|
|
"Copy memory at <src> of <count> bytes to <dst>\n";
|
|
|
|
U_BOOT_CMD_START(memcpy)
|
|
.maxargs = CONFIG_MAXARGS,
|
|
.cmd = do_mem_cp,
|
|
.usage = "memory copy",
|
|
U_BOOT_CMD_HELP(cmd_memcpy_help)
|
|
U_BOOT_CMD_END
|
|
|
|
static struct device_d mem_dev = {
|
|
.name = "mem",
|
|
.id = "mem",
|
|
.map_base = 0,
|
|
.size = ~0, /* FIXME: should be 0x100000000, ahem... */
|
|
};
|
|
|
|
static struct driver_d mem_drv = {
|
|
.name = "mem",
|
|
.probe = dummy_probe,
|
|
.read = mem_read,
|
|
.write = mem_write,
|
|
};
|
|
|
|
static struct driver_d ram_drv = {
|
|
.name = "ram",
|
|
.probe = dummy_probe,
|
|
.read = mem_read,
|
|
.write = mem_write,
|
|
.type = DEVICE_TYPE_DRAM,
|
|
};
|
|
|
|
static struct driver_d rom_drv = {
|
|
.name = "rom",
|
|
.probe = dummy_probe,
|
|
.read = mem_read,
|
|
};
|
|
|
|
static int mem_init(void)
|
|
{
|
|
rw_buf = malloc(RW_BUF_SIZE);
|
|
if(!rw_buf) {
|
|
printf("%s: Out of memory\n", __FUNCTION__);
|
|
return -1;
|
|
}
|
|
|
|
register_device(&mem_dev);
|
|
register_driver(&mem_drv);
|
|
register_driver(&ram_drv);
|
|
register_driver(&rom_drv);
|
|
return 0;
|
|
}
|
|
|
|
device_initcall(mem_init);
|
|
|