working version
Dependencies: mbed mbed-rtos SimpleDMA FreescaleIAP eeprom
Fork of CDMS_CODE_FM_28JAN2017 by
EEPROM.h@357:f3d48d62e00e, 2022-04-03 (annotated)
- Committer:
- samp1234
- Date:
- Sun Apr 03 15:35:53 2022 +0000
- Revision:
- 357:f3d48d62e00e
First commit test
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
samp1234 | 357:f3d48d62e00e | 1 | #ifndef EEPROM_H |
samp1234 | 357:f3d48d62e00e | 2 | #define EEPROM_H |
samp1234 | 357:f3d48d62e00e | 3 | |
samp1234 | 357:f3d48d62e00e | 4 | //#include "pinconfig.h" |
samp1234 | 357:f3d48d62e00e | 5 | //#include "eeprom.h" |
samp1234 | 357:f3d48d62e00e | 6 | //#include "DefinitionsAndGlobals.h" |
samp1234 | 357:f3d48d62e00e | 7 | #define ee_scl PIN86 |
samp1234 | 357:f3d48d62e00e | 8 | #define ee_sda PIN87 |
samp1234 | 357:f3d48d62e00e | 9 | #define check 10 |
samp1234 | 357:f3d48d62e00e | 10 | |
samp1234 | 357:f3d48d62e00e | 11 | //EEPROM e2prom(ee_sda, ee_scl, 0, EEPROM::T24C512); // T24C1024 for 1Mbit EEPROM |
samp1234 | 357:f3d48d62e00e | 12 | EEPROM e2prom(ee_sda, ee_scl, 0x0, EEPROM::T24C512); |
samp1234 | 357:f3d48d62e00e | 13 | |
samp1234 | 357:f3d48d62e00e | 14 | int32_t INITIAL_EEPROM[29] = {1,1,1,80000,1,0,0,0,0,1,1,20,85,20,30,3,24,1,0,0,0,0,0,0,0,0,0,0,0}; |
samp1234 | 357:f3d48d62e00e | 15 | //int32_t INITIAL_EEPROM[32] = {1,0,1,0,1,0,1,0,1,35001,0xff,300,85,20,20,3,0x80000,0,0,0,0,0,0,0,0,0,0,0,0,0,0,0}; |
samp1234 | 357:f3d48d62e00e | 16 | |
samp1234 | 357:f3d48d62e00e | 17 | uint32_t flasharray_thres[32]; |
samp1234 | 357:f3d48d62e00e | 18 | uint32_t flasharray_thres_1[32]; |
samp1234 | 357:f3d48d62e00e | 19 | |
samp1234 | 357:f3d48d62e00e | 20 | void I2C_EEPROM_busreset() |
samp1234 | 357:f3d48d62e00e | 21 | { |
samp1234 | 357:f3d48d62e00e | 22 | gPC.printf("\n\rChecking"); |
samp1234 | 357:f3d48d62e00e | 23 | PORTC->PCR[10] &= 0xfffffffb; //Enabling high slew rates for SDA and SCL lines |
samp1234 | 357:f3d48d62e00e | 24 | PORTC->PCR[11] &= 0xfffffffb; //Enabling high slew rates for SDA and SCL lines |
samp1234 | 357:f3d48d62e00e | 25 | I2C1->C1 &= 0x7f; //Disabling I2C module |
samp1234 | 357:f3d48d62e00e | 26 | SIM->SCGC4 &= 0xffffff7f; //Disabling clock to I2C module |
samp1234 | 357:f3d48d62e00e | 27 | SIM->SCGC4 |= 0x00000080; //Enabling clock to I2C module |
samp1234 | 357:f3d48d62e00e | 28 | I2C1->C1 |= 0x80; //Enabling I2C module |
samp1234 | 357:f3d48d62e00e | 29 | PORTC->PCR[10] |= 0x00000004; //Disabling high slew rates for SDA and SCL lines |
samp1234 | 357:f3d48d62e00e | 30 | PORTC->PCR[11] |= 0x00000004; //Disabling high slew rates for SDA and SCL lines |
samp1234 | 357:f3d48d62e00e | 31 | Thread::wait(1); //Wait for all I2C registers to be updates to their their values |
samp1234 | 357:f3d48d62e00e | 32 | } |
samp1234 | 357:f3d48d62e00e | 33 | |
samp1234 | 357:f3d48d62e00e | 34 | void mcpy(uint32_t *a2,int8_t *a1,int n){ |
samp1234 | 357:f3d48d62e00e | 35 | |
samp1234 | 357:f3d48d62e00e | 36 | *a2=0; |
samp1234 | 357:f3d48d62e00e | 37 | for (int i=0;i<n;i++){ |
samp1234 | 357:f3d48d62e00e | 38 | *(a2) += *(a1+i); |
samp1234 | 357:f3d48d62e00e | 39 | if(i<n-1){ |
samp1234 | 357:f3d48d62e00e | 40 | *(a2)=(*(a2))<<8; |
samp1234 | 357:f3d48d62e00e | 41 | //printf("%d\n",*(a2)); |
samp1234 | 357:f3d48d62e00e | 42 | } |
samp1234 | 357:f3d48d62e00e | 43 | } |
samp1234 | 357:f3d48d62e00e | 44 | |
samp1234 | 357:f3d48d62e00e | 45 | } |
samp1234 | 357:f3d48d62e00e | 46 | |
samp1234 | 357:f3d48d62e00e | 47 | void rmcpy(uint8_t *a1,uint32_t *a2,int n){ |
samp1234 | 357:f3d48d62e00e | 48 | |
samp1234 | 357:f3d48d62e00e | 49 | for (int i=0;i<n;i++){ |
samp1234 | 357:f3d48d62e00e | 50 | *(a1+i) = (*(a2))>>((n*8)-(8*(i+1))); |
samp1234 | 357:f3d48d62e00e | 51 | } |
samp1234 | 357:f3d48d62e00e | 52 | |
samp1234 | 357:f3d48d62e00e | 53 | } |
samp1234 | 357:f3d48d62e00e | 54 | |
samp1234 | 357:f3d48d62e00e | 55 | void WRITE_TO_EEPROM(uint32_t address, int32_t data_block) |
samp1234 | 357:f3d48d62e00e | 56 | { |
samp1234 | 357:f3d48d62e00e | 57 | e2prom.write(address*4+10,data_block); |
samp1234 | 357:f3d48d62e00e | 58 | wait_us(1); |
samp1234 | 357:f3d48d62e00e | 59 | } |
samp1234 | 357:f3d48d62e00e | 60 | |
samp1234 | 357:f3d48d62e00e | 61 | void THRES_WRITE_TO_EEPROM(uint16_t mid, uint32_t* thres_data,int val) |
samp1234 | 357:f3d48d62e00e | 62 | { |
samp1234 | 357:f3d48d62e00e | 63 | int8_t data[128] = {0}; |
samp1234 | 357:f3d48d62e00e | 64 | //memcpy(data,thres_data,128); |
samp1234 | 357:f3d48d62e00e | 65 | if(val == 1 ) |
samp1234 | 357:f3d48d62e00e | 66 | memcpy(data,thres_data,128); |
samp1234 | 357:f3d48d62e00e | 67 | if(val == 2) |
samp1234 | 357:f3d48d62e00e | 68 | memcpy(data,thres_data,48); |
samp1234 | 357:f3d48d62e00e | 69 | if(val == 3) |
samp1234 | 357:f3d48d62e00e | 70 | memcpy(data,thres_data,80); |
samp1234 | 357:f3d48d62e00e | 71 | if(mid <11 & mid >1) |
samp1234 | 357:f3d48d62e00e | 72 | { |
samp1234 | 357:f3d48d62e00e | 73 | e2prom.write((uint32_t)(mid-1)*128,data,128); |
samp1234 | 357:f3d48d62e00e | 74 | } |
samp1234 | 357:f3d48d62e00e | 75 | } |
samp1234 | 357:f3d48d62e00e | 76 | |
samp1234 | 357:f3d48d62e00e | 77 | void WRITE_PMS_TO_EEPROM(uint16_t pmid, uint32_t* thres_data) |
samp1234 | 357:f3d48d62e00e | 78 | { |
samp1234 | 357:f3d48d62e00e | 79 | int8_t data[128]; |
samp1234 | 357:f3d48d62e00e | 80 | memcpy(data,thres_data,128); |
samp1234 | 357:f3d48d62e00e | 81 | |
samp1234 | 357:f3d48d62e00e | 82 | if(pmid <7 & pmid >0) |
samp1234 | 357:f3d48d62e00e | 83 | { |
samp1234 | 357:f3d48d62e00e | 84 | e2prom.write((uint32_t)(1280 + (pmid-1)*128),data,128); |
samp1234 | 357:f3d48d62e00e | 85 | } |
samp1234 | 357:f3d48d62e00e | 86 | } |
samp1234 | 357:f3d48d62e00e | 87 | |
samp1234 | 357:f3d48d62e00e | 88 | void UPDATE_PMS_ENTRY(uint32_t address, uint32_t data_block) |
samp1234 | 357:f3d48d62e00e | 89 | { |
samp1234 | 357:f3d48d62e00e | 90 | e2prom.write((1280 + (address*4)),data_block); |
samp1234 | 357:f3d48d62e00e | 91 | wait_us(1); |
samp1234 | 357:f3d48d62e00e | 92 | } |
samp1234 | 357:f3d48d62e00e | 93 | |
samp1234 | 357:f3d48d62e00e | 94 | uint32_t READ_FROM_EERPOM(uint32_t address) |
samp1234 | 357:f3d48d62e00e | 95 | { |
samp1234 | 357:f3d48d62e00e | 96 | int32_t data; |
samp1234 | 357:f3d48d62e00e | 97 | e2prom.read(address*4+10, data); |
samp1234 | 357:f3d48d62e00e | 98 | wait_ms(10); |
samp1234 | 357:f3d48d62e00e | 99 | return (uint32_t)data; |
samp1234 | 357:f3d48d62e00e | 100 | } |
samp1234 | 357:f3d48d62e00e | 101 | |
samp1234 | 357:f3d48d62e00e | 102 | void THRES_READ_FROM_EEPROM(uint16_t mid, uint32_t* data32,int val) |
samp1234 | 357:f3d48d62e00e | 103 | { |
samp1234 | 357:f3d48d62e00e | 104 | int8_t data[128]; |
samp1234 | 357:f3d48d62e00e | 105 | if(mid<11 & mid >1) |
samp1234 | 357:f3d48d62e00e | 106 | { |
samp1234 | 357:f3d48d62e00e | 107 | e2prom.read((uint32_t)(mid-1)*128,data,128); |
samp1234 | 357:f3d48d62e00e | 108 | } |
samp1234 | 357:f3d48d62e00e | 109 | if(val == 1 ) |
samp1234 | 357:f3d48d62e00e | 110 | memcpy(data32,data,128); |
samp1234 | 357:f3d48d62e00e | 111 | if(val == 2) |
samp1234 | 357:f3d48d62e00e | 112 | memcpy(data32,data,48); |
samp1234 | 357:f3d48d62e00e | 113 | if(val == 3) |
samp1234 | 357:f3d48d62e00e | 114 | memcpy(data32,data,80); |
samp1234 | 357:f3d48d62e00e | 115 | /*for(int i=0;i<32;i++){ |
samp1234 | 357:f3d48d62e00e | 116 | mcpy(data32+i,data+4*i,4); |
samp1234 | 357:f3d48d62e00e | 117 | }*/ |
samp1234 | 357:f3d48d62e00e | 118 | wait_ms(10); |
samp1234 | 357:f3d48d62e00e | 119 | } |
samp1234 | 357:f3d48d62e00e | 120 | |
samp1234 | 357:f3d48d62e00e | 121 | void READ_PMS_FROM_EEPROM(uint16_t pmid, uint32_t* data32) |
samp1234 | 357:f3d48d62e00e | 122 | { |
samp1234 | 357:f3d48d62e00e | 123 | int8_t data[128]; |
samp1234 | 357:f3d48d62e00e | 124 | if(pmid<7 & pmid > 0) |
samp1234 | 357:f3d48d62e00e | 125 | { |
samp1234 | 357:f3d48d62e00e | 126 | e2prom.read((uint32_t)(1280 + (pmid-1)*128),data,128); |
samp1234 | 357:f3d48d62e00e | 127 | } |
samp1234 | 357:f3d48d62e00e | 128 | memcpy(data32,data,128); |
samp1234 | 357:f3d48d62e00e | 129 | /*for(int i=0;i<32;i++){ |
samp1234 | 357:f3d48d62e00e | 130 | mcpy(data32+i,data+4*i,4); |
samp1234 | 357:f3d48d62e00e | 131 | }*/ |
samp1234 | 357:f3d48d62e00e | 132 | wait_ms(10); |
samp1234 | 357:f3d48d62e00e | 133 | } |
samp1234 | 357:f3d48d62e00e | 134 | |
samp1234 | 357:f3d48d62e00e | 135 | void INIT_EEPROM() |
samp1234 | 357:f3d48d62e00e | 136 | { |
samp1234 | 357:f3d48d62e00e | 137 | // To be commented starts |
samp1234 | 357:f3d48d62e00e | 138 | int32_t test_buffer; |
samp1234 | 357:f3d48d62e00e | 139 | test_buffer = READ_FROM_EERPOM(17); |
samp1234 | 357:f3d48d62e00e | 140 | // test_buffer = 0; |
samp1234 | 357:f3d48d62e00e | 141 | // e2prom.ready(); |
samp1234 | 357:f3d48d62e00e | 142 | // e2prom.read(2,test_buffer); |
samp1234 | 357:f3d48d62e00e | 143 | |
samp1234 | 357:f3d48d62e00e | 144 | if(test_buffer != 1) |
samp1234 | 357:f3d48d62e00e | 145 | { |
samp1234 | 357:f3d48d62e00e | 146 | if(test_buffer == 0) |
samp1234 | 357:f3d48d62e00e | 147 | { |
samp1234 | 357:f3d48d62e00e | 148 | for(int i=0;i<29;i++) |
samp1234 | 357:f3d48d62e00e | 149 | WRITE_TO_EEPROM( i, INITIAL_EEPROM[i]); |
samp1234 | 357:f3d48d62e00e | 150 | WRITE_TO_EEPROM(17,0x01); |
samp1234 | 357:f3d48d62e00e | 151 | gPC.printf("Initializing EEPROM - Day 0\n\r"); |
samp1234 | 357:f3d48d62e00e | 152 | } |
samp1234 | 357:f3d48d62e00e | 153 | if(test_buffer == 2) |
samp1234 | 357:f3d48d62e00e | 154 | { |
samp1234 | 357:f3d48d62e00e | 155 | for(int i=0;i<29;i++) |
samp1234 | 357:f3d48d62e00e | 156 | WRITE_TO_EEPROM( i, INITIAL_EEPROM[i]); |
samp1234 | 357:f3d48d62e00e | 157 | WRITE_TO_EEPROM( 5, 1); |
samp1234 | 357:f3d48d62e00e | 158 | WRITE_TO_EEPROM(17,0x01); |
samp1234 | 357:f3d48d62e00e | 159 | gPC.printf("Initializing EEPROM - Reset EEPROM Paramters only\n\r"); |
samp1234 | 357:f3d48d62e00e | 160 | } |
samp1234 | 357:f3d48d62e00e | 161 | } |
samp1234 | 357:f3d48d62e00e | 162 | |
samp1234 | 357:f3d48d62e00e | 163 | // To be commented ends*/ |
samp1234 | 357:f3d48d62e00e | 164 | gPC.printf("Reading intial parametrs from EEPROM\n"); |
samp1234 | 357:f3d48d62e00e | 165 | |
samp1234 | 357:f3d48d62e00e | 166 | EPS_V_A_EN_STATUS = READ_FROM_EERPOM(0); |
samp1234 | 357:f3d48d62e00e | 167 | BAE_STATUS = READ_FROM_EERPOM(1); |
samp1234 | 357:f3d48d62e00e | 168 | SD_STATUS = READ_FROM_EERPOM(2); |
samp1234 | 357:f3d48d62e00e | 169 | //PL_STATUS = read[3]; |
samp1234 | 357:f3d48d62e00e | 170 | SD_LIB_BLK_CURRENT = READ_FROM_EERPOM(3); |
samp1234 | 357:f3d48d62e00e | 171 | PL_BEE_SW_STATUS = READ_FROM_EERPOM(4); |
samp1234 | 357:f3d48d62e00e | 172 | //PL_EPS_LATCH_SW_EN = read[4]; |
samp1234 | 357:f3d48d62e00e | 173 | RTC_INIT_STATUS = READ_FROM_EERPOM(5); |
samp1234 | 357:f3d48d62e00e | 174 | CDMS_RTC_DISABLE = READ_FROM_EERPOM(6); |
samp1234 | 357:f3d48d62e00e | 175 | CDMS_RESET_COUNTER = READ_FROM_EERPOM(7); |
samp1234 | 357:f3d48d62e00e | 176 | TIME_LATEST_CDSMS_RESET = READ_FROM_EERPOM(8); |
samp1234 | 357:f3d48d62e00e | 177 | COM_TC_BYTES_LIMIT = READ_FROM_EERPOM(9); |
samp1234 | 357:f3d48d62e00e | 178 | COM_RX_CURRENT_MAX = READ_FROM_EERPOM(10); |
samp1234 | 357:f3d48d62e00e | 179 | COM_RX_DISABLE_TIMEOUT = READ_FROM_EERPOM(11); |
samp1234 | 357:f3d48d62e00e | 180 | COM_PA_TMP_HIGH = 85;//read[12]; |
samp1234 | 357:f3d48d62e00e | 181 | COM_PA_RECOVERY_TIMEOUT = READ_FROM_EERPOM(13); |
samp1234 | 357:f3d48d62e00e | 182 | COM_SESSION_TIMEOUT = READ_FROM_EERPOM(14); |
samp1234 | 357:f3d48d62e00e | 183 | COM_RSSI_MIN = READ_FROM_EERPOM(15); |
samp1234 | 357:f3d48d62e00e | 184 | PL_STATE = READ_FROM_EERPOM(16); |
samp1234 | 357:f3d48d62e00e | 185 | |
samp1234 | 357:f3d48d62e00e | 186 | THRES_READ_FROM_EEPROM(0x0002,flasharray_thres,1); |
samp1234 | 357:f3d48d62e00e | 187 | for(uint8_t z=0;z<24;z++) |
samp1234 | 357:f3d48d62e00e | 188 | scp_threshold_m0[z] = flasharray_thres[z] ; |
samp1234 | 357:f3d48d62e00e | 189 | for(uint8_t z=24;z<32;z++) |
samp1234 | 357:f3d48d62e00e | 190 | scp_threshold_m0[z+8] = flasharray_thres[z] ; |
samp1234 | 357:f3d48d62e00e | 191 | |
samp1234 | 357:f3d48d62e00e | 192 | THRES_READ_FROM_EEPROM(0x0003,scp_threshold_m0+(40),2); |
samp1234 | 357:f3d48d62e00e | 193 | |
samp1234 | 357:f3d48d62e00e | 194 | THRES_READ_FROM_EEPROM(0x0004,scp_threshold_m1,1); |
samp1234 | 357:f3d48d62e00e | 195 | |
samp1234 | 357:f3d48d62e00e | 196 | THRES_READ_FROM_EEPROM(0x0005,scp_threshold_m1+(32),3); |
samp1234 | 357:f3d48d62e00e | 197 | |
samp1234 | 357:f3d48d62e00e | 198 | THRES_READ_FROM_EEPROM(0x0006,flasharray_thres,2); |
samp1234 | 357:f3d48d62e00e | 199 | scp_threshold_m0_1[7] = flasharray_thres[0]; |
samp1234 | 357:f3d48d62e00e | 200 | scp_threshold_m0_1[5] = flasharray_thres[1] ; |
samp1234 | 357:f3d48d62e00e | 201 | scp_threshold_m0_1[8] = flasharray_thres[2] ; |
samp1234 | 357:f3d48d62e00e | 202 | scp_threshold_m0_1[6] = flasharray_thres[3] ; |
samp1234 | 357:f3d48d62e00e | 203 | for(uint8_t z=0;z<5;z++) |
samp1234 | 357:f3d48d62e00e | 204 | scp_threshold_m0_1[z] = flasharray_thres[z+4] ; |
samp1234 | 357:f3d48d62e00e | 205 | scp_sfp_threshold_m0_2[0] = flasharray_thres[9] ; |
samp1234 | 357:f3d48d62e00e | 206 | scp_sfp_threshold_m0_2[1] = flasharray_thres[10] ; |
samp1234 | 357:f3d48d62e00e | 207 | scp_sfp_threshold_m0_2[2] = flasharray_thres[11] ; |
samp1234 | 357:f3d48d62e00e | 208 | |
samp1234 | 357:f3d48d62e00e | 209 | THRES_READ_FROM_EEPROM(0x0007,flasharray_thres,1); |
samp1234 | 357:f3d48d62e00e | 210 | for(uint8_t z=0;z<24;z++) |
samp1234 | 357:f3d48d62e00e | 211 | sfp_threshold_m0[z] = flasharray_thres[z] ; |
samp1234 | 357:f3d48d62e00e | 212 | for(uint8_t z=24;z<32;z++) |
samp1234 | 357:f3d48d62e00e | 213 | sfp_threshold_m0[z+8] = flasharray_thres[z] ; |
samp1234 | 357:f3d48d62e00e | 214 | |
samp1234 | 357:f3d48d62e00e | 215 | THRES_READ_FROM_EEPROM(0x0008,sfp_threshold_m0+(40),2); |
samp1234 | 357:f3d48d62e00e | 216 | |
samp1234 | 357:f3d48d62e00e | 217 | THRES_READ_FROM_EEPROM(0x0009,sfp_threshold_m1,1); |
samp1234 | 357:f3d48d62e00e | 218 | |
samp1234 | 357:f3d48d62e00e | 219 | THRES_READ_FROM_EEPROM(0x000A,sfp_threshold_m1+(32),3); |
samp1234 | 357:f3d48d62e00e | 220 | |
samp1234 | 357:f3d48d62e00e | 221 | /*READ_PMS_FROM_EEPROM(0x0001, pl_block); |
samp1234 | 357:f3d48d62e00e | 222 | |
samp1234 | 357:f3d48d62e00e | 223 | READ_PMS_FROM_EEPROM(0x0002, pl_block + (32)); |
samp1234 | 357:f3d48d62e00e | 224 | |
samp1234 | 357:f3d48d62e00e | 225 | READ_PMS_FROM_EEPROM(0x0003, pl_block + (64)); //Uncomment and test this after all other PMS functionality has been verified |
samp1234 | 357:f3d48d62e00e | 226 | |
samp1234 | 357:f3d48d62e00e | 227 | READ_PMS_FROM_EEPROM(0x0004, pl_block + (96)); |
samp1234 | 357:f3d48d62e00e | 228 | |
samp1234 | 357:f3d48d62e00e | 229 | READ_PMS_FROM_EEPROM(0x0005, pl_block + (128)); |
samp1234 | 357:f3d48d62e00e | 230 | |
samp1234 | 357:f3d48d62e00e | 231 | READ_PMS_FROM_EEPROM(0x0006, pl_block + (160));*/ |
samp1234 | 357:f3d48d62e00e | 232 | |
samp1234 | 357:f3d48d62e00e | 233 | |
samp1234 | 357:f3d48d62e00e | 234 | gPC.printf("0 = \r%d\n\r", READ_FROM_EERPOM(0)); |
samp1234 | 357:f3d48d62e00e | 235 | gPC.printf("1 = %d\n\r", READ_FROM_EERPOM(1)); |
samp1234 | 357:f3d48d62e00e | 236 | gPC.printf("2 = %d\n\r", READ_FROM_EERPOM(2)); |
samp1234 | 357:f3d48d62e00e | 237 | gPC.printf("3 = %d\n\r", READ_FROM_EERPOM(3)); |
samp1234 | 357:f3d48d62e00e | 238 | gPC.printf("4 = %d\n\r", READ_FROM_EERPOM(4)); |
samp1234 | 357:f3d48d62e00e | 239 | gPC.printf("5 = %d\n\r", READ_FROM_EERPOM(5)); |
samp1234 | 357:f3d48d62e00e | 240 | gPC.printf("6= %d\n\r", READ_FROM_EERPOM(6)); |
samp1234 | 357:f3d48d62e00e | 241 | gPC.printf("7= %d\n\r", READ_FROM_EERPOM(7)); |
samp1234 | 357:f3d48d62e00e | 242 | gPC.printf("8= %d\n\r", READ_FROM_EERPOM(8)); |
samp1234 | 357:f3d48d62e00e | 243 | gPC.printf("9= %d\n\r", READ_FROM_EERPOM(9)); |
samp1234 | 357:f3d48d62e00e | 244 | gPC.printf("10= %d\n\r", READ_FROM_EERPOM(10)); |
samp1234 | 357:f3d48d62e00e | 245 | gPC.printf("11= %d\n\r", READ_FROM_EERPOM(11)); |
samp1234 | 357:f3d48d62e00e | 246 | gPC.printf("12= %d\n\r", READ_FROM_EERPOM(12)); |
samp1234 | 357:f3d48d62e00e | 247 | gPC.printf("13= %d\n\r", READ_FROM_EERPOM(13)); |
samp1234 | 357:f3d48d62e00e | 248 | gPC.printf("14= %d\n\r", READ_FROM_EERPOM(14)); |
samp1234 | 357:f3d48d62e00e | 249 | gPC.printf("15= %d\n\r", READ_FROM_EERPOM(15)); |
samp1234 | 357:f3d48d62e00e | 250 | gPC.printf("16 = %u\n\r", READ_FROM_EERPOM(16)); |
samp1234 | 357:f3d48d62e00e | 251 | gPC.printf("test buffer 17 = %u\n\r", READ_FROM_EERPOM(17)); |
samp1234 | 357:f3d48d62e00e | 252 | |
samp1234 | 357:f3d48d62e00e | 253 | |
samp1234 | 357:f3d48d62e00e | 254 | // SD_LIB_BLK_CURRENT = READ_FROM_EERPOM(16); |
samp1234 | 357:f3d48d62e00e | 255 | // added by samp |
samp1234 | 357:f3d48d62e00e | 256 | |
samp1234 | 357:f3d48d62e00e | 257 | |
samp1234 | 357:f3d48d62e00e | 258 | } |
samp1234 | 357:f3d48d62e00e | 259 | |
samp1234 | 357:f3d48d62e00e | 260 | /*===================================================MMS Functions=================================================*/ |
samp1234 | 357:f3d48d62e00e | 261 | |
samp1234 | 357:f3d48d62e00e | 262 | void FCTN_CDMS_WR_S_EEPROM(uint16_t mid,uint32_t datablock); |
samp1234 | 357:f3d48d62e00e | 263 | |
samp1234 | 357:f3d48d62e00e | 264 | void FCTN_CDMS_WR_S_EEPROM(uint16_t mid,uint32_t datablock) |
samp1234 | 357:f3d48d62e00e | 265 | { |
samp1234 | 357:f3d48d62e00e | 266 | if(mid == 0x0100) |
samp1234 | 357:f3d48d62e00e | 267 | { |
samp1234 | 357:f3d48d62e00e | 268 | WRITE_TO_EEPROM(11,(datablock>>16) & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 269 | WRITE_TO_EEPROM(13,(datablock>>8) & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 270 | WRITE_TO_EEPROM(14,datablock & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 271 | } |
samp1234 | 357:f3d48d62e00e | 272 | else if(mid == 0x0101) |
samp1234 | 357:f3d48d62e00e | 273 | { |
samp1234 | 357:f3d48d62e00e | 274 | WRITE_TO_EEPROM(12,(datablock>>16) & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 275 | WRITE_TO_EEPROM(10,(datablock>>8) & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 276 | WRITE_TO_EEPROM(15,datablock & 0x000000FF); |
samp1234 | 357:f3d48d62e00e | 277 | } |
samp1234 | 357:f3d48d62e00e | 278 | else if(mid == 0x0102) |
samp1234 | 357:f3d48d62e00e | 279 | { |
samp1234 | 357:f3d48d62e00e | 280 | WRITE_TO_EEPROM(9,datablock & 0x0000FFFF); |
samp1234 | 357:f3d48d62e00e | 281 | } |
samp1234 | 357:f3d48d62e00e | 282 | else if(mid == 0x0103) |
samp1234 | 357:f3d48d62e00e | 283 | { |
samp1234 | 357:f3d48d62e00e | 284 | WRITE_TO_EEPROM(6,datablock & 0x00000001); |
samp1234 | 357:f3d48d62e00e | 285 | } |
samp1234 | 357:f3d48d62e00e | 286 | else if(mid == 0x0104) |
samp1234 | 357:f3d48d62e00e | 287 | { |
samp1234 | 357:f3d48d62e00e | 288 | WRITE_TO_EEPROM(17,datablock & 0x00000001); |
samp1234 | 357:f3d48d62e00e | 289 | } |
samp1234 | 357:f3d48d62e00e | 290 | } |
samp1234 | 357:f3d48d62e00e | 291 | |
samp1234 | 357:f3d48d62e00e | 292 | #endif |