Duy tran / Mbed OS iot_water_monitor_v2

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   easy-connect-v16 Watchdog FP MQTTPacket RecordType-v-16 watersenor_and_temp_code

Flash/flash_programming.cpp@38:64e3e9acb49c, 2018-02-19 (annotated)

Committer:
DuyLionTran
Date:
Mon Feb 19 14:18:22 2018 +0000
Revision:
38:64e3e9acb49c
Parent:
35:fc800d35c1ba
Child:
43:dcde0e66874a
* version 2.6.3 	02-19-2017: developing calibration. the average voltage is ok

Who changed what in which revision?

UserRevisionLine numberNew contents of line
DuyLionTran 32:8226837c56ae 1 #include "flash_programming.h"
DuyLionTran 32:8226837c56ae 2 #include "stm32l4xx_hal_flash.h"
DuyLionTran 32:8226837c56ae 3
DuyLionTran 32:8226837c56ae 4 uint32_t PageError = 0;
DuyLionTran 32:8226837c56ae 5
DuyLionTran 32:8226837c56ae 6 FLASH_EraseInitTypeDef EraseInitStruct;
DuyLionTran 32:8226837c56ae 7
DuyLionTran 32:8226837c56ae 8 uint32_t FP_GetPage(uint32_t Addr) {
DuyLionTran 32:8226837c56ae 9 uint32_t page = 0;
DuyLionTran 32:8226837c56ae 10
DuyLionTran 32:8226837c56ae 11 if (Addr < (FLASH_BASE + FLASH_BANK_SIZE))
DuyLionTran 32:8226837c56ae 12 {
DuyLionTran 32:8226837c56ae 13 /* Bank 1 */
DuyLionTran 32:8226837c56ae 14 page = (Addr - FLASH_BASE) / FLASH_PAGE_SIZE;
DuyLionTran 32:8226837c56ae 15 }
DuyLionTran 32:8226837c56ae 16 else
DuyLionTran 32:8226837c56ae 17 {
DuyLionTran 32:8226837c56ae 18 /* Bank 2 */
DuyLionTran 32:8226837c56ae 19 page = (Addr - (FLASH_BASE + FLASH_BANK_SIZE)) / FLASH_PAGE_SIZE;
DuyLionTran 32:8226837c56ae 20 }
DuyLionTran 32:8226837c56ae 21
DuyLionTran 32:8226837c56ae 22 return page;
DuyLionTran 32:8226837c56ae 23 }
DuyLionTran 32:8226837c56ae 24
DuyLionTran 32:8226837c56ae 25 int FP_ClearFlags() {
DuyLionTran 32:8226837c56ae 26 __HAL_FLASH_CLEAR_FLAG(FLASH_FLAG_EOP | FLASH_FLAG_PGAERR | FLASH_FLAG_OPTVERR | FLASH_FLAG_PGSERR);
DuyLionTran 32:8226837c56ae 27 if((__HAL_FLASH_GET_FLAG(FLASH_FLAG_OPERR)) || (__HAL_FLASH_GET_FLAG(FLASH_FLAG_PROGERR)) ||
DuyLionTran 32:8226837c56ae 28 (__HAL_FLASH_GET_FLAG(FLASH_FLAG_WRPERR)) || (__HAL_FLASH_GET_FLAG(FLASH_FLAG_PGAERR)) ||
DuyLionTran 32:8226837c56ae 29 (__HAL_FLASH_GET_FLAG(FLASH_FLAG_SIZERR)) || (__HAL_FLASH_GET_FLAG(FLASH_FLAG_PGSERR))) {
DuyLionTran 32:8226837c56ae 30 printf("Clear flag error\r\n");
DuyLionTran 32:8226837c56ae 31 return FAILED;
DuyLionTran 32:8226837c56ae 32 }
DuyLionTran 32:8226837c56ae 33 return PASSED;
DuyLionTran 32:8226837c56ae 34 }
DuyLionTran 32:8226837c56ae 35
DuyLionTran 32:8226837c56ae 36 uint32_t FP_ReadValue(uint32_t Addr) {
DuyLionTran 32:8226837c56ae 37 uint32_t ReturnValue = *(__IO uint32_t*)Addr;
DuyLionTran 32:8226837c56ae 38 return ReturnValue;
DuyLionTran 32:8226837c56ae 39 }
DuyLionTran 32:8226837c56ae 40
DuyLionTran 34:601effb7b7fe 41 int FP_WriteRelayStates(uint8_t RelayState1, uint8_t RelayState2, uint8_t RelayState3) {
DuyLionTran 33:5b90257d2d57 42 uint8_t CurrentPage = FP_GetPage(RELAY_BASE_ADDRESS);
DuyLionTran 33:5b90257d2d57 43 uint32_t CurrentAddress = RELAY1_ADDRESS;
DuyLionTran 32:8226837c56ae 44
DuyLionTran 32:8226837c56ae 45 EraseInitStruct.TypeErase = FLASH_TYPEERASE_PAGES;
DuyLionTran 32:8226837c56ae 46 EraseInitStruct.Banks = FLASH_BANK_1;
DuyLionTran 32:8226837c56ae 47 EraseInitStruct.Page = CurrentPage;
DuyLionTran 32:8226837c56ae 48 EraseInitStruct.NbPages = 1;
DuyLionTran 32:8226837c56ae 49
DuyLionTran 32:8226837c56ae 50 if (FP_ClearFlags() != PASSED) {
DuyLionTran 32:8226837c56ae 51 return FAILED;
DuyLionTran 32:8226837c56ae 52 }
DuyLionTran 32:8226837c56ae 53 HAL_FLASH_Unlock();
DuyLionTran 32:8226837c56ae 54
DuyLionTran 33:5b90257d2d57 55 if ((FP_ReadValue(RELAY1_ADDRESS) == RelayState1) &&
DuyLionTran 34:601effb7b7fe 56 (FP_ReadValue(RELAY2_ADDRESS) == RelayState2) &&
DuyLionTran 34:601effb7b7fe 57 (FP_ReadValue(RELAY3_ADDRESS) == RelayState3)) {
DuyLionTran 33:5b90257d2d57 58 printf("Relay values don't change, no need to write\r\n");
DuyLionTran 32:8226837c56ae 59 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 60 return PASSED;
DuyLionTran 32:8226837c56ae 61 }
DuyLionTran 32:8226837c56ae 62 if (HAL_FLASHEx_Erase(&EraseInitStruct, &PageError) != HAL_OK) {
DuyLionTran 32:8226837c56ae 63 printf("Erase error, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 32:8226837c56ae 64 }
DuyLionTran 34:601effb7b7fe 65 while (CurrentAddress < (RELAY3_ADDRESS + STEP_ADDRESS)) {
DuyLionTran 33:5b90257d2d57 66 switch (CurrentAddress) {
DuyLionTran 33:5b90257d2d57 67 case (RELAY1_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, RelayState1) == HAL_OK) {
DuyLionTran 33:5b90257d2d57 68 printf("Write Relay 1 State OK\r\n");
DuyLionTran 33:5b90257d2d57 69 }
DuyLionTran 33:5b90257d2d57 70 else {
DuyLionTran 33:5b90257d2d57 71 printf("Write Relay 1 State failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 33:5b90257d2d57 72 }
DuyLionTran 33:5b90257d2d57 73 break;
DuyLionTran 33:5b90257d2d57 74 case (RELAY2_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, RelayState2) == HAL_OK) {
DuyLionTran 33:5b90257d2d57 75 printf("Write Relay 2 State OK\r\n");
DuyLionTran 33:5b90257d2d57 76 }
DuyLionTran 33:5b90257d2d57 77 else {
DuyLionTran 33:5b90257d2d57 78 printf("Write Relay 2 State failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 33:5b90257d2d57 79 }
DuyLionTran 35:fc800d35c1ba 80 break;
DuyLionTran 34:601effb7b7fe 81 case (RELAY3_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, RelayState3) == HAL_OK) {
DuyLionTran 34:601effb7b7fe 82 printf("Write Relay 3 State OK\r\n");
DuyLionTran 34:601effb7b7fe 83 }
DuyLionTran 34:601effb7b7fe 84 else {
DuyLionTran 34:601effb7b7fe 85 printf("Write Relay 3 State failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 34:601effb7b7fe 86 }
DuyLionTran 33:5b90257d2d57 87 break;
DuyLionTran 33:5b90257d2d57 88 default: break;
DuyLionTran 33:5b90257d2d57 89 }
DuyLionTran 33:5b90257d2d57 90 CurrentAddress = CurrentAddress + STEP_ADDRESS;
DuyLionTran 32:8226837c56ae 91 }
DuyLionTran 33:5b90257d2d57 92
DuyLionTran 33:5b90257d2d57 93 CurrentAddress = RELAY1_ADDRESS;
DuyLionTran 34:601effb7b7fe 94 while (CurrentAddress < (RELAY3_ADDRESS + STEP_ADDRESS)) {
DuyLionTran 33:5b90257d2d57 95 switch (CurrentAddress) {
DuyLionTran 33:5b90257d2d57 96 case (RELAY1_ADDRESS): if (FP_ReadValue(CurrentAddress) == RelayState1) {
DuyLionTran 33:5b90257d2d57 97 printf("Read back Relay 1 State: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 33:5b90257d2d57 98 }
DuyLionTran 33:5b90257d2d57 99 else {
DuyLionTran 33:5b90257d2d57 100 printf("Write Relay 1 State failed, wrong read back value\r\n");
DuyLionTran 33:5b90257d2d57 101 HAL_FLASH_Lock();
DuyLionTran 33:5b90257d2d57 102 return FAILED;
DuyLionTran 33:5b90257d2d57 103 }
DuyLionTran 33:5b90257d2d57 104 break;
DuyLionTran 33:5b90257d2d57 105 case (RELAY2_ADDRESS): if (FP_ReadValue(CurrentAddress) == RelayState2) {
DuyLionTran 33:5b90257d2d57 106 printf("Read back Relay 2 State: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 33:5b90257d2d57 107 }
DuyLionTran 33:5b90257d2d57 108 else {
DuyLionTran 33:5b90257d2d57 109 printf("Write Relay 2 State failed, wrong read back value\r\n");
DuyLionTran 33:5b90257d2d57 110 HAL_FLASH_Lock();
DuyLionTran 33:5b90257d2d57 111 return FAILED;
DuyLionTran 33:5b90257d2d57 112 }
DuyLionTran 33:5b90257d2d57 113 break;
DuyLionTran 34:601effb7b7fe 114 case (RELAY3_ADDRESS): if (FP_ReadValue(CurrentAddress) == RelayState3) {
DuyLionTran 34:601effb7b7fe 115 printf("Read back Relay 3 State: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 34:601effb7b7fe 116 }
DuyLionTran 34:601effb7b7fe 117 else {
DuyLionTran 34:601effb7b7fe 118 printf("Write Relay 3 State failed, wrong read back value\r\n");
DuyLionTran 34:601effb7b7fe 119 HAL_FLASH_Lock();
DuyLionTran 34:601effb7b7fe 120 return FAILED;
DuyLionTran 34:601effb7b7fe 121 }
DuyLionTran 34:601effb7b7fe 122 break;
DuyLionTran 33:5b90257d2d57 123 default: break;
DuyLionTran 33:5b90257d2d57 124 }
DuyLionTran 33:5b90257d2d57 125 CurrentAddress = CurrentAddress + STEP_ADDRESS;
DuyLionTran 32:8226837c56ae 126 }
DuyLionTran 32:8226837c56ae 127 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 128 return PASSED;
DuyLionTran 32:8226837c56ae 129 }
DuyLionTran 32:8226837c56ae 130
DuyLionTran 33:5b90257d2d57 131 int FP_WriteConfigValues(uint8_t Mode, uint8_t MinOxi, uint8_t MaxOxi, uint32_t UploadPeriod) {
DuyLionTran 32:8226837c56ae 132 uint8_t CurrentPage = FP_GetPage(CONF_BASE_ADDRESS);
DuyLionTran 33:5b90257d2d57 133 uint32_t CurrentAddress = MODE_ADDRESS;
DuyLionTran 32:8226837c56ae 134 EraseInitStruct.TypeErase = FLASH_TYPEERASE_PAGES;
DuyLionTran 32:8226837c56ae 135 EraseInitStruct.Banks = FLASH_BANK_1;
DuyLionTran 32:8226837c56ae 136 EraseInitStruct.Page = CurrentPage;
DuyLionTran 32:8226837c56ae 137 EraseInitStruct.NbPages = 1;
DuyLionTran 32:8226837c56ae 138
DuyLionTran 32:8226837c56ae 139 if (FP_ClearFlags() != PASSED) {
DuyLionTran 32:8226837c56ae 140 return FAILED;
DuyLionTran 32:8226837c56ae 141 }
DuyLionTran 32:8226837c56ae 142 HAL_FLASH_Unlock();
DuyLionTran 32:8226837c56ae 143
DuyLionTran 33:5b90257d2d57 144 if ((FP_ReadValue(MODE_ADDRESS) == Mode) &&
DuyLionTran 33:5b90257d2d57 145 (FP_ReadValue(MIN_OXI_ADDRESS) == MinOxi) &&
DuyLionTran 32:8226837c56ae 146 (FP_ReadValue(MAX_OXI_ADDRESS) == MaxOxi) &&
DuyLionTran 33:5b90257d2d57 147 (FP_ReadValue(UPLOAD_PERIOD_ADDRESS) == UploadPeriod)) {
DuyLionTran 33:5b90257d2d57 148 printf("Configuration values don't change, no need to write\r\n");
DuyLionTran 32:8226837c56ae 149 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 150 return PASSED;
DuyLionTran 32:8226837c56ae 151 }
DuyLionTran 32:8226837c56ae 152 if (HAL_FLASHEx_Erase(&EraseInitStruct, &PageError) != HAL_OK) {
DuyLionTran 32:8226837c56ae 153 printf("Erase error, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 32:8226837c56ae 154 }
DuyLionTran 33:5b90257d2d57 155 while (CurrentAddress < (UPLOAD_PERIOD_ADDRESS + STEP_ADDRESS)) {
DuyLionTran 32:8226837c56ae 156 switch (CurrentAddress) {
DuyLionTran 33:5b90257d2d57 157 case (MODE_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, Mode) == HAL_OK) {
DuyLionTran 33:5b90257d2d57 158 printf("Write Mode OK\r\n");
DuyLionTran 33:5b90257d2d57 159 }
DuyLionTran 33:5b90257d2d57 160 else {
DuyLionTran 33:5b90257d2d57 161 printf("Write Mode failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 33:5b90257d2d57 162 }
DuyLionTran 33:5b90257d2d57 163 break;
DuyLionTran 32:8226837c56ae 164 case (MIN_OXI_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, MinOxi) == HAL_OK) {
DuyLionTran 32:8226837c56ae 165 printf("Write MinOxi OK\r\n");
DuyLionTran 32:8226837c56ae 166 }
DuyLionTran 32:8226837c56ae 167 else {
DuyLionTran 32:8226837c56ae 168 printf("Write MinOxi failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 32:8226837c56ae 169 }
DuyLionTran 32:8226837c56ae 170 break;
DuyLionTran 32:8226837c56ae 171 case (MAX_OXI_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, MaxOxi) == HAL_OK) {
DuyLionTran 32:8226837c56ae 172 printf("Write MaxOxi OK\r\n");
DuyLionTran 32:8226837c56ae 173 }
DuyLionTran 32:8226837c56ae 174 else {
DuyLionTran 32:8226837c56ae 175 printf("Write MaxOxi failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 32:8226837c56ae 176 }
DuyLionTran 32:8226837c56ae 177 break;
DuyLionTran 33:5b90257d2d57 178 case (UPLOAD_PERIOD_ADDRESS): if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, UploadPeriod) == HAL_OK) {
DuyLionTran 32:8226837c56ae 179 printf("Write UploadPeriod OK\r\n");
DuyLionTran 32:8226837c56ae 180 }
DuyLionTran 32:8226837c56ae 181 else {
DuyLionTran 32:8226837c56ae 182 printf("Write UploadPeriod failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 32:8226837c56ae 183 }
DuyLionTran 32:8226837c56ae 184 break;
DuyLionTran 32:8226837c56ae 185 default: break;
DuyLionTran 32:8226837c56ae 186 }
DuyLionTran 32:8226837c56ae 187 CurrentAddress = CurrentAddress + STEP_ADDRESS;
DuyLionTran 32:8226837c56ae 188 }
DuyLionTran 32:8226837c56ae 189
DuyLionTran 33:5b90257d2d57 190 CurrentAddress = MODE_ADDRESS;
DuyLionTran 33:5b90257d2d57 191 while (CurrentAddress < (UPLOAD_PERIOD_ADDRESS + STEP_ADDRESS)) {
DuyLionTran 32:8226837c56ae 192 switch (CurrentAddress) {
DuyLionTran 33:5b90257d2d57 193 case (MODE_ADDRESS): if (FP_ReadValue(CurrentAddress) == Mode) {
DuyLionTran 33:5b90257d2d57 194 printf("Read back Mode: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 33:5b90257d2d57 195 }
DuyLionTran 33:5b90257d2d57 196 else {
DuyLionTran 33:5b90257d2d57 197 printf("Write Mode failed, wrong read back value\r\n");
DuyLionTran 33:5b90257d2d57 198 HAL_FLASH_Lock();
DuyLionTran 33:5b90257d2d57 199 return FAILED;
DuyLionTran 33:5b90257d2d57 200 }
DuyLionTran 33:5b90257d2d57 201 break;
DuyLionTran 32:8226837c56ae 202 case (MIN_OXI_ADDRESS): if (FP_ReadValue(CurrentAddress) == MinOxi) {
DuyLionTran 32:8226837c56ae 203 printf("Read back MinOxi: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 32:8226837c56ae 204 }
DuyLionTran 32:8226837c56ae 205 else {
DuyLionTran 32:8226837c56ae 206 printf("Write MinOxi failed, wrong read back value\r\n");
DuyLionTran 32:8226837c56ae 207 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 208 return FAILED;
DuyLionTran 32:8226837c56ae 209 }
DuyLionTran 32:8226837c56ae 210 break;
DuyLionTran 32:8226837c56ae 211 case (MAX_OXI_ADDRESS): if (FP_ReadValue(CurrentAddress) == MaxOxi) {
DuyLionTran 32:8226837c56ae 212 printf("Read back MaxOxi: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 32:8226837c56ae 213 }
DuyLionTran 32:8226837c56ae 214 else {
DuyLionTran 32:8226837c56ae 215 printf("Write MaxOxi failed, wrong read back value\r\n");
DuyLionTran 32:8226837c56ae 216 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 217 return FAILED;
DuyLionTran 32:8226837c56ae 218 }
DuyLionTran 32:8226837c56ae 219 break;
DuyLionTran 33:5b90257d2d57 220 case (UPLOAD_PERIOD_ADDRESS): if (FP_ReadValue(CurrentAddress) == UploadPeriod) {
DuyLionTran 32:8226837c56ae 221 printf("Read back UploadPeriod: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 32:8226837c56ae 222 }
DuyLionTran 32:8226837c56ae 223 else {
DuyLionTran 32:8226837c56ae 224 printf("Write UploadPeriod failed, wrong read back value\r\n");
DuyLionTran 32:8226837c56ae 225 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 226 return FAILED;
DuyLionTran 32:8226837c56ae 227 }
DuyLionTran 32:8226837c56ae 228 break;
DuyLionTran 32:8226837c56ae 229 default: break;
DuyLionTran 32:8226837c56ae 230 }
DuyLionTran 32:8226837c56ae 231 CurrentAddress = CurrentAddress + STEP_ADDRESS;
DuyLionTran 32:8226837c56ae 232 }
DuyLionTran 32:8226837c56ae 233 HAL_FLASH_Lock();
DuyLionTran 32:8226837c56ae 234 return PASSED;
DuyLionTran 38:64e3e9acb49c 235 }
DuyLionTran 38:64e3e9acb49c 236
DuyLionTran 38:64e3e9acb49c 237 int FP_WriteConfigValues(uint32_t SaturationDoVoltage) {
DuyLionTran 38:64e3e9acb49c 238 uint8_t CurrentPage = FP_GetPage(SAT_DO_VOLT_ADDRESS);
DuyLionTran 38:64e3e9acb49c 239 uint32_t CurrentAddress = SAT_DO_VOLT_ADDRESS;
DuyLionTran 38:64e3e9acb49c 240 EraseInitStruct.TypeErase = FLASH_TYPEERASE_PAGES;
DuyLionTran 38:64e3e9acb49c 241 EraseInitStruct.Banks = FLASH_BANK_1;
DuyLionTran 38:64e3e9acb49c 242 EraseInitStruct.Page = CurrentPage;
DuyLionTran 38:64e3e9acb49c 243 EraseInitStruct.NbPages = 1;
DuyLionTran 38:64e3e9acb49c 244
DuyLionTran 38:64e3e9acb49c 245 if (FP_ClearFlags() != PASSED) {
DuyLionTran 38:64e3e9acb49c 246 return FAILED;
DuyLionTran 38:64e3e9acb49c 247 }
DuyLionTran 38:64e3e9acb49c 248 HAL_FLASH_Unlock();
DuyLionTran 38:64e3e9acb49c 249
DuyLionTran 38:64e3e9acb49c 250 if ((FP_ReadValue(SAT_DO_VOLT_ADDRESS) == SaturationDoVoltage)) {
DuyLionTran 38:64e3e9acb49c 251 printf("Configuration values doesn't change, no need to write\r\n");
DuyLionTran 38:64e3e9acb49c 252 HAL_FLASH_Lock();
DuyLionTran 38:64e3e9acb49c 253 return PASSED;
DuyLionTran 38:64e3e9acb49c 254 }
DuyLionTran 38:64e3e9acb49c 255 if (HAL_FLASHEx_Erase(&EraseInitStruct, &PageError) != HAL_OK) {
DuyLionTran 38:64e3e9acb49c 256 printf("Erase error, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 38:64e3e9acb49c 257 }
DuyLionTran 38:64e3e9acb49c 258 if (HAL_FLASH_Program(FLASH_TYPEPROGRAM_DOUBLEWORD, CurrentAddress, SaturationDoVoltage) == HAL_OK) {
DuyLionTran 38:64e3e9acb49c 259 printf("Write SaturationDoVoltage OK\r\n");
DuyLionTran 38:64e3e9acb49c 260 }
DuyLionTran 38:64e3e9acb49c 261 else {
DuyLionTran 38:64e3e9acb49c 262 printf("Write SaturationDoVoltage failed, error num %d\r\n", HAL_FLASH_GetError());
DuyLionTran 38:64e3e9acb49c 263 }
DuyLionTran 38:64e3e9acb49c 264 if (FP_ReadValue(CurrentAddress) == SaturationDoVoltage) {
DuyLionTran 38:64e3e9acb49c 265 printf("Read back SaturationDoVoltage: %d\r\n", FP_ReadValue(CurrentAddress));
DuyLionTran 38:64e3e9acb49c 266 }
DuyLionTran 38:64e3e9acb49c 267 else {
DuyLionTran 38:64e3e9acb49c 268 printf("Write SaturationDoVoltage failed, wrong read back value\r\n");
DuyLionTran 38:64e3e9acb49c 269 HAL_FLASH_Lock();
DuyLionTran 38:64e3e9acb49c 270 return FAILED;
DuyLionTran 38:64e3e9acb49c 271 }
DuyLionTran 38:64e3e9acb49c 272 HAL_FLASH_Lock();
DuyLionTran 38:64e3e9acb49c 273 return PASSED;
DuyLionTran 26:f40cc4d011b0 274 }