qi-hardware/antorcha
1
0
Fork 0
mirror of git://projects.qi-hardware.com/antorcha.git synced 2024-11-22 08:05:20 +02:00
Code

tornado/fw/ben.c: new option -w to write to a sector

Browse Source
This commit is contained in:
Werner Almesberger 2012-12-05 12:56:51 -03:00
parent 0703611bbd
commit cb324a81fc
1 changed files with 43 additions and 7 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

50
tornado/fw/ben/ben.c
View File

@ -12,6 +12,7 @@
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <fcntl.h>
#include <sys/mman.h>
@ -51,16 +52,10 @@ static void io_setup(void)
}
int main(void)
static void read_block(void)
{
int i;
io_setup();
if (!mmc_init()) {
fprintf(stderr, "mmc_init failed\n");
exit(1);
}
if (!mmc_begin_read(0)) {
fprintf(stderr, "mmc_begin_read failed\n");
exit(1);
@ -68,6 +63,47 @@ int main(void)
for (i = 0; i != MMC_BLOCK; i++)
printf("%02x%c", mmc_read(), (i & 15) == 15 ? '\n' : ' ');
mmc_end_read();
}
static void write_block(void)
{
int i;
if (!mmc_begin_write(0)) {
fprintf(stderr, "mmc_begin_write failed\n");
exit(1);
}
for (i = 0; i != MMC_BLOCK; i++)
mmc_write(i);
if (!mmc_end_write()) {
fprintf(stderr, "mmc_end_write failed\n");
exit(1);
}
}
static void usage(const char *name)
{
fprintf(stderr, "usage: %s [-w]\n", name);
exit(1);
}
int main(int argc, char **argv)
{
io_setup();
if (!mmc_init()) {
fprintf(stderr, "mmc_init failed\n");
exit(1);
}
if (argc == 1)
read_block();
else if (!strcmp(argv[1], "-w"))
write_block();
else
usage(*argv);
return 0;
}