void Commands(char * buf)
{
//PORTA ^= (1<<PA7);
at45_write( (uint16_t)(buf[0]|(buf[1]<<8)), &buf[2]);
at45_read( (uint16_t)(buf[0]|(buf[1]<<8)), 1);
//if(buf[0]==0x77 && buf[1]==0x88)
CommandAnswer(320);
}
// main function
extern void main(void) {
unsigned char flag, numb_pages;
unsigned i, write_size, read_size, temp_six_vector, six_vector, errors;
// calculate temp six vector
numb_pages = 0;
i = AT45_PAGE_NUMB;
while(i >>= 1)
numb_pages++;
temp_six_vector = (numb_pages << 13) + (AT45_PAGE_SIZE << 17);
// setup SYS interrupt
aic_configure_irq(AT91C_ID_SYS, AT91C_AIC_PRIOR_LOWEST,
AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, aic_asm_sys_handler);
// enable SYS interrupt
aic_enable_irq(AT91C_ID_SYS);
// setup rtt - 1Hz clock
AT91C_BASE_ST->ST_RTMR = 0x4000;
upoint_r = pt_mem_area, upoint_w = (pt_mem_area + AT45DB642D_SIZE);
put_string("Init AT45DB642D and get device information\n");
if (!at45_init())
put_string("Device inited and ready\n");
else
put_string("Error!\n");
while (flag != 'q') {
put_string("\nload(l), write(w), quit(q), erase(e): ");
flag = get_char();
switch(flag) {
// loading data to sdram
case 'l':
put_string("Please trasfer the boot file:\n");
transfer_size = 0;
// setup rtt interrupt flag
AT91C_BASE_ST->ST_IER = AT91C_ST_RTTINC;
// enable RXRDY interrupt in DBGU
AT91C_BASE_DBGU->DBGU_IER |= AT91C_US_RXRDY;
while(!transfer_size);
delay(100000);
if (transfer_size > 0) {
put_string("Transfer complete\n");
util_printf("Byte's sended: %x\n", transfer_size);
}
break;
// writing bytes from data flash
case 'w':
if (transfer_size == 0) {
put_string("Please transfer begin, write end\n");
break;
}
else if (transfer_size > (AT45DB642D_SIZE)) {
put_string("Trasfer is larger than flash size\n");
break;
}
else {
if ((unsigned)transfer_size % AT45_PAGE_SIZE)
write_size = ((unsigned)transfer_size / AT45_PAGE_SIZE + 1) * AT45_PAGE_SIZE;
else
write_size = transfer_size;
put_string("\nModification of Arm Interrupt Vector #6\n");
six_vector = (write_size / 512) + 1 + temp_six_vector;
util_printf("Six vector is 0x%x\n", six_vector);
upoint_w[5] = six_vector;
util_printf("Write 0x%x bytes\n", write_size);
array_view(upoint_w, write_size);
if (!at45_write(0x0, upoint_w, write_size))
put_string("Write success\n");
else
put_string("Error!\n");
if (!at45_read(0x0, upoint_r, write_size)) {
put_string("Read success\nStart verification\n");
six_vector = upoint_r[5];
if ((six_vector & 0xfffff000) - temp_six_vector) {
util_printf("Six vector is damage, current 0x%x, original 0x%x\n",
six_vector, temp_six_vector);
break;
}
else {
put_string("Six vector is correct\nStart code verification\n");
}
for (i = 0; i < write_size / 4; i++) {
if (upoint_r[i] != upoint_w[i]) {
errors++;
util_printf("Addr - %x, write - %x, read - %x\n", i, upoint_w[i], upoint_r[i]);
}
}
put_string("Stop code verification\n");
if (errors)
put_string("Verification failed!\n");
else
put_string("Verification success!\n");
}
}
break;
// erase first page
case 'e':
if (!at45_read(0x0, upoint_r, 0x20)) {
six_vector = upoint_r[5];
read_size = (six_vector & 0xff) * 512;
for (i = 0; i <= read_size; i += AT45_PAGE_SIZE) {
if (!at45_page_erase(i))
put_string("Erase success\n");
else
put_string("Error!\n");
}
}
break;
// exit of loop
case 'q':
put_string("\nQuit & Reset\n");
AT91C_BASE_ST->ST_WDMR = 256 | AT91C_ST_RSTEN;
AT91C_BASE_ST->ST_CR = AT91C_ST_WDRST;
break;
// undef
default:
put_string("\nUndefined command\n");
break;
}
}
// Infinity loop
while (1) {
// Disable pck for idle cpu mode
AT91C_BASE_PMC->PMC_SCDR = AT91C_PMC_PCK;
}
}