1 files changed, 62 insertions, 13 deletions

diff --git a/main.c b/main.c
index b3842d3..7310e0f 100644
--- a/main.c
+++ b/main.c
@@ -31,7 +31,9 @@
 static void InitPorts(void);
 static void GlobalInit(void);
 
+volatile u16 TAVector;
 volatile u16 Timer1;
+volatile u16 Timer2;
 volatile u16 SW1State;
 volatile u16 SW2State;
 
@@ -54,20 +56,25 @@ volatile u8 bVCC3 = true;
 
 #endif
 
-#define STOP          10
-#define WAIT_START    20
-#define WAIT_ATX_OK   30
-#define WAIT_V1P0     40
-#define WAIT_V1P2     50
-#define WAIT_V1P8     60
-#define WAIT_RSMRST   70
-#define CK410_VTT_GD  80
-#define CPU_RUN       90
-#define WAIT_STOP     100
+#define STOP             10
+#define WAIT_START       20
+#define WAIT_ATX_OK      30
+#define WAIT_V1P0        40
+#define WAIT_V1P2        50
+#define WAIT_V1P8        60
+#define WAIT_RSMRST      70
+#define CK410_VTT_GD     80
+#define STATE_SYS_PWR_OK 90
+#define CPU_RUN          100
+#define WAIT_STOP        110
+
+#define RST_STATE        10
+#define ON_STATE         20
+#define RST_WAIT         30
 
 int main(void)
 {
-  u16 state;
+  u16 state, resetState;
 
   WDTCTL = WDTPW + WDTHOLD; // Stop watchdog timer to prevent time out reset
 
@@ -79,7 +86,33 @@ int main(void)
   __enable_interrupt();
 
   state = WAIT_START;
+  resetState = ON_STATE;
   while (1) {
+    
+     switch (resetState) {
+     case ON_STATE:
+       if (SW2State > 300) {
+         resetState = RST_STATE;
+       }
+       break;
+       
+     case RST_STATE:
+       SetBit(P2DIR, IMCH_RSMRST_N);
+       ClrBit(P2OUT, IMCH_RSMRST_N);
+       Timer2 = 100;
+       resetState = RST_WAIT;
+       break;
+     
+     case RST_WAIT:
+       if (Timer2 == 0) {
+          ClrBit(P2DIR, IMCH_RSMRST_N);
+          SetBit(P2OUT, IMCH_RSMRST_N);
+          if (SW2State == 0)
+            resetState = ON_STATE;
+       }
+       break;
+     }
+     
     switch (state) {
     case WAIT_START:
       if (SW1State > 30)
@@ -97,6 +130,9 @@ int main(void)
       if (SW1State || TENSION_EXPIRED)
         state = STOP;
       if ((P4IN & ATX_PWROK) && TENSION_WAIT(bV2P5 && bVCC3)) {
+        SetBit(P2DIR, SYS_RESET_N); //modif jmo 25072012
+        ClrBit(P2OUT, SYS_RESET_N); //modif jmo 25072012
+
         ClrBit(P1OUT, V1P2_CORE_EN_N);
         Timer1 = 30;
         state = WAIT_V1P2;
@@ -148,8 +184,16 @@ int main(void)
       if (Timer1 == 0) {
         SetBit(P2DIR, CK410_PWR_GD_N);
         ClrBit(P2OUT, CK410_PWR_GD_N);
-        Timer1 = 300;
-        state = CPU_RUN;
+        Timer1 = 110;
+        state = STATE_SYS_PWR_OK;
+      }
+      break;
+    
+    case STATE_SYS_PWR_OK:
+      if (Timer1 == 0) {
+         SetBit(P3OUT, SYS_PWR_OK);
+         Timer1 = 10;
+         state = CPU_RUN;
       }
       break;
 
@@ -215,6 +259,11 @@ __interrupt void Timer_A(void)
 
   if (Timer1)
     Timer1--;
+
+  if (Timer2)
+    Timer2--;
+  
+  TAVector = TAIV;
 }
 
 static void InitPorts(void)