/* * ===================================================================================== * * ________ .__ __ ________ ____ ________ * \_____ \ __ __|__| ____ | | __\______ \ _______ _/_ |/ _____/ * / / \ \| | \ |/ ___\| |/ / | | \_/ __ \ \/ /| / __ \ * / \_/. \ | / \ \___| < | ` \ ___/\ / | \ |__\ \ * \_____\ \_/____/|__|\___ >__|_ \/_______ /\___ >\_/ |___|\_____ / * \__> \/ \/ \/ \/ \/ * * www.optixx.org * * * Version: 1.0 * Created: 07/21/2009 03:32:16 PM * Author: david@optixx.org * Based on: custom-class, a basic USB example * Author: Christian Starkjohann * ===================================================================================== */ #define BANK_SIZE_SHIFT 15 #define BANK_SIZE (1< #include #include #include #include #include /* this is libusb */ #include "opendevice.h" /* common code moved to separate module */ #include "../requests.h" /* custom request numbers */ #include "../usbconfig.h" /* device's VID/PID and names */ void dump_packet(uint32_t addr, uint32_t len, uint8_t * packet) { uint16_t i, j; uint16_t sum = 0; uint8_t clear = 0; for (i = 0; i < len; i += 16) { sum = 0; for (j = 0; j < 16; j++) { sum += packet[i + j]; } if (!sum) { clear = 1; continue; } if (clear) { printf("*\n"); clear = 0; } printf("%08x:", addr + i); for (j = 0; j < 16; j++) { printf(" %02x", packet[i + j]); } printf(" |"); for (j = 0; j < 16; j++) { if (packet[i + j] >= 33 && packet[i + j] <= 126) printf("%c", packet[i + j]); else printf("."); } printf("|\n"); } } uint16_t crc_xmodem_update(uint16_t crc, uint8_t data) { int i; crc = crc ^ ((uint16_t) data << 8); for (i = 0; i < 8; i++) { if (crc & 0x8000) crc = (crc << 1) ^ 0x1021; else crc <<= 1; } return crc; } uint16_t do_crc(uint8_t * data, uint16_t size) { uint16_t crc = 0; uint16_t i; for (i = 0; i < size; i++) { crc = crc_xmodem_update(crc, data[i]); } return crc; } uint16_t do_crc_update(uint16_t crc, uint8_t * data, uint16_t size) { uint16_t i; for (i = 0; i < size; i++) crc = crc_xmodem_update(crc, data[i]); return crc; } static void usage(char *name) { fprintf(stderr, "usage:\n"); fprintf(stderr, " %s upload filename.. upload\n", name); } int main(int argc, char **argv) { usb_dev_handle *handle = NULL; const unsigned char rawVid[2] = { USB_CFG_VENDOR_ID }, rawPid[2] = { USB_CFG_DEVICE_ID}; char vendor[] = { USB_CFG_VENDOR_NAME, 0 }, product[] = { USB_CFG_DEVICE_NAME, 0}; int cnt, vid, pid; uint8_t *read_buffer; uint8_t *crc_buffer; uint8_t *ptr; uint32_t addr = 0; uint16_t addr_lo = 0; uint16_t addr_hi = 0; uint32_t step = 0; uint16_t crc = 0; uint8_t bank = 0; uint8_t bank_cnt = 0; uint32_t file_size = 0; uint32_t file_offset = 0; FILE *fp; usb_init(); if (argc < 2) { /* we need at least one argument */ usage(argv[0]); exit(1); } /* * compute VID/PID from usbconfig.h so that there is a central source * of information */ vid = rawVid[1] * 256 + rawVid[0]; pid = rawPid[1] * 256 + rawPid[0]; /* * The following function is in opendevice.c: */ if (usbOpenDevice(&handle, vid, vendor, pid, product, NULL, NULL, NULL) != 0) { fprintf(stderr, "Could not find USB device \"%s\" with vid=0x%x pid=0x%x\n", product, vid, pid); exit(1); } printf("Open USB device \"%s\" with vid=0x%x pid=0x%x\n", product, vid, pid); if (strcasecmp(argv[1], "upload") == 0) { if (argc < 3) { /* we need at least one argument */ usage(argv[0]); exit(1); } fp = fopen(argv[2], "r"); if (fp == NULL) { fprintf(stderr, "Cannot open file %s ", argv[2]); exit(1); } fseek (fp, 0, SEEK_END); file_size = ftell (fp); file_offset = 512; if (strstr(argv[2],".smc") || strstr(argv[2],".swc")){ printf("Skip 512 Byte header\n"); file_size -= 512; fseek (fp, 512, SEEK_SET); } else { fseek (fp, 0, SEEK_SET); } bank_cnt = file_size / BANK_SIZE; printf("Transfer '%s' %i Bytes, %i Banks\n",argv[2],file_size,bank_cnt); read_buffer = (unsigned char *) malloc(READ_BUFFER_SIZE); crc_buffer = (unsigned char *) malloc(0x1000); memset(crc_buffer, 0, 0x1000); addr = 0x000000; cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_MODE_AVR, 0, 0, NULL, 0, 5000); cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_BULK_UPLOAD_INIT, BANK_SIZE_SHIFT , bank_cnt, NULL, 0, 5000); if (cnt < 0) { fprintf(stderr, "USB error: %s\n", usb_strerror()); usb_close(handle); exit(-1); } ptr = crc_buffer; while ((cnt = fread(read_buffer, READ_BUFFER_SIZE, 1, fp)) > 0) { ptr = crc_buffer; for (step = 0; step < READ_BUFFER_SIZE; step += SEND_BUFFER_SIZE) { addr_lo = addr & 0xffff; addr_hi = (addr >> 16) & 0x00ff; if (addr == 0x000000){ cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_BULK_UPLOAD_ADDR, addr_hi, addr_lo, (char *) read_buffer + step, SEND_BUFFER_SIZE, 5000); } else { cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_BULK_UPLOAD_NEXT, addr_hi, addr_lo, (char *) read_buffer + step, SEND_BUFFER_SIZE, 5000); } if (cnt < 0) { fprintf(stderr, "USB error: %s\n", usb_strerror()); usb_close(handle); exit(-1); } memcpy(ptr, read_buffer + step, SEND_BUFFER_SIZE); addr += SEND_BUFFER_SIZE; ptr += SEND_BUFFER_SIZE; if ( addr % BANK_SIZE == 0){ crc = do_crc(crc_buffer, 0x1000); printf ("bank=0x%02x addr=0x%08x addr=0x%08x crc=0x%04x\n", bank, addr - 0x1000, addr, crc); ptr = crc_buffer; if ( addr % BANK_SIZE == 0) { bank++; } } } } bank = 0; cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_BULK_UPLOAD_END, 0, 0, NULL, 0, 5000); fseek(fp, file_offset, SEEK_SET); while ((cnt = fread(read_buffer, READ_BUFFER_SIZE, 1, fp)) > 0) { printf ("bank=0x%02x crc=0x%04x\n", bank++, do_crc(read_buffer, READ_BUFFER_SIZE)); } fclose(fp); cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_MODE_SNES, 0, 0, NULL, 0, 5000); if (cnt < 1) { if (cnt < 0) { fprintf(stderr, "USB error: %s\n", usb_strerror()); } else { fprintf(stderr, "only %d bytes received.\n", cnt); } } } else if (strcasecmp(argv[1], "crc") == 0) { /* * if(argc < 2){ usage(argv[0]); exit(1); } */ addr = 0x000000; addr_lo = addr & 0xffff; addr_hi = (addr >> 16) & 0xff; printf("Request CRC for Addr: 0x%06x\n", addr); cnt = usb_control_msg(handle, USB_TYPE_VENDOR | USB_RECIP_DEVICE | USB_ENDPOINT_OUT, USB_CRC_ADDR, addr_hi, addr_lo, NULL, (1 << 15) / 4, 5000); if (cnt < 1) { if (cnt < 0) { fprintf(stderr, "USB error: %s\n", usb_strerror()); } else { fprintf(stderr, "only %d bytes received.\n", cnt); } } } else { usage(argv[0]); exit(1); } usb_close(handle); return 0; }