w00t, wtf IT WORKS NOW!!!1

[pyfrprog.git] / pkernel / main.c

diff --git a/pkernel/main.c b/pkernel/main.c
index 2a5cae2ed8ec3f30384125955fe10d2fcb7eea8d..89fc2c85f0a415eb04839d99c4a7a0b86e154905 100644 (file)
--- a/pkernel/main.c
+++ b/pkernel/main.c
@@ -1,22 +1,29 @@
 #include "mb91465k.h"
-#include "vectors.h"
-#include "rlt.h"
 #include "flash.h"
 
+#pragma section CODE=IRAM,attr=CODE
+
+void increaseled(void)
+{
+       PDR14 = (PDR14+1)%256;
+       HWWD_CL = 0;
+}
+
 void main(void)
 {
        unsigned char error = 0;
        unsigned char global_error = 0; 
        unsigned int i, baseaddr;
+       unsigned int toflash[] = {0x9b00,
+                                                               0x0d4e,
+                                                               0xcff1,
+                                                               0x1601,
+                                                               0x9b05,
+                                                               0x04c7,
+                                                               0xc106,
+                                                               0x1656,
+                                                               0xe0fb}; //len = 9
        
-       /*      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*/
@@ -25,12 +32,6 @@ void main(void)
        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        */
        InitUart4();
 
@@ -38,6 +39,7 @@ void main(void)
        Puts4(" \n\n");
        Puts4("\n\n********** Welcome to FUJITSU FLASH Programming Demo **********\n");
 
+#if 1
        i = 0;
        baseaddr = 0xf4000;
        for (; i <0x30; i+=4) {
@@ -46,38 +48,30 @@ void main(void)
                Puts4(error == 1 ? "[success] " : "[failed] ");
                Puthex4(baseaddr + i, 6);
        }
-
-       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");
-       }
-               
+#endif
        i=0;
        Puts4("\nCurrent Content of FLASH at 0xf4000 ... 0xf401F:\n");
        while(i < 0x20)
        {
-               Puts4("0x"); Puthex4( *(unsigned char *)(0xf4000 + i), 2); Puts4("  ");
+               Puts4("0x"); Puthex4( *(unsigned char *)(0xf4000 + i), 2); Puts4(" ");
                i++;
                if( (i % 0x10) == 0 ) Puts4("\n");
        }
-       Puts4("\n");
+       Puts4("\n");
+
+
+       i = 0;
+       baseaddr = 0xf4000;
+       for(; i<9; i++) {
+               Puts4("\nwrite: ");
+               error = FLASH_WriteHalfWord(baseaddr + (2*i), toflash[i]);
+               Puts4(error == 1 ? "[sucess] " : "[failed] ");
+               Puts4("0x");
+               Puthex4(toflash[i], 4);
+               Puts4(" @0x");
+               Puthex4(baseaddr + (2*i), 6);
+       }
 
-                               
        /*      Output Ready Meassage   */
        if( global_error != 0 )
        {
@@ -88,8 +82,6 @@ void main(void)
                Puts4("\n********* FLASH Programming Demo done **********\n");
        }
 
-       RLT_EnableInterrupt(0, 0);
-                                       
     while(1)
     {