From ef4f563559f195672d07114670a461a7c55ea22b Mon Sep 17 00:00:00 2001 From: "Suren A. Chilingaryan" Date: Wed, 19 Mar 2014 23:12:31 +0100 Subject: Add HEB scripts and re-organize the structure --- apps/CMakeLists.txt | 2 + apps/heb_strip_bad_values.c | 98 +++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 100 insertions(+) create mode 100644 apps/heb_strip_bad_values.c (limited to 'apps') diff --git a/apps/CMakeLists.txt b/apps/CMakeLists.txt index b3ce318..85457a1 100644 --- a/apps/CMakeLists.txt +++ b/apps/CMakeLists.txt @@ -11,3 +11,5 @@ add_executable(pio_test pio_test.c) target_link_libraries(pio_test pcilib rt) add_executable(compare_to_value compare_to_value.c) + +add_executable(heb_strip_bad_values heb_strip_bad_values.c) diff --git a/apps/heb_strip_bad_values.c b/apps/heb_strip_bad_values.c new file mode 100644 index 0000000..e04a53c --- /dev/null +++ b/apps/heb_strip_bad_values.c @@ -0,0 +1,98 @@ +#include +#include +#include +#include +#include +#include + +int main(int argc, char *argv[]) { + long i, num; + size_t count = 0, total = 0, size; + int offset = 3, toread = 1, toskip = 3; + uint32_t value; + uint32_t *buf; + uint32_t expected = 0; + uint32_t blocks = 0, status_good = 0; + + char fixed[4096]; + struct stat st_buf; + + if ((argc != 2)&&(argc != 5)) { + printf("Usage: %s [offset_dwords read_dwords skip_dwords] \n", argv[0]); + exit(0); + } + + FILE *f = fopen(argv[1], "r"); + if (!f) { + printf("Can't open %s\n", argv[1]); + exit(1); + } + + stat(argv[1], &st_buf); + size = st_buf.st_size / sizeof(uint32_t); + + + buf = malloc(size * sizeof(uint32_t)); + if (!buf) { + printf("Can't allocate %lu bytes of memory\n", size * sizeof(uint32_t)); + exit(1); + } + + if (argc == 5) { + offset = atoi(argv[2]); + toread = atoi(argv[3]); + toskip = atoi(argv[4]); + } + + + num = fread(buf, 4, size, f); + if (num != size) { + printf("Failed to read %lu dwords, only %lu read\n", size, num); + exit(1); + } + fclose(f); + + sprintf(fixed, "%s.fixed", argv[1]); + f = fopen(fixed, "w"); + if (!f) { + printf("Failed to open %s for output\n", fixed); + exit(1); + } + + expected = (buf[offset]>>24) + 2; + for (i = 1; i < size; i += (toread + toskip)) { + total++; + + value = buf[i + offset] >> 24; +// printf("0x%lx: value (%lx) = expected (%lx)\n", i + offset, value, expected); + if (value == expected) { + if (!status_good) { + status_good = 1; + blocks++; + } + fwrite(&buf[i], 4, toread + toskip, f); + expected += 2; + if (expected == 0xb8) + expected = 0; + } else if ((!status_good)&&(value == 0)&&((i + toread + toskip)< size)) { + value = buf[i + offset + toread + toskip] >> 24; + if (value == 2) { + status_good = 1; + blocks++; + fwrite(&buf[i], 4, toread + toskip, f); + expected = 2; + } else { + count++; + } + } else { + printf("0x%lx: value (%x) = expected (%x)\n", (i + offset)*sizeof(uint32_t), value, expected); + status_good = 0; + count++; + } + } + fclose(f); + free(buf); + + printf("%lu of %lu is wrong\n", count, total); + return 0; +} -- cgit v1.2.3