Diff: FMS_all.h

Revision:

249:1560c64adffb

Parent:

248:407ab7e337cd

--- a/FMS_all.h	Fri Jul 08 12:53:24 2016 +0000
+++ b/FMS_all.h	Fri Jul 08 14:47:00 2016 +0000
@@ -157,14 +157,12 @@
 
 void SW_ON_V_A_EN()
 {
-    TRXY_PWR_CNTRL = 1;
-    TRZ_PWR_CNTRL = 1;
+    V_A_EN = 1;
 }
 
 void SW_OFF_V_A_EN()
 {
-    TRXY_PWR_CNTRL = 0;
-    TRZ_PWR_CNTRL = 0;    
+    V_A_EN = 0;
 }
 
 void RST_SD()
@@ -209,16 +207,16 @@
 
 void SYS_PWR_RESET()  // Have to be decided with EPS team.
 {
-    
+    /*sys_pwr_rst = 0;
+    wait_ms(10);
+    sys_pwr_rst = 1;*/
 }
 
 void EPS_V_A_EN()     // This is a reset function
 {
-    TRXY_PWR_CNTRL = 0;
-    TRZ_PWR_CNTRL = 0;
+    V_A_EN = 0;
     wait_ms(10);
-    TRXY_PWR_CNTRL = 1;
-    TRZ_PWR_CNTRL = 1;
+    V_A_EN = 1;
 }
 
 void EPS_V_C_EN()     // This is a reset function
@@ -279,11 +277,16 @@
 
 /*===================================================MMS Functions=================================================*/
 
-void READ_RAM(uint8_t *);
-void WRITE_TO_FLASH();
-void READ_FLASH();
+void WRITE_TO_FLASH(uint8_t *);
 
-void READ_RAM(uint8_t *RAM)
+void WRITE_TO_FLASH(uint8_t *flash)
 {
-    
-}
\ No newline at end of file
+    uint32_t FLASH[5];
+    FLASH[0] = ((uint32_t)flash[0] << 24) | ((uint32_t)flash[1] << 16) | ((uint32_t)flash[2] << 8) | ((uint32_t)flash[3]); 
+    FLASH[1] = ((uint32_t)flash[4] << 24) | ((uint32_t)flash[5] << 16) | ((uint32_t)flash[6] << 8) | ((uint32_t)flash[7]);
+    FLASH[2] = ((uint32_t)flash[8] << 24) | ((uint32_t)flash[9] << 16) | ((uint32_t)flash[10] << 8) | ((uint32_t)flash[11]);
+    FLASH[3] = ((uint32_t)flash[12] << 24) | ((uint32_t)flash[13] << 16) | ((uint32_t)flash[14] << 8) | ((uint32_t)flash[15]);
+    FLASH[4] = ((uint32_t)flash[16] << 24) | ((uint32_t)flash[17] << 16) | ((uint32_t)flash[18] << 8) | ((uint32_t)flash[19]);
+    erase_sector(strt_add);
+    program_flash(strt_add, (char*)FLASH,160);
+}