123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121 |
- /*
- * =====================================================================================
- *
- * ________ .__ __ ________ ____ ________
- * \_____ \ __ __|__| ____ | | __\______ \ _______ _/_ |/ _____/
- * / / \ \| | \ |/ ___\| |/ / | | \_/ __ \ \/ /| / __ \
- * / \_/. \ | / \ \___| < | ` \ ___/\ / | \ |__\ \
- * \_____\ \_/____/|__|\___ >__|_ \/_______ /\___ >\_/ |___|\_____ /
- * \__> \/ \/ \/ \/ \/
- *
- * www.optixx.org
- *
- *
- * Version: 1.0
- * Created: 07/21/2009 03:32:16 PM
- * Author: david@optixx.org
- *
- * =====================================================================================
- */
- #include <stdlib.h>
- #include <stdint.h>
- #include "crc.h"
- #include "uart.h"
- #include "config.h"
- #include "sram.h"
- #include "debug.h"
- extern FILE uart_stdout;
- 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;
- }
- uint16_t crc_check_bulk_memory(uint32_t bottom_addr, uint32_t top_addr, uint32_t bank_size)
- {
- uint16_t crc = 0;
- uint32_t addr = 0;
- uint8_t req_bank = 0;
- sram_bulk_read_start(bottom_addr);
-
- for (addr = bottom_addr; addr < top_addr; addr++) {
- if (addr && addr % bank_size == 0) {
- debug(DEBUG_CRC,"crc_check_bulk_memory: bank=0x%02x addr=0x%08lx crc=0x%04x\n",
- req_bank,addr,crc);
- req_bank++;
- crc = 0;
- }
- crc = crc_xmodem_update(crc, sram_bulk_read());
- sram_bulk_read_next();
- }
- if (addr % 0x8000 == 0)
- debug(DEBUG_CRC,"crc_check_bulk_memory: bank=0x%02x addr=0x%08lx crc=0x%04x\n",
- req_bank,addr,crc);
- sram_bulk_read_end();
- return crc;
- }
- void crc_check_memory(uint32_t bottom_addr,uint32_t top_addr,uint32_t bank_size,uint8_t *buffer)
- {
- uint16_t crc = 0;
- uint32_t addr;
- uint8_t req_bank = 0;
- for (addr = bottom_addr; addr < top_addr; addr += TRANSFER_BUFFER_SIZE) {
- if (addr && addr % bank_size == 0) {
- debug(DEBUG_CRC,"crc_check_memory: bank=0x%02x addr=0x%08lx crc=0x%04x\n",
- req_bank,addr,crc);
- req_bank++;
- crc = 0;
- }
- sram_read_buffer(addr, buffer, TRANSFER_BUFFER_SIZE);
- crc = do_crc_update(crc, buffer, TRANSFER_BUFFER_SIZE);
- }
- }
- uint16_t crc_check_memory_range(uint32_t start_addr, uint32_t size,uint8_t *buffer)
- {
- uint16_t crc = 0;
- uint32_t addr;
- for (addr = start_addr; addr < start_addr + size; addr += TRANSFER_BUFFER_SIZE) {
- sram_read_buffer(addr, buffer, TRANSFER_BUFFER_SIZE);
- crc = do_crc_update(crc, buffer, TRANSFER_BUFFER_SIZE);
- }
- return crc;
- }
|