for frequency correction testing

Dependencies:   FreescaleIAP SimpleDMA mbed-rtos mbed

Fork of CDMS_CODE by shubham c

Committer:
chaithanyarss
Date:
Thu Dec 15 12:11:21 2016 +0000
Revision:
327:77b281bf5a72
Parent:
315:f9a30c8cbe96
Child:
324:c0a5228cc666
for mahesh

Who changed what in which revision?

UserRevisionLine numberNew contents of line
aniruddhv 52:0bd68655c651 1 #include "FreescaleIAP.h"
aniruddhv 52:0bd68655c651 2
chaithanyarss 261:1e54415b34d3 3 int strt_add_thres = flash_size() - (11*SECTOR_SIZE);
chaithanyarss 261:1e54415b34d3 4 uint32_t flasharray_thres[32] = {0};
chaithanyarss 261:1e54415b34d3 5
ee12b079 259:066a7abd2a5f 6 void FCTN_CDMS_WR_FLASH(uint16_t , uint32_t);
chaithanyarss 257:7d404e9dc9e2 7 int strt_add = flash_size() - (2*SECTOR_SIZE);
chaithanyarss 257:7d404e9dc9e2 8 uint32_t flasharray[32]; //256+(3*1024)
chaithanyarss 257:7d404e9dc9e2 9 uint32_t INITIAL_FLASH[32];
chaithanyarss 315:f9a30c8cbe96 10
chaithanyarss 257:7d404e9dc9e2 11 /*corrected*/
chaithanyarss 257:7d404e9dc9e2 12 int *nativeflash = (int*)strt_add;
chaithanyarss 257:7d404e9dc9e2 13
chaithanyarss 257:7d404e9dc9e2 14 void FLASH_INI()
chaithanyarss 257:7d404e9dc9e2 15 {
chaithanyarss 315:f9a30c8cbe96 16 INITIAL_FLASH[16] = 8000;
chaithanyarss 257:7d404e9dc9e2 17 uint32_t read[32];
chaithanyarss 257:7d404e9dc9e2 18 for(int i=0;i<32;i++)
chaithanyarss 315:f9a30c8cbe96 19 {
chaithanyarss 315:f9a30c8cbe96 20 read[i] = nativeflash[i];
chaithanyarss 315:f9a30c8cbe96 21 }
chaithanyarss 257:7d404e9dc9e2 22
chaithanyarss 257:7d404e9dc9e2 23 if(read[0] == -1)
chaithanyarss 315:f9a30c8cbe96 24 {
chaithanyarss 257:7d404e9dc9e2 25 for(int j=0;j<32;j++)
chaithanyarss 315:f9a30c8cbe96 26 {
chaithanyarss 315:f9a30c8cbe96 27 FCTN_CDMS_WR_FLASH(j,INITIAL_FLASH[j]);
chaithanyarss 315:f9a30c8cbe96 28 }
chaithanyarss 315:f9a30c8cbe96 29 }
chaithanyarss 257:7d404e9dc9e2 30 else
chaithanyarss 315:f9a30c8cbe96 31 {
chaithanyarss 257:7d404e9dc9e2 32 for(int j=0;j<32;j++)
chaithanyarss 315:f9a30c8cbe96 33 {
chaithanyarss 315:f9a30c8cbe96 34 read[j] = nativeflash[j];
chaithanyarss 257:7d404e9dc9e2 35 }
chaithanyarss 315:f9a30c8cbe96 36 }
chaithanyarss 315:f9a30c8cbe96 37 EPS_V_A_EN_STATUS = read[0];
chaithanyarss 315:f9a30c8cbe96 38 BAE_STATUS = read[1];
chaithanyarss 315:f9a30c8cbe96 39 SD_STATUS = read[2];
chaithanyarss 315:f9a30c8cbe96 40 PL_STATUS = read[3];
chaithanyarss 315:f9a30c8cbe96 41 PL_EPS_LATCH_SW_EN = read[4];
chaithanyarss 315:f9a30c8cbe96 42 RTC_INIT_STATUS = read[5];
chaithanyarss 315:f9a30c8cbe96 43 CDMS_RTC_DISABLE = read[6];
chaithanyarss 315:f9a30c8cbe96 44 CDMS_RESET_COUNTER = read[7];
chaithanyarss 315:f9a30c8cbe96 45 TIME_LATEST_CDSMS_RESET = read[8];
chaithanyarss 315:f9a30c8cbe96 46 COM_TC_BYTES_LIMIT = read[9];
chaithanyarss 315:f9a30c8cbe96 47 COM_RX_CURRENT_MAX = read[10];
chaithanyarss 315:f9a30c8cbe96 48 COM_RX_DISABLE_TIMEOUT = read[11];
chaithanyarss 315:f9a30c8cbe96 49 COM_PA_TMP_HIGH = read[12];
chaithanyarss 315:f9a30c8cbe96 50 COM_PA_RECOVERY_TIMEOUT = read[13];
chaithanyarss 315:f9a30c8cbe96 51 COM_SESSION_TIMEOUT = read[14];
chaithanyarss 315:f9a30c8cbe96 52 COM_RSSI_MIN = read[15];
chaithanyarss 315:f9a30c8cbe96 53 SD_LIB_BLK_CURRENT = read[16];
chaithanyarss 257:7d404e9dc9e2 54 }
aniruddhv 52:0bd68655c651 55
aniruddhv 52:0bd68655c651 56 /*Writing to the Flash*/
chaithanyarss 257:7d404e9dc9e2 57 void FCTN_CDMS_WR_FLASH(uint16_t j,uint32_t datablock) //j-position to write address ; fdata - flash data to be written
aniruddhv 52:0bd68655c651 58 {
chaithanyarss 261:1e54415b34d3 59 for(int i=0;i<17;i++)
aniruddhv 52:0bd68655c651 60 {
aniruddhv 52:0bd68655c651 61 flasharray[i]=nativeflash[i];
aniruddhv 52:0bd68655c651 62 }
chaithanyarss 257:7d404e9dc9e2 63 flasharray[j]=datablock;
aniruddhv 52:0bd68655c651 64 erase_sector(strt_add);
chaithanyarss 257:7d404e9dc9e2 65 program_flash(strt_add, (char*)flasharray,32);
aniruddhv 52:0bd68655c651 66 }
aniruddhv 52:0bd68655c651 67 /*End*/
aniruddhv 52:0bd68655c651 68
chaithanyarss 257:7d404e9dc9e2 69 /*===================================================MMS Functions=================================================*/
chaithanyarss 261:1e54415b34d3 70
chaithanyarss 261:1e54415b34d3 71 void FCTN_CDMS_WR_S_FLASH(uint16_t mid,uint32_t datablock);
chaithanyarss 261:1e54415b34d3 72
chaithanyarss 261:1e54415b34d3 73 void FCTN_CDMS_WR_S_FLASH(uint16_t mid,uint32_t datablock)
chaithanyarss 261:1e54415b34d3 74 {
chaithanyarss 261:1e54415b34d3 75 if(mid == 0x0100)
chaithanyarss 261:1e54415b34d3 76 {
chaithanyarss 261:1e54415b34d3 77 FCTN_CDMS_WR_FLASH(11,(datablock>>16) & 0x000000FF);
chaithanyarss 261:1e54415b34d3 78 FCTN_CDMS_WR_FLASH(13,(datablock>>8) & 0x000000FF);
chaithanyarss 261:1e54415b34d3 79 FCTN_CDMS_WR_FLASH(14,datablock & 0x000000FF);
chaithanyarss 261:1e54415b34d3 80 }
chaithanyarss 261:1e54415b34d3 81 else if(mid == 0x0101)
chaithanyarss 261:1e54415b34d3 82 {
chaithanyarss 261:1e54415b34d3 83 FCTN_CDMS_WR_FLASH(12,(datablock>>16) & 0x000000FF);
chaithanyarss 261:1e54415b34d3 84 FCTN_CDMS_WR_FLASH(10,(datablock>>8) & 0x000000FF);
chaithanyarss 261:1e54415b34d3 85 FCTN_CDMS_WR_FLASH(15,datablock & 0x000000FF);
chaithanyarss 261:1e54415b34d3 86 }
chaithanyarss 261:1e54415b34d3 87 else if(mid == 0x0102)
chaithanyarss 261:1e54415b34d3 88 {
chaithanyarss 261:1e54415b34d3 89 FCTN_CDMS_WR_FLASH(9,datablock & 0x0000FFFF);
chaithanyarss 261:1e54415b34d3 90 }
chaithanyarss 261:1e54415b34d3 91 else if(mid == 0x0103)
chaithanyarss 261:1e54415b34d3 92 {
chaithanyarss 261:1e54415b34d3 93 FCTN_CDMS_WR_FLASH(6,datablock & 0x00000001);
chaithanyarss 261:1e54415b34d3 94 }
chaithanyarss 261:1e54415b34d3 95 }