#include "mb91465k.h"
-#include "vectors.h"
-#include "rlt.h"
#include "flash.h"
+#define BUFSIZE 0x20
+#define cleardata() memset(data,0,BUFSIZE)
+
+static void increaseled(void)
+{
+ PDR14 = ~(((~PDR14)+1)%256);
+}
+
+static unsigned char recvbyte(void)
+{
+ return Getch4();
+}
+
+static unsigned short recvword(void)
+{
+ static unsigned char b1, b2;
+ static unsigned short ret;
+ b1 = recvbyte();
+ b2 = recvbyte();
+ ret = (unsigned short)(b2 << 8) | b1;
+ return ret;
+}
+
+static unsigned int recvdword(void)
+{
+ static unsigned char b1, b2, b3, b4;
+ static unsigned int ret;
+ b1 = recvbyte();
+ b2 = recvbyte();
+ b3 = recvbyte();
+ b4 = recvbyte();
+ ret = ((unsigned int) (b4 << 24)) | ((unsigned int) (b3 << 16)) | ((unsigned int) (b2 << 8)) |(unsigned int)b1;
+ return ret;
+}
+
+static void halt(void)
+{
+ while(1) {
+ HWWD_CL = 0;
+ }
+}
+
+static void panic(void)
+{
+ PDR14 = 0x22;
+ halt();
+}
+
void main(void)
{
- unsigned char error = 0;
- unsigned char global_error = 0;
- unsigned int i, baseaddr;
+ unsigned int address;
+ unsigned short i, size, next;
+ unsigned char running = 1, data[BUFSIZE] = {0};
- /* Enable Clock Monitor */
- CSCFG_MONCKI = 1;
- CMCFG = 0x0D;
-
- __EI(); /* enable interrupts */
- __set_il(31); /* allow all levels */
- InitIrqLevels(); /* init interrupts */
-
- PORTEN = 0x3; /* enable I/O Ports */
- /* This feature is not supported by MB91V460A */
- /* For all other devices the I/O Ports must be enabled*/
-
- /* Enable LEDs */
+ PORTEN = 0x3; /* enable I/O Ports */
+
+ /*Enable LEDs*/
DDR14 = 0xFF;
PDR14 = 0xff;
- /* Initialize Reload Timer Channel 0 */
- RLT_InitializeTimer(0, RLT_RUMMODE_RELOAD, RLT_CLOCKMODE_DIV32, RLT_TRIGGER_SOFTWARE, RLT_OUTOUTMODE_HIGHLEVEL);
- RLT_SetReloadValue(0,0xfffe);
- RLT_TriggerTimer(0);
- RLT_EnableInterrupt(0, 1);
-
- /* Initialize UART4 */
+ /*Initialize UART4*/
InitUart4();
- /* Output Welcome Message */
- Puts4(" \n\n");
- Puts4("\n\n********** Welcome to FUJITSU FLASH Programming Demo **********\n");
+ while(running) {
+ cleardata();
+ increaseled();
+ switch(recvbyte()) {
+ case 0x15: //chip erase
+ Putch4(0x45);
+ increaseled();
+ if(FLASH_ChipErase() != 1) {
+ panic();
+ }
+ Putch4(0x23);
+ break;
- i = 0;
- baseaddr = 0xf4000;
- for (; i <0x30; i+=4) {
- error = FLASH_SectorErase(baseaddr + i);
- Puts4("\nerased: ");
- Puts4(error == 1 ? "[success] " : "[failed] ");
- Puthex4(baseaddr + i, 6);
- }
+ case 0x12: //erase
+ Putch4(0x11);
+ address = recvdword();
+ increaseled();
- Puts4("Write simpleprog to 0xf4000 ... ");
- error = FLASH_WriteHalfWord(0xf4000,0x9b00);
- error = FLASH_WriteHalfWord(0xf4002,0x0d4e);
- error = FLASH_WriteHalfWord(0xf4004,0xcff1);
- error = FLASH_WriteHalfWord(0xf4006,0x1601);
- error = FLASH_WriteHalfWord(0xf4008,0x9b05);
- error = FLASH_WriteHalfWord(0xf4010,0x04c7);
- error = FLASH_WriteHalfWord(0xf4012,0xc106);
- error = FLASH_WriteHalfWord(0xf4014,0x1656);
- error = FLASH_WriteHalfWord(0xf4016,0xe0fb);
- if( error == 1 )
- {
- Puts4("done.\n");
- }
- else
- {
- global_error = 1;
- Puts4("failed.\n");
- }
-
- i=0;
- Puts4("\nCurrent Content of FLASH at 0xf4000 ... 0xf401F:\n");
- while(i < 0x20)
- {
- Puts4("0x"); Puthex4( *(unsigned char *)(0xf4000 + i), 2); Puts4(" ");
- i++;
- if( (i % 0x10) == 0 ) Puts4("\n");
+ size = recvword();
+ increaseled();
+
+ PDR14 = 0xff;
+ for(i=0; i<(size+4); i+=4) { /* erase */
+ if(FLASH_SectorErase(address + i) != 1) {
+ panic();
+ }
+ increaseled();
+ }
+ Putch4(0x18); //Erasing done.
+ break;
+
+ case 0x13: //receive
+ Putch4(0x37);
+ increaseled();
+
+ address = recvdword();
+ increaseled();
+
+ size = recvword();
+ increaseled();
+
+ PDR14 = 0xff;
+ for(i=0; i<size; i++) { /* get data */
+ increaseled();
+ data[i] = recvbyte();
+ }
+
+ PDR14 = 0xff;
+ for(i=0; i<size; i+=2) { /* flash the data */
+ increaseled();
+ next = (((unsigned short)data[i])<<8) | (unsigned short)data[i+1];
+ if(FLASH_WriteHalfWord(address + i, next) != 1) {
+ panic();
+ }
+ }
+ Putch4(0x28); //Flashing done.
+ break;
+
+ case 0x97: /* exit and restart (let do this by the watchdog!) */
+ while(1) {
+ increaseled();
+ }
+
+ case 0x99: /* exit */
+ running = 0;
+ break;
+ default: break;
+ }
}
- Puts4("\n");
-
- /* Output Ready Meassage */
- if( global_error != 0 )
- {
- Puts4("\n********* FLASH Programming Demo failed **********\n");
+ PDR14 = 0x55; //signal that we finished now!
+ halt();
+
+#if 0
+ i = 0;
+ baseaddr = 0xf4000;
+ for (; i <0x10; i+=4) {
+ (void) FLASH_SectorErase(baseaddr + i);
+ increaseled();
}
- else
- {
- Puts4("\n********* FLASH Programming Demo done **********\n");
+
+ i = 0;
+ baseaddr = 0xf4000;
+ for(; i<9; i++) {
+ increaseled();
+ (void) FLASH_WriteHalfWord(baseaddr + (2*i), toflash[i]);
}
- RLT_EnableInterrupt(0, 0);
-
- while(1)
- {
-
- HWWD_CL = 0;
- }
+#endif
}