int sfcx_DMAread_block(unsigned char *data, unsigned char *meta, int raw, unsigned long rawlength, unsigned long length)
{
int status;
sfcx_writereg(SFCX_STATUS, sfcx_readreg(SFCX_STATUS));
sfcx_writereg(SFCX_CONFIG, (sfcx_readreg(SFCX_CONFIG)|CONFIG_DMA_LEN));
// Set flash address (logical)
//address &= 0x3fffe00; // Align to page
sfcx_writereg(SFCX_ADDRESS, 0);
// Set the target address for data
sfcx_writereg(SFCX_DPHYSADDR,data-BASE_ADDRESS);
// Set the target address for meta
sfcx_writereg(SFCX_MPHYSADDR,meta-BASE_ADDRESS);
// Command the read
// Either a logical read (0x200 bytes, no meta data)
// or a Physical read (0x210 bytes with meta data)
sfcx_writereg(SFCX_COMMAND, raw ? DMA_PHY_TO_RAM : DMA_LOG_TO_RAM);
// Wait Busy
while ((status = sfcx_readreg(SFCX_STATUS)) & STATUS_BUSY);
if (!SFCX_SUCCESS(status))
{
if (status & STATUS_BB_ER)
printf(" ! SFCX: Bad block found at %08X\n");
else if (status & STATUS_ECC_ER)
// printf(" ! SFCX: (Corrected) ECC error at address %08X: %08X\n", address, status);
status = status;
else if (!raw && (status & STATUS_ILL_LOG))
printf(" ! SFCX: Illegal logical block at %08X (status: %08X)\n", status);
else
printf(" ! SFCX: Unknown error at address %08X: %08X. Please worry.\n", status);
}
// Set internal page buffer pointer to 0
sfcx_writereg(SFCX_ADDRESS, 0);
int i;
//int page_sz = raw ? sfc.page_sz_phys : sfc.page_sz;
for (i = 0; i < length; i += 4)
{
// Byteswap the data
*(int*)(&data[i]) = __builtin_bswap32(read32(&data[i]));
}
for (i = 0; i < (rawlength - length); i += 4) // sfc.block_sz_phys - sfc.block_sz == META SIZE
{
// Byteswap the data
*(int*)(&meta[i]) = __builtin_bswap32(read32(&meta[i]));
}
return status;
}
int flash_from_file(const char *filename, int raw) {
int i, logic_pos, status = 0x200;
unsigned char *block, *block_flash, *bad_block;
float pct = 0.f;
FILE *f = fopen(filename, "rb");
if (!f) {
printf("\nError: Failed to open file: %s\n", filename);
return -1;
}
printf("\nFlashing from %s...\n", filename);
printf("0x%x block's to write...\n", sfc.size_blocks);
if (!f)
return -1;
if (raw == -1) /* auto */ {
fseek(f, 0, SEEK_END);
raw = detect_read_write_modus(ftell(f));
if (raw == -1)
return -1;
fseek(f, 0, SEEK_SET);
}
block = (unsigned char*) malloc(sfc.block_sz_phys);
block_flash = (unsigned char*) malloc(sfc.block_sz_phys);
bad_block = (unsigned char*) malloc(sfc.block_sz_phys);
unsigned nand_size = sfc.size_bytes;
// Dump only 64mb on big nand
if ((nand_size == NAND_SIZE_512MB) | (nand_size == NAND_SIZE_256MB)) {
nand_size = NAND_SIZE_64MB;
}
for (i = 0; i < nand_size; i += sfc.block_sz) {
memset(block, 0xFF, sizeof (block));
if (!fread(block, 1, sfc.page_sz_phys * sfc.pages_in_block, f)) {
printf("Error reading ...\r\n");
return i;
}
pct = ((float) i / (float) (nand_size));
App.SetProgressValue(pct);
// printf("Writing block: 0x%x of 0x%x (%iMB/%iMB)\r\n", sfcx_address_to_block(i) +1 , sfc.size_blocks , (i + sfc.block_sz) >> 20, nand_size >> 20);
//Check for bad block
sfcx_writereg(SFCX_STATUS, sfcx_readreg(SFCX_STATUS));
sfcx_writereg(SFCX_ADDRESS, i);
sfcx_writereg(SFCX_COMMAND, raw ? PHY_PAGE_TO_BUF : LOG_PAGE_TO_BUF);
// Wait Busy
while ((status = sfcx_readreg(SFCX_STATUS)) & 1);
if ((!raw)) {
logic_pos = sfcx_readreg(SFCX_PHYSICAL);
if (!(logic_pos & 0x04000000)) /* shouldn't happen, unless the existing image is broken. just assume the block is okay. */ {
printf("Error: Uh, oh, don't know. Reading @ block %08x failed. logic_pos: %i\r\n", i, sfcx_address_to_block(logic_pos));
logic_pos = i;
}
logic_pos &= 0x3fffe00;
if (logic_pos != i) {
printf("Relocating/moving bad block from position 0x%x to 0x%x\r\n", sfcx_address_to_block(i), sfcx_address_to_block(logic_pos));
}
} else if (status & 0x40) //Bad Block Management
{
printf("Bad block ...\r\n");
#if 0
logic_pos = sfc.last_bad_block_pos * sfc.block_sz;
sfc.last_bad_block_pos--;
sfcx_set_blocknumber(block, sfcx_address_to_block(i));
sfcx_calcecc((int*) block);
if (logic_pos != i) {
printf("Relocating/moving bad block from position 0x%x to 0x%x\n", sfcx_address_to_block(i), sfcx_address_to_block(logic_pos));
}
#endif
} else {
logic_pos = i;
}
#if 0
if (sfc.last_bad_block_pos == sfcx_address_to_block(i)) {
//We reach the the last entry bad block in reserved area
printf("\nWriting only to last entry bad block in the reserved area.");
break;
}
#endif
//Erase block in Nand
sfcx_erase_block(logic_pos);
//Write block to Nand
sfcx_write_block(block, logic_pos);
}
printf("\nWrite done\n");
fclose(f);
free(block);
free(block_flash);
free(bad_block);
if (App.Warning("Flashing is complete, reboot the console?") == TRUE) {
xenon_smc_power_reboot();
}
return 0;
}
