Gan likun / The prosthetic control

The prosthetic control（MIT）

drivers/FlashIAP.cpp@0:20e0c61e0684, 2022-06-23 (annotated)

Committer:
ganlikun
Date:
Thu Jun 23 05:23:34 2022 +0000
Revision:
0:20e0c61e0684
01

Who changed what in which revision?

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