Denislam Valeev / Mbed OS Nucleo_rtos_basic

1

mbed-os/drivers/FlashIAP.cpp@0:e056ac8fecf8, 2018-03-13 (annotated)

Committer:
valeyev
Date:
Tue Mar 13 07:17:50 2018 +0000
Revision:
0:e056ac8fecf8
looking for...

Who changed what in which revision?

UserRevisionLine numberNew contents of line
valeyev 0:e056ac8fecf8 1 /* mbed Microcontroller Library
valeyev 0:e056ac8fecf8 2 * Copyright (c) 2017 ARM Limited
valeyev 0:e056ac8fecf8 3 *
valeyev 0:e056ac8fecf8 4 * Permission is hereby granted, free of charge, to any person obtaining a copy
valeyev 0:e056ac8fecf8 5 * of this software and associated documentation files (the "Software"), to deal
valeyev 0:e056ac8fecf8 6 * in the Software without restriction, including without limitation the rights
valeyev 0:e056ac8fecf8 7 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
valeyev 0:e056ac8fecf8 8 * copies of the Software, and to permit persons to whom the Software is
valeyev 0:e056ac8fecf8 9 * furnished to do so, subject to the following conditions:
valeyev 0:e056ac8fecf8 10 *
valeyev 0:e056ac8fecf8 11 * The above copyright notice and this permission notice shall be included in
valeyev 0:e056ac8fecf8 12 * all copies or substantial portions of the Software.
valeyev 0:e056ac8fecf8 13 *
valeyev 0:e056ac8fecf8 14 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
valeyev 0:e056ac8fecf8 15 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
valeyev 0:e056ac8fecf8 16 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
valeyev 0:e056ac8fecf8 17 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
valeyev 0:e056ac8fecf8 18 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
valeyev 0:e056ac8fecf8 19 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
valeyev 0:e056ac8fecf8 20 * SOFTWARE.
valeyev 0:e056ac8fecf8 21 */
valeyev 0:e056ac8fecf8 22
valeyev 0:e056ac8fecf8 23 #include <stdio.h>
valeyev 0:e056ac8fecf8 24 #include <string.h>
valeyev 0:e056ac8fecf8 25 #include <algorithm>
valeyev 0:e056ac8fecf8 26 #include "FlashIAP.h"
valeyev 0:e056ac8fecf8 27 #include "mbed_assert.h"
valeyev 0:e056ac8fecf8 28
valeyev 0:e056ac8fecf8 29
valeyev 0:e056ac8fecf8 30 #ifdef DEVICE_FLASH
valeyev 0:e056ac8fecf8 31
valeyev 0:e056ac8fecf8 32 namespace mbed {
valeyev 0:e056ac8fecf8 33
valeyev 0:e056ac8fecf8 34 SingletonPtr<PlatformMutex> FlashIAP::_mutex;
valeyev 0:e056ac8fecf8 35
valeyev 0:e056ac8fecf8 36 static inline bool is_aligned(uint32_t number, uint32_t alignment)
valeyev 0:e056ac8fecf8 37 {
valeyev 0:e056ac8fecf8 38 if ((number % alignment) != 0) {
valeyev 0:e056ac8fecf8 39 return false;
valeyev 0:e056ac8fecf8 40 } else {
valeyev 0:e056ac8fecf8 41 return true;
valeyev 0:e056ac8fecf8 42 }
valeyev 0:e056ac8fecf8 43 }
valeyev 0:e056ac8fecf8 44
valeyev 0:e056ac8fecf8 45 FlashIAP::FlashIAP()
valeyev 0:e056ac8fecf8 46 {
valeyev 0:e056ac8fecf8 47
valeyev 0:e056ac8fecf8 48 }
valeyev 0:e056ac8fecf8 49
valeyev 0:e056ac8fecf8 50 FlashIAP::~FlashIAP()
valeyev 0:e056ac8fecf8 51 {
valeyev 0:e056ac8fecf8 52
valeyev 0:e056ac8fecf8 53 }
valeyev 0:e056ac8fecf8 54
valeyev 0:e056ac8fecf8 55 int FlashIAP::init()
valeyev 0:e056ac8fecf8 56 {
valeyev 0:e056ac8fecf8 57 int ret = 0;
valeyev 0:e056ac8fecf8 58 _mutex->lock();
valeyev 0:e056ac8fecf8 59 if (flash_init(&_flash)) {
valeyev 0:e056ac8fecf8 60 ret = -1;
valeyev 0:e056ac8fecf8 61 }
valeyev 0:e056ac8fecf8 62 uint32_t page_size = get_page_size();
valeyev 0:e056ac8fecf8 63 _page_buf = new uint8_t[page_size];
valeyev 0:e056ac8fecf8 64
valeyev 0:e056ac8fecf8 65 _mutex->unlock();
valeyev 0:e056ac8fecf8 66 return ret;
valeyev 0:e056ac8fecf8 67 }
valeyev 0:e056ac8fecf8 68
valeyev 0:e056ac8fecf8 69 int FlashIAP::deinit()
valeyev 0:e056ac8fecf8 70 {
valeyev 0:e056ac8fecf8 71 int ret = 0;
valeyev 0:e056ac8fecf8 72 _mutex->lock();
valeyev 0:e056ac8fecf8 73 if (flash_free(&_flash)) {
valeyev 0:e056ac8fecf8 74 ret = -1;
valeyev 0:e056ac8fecf8 75 }
valeyev 0:e056ac8fecf8 76 delete[] _page_buf;
valeyev 0:e056ac8fecf8 77 _mutex->unlock();
valeyev 0:e056ac8fecf8 78 return ret;
valeyev 0:e056ac8fecf8 79 }
valeyev 0:e056ac8fecf8 80
valeyev 0:e056ac8fecf8 81
valeyev 0:e056ac8fecf8 82 int FlashIAP::read(void *buffer, uint32_t addr, uint32_t size)
valeyev 0:e056ac8fecf8 83 {
valeyev 0:e056ac8fecf8 84 int32_t ret = -1;
valeyev 0:e056ac8fecf8 85 _mutex->lock();
valeyev 0:e056ac8fecf8 86 ret = flash_read(&_flash, addr, (uint8_t *) buffer, size);
valeyev 0:e056ac8fecf8 87 _mutex->unlock();
valeyev 0:e056ac8fecf8 88 return ret;
valeyev 0:e056ac8fecf8 89 }
valeyev 0:e056ac8fecf8 90
valeyev 0:e056ac8fecf8 91 int FlashIAP::program(const void *buffer, uint32_t addr, uint32_t size)
valeyev 0:e056ac8fecf8 92 {
valeyev 0:e056ac8fecf8 93 uint32_t page_size = get_page_size();
valeyev 0:e056ac8fecf8 94 uint32_t flash_size = flash_get_size(&_flash);
valeyev 0:e056ac8fecf8 95 uint32_t flash_start_addr = flash_get_start_address(&_flash);
valeyev 0:e056ac8fecf8 96 uint32_t chunk, prog_size;
valeyev 0:e056ac8fecf8 97 const uint8_t *buf = (uint8_t *) buffer;
valeyev 0:e056ac8fecf8 98 const uint8_t *prog_buf;
valeyev 0:e056ac8fecf8 99
valeyev 0:e056ac8fecf8 100 // addr should be aligned to page size
valeyev 0:e056ac8fecf8 101 if (!is_aligned(addr, page_size) || (!buffer) ||
valeyev 0:e056ac8fecf8 102 ((addr + size) > (flash_start_addr + flash_size))) {
valeyev 0:e056ac8fecf8 103 return -1;
valeyev 0:e056ac8fecf8 104 }
valeyev 0:e056ac8fecf8 105
valeyev 0:e056ac8fecf8 106 int ret = 0;
valeyev 0:e056ac8fecf8 107 _mutex->lock();
valeyev 0:e056ac8fecf8 108 while (size) {
valeyev 0:e056ac8fecf8 109 uint32_t current_sector_size = flash_get_sector_size(&_flash, addr);
valeyev 0:e056ac8fecf8 110 chunk = std::min(current_sector_size - (addr % current_sector_size), size);
valeyev 0:e056ac8fecf8 111 if (chunk < page_size) {
valeyev 0:e056ac8fecf8 112 memcpy(_page_buf, buf, chunk);
valeyev 0:e056ac8fecf8 113 memset(_page_buf + chunk, 0xFF, page_size - chunk);
valeyev 0:e056ac8fecf8 114 prog_buf = _page_buf;
valeyev 0:e056ac8fecf8 115 prog_size = page_size;
valeyev 0:e056ac8fecf8 116 } else {
valeyev 0:e056ac8fecf8 117 chunk = chunk / page_size * page_size;
valeyev 0:e056ac8fecf8 118 prog_buf = buf;
valeyev 0:e056ac8fecf8 119 prog_size = chunk;
valeyev 0:e056ac8fecf8 120 }
valeyev 0:e056ac8fecf8 121 if (flash_program_page(&_flash, addr, prog_buf, prog_size)) {
valeyev 0:e056ac8fecf8 122 ret = -1;
valeyev 0:e056ac8fecf8 123 break;
valeyev 0:e056ac8fecf8 124 }
valeyev 0:e056ac8fecf8 125 size -= chunk;
valeyev 0:e056ac8fecf8 126 addr += chunk;
valeyev 0:e056ac8fecf8 127 buf += chunk;
valeyev 0:e056ac8fecf8 128 }
valeyev 0:e056ac8fecf8 129 _mutex->unlock();
valeyev 0:e056ac8fecf8 130
valeyev 0:e056ac8fecf8 131 return ret;
valeyev 0:e056ac8fecf8 132 }
valeyev 0:e056ac8fecf8 133
valeyev 0:e056ac8fecf8 134 bool FlashIAP::is_aligned_to_sector(uint32_t addr, uint32_t size)
valeyev 0:e056ac8fecf8 135 {
valeyev 0:e056ac8fecf8 136 uint32_t current_sector_size = flash_get_sector_size(&_flash, addr);
valeyev 0:e056ac8fecf8 137 if (!is_aligned(size, current_sector_size) ||
valeyev 0:e056ac8fecf8 138 !is_aligned(addr, current_sector_size)) {
valeyev 0:e056ac8fecf8 139 return false;
valeyev 0:e056ac8fecf8 140 } else {
valeyev 0:e056ac8fecf8 141 return true;
valeyev 0:e056ac8fecf8 142 }
valeyev 0:e056ac8fecf8 143 }
valeyev 0:e056ac8fecf8 144
valeyev 0:e056ac8fecf8 145 int FlashIAP::erase(uint32_t addr, uint32_t size)
valeyev 0:e056ac8fecf8 146 {
valeyev 0:e056ac8fecf8 147 uint32_t current_sector_size;
valeyev 0:e056ac8fecf8 148 uint32_t flash_size = flash_get_size(&_flash);
valeyev 0:e056ac8fecf8 149 uint32_t flash_start_addr = flash_get_start_address(&_flash);
valeyev 0:e056ac8fecf8 150 uint32_t flash_end_addr = flash_start_addr + flash_size;
valeyev 0:e056ac8fecf8 151 uint32_t erase_end_addr = addr + size;
valeyev 0:e056ac8fecf8 152
valeyev 0:e056ac8fecf8 153 if (erase_end_addr > flash_end_addr) {
valeyev 0:e056ac8fecf8 154 return -1;
valeyev 0:e056ac8fecf8 155 } else if (erase_end_addr < flash_end_addr){
valeyev 0:e056ac8fecf8 156 uint32_t following_sector_size = flash_get_sector_size(&_flash, erase_end_addr);
valeyev 0:e056ac8fecf8 157 if (!is_aligned(erase_end_addr, following_sector_size)) {
valeyev 0:e056ac8fecf8 158 return -1;
valeyev 0:e056ac8fecf8 159 }
valeyev 0:e056ac8fecf8 160 }
valeyev 0:e056ac8fecf8 161
valeyev 0:e056ac8fecf8 162 int32_t ret = 0;
valeyev 0:e056ac8fecf8 163 _mutex->lock();
valeyev 0:e056ac8fecf8 164 while (size) {
valeyev 0:e056ac8fecf8 165 ret = flash_erase_sector(&_flash, addr);
valeyev 0:e056ac8fecf8 166 if (ret != 0) {
valeyev 0:e056ac8fecf8 167 ret = -1;
valeyev 0:e056ac8fecf8 168 break;
valeyev 0:e056ac8fecf8 169 }
valeyev 0:e056ac8fecf8 170 current_sector_size = flash_get_sector_size(&_flash, addr);
valeyev 0:e056ac8fecf8 171 size -= current_sector_size;
valeyev 0:e056ac8fecf8 172 addr += current_sector_size;
valeyev 0:e056ac8fecf8 173 }
valeyev 0:e056ac8fecf8 174 _mutex->unlock();
valeyev 0:e056ac8fecf8 175 return ret;
valeyev 0:e056ac8fecf8 176 }
valeyev 0:e056ac8fecf8 177
valeyev 0:e056ac8fecf8 178 uint32_t FlashIAP::get_page_size() const
valeyev 0:e056ac8fecf8 179 {
valeyev 0:e056ac8fecf8 180 return flash_get_page_size(&_flash);
valeyev 0:e056ac8fecf8 181 }
valeyev 0:e056ac8fecf8 182
valeyev 0:e056ac8fecf8 183 uint32_t FlashIAP::get_sector_size(uint32_t addr) const
valeyev 0:e056ac8fecf8 184 {
valeyev 0:e056ac8fecf8 185 return flash_get_sector_size(&_flash, addr);
valeyev 0:e056ac8fecf8 186 }
valeyev 0:e056ac8fecf8 187
valeyev 0:e056ac8fecf8 188 uint32_t FlashIAP::get_flash_start() const
valeyev 0:e056ac8fecf8 189 {
valeyev 0:e056ac8fecf8 190 return flash_get_start_address(&_flash);
valeyev 0:e056ac8fecf8 191 }
valeyev 0:e056ac8fecf8 192
valeyev 0:e056ac8fecf8 193 uint32_t FlashIAP::get_flash_size() const
valeyev 0:e056ac8fecf8 194 {
valeyev 0:e056ac8fecf8 195 return flash_get_size(&_flash);
valeyev 0:e056ac8fecf8 196 }
valeyev 0:e056ac8fecf8 197
valeyev 0:e056ac8fecf8 198 }
valeyev 0:e056ac8fecf8 199
valeyev 0:e056ac8fecf8 200 #endif