123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380 |
- /*
- * =====================================================================================
- *
- * ________ .__ __ ________ ____ ________
- * \_____ \ __ __|__| ____ | | __\______ \ _______ _/_ |/ _____/
- * / / \ \| | \ |/ ___\| |/ / | | \_/ __ \ \/ /| / __ \
- * / \_/. \ | / \ \___| < | ` \ ___/\ / | \ |__\ \
- * \_____\ \_/____/|__|\___ >__|_ \/_______ /\___ >\_/ |___|\_____ /
- * \__> \/ \/ \/ \/ \/
- *
- * www.optixx.org
- *
- *
- * Version: 1.0
- * Created: 07/21/2009 03:32:16 PM
- * Author: david@optixx.org
- *
- * =====================================================================================
- */
- #include <avr/io.h>
- #include <avr/interrupt.h>
- #include <util/delay.h>
- #include <stdlib.h>
- #include <avr/pgmspace.h>
- #include <avr/eeprom.h>
- #include "usbdrv.h"
- #include "oddebug.h"
- #include "config.h"
- #include "requests.h"
- #include "uart.h"
- #include "sram.h"
- #include "debug.h"
- #include "info.h"
- #include "dump.h"
- #include "crc.h"
- #include "usb_bulk.h"
- #include "timer.h"
- #include "watchdog.h"
- #include "rle.h"
- #include "loader.h"
- #include "command.h"
- #include "shared_memory.h"
- #include "irq.h"
- #include "testing.h"
- extern const char _rom[] PROGMEM;
- extern FILE uart_stdout;
- uint8_t debug_level = (DEBUG | DEBUG_USB | DEBUG_CRC | DEBUG_SHM );
- uint8_t read_buffer[TRANSFER_BUFFER_SIZE];
- uint32_t req_addr = 0;
- uint32_t req_addr_end = 0;
- uint32_t req_size;
- uint8_t req_bank;
- uint32_t req_bank_size;
- uint16_t req_bank_cnt;
- uint8_t req_percent;
- uint8_t req_percent_last;
- uint8_t req_state = REQ_STATUS_IDLE;
- uint8_t rx_remaining = 0;
- uint8_t tx_remaining = 0;
- uint16_t sync_errors = 0;
- uint8_t tx_buffer[32];
- uint8_t data_buffer[4];
- uint32_t addr;
- uint16_t crc = 0;
- usbMsgLen_t usbFunctionSetup(uchar data[8])
- {
- usbRequest_t *rq = (void *) data;
- uint8_t ret_len = 0;
- if (rq->bRequest == USB_BULK_UPLOAD_INIT) {
- req_bank = 0;
- rx_remaining = 0;
- debug_P(DEBUG_USB, PSTR("USB_BULK_UPLOAD_INIT: %i %i\n"), rq->wValue.word,
- rq->wIndex.word);
- req_bank_size = (uint32_t) (1L << rq->wValue.word);
- req_bank_cnt = rq->wIndex.word;
- req_addr_end = (uint32_t) req_bank_size *req_bank_cnt;
- req_percent = 0;
- req_percent_last = 0;
- sync_errors = 0;
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_INIT: bank_size=0x%08lx bank_cnt=0x%x end_addr=0x%08lx\n"),
- req_bank_size, req_bank_cnt, req_addr_end);
- shared_memory_write(SHARED_MEM_TX_CMD_UPLOAD_START, 0);
- shared_memory_write(SHARED_MEM_TX_CMD_BANK_COUNT, req_bank_cnt);
- if (req_addr == 0x000000) {
- timer_start();
- }
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_BULK_UPLOAD_ADDR) {
- req_state = REQ_STATUS_BULK_UPLOAD;
- req_addr = rq->wValue.word;
- req_addr = req_addr << 16;
- req_addr = req_addr | rq->wIndex.word;
- rx_remaining = rq->wLength.word;
- if (req_addr && req_addr % req_bank_size == 0) {
- #ifdef FLT_DEBUG
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_ADDR: req_bank=0x%02x addr=0x%08lx time=%.4f\n"),
- req_bank, req_addr, timer_stop());
- #else
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_ADDR: req_bank=0x%02x addr=0x%08lx time=%i\n"),
- req_bank, req_addr, timer_stop_int());
- #endif
- req_bank++;
- timer_start();
- } else {
- sram_bulk_write_start(req_addr);
- }
- ret_len = USB_MAX_TRANS;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_BULK_UPLOAD_NEXT) {
- req_state = REQ_STATUS_BULK_UPLOAD;
- req_addr = rq->wValue.word;
- req_addr = req_addr << 16;
- req_addr = req_addr | rq->wIndex.word;
- rx_remaining = rq->wLength.word;
- req_percent = (uint32_t)( 100 * req_addr ) / req_addr_end;
- if (req_percent!=req_percent_last){
- shared_memory_write(SHARED_MEM_TX_CMD_UPLOAD_PROGESS, req_percent);
- }
- req_percent_last = req_percent;
- shared_memory_scratchpad_region_save_helper(req_addr);
- if (req_addr && (req_addr % req_bank_size) == 0) {
- #ifdef FLT_DEBUG
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_NEXT: req_bank=0x%02x addr=0x%08lx time=%.4f\n"),
- req_bank, req_addr, timer_stop());
- #else
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_NEXT: req_bank=0x%02x addr=0x%08lx time=%i\n"),
- req_bank, req_addr, timer_stop_int());
- #endif
- req_bank++;
- timer_start();
- shared_memory_write(SHARED_MEM_TX_CMD_BANK_CURRENT, req_bank);
- }
- ret_len = USB_MAX_TRANS;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_BULK_UPLOAD_END) {
- if (req_state != REQ_STATUS_BULK_UPLOAD) {
- debug_P(DEBUG_USB,
- PSTR("USB_BULK_UPLOAD_END: ERROR state is not REQ_STATUS_BULK_UPLOAD\n"));
- return 0;
- }
- debug_P(DEBUG_USB, PSTR("USB_BULK_UPLOAD_END:\n"));
- req_state = REQ_STATUS_IDLE;
- sram_bulk_write_end();
- shared_memory_write(SHARED_MEM_TX_CMD_UPLOAD_END, 0);
- ret_len = 0;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_CRC) {
- req_addr = rq->wValue.word;
- req_addr = req_addr << 16;
- req_addr = req_addr | rq->wIndex.word;
- debug_P(DEBUG_USB, PSTR("USB_CRC: addr=0x%08lx \n"), req_addr);
- crc_check_bulk_memory(0x000000, req_addr, req_bank_size);
- ret_len = 0;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_MODE_SNES) {
- req_state = REQ_STATUS_SNES;
- debug_P(DEBUG_USB, PSTR("USB_MODE_SNES:\n"));
- ret_len = 0;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_MODE_AVR) {
- req_state = REQ_STATUS_AVR;
- debug_P(DEBUG_USB, PSTR("USB_MODE_AVR:\n"));
- ret_len = 0;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_AVR_RESET) {
- debug_P(DEBUG_USB, PSTR("USB_AVR_RESET:\n"));
- soft_reset();
- ret_len = 0;
- /*
- * -------------------------------------------------------------------------
- */
- } else if (rq->bRequest == USB_CRC_ADDR) {
- req_state = REQ_STATUS_CRC;
- req_addr = rq->wValue.word;
- req_addr = req_addr << 16;
- req_addr = req_addr | rq->wIndex.word;
- debug_P(DEBUG_USB, PSTR("USB_CRC_ADDR: addr=0x%lx size=%i\n"), req_addr,
- rq->wLength.word);
- req_size = rq->wLength.word;
- req_size = req_size << 2;
- tx_remaining = 2;
- debug_P(DEBUG_USB, PSTR("USB_CRC_ADDR: addr=0x%lx size=%li\n"), req_addr,
- req_size);
- crc = crc_check_memory_range(req_addr, req_size, read_buffer);
- tx_buffer[0] = crc & 0xff;
- tx_buffer[1] = (crc >> 8) & 0xff;
- ret_len = 2;
- req_state = REQ_STATUS_IDLE;
- }
- usbMsgPtr = data_buffer;
- return ret_len; /* default for not implemented requests: return no data back to host */
- }
- /*
- * -------------------------------------------------------------------------
- */
- void usb_connect()
- {
- uint8_t i = 0;
- info_P(PSTR("USB init\n"));
- usbDeviceDisconnect(); /* enforce re-enumeration, do this while */
- cli();
- info_P(PSTR("USB disconnect\n"));
- i = 10;
- while (--i) { /* fake USB disconnect for > 250 ms */
- led_on();
- _delay_ms(15);
- led_off();
- _delay_ms(35);
- }
- led_on();
- usbDeviceConnect();
- info_P(PSTR("USB connect\n"));
- }
- void boot_startup_rom(uint16_t init_delay)
- {
- info_P(PSTR("Fetch loader rom\n"));
- info_P(PSTR("Activate AVR bus\n"));
- avr_bus_active();
- info_P(PSTR("IRQ off\n"));
- snes_irq_lo();
- snes_irq_off();
- snes_lorom();
- rle_decode(&_rom, ROM_BUFFER_SIZE, 0x000000);
- info_P(PSTR("\n"));
- #if 0
- dump_memory(0x010000 - 0x100, 0x010000);
- uint16_t crc;
- crc = crc_check_bulk_memory((uint32_t)0x000000,0x010000, 0x010000);
- info(PSTR("crc=%x\n"),crc);
- #endif
- snes_hirom();
- snes_wr_disable();
- snes_bus_active();
- info_P(PSTR("Activate SNES bus\n"));
- send_reset();
- _delay_ms(init_delay);
- }
- void banner(){
- uint8_t i;
- for (i=0;i<40;i++)
- info_P(PSTR("\n"));
- info_P(PSTR(" ________ .__ __ ________ ____ ________\n"));
- info_P(PSTR(" \\_____ \\ __ __|__| ____ | | __\\______ \\ _______ _/_ |/ _____/\n"));
- info_P(PSTR(" / / \\ \\| | \\ |/ ___\\| |/ / | | \\_/ __ \\ \\/ /| / __ \\ \n"));
- info_P(PSTR(" / \\_/. \\ | / \\ \\___| < | ` \\ ___/\\ / | \\ |__\\ \\ \n"));
- info_P(PSTR(" \\_____\\ \\_/____/|__|\\___ >__|_ \\/_______ /\\___ >\\_/ |___|\\_____ / \n"));
- info_P(PSTR(" \\__> \\/ \\/ \\/ \\/ \\/ \n"));
- info_P(PSTR("\n"));
- info_P(PSTR(" www.optixx.org\n"));
- info_P(PSTR("\n"));
- info_P(PSTR("System Hw: %s Sw: %s\n"),HW_VERSION,SW_VERSION);
-
- }
- void globals_init(){
- req_addr = 0;
- req_addr_end = 0;
- req_state = REQ_STATUS_IDLE;
- rx_remaining = 0;
- tx_remaining = 0;
- sync_errors = 0;
- }
- int main(void)
- {
- uart_init();
- stdout = &uart_stdout;
- banner();
-
- system_init();
- shared_memory_init();
- snes_reset_hi();
- snes_reset_off();
- irq_init();
- boot_startup_rom(50);
-
- globals_init();
- usbInit();
- usb_connect();
-
- while (1) {
- avr_bus_active();
- info_P(PSTR("Activate AVR bus\n"));
- snes_lorom();
- info_P(PSTR("Disable SNES WR\n"));
- snes_wr_disable();
- sei();
- info_P(PSTR("USB poll\n"));
- while (req_state != REQ_STATUS_SNES) {
- usbPoll();
- }
-
-
- shared_memory_write(SHARED_MEM_TX_CMD_TERMINATE, 0);
- #if 0
- shared_memory_scratchpad_region_tx_restore();
- shared_memory_scratchpad_region_rx_restore();
- #endif
-
- info_P(PSTR("-->Switch TO SNES\n"));
- set_rom_mode();
- snes_wr_disable();
- info_P(PSTR("Disable SNES WR\n"));
- snes_bus_active();
- info_P(PSTR("Activate SNES bus\n"));
- irq_stop();
- send_reset();
- info_P(PSTR("Poll USB\n"));
- while ((req_state != REQ_STATUS_AVR)) {
- usbPoll();
- }
- info_P(PSTR("-->Switch TO AVR\n"));
-
- shared_memory_init();
- irq_init();
- boot_startup_rom(500);
-
-
- }
- return 0;
- }
|