X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Ffwflash.c;h=85a64fa8e95458097e129742d509fcfeca1d8e3c;hp=8b89941d247a1c799d918cfe63c666673ea13c37;hb=3e0847553a5d514589116f8cf933d454a0db491c;hpb=6c971d9882182e2760171231cec0317d539eb979 diff --git a/betty/fwflash.c b/betty/fwflash.c index 8b89941..85a64fa 100644 --- a/betty/fwflash.c +++ b/betty/fwflash.c @@ -22,17 +22,21 @@ #define BANK2 0x82000000 #define BANK_SIZE 0x00100000 #define BOOTLOADER 0x7fffe000 -#define BL_SIZE 0x00000800 +#define BL_SIZE 0x00002000 /* flash cmd addresses - flash[0-18] <--> arm[1-19]*/ -#define B0F555 (*((volatile unsigned long *)(BANK0|0xaaa))) // 0x555 -#define B0F2AA (*((volatile unsigned long *)(BANK0|0x554))) // 0x2aa -#define B2F555 (*((volatile unsigned long *)(BANK2|0xaaa))) // 0x555 -#define B2F2AA (*((volatile unsigned long *)(BANK2|0x554))) // 0x2aa +#define B0F555 (*((volatile unsigned short *)(BANK0|0xaaa))) // 0x555 +#define B0F2AA (*((volatile unsigned short *)(BANK0|0x554))) // 0x2aa +#define B0F (*((volatile unsigned short *)(BANK0))) +#define B2F555 (*((volatile unsigned short *)(BANK2|0xaaa))) // 0x555 +#define B2F2AA (*((volatile unsigned short *)(BANK2|0x554))) // 0x2aa +#define B2F (*((volatile unsigned short *)(BANK2))) /* commands */ #define CMD_READ 'R' +#define CMD_WRITE 'W' #define CMD_CHIP_ERASE 'E' +#define CMD_SECTOR_ERASE 'S' #define CMD_CHIP_ID 'I' #define BUFSIZE 16 @@ -45,21 +49,67 @@ typedef unsigned char u8; typedef unsigned short u16; typedef unsigned int u32; +/* + * sector addresses + */ + +unsigned long sector_address[19]={ + 0x00000,0x02000,0x03000,0x04000,0x08000, + 0x10000,0x18000, + 0x20000,0x28000, + 0x30000,0x38000, + 0x40000,0x48000, + 0x50000,0x58000, + 0x60000,0x68000, + 0x70000,0x78000 +}; + /* * functions */ +void uart0_send_byte(u8 send); + void mmap_init(u8 memtype) { MEMMAP=memtype; } +void pll_init(void) { + + /* configuration */ + PLLCFG=0x42; // multiplier = 3 (for cclk), dividor = 4 (for f_cco) + PLLCON=0x03; // enable and set as clk source for the lpc + /* feed sequence */ + PLLFEED=0xaa; + PLLFEED=0x55; + /* wait for lock */ + while(!(PLLSTAT&(1<<10))) + continue; +} + +void ext_mem_bank_init(void) { + + BCFG0=0x10000420; // flash 1 + BCFG1=0x00000c42; // lcd + BCFG2=0x10000420; // flash 2 +} + +void pin_select_init() { + + /* + * a[19:2] -> address lines + */ + + PINSEL2=0x0d6041d4; +} + void uart0_init(void) { PINSEL0=0x05; // pin select -> tx, rx UART0_FCR=0x07; // enable fifo UART0_LCR=0x83; // set dlab + word length - UART0_DLL=0x10; // br: 9600 @ 10/4 mhz + UART0_DLL=0x04; // br: 38400 @ 10/4 mhz UART0_DLM=0x00; UART0_LCR=0x03; // unset dlab } @@ -97,7 +147,7 @@ void uart0_send_buf16(u16 *buf,int len) { i=0; - for(i=0;i18) + return; + a18_12=sector_address[sector]<<1; + + if((flash!='0')&(flash!='2')) + return; + + switch(flash) { + case '0': + base=0x80000000; + B0F555=0xaa; + B0F2AA=0x55; + B0F555=0x80; + B0F555=0xaa; + B0F2AA=0x55; + *((volatile u16 *)(base|a18_12))=0x30; + break; + case '2': + base=0x82000000; + B2F555=0xaa; + B2F2AA=0x55; + B2F555=0x80; + B2F555=0xaa; + B2F2AA=0x55; + *((volatile u16 *)(base|a18_12))=0x30; + break; + default: + return; + } + + return; +} + +void flash_chip_erase(u8 bank) { + + u8 status; + + if((bank!='0')&(bank!='2')) + return; + + if(bank=='0') { + B0F555=0xaa; + B0F2AA=0x55; + B0F555=0x80; + B0F555=0xaa; + B0F2AA=0x55; + B0F555=0x10; + } + else { + B2F555=0xaa; + B2F2AA=0x55; + B2F555=0x80; + B2F555=0xaa; + B2F2AA=0x55; + B2F555=0x10; + } + + while(1) { + if(bank=='0') + status=B0F; + else + status=B2F; + + if(status&0x80) { + /* send an ack */ + uart0_send_byte(status); + break; + } + } +} + +void unlock_bypass(u8 bank) { + + if((bank!='0')&(bank!='2')) + return; + + if(bank=='0') { + B0F555=0xaa; + B0F2AA=0x55; + B0F555=0x20; + } + else { + B2F555=0xaa; + B2F2AA=0x55; + B2F555=0x20; + } +} + +void unlock_bypass_reset(u8 bank) { + + if((bank!='0')&(bank!='2')) + return; + + if(bank=='0') { + B0F=0x90; + B0F=0x00; + } + else { + B2F=0x90; + B2F=0x00; + } +} + +int flash_write(u32 addr,u16 data) { + + u16 check; + + if(data==0xffff) + return 0; + + *((unsigned volatile short *)addr)=0xa0; + *((unsigned volatile short *)addr)=data; + while(1) { + check=*((unsigned short *)addr); + if((data&0x80)==(check&0x80)) + break; + } + if(data!=check) + return -1; + + return 0; +} + +int receive_data_and_write_to_flash(u32 addr,u32 datalen) { + + u8 bank; + u32 i,ret; + u16 data; + u8 cksm; + u8 byte; + + /* which bank to program */ + if(addr<0x82000000) + bank='0'; + else + bank='2'; + + /* unlock bypass */ + unlock_bypass(bank); + + /* receive and write data */ + cksm=0; + ret=0; + for(i=0;i=BANK0)&(addr+datalen=BANK0)&(addr+datalen<=BANK0+BANK_SIZE)) uart0_send_buf16((u16 *)addr,datalen); - if((addr>=BANK2)&(addr+datalen=BANK2)&(addr+datalen<=BANK2+BANK_SIZE)) uart0_send_buf16((u16 *)addr,datalen); - if((addr>=BOOTLOADER)&(addr+datalen=BOOTLOADER)&(addr+datalen<=BOOTLOADER+BL_SIZE)) uart0_send_buf32((u32 *)addr,datalen); break; + case CMD_WRITE: + /* data length */ + datalen=buf[0]<<24|buf[1]<<16|buf[2]<<8|buf[3]; + /* check addr and data len */ + if(((addr>=BANK0)&(addr+datalen<=BANK0+BANK_SIZE))| + ((addr>=BANK2)&(addr+datalen<=BANK2+BANK_SIZE))) + receive_data_and_write_to_flash(addr,datalen); + break; case CMD_CHIP_ERASE: - if(buf[0]=='0') { - B0F555=0xaa; - B0F2AA=0x55; - B0F555=0x80; - B0F555=0xaa; - B0F2AA=0x55; - B0F555=0x10; - } - else if(buf[0]=='2') { - B2F555=0xaa; - B2F2AA=0x55; - B2F555=0x80; - B2F555=0xaa; - B2F2AA=0x55; - B2F555=0x10; - } - uart0_send_byte(buf[0]); + flash_chip_erase(buf[0]); break; case CMD_CHIP_ID: if(buf[0]=='0') { @@ -249,16 +487,19 @@ int main(void) { B0F2AA=0x55; B0F555=0x90; data=*((u16 *)BANK0); + uart0_send_buf16(&data,2); data=*((u16 *)(BANK0|0x200)); + uart0_send_buf16(&data,2); } else if(buf[0]=='2') { B2F555=0xaa; B2F2AA=0x55; B2F555=0x90; data=*((u16 *)BANK2); + uart0_send_buf16(&data,2); data=*((u16 *)(BANK2|0x200)); + uart0_send_buf16(&data,2); } - uart0_send_buf16(&data,2); break; default: break;