diff options
Diffstat (limited to 'ao-tools/ao-stmload/ao-selfload.c')
-rw-r--r-- | ao-tools/ao-stmload/ao-selfload.c | 127 |
1 files changed, 0 insertions, 127 deletions
diff --git a/ao-tools/ao-stmload/ao-selfload.c b/ao-tools/ao-stmload/ao-selfload.c deleted file mode 100644 index dee1c3cb..00000000 --- a/ao-tools/ao-stmload/ao-selfload.c +++ /dev/null @@ -1,127 +0,0 @@ -/* - * Copyright © 2013 Keith Packard <keithp@keithp.com> - * - * 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; version 2 of the License. - * - * 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. - */ - -#include <stdio.h> -#include <stdint.h> -#include <stdlib.h> -#include <sysexits.h> -#include <unistd.h> -#include <string.h> -#include "cc.h" -#include "cc-usb.h" -#include "ccdbg.h" -#include "ao-stmload.h" - -int ao_self_verbose; - -#define TRACE(...) if (ao_self_verbose) printf (__VA_ARGS__) - -void -ao_self_block_read(struct cc_usb *cc, uint32_t address, uint8_t block[256]) -{ - int byte; - cc_usb_sync(cc); - cc_usb_printf(cc, "R %x\n", address); - for (byte = 0; byte < 0x100; byte++) { - block[byte] = cc_usb_getchar(cc); - } - TRACE ("\nread %08x\n", address); - for (byte = 0; byte < 0x100; byte++) { - TRACE (" %02x", block[byte]); - if ((byte & 0xf) == 0xf) - TRACE ("\n"); - } -} - -void -ao_self_block_write(struct cc_usb *cc, uint32_t address, uint8_t block[256]) -{ - int byte; - cc_usb_sync(cc); - cc_usb_printf(cc, "W %x\n", address); - TRACE ("write %08x\n", address); - for (byte = 0; byte < 0x100; byte++) { - TRACE (" %02x", block[byte]); - if ((byte & 0xf) == 0xf) - TRACE ("\n"); - } - for (byte = 0; byte < 0x100; byte++) { - cc_usb_printf(cc, "%c", block[byte]); - } -} - -struct ao_hex_image * -ao_self_read(struct cc_usb *cc, uint32_t address, uint32_t length) -{ - struct ao_hex_image *image; - int pages; - int page; - uint32_t base = address & ~0xff; - uint32_t bound = (address + length + 0xff) & ~0xff; - - image = calloc(sizeof (struct ao_hex_image) + (bound - base), 1); - image->address = base; - image->length = bound - base; - pages = image->length / 0x100; - for (page = 0; page < pages; page++) - ao_self_block_read(cc, image->address + page * 0x100, image->data + page * 0x100); - return image; -} - -int -ao_self_write(struct cc_usb *cc, struct ao_hex_image *image) -{ - uint8_t block[256]; - uint8_t check[256]; - uint32_t base, bound, length, address; - uint32_t pages; - uint32_t page; - - base = image->address & ~0xff; - bound = (image->address + image->length + 0xff) & ~0xff; - - address = base; - length = bound - base; - - pages = length / 0x100; - printf ("Write %08x %d pages: ", address, length/0x100); fflush(stdout); - for (page = 0; page < pages; page++) { - uint32_t start, stop; - address = base + page * 0x100; - - if (address < image->address || address + 0x100 > image->address + image->length) { - ao_self_block_read(cc, address, block); - } - start = address; - stop = address + 0x100; - if (start < image->address) - start = image->address; - if (stop > image->address + image->length) - stop = image->address + image->length; - memcpy(block + start - address, image->data + start - image->address, stop - start); - ao_self_block_write(cc, address, block); - ao_self_block_read(cc, address, check); - if (memcmp(block, check, 0x100) != 0) { - fprintf(stderr, "Block at 0x%08x doesn't match\n", address); - return 0; - } - putchar('.'); fflush(stdout); - } - printf("done\n"); - cc_usb_printf(cc,"a\n"); - return 1; -} |