Kev Mann / mbed-dev-OS5_10_4

RTC auf true

features/storage/blockdevice/ChainingBlockDevice.cpp@2:7aab896b1a3b, 2019-03-13 (annotated)

Committer:
kevman
Date:
Wed Mar 13 11:03:24 2019 +0000
Revision:
2:7aab896b1a3b
Parent:
0:38ceb79fef03 
2019-03-13

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kevman 0:38ceb79fef03 1 /* mbed Microcontroller Library
kevman 0:38ceb79fef03 2 * Copyright (c) 2017 ARM Limited
kevman 0:38ceb79fef03 3 *
kevman 0:38ceb79fef03 4 * Licensed under the Apache License, Version 2.0 (the "License");
kevman 0:38ceb79fef03 5 * you may not use this file except in compliance with the License.
kevman 0:38ceb79fef03 6 * You may obtain a copy of the License at
kevman 0:38ceb79fef03 7 *
kevman 0:38ceb79fef03 8 * http://www.apache.org/licenses/LICENSE-2.0
kevman 0:38ceb79fef03 9 *
kevman 0:38ceb79fef03 10 * Unless required by applicable law or agreed to in writing, software
kevman 0:38ceb79fef03 11 * distributed under the License is distributed on an "AS IS" BASIS,
kevman 0:38ceb79fef03 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kevman 0:38ceb79fef03 13 * See the License for the specific language governing permissions and
kevman 0:38ceb79fef03 14 * limitations under the License.
kevman 0:38ceb79fef03 15 */
kevman 0:38ceb79fef03 16
kevman 0:38ceb79fef03 17 #include "ChainingBlockDevice.h"
kevman 0:38ceb79fef03 18 #include "platform/mbed_critical.h"
kevman 0:38ceb79fef03 19
kevman 0:38ceb79fef03 20
kevman 0:38ceb79fef03 21 ChainingBlockDevice::ChainingBlockDevice(BlockDevice **bds, size_t bd_count)
kevman 0:38ceb79fef03 22 : _bds(bds), _bd_count(bd_count)
kevman 0:38ceb79fef03 23 , _read_size(0), _program_size(0), _erase_size(0), _size(0)
kevman 0:38ceb79fef03 24 , _erase_value(-1), _init_ref_count(0), _is_initialized(false)
kevman 0:38ceb79fef03 25 {
kevman 0:38ceb79fef03 26 }
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 static bool is_aligned(uint64_t x, uint64_t alignment)
kevman 0:38ceb79fef03 29 {
kevman 0:38ceb79fef03 30 return (x / alignment) * alignment == x;
kevman 0:38ceb79fef03 31 }
kevman 0:38ceb79fef03 32
kevman 0:38ceb79fef03 33 int ChainingBlockDevice::init()
kevman 0:38ceb79fef03 34 {
kevman 0:38ceb79fef03 35 int err;
kevman 0:38ceb79fef03 36 uint32_t val = core_util_atomic_incr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 37
kevman 0:38ceb79fef03 38 if (val != 1) {
kevman 0:38ceb79fef03 39 return BD_ERROR_OK;
kevman 0:38ceb79fef03 40 }
kevman 0:38ceb79fef03 41
kevman 0:38ceb79fef03 42 _read_size = 0;
kevman 0:38ceb79fef03 43 _program_size = 0;
kevman 0:38ceb79fef03 44 _erase_size = 0;
kevman 0:38ceb79fef03 45 _erase_value = -1;
kevman 0:38ceb79fef03 46 _size = 0;
kevman 0:38ceb79fef03 47
kevman 0:38ceb79fef03 48 // Initialize children block devices, find all sizes and
kevman 0:38ceb79fef03 49 // assert that block sizes are similar. We can't do this in
kevman 0:38ceb79fef03 50 // the constructor since some block devices may need to be
kevman 0:38ceb79fef03 51 // initialized before they know their block size/count
kevman 0:38ceb79fef03 52 for (size_t i = 0; i < _bd_count; i++) {
kevman 0:38ceb79fef03 53 err = _bds[i]->init();
kevman 0:38ceb79fef03 54 if (err) {
kevman 0:38ceb79fef03 55 goto fail;
kevman 0:38ceb79fef03 56 }
kevman 0:38ceb79fef03 57
kevman 0:38ceb79fef03 58 bd_size_t read = _bds[i]->get_read_size();
kevman 0:38ceb79fef03 59 if (i == 0 || (read >= _read_size && is_aligned(read, _read_size))) {
kevman 0:38ceb79fef03 60 _read_size = read;
kevman 0:38ceb79fef03 61 } else {
kevman 0:38ceb79fef03 62 MBED_ASSERT(_read_size > read && is_aligned(_read_size, read));
kevman 0:38ceb79fef03 63 }
kevman 0:38ceb79fef03 64
kevman 0:38ceb79fef03 65 bd_size_t program = _bds[i]->get_program_size();
kevman 0:38ceb79fef03 66 if (i == 0 || (program >= _program_size && is_aligned(program, _program_size))) {
kevman 0:38ceb79fef03 67 _program_size = program;
kevman 0:38ceb79fef03 68 } else {
kevman 0:38ceb79fef03 69 MBED_ASSERT(_program_size > program && is_aligned(_program_size, program));
kevman 0:38ceb79fef03 70 }
kevman 0:38ceb79fef03 71
kevman 0:38ceb79fef03 72 bd_size_t erase = _bds[i]->get_erase_size();
kevman 0:38ceb79fef03 73 if (i == 0 || (erase >= _erase_size && is_aligned(erase, _erase_size))) {
kevman 0:38ceb79fef03 74 _erase_size = erase;
kevman 0:38ceb79fef03 75 } else {
kevman 0:38ceb79fef03 76 MBED_ASSERT(_erase_size > erase && is_aligned(_erase_size, erase));
kevman 0:38ceb79fef03 77 }
kevman 0:38ceb79fef03 78
kevman 0:38ceb79fef03 79 int value = _bds[i]->get_erase_value();
kevman 0:38ceb79fef03 80 if (i == 0 || value == _erase_value) {
kevman 0:38ceb79fef03 81 _erase_value = value;
kevman 0:38ceb79fef03 82 } else {
kevman 0:38ceb79fef03 83 _erase_value = -1;
kevman 0:38ceb79fef03 84 }
kevman 0:38ceb79fef03 85
kevman 0:38ceb79fef03 86 _size += _bds[i]->size();
kevman 0:38ceb79fef03 87 }
kevman 0:38ceb79fef03 88
kevman 0:38ceb79fef03 89 _is_initialized = true;
kevman 0:38ceb79fef03 90 return BD_ERROR_OK;
kevman 0:38ceb79fef03 91
kevman 0:38ceb79fef03 92 fail:
kevman 0:38ceb79fef03 93 _is_initialized = false;
kevman 0:38ceb79fef03 94 _init_ref_count = 0;
kevman 0:38ceb79fef03 95 return err;
kevman 0:38ceb79fef03 96 }
kevman 0:38ceb79fef03 97
kevman 0:38ceb79fef03 98 int ChainingBlockDevice::deinit()
kevman 0:38ceb79fef03 99 {
kevman 0:38ceb79fef03 100 if (!_is_initialized) {
kevman 0:38ceb79fef03 101 return BD_ERROR_OK;
kevman 0:38ceb79fef03 102 }
kevman 0:38ceb79fef03 103
kevman 0:38ceb79fef03 104 uint32_t val = core_util_atomic_decr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 105
kevman 0:38ceb79fef03 106 if (val) {
kevman 0:38ceb79fef03 107 return BD_ERROR_OK;
kevman 0:38ceb79fef03 108 }
kevman 0:38ceb79fef03 109
kevman 0:38ceb79fef03 110 for (size_t i = 0; i < _bd_count; i++) {
kevman 0:38ceb79fef03 111 int err = _bds[i]->deinit();
kevman 0:38ceb79fef03 112 if (err) {
kevman 0:38ceb79fef03 113 return err;
kevman 0:38ceb79fef03 114 }
kevman 0:38ceb79fef03 115 }
kevman 0:38ceb79fef03 116
kevman 0:38ceb79fef03 117 _is_initialized = false;
kevman 0:38ceb79fef03 118 return BD_ERROR_OK;
kevman 0:38ceb79fef03 119 }
kevman 0:38ceb79fef03 120
kevman 0:38ceb79fef03 121 int ChainingBlockDevice::sync()
kevman 0:38ceb79fef03 122 {
kevman 0:38ceb79fef03 123 if (!_is_initialized) {
kevman 0:38ceb79fef03 124 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 125 }
kevman 0:38ceb79fef03 126
kevman 0:38ceb79fef03 127 for (size_t i = 0; i < _bd_count; i++) {
kevman 0:38ceb79fef03 128 int err = _bds[i]->sync();
kevman 0:38ceb79fef03 129 if (err) {
kevman 0:38ceb79fef03 130 return err;
kevman 0:38ceb79fef03 131 }
kevman 0:38ceb79fef03 132 }
kevman 0:38ceb79fef03 133
kevman 0:38ceb79fef03 134 return 0;
kevman 0:38ceb79fef03 135 }
kevman 0:38ceb79fef03 136
kevman 0:38ceb79fef03 137 int ChainingBlockDevice::read(void *b, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 138 {
kevman 0:38ceb79fef03 139 MBED_ASSERT(is_valid_read(addr, size));
kevman 0:38ceb79fef03 140 if (!_is_initialized) {
kevman 0:38ceb79fef03 141 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 142 }
kevman 0:38ceb79fef03 143
kevman 0:38ceb79fef03 144 uint8_t *buffer = static_cast<uint8_t*>(b);
kevman 0:38ceb79fef03 145
kevman 0:38ceb79fef03 146 // Find block devices containing blocks, may span multiple block devices
kevman 0:38ceb79fef03 147 for (size_t i = 0; i < _bd_count && size > 0; i++) {
kevman 0:38ceb79fef03 148 bd_size_t bdsize = _bds[i]->size();
kevman 0:38ceb79fef03 149
kevman 0:38ceb79fef03 150 if (addr < bdsize) {
kevman 0:38ceb79fef03 151 bd_size_t read = size;
kevman 0:38ceb79fef03 152 if (addr + read > bdsize) {
kevman 0:38ceb79fef03 153 read = bdsize - addr;
kevman 0:38ceb79fef03 154 }
kevman 0:38ceb79fef03 155
kevman 0:38ceb79fef03 156 int err = _bds[i]->read(buffer, addr, read);
kevman 0:38ceb79fef03 157 if (err) {
kevman 0:38ceb79fef03 158 return err;
kevman 0:38ceb79fef03 159 }
kevman 0:38ceb79fef03 160
kevman 0:38ceb79fef03 161 buffer += read;
kevman 0:38ceb79fef03 162 addr += read;
kevman 0:38ceb79fef03 163 size -= read;
kevman 0:38ceb79fef03 164 }
kevman 0:38ceb79fef03 165
kevman 0:38ceb79fef03 166 addr -= bdsize;
kevman 0:38ceb79fef03 167 }
kevman 0:38ceb79fef03 168
kevman 0:38ceb79fef03 169 return 0;
kevman 0:38ceb79fef03 170 }
kevman 0:38ceb79fef03 171
kevman 0:38ceb79fef03 172 int ChainingBlockDevice::program(const void *b, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 173 {
kevman 0:38ceb79fef03 174 MBED_ASSERT(is_valid_program(addr, size));
kevman 0:38ceb79fef03 175 if (!_is_initialized) {
kevman 0:38ceb79fef03 176 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 177 }
kevman 0:38ceb79fef03 178
kevman 0:38ceb79fef03 179 const uint8_t *buffer = static_cast<const uint8_t*>(b);
kevman 0:38ceb79fef03 180
kevman 0:38ceb79fef03 181 // Find block devices containing blocks, may span multiple block devices
kevman 0:38ceb79fef03 182 for (size_t i = 0; i < _bd_count && size > 0; i++) {
kevman 0:38ceb79fef03 183 bd_size_t bdsize = _bds[i]->size();
kevman 0:38ceb79fef03 184
kevman 0:38ceb79fef03 185 if (addr < bdsize) {
kevman 0:38ceb79fef03 186 bd_size_t program = size;
kevman 0:38ceb79fef03 187 if (addr + program > bdsize) {
kevman 0:38ceb79fef03 188 program = bdsize - addr;
kevman 0:38ceb79fef03 189 }
kevman 0:38ceb79fef03 190
kevman 0:38ceb79fef03 191 int err = _bds[i]->program(buffer, addr, program);
kevman 0:38ceb79fef03 192 if (err) {
kevman 0:38ceb79fef03 193 return err;
kevman 0:38ceb79fef03 194 }
kevman 0:38ceb79fef03 195
kevman 0:38ceb79fef03 196 buffer += program;
kevman 0:38ceb79fef03 197 addr += program;
kevman 0:38ceb79fef03 198 size -= program;
kevman 0:38ceb79fef03 199 }
kevman 0:38ceb79fef03 200
kevman 0:38ceb79fef03 201 addr -= bdsize;
kevman 0:38ceb79fef03 202 }
kevman 0:38ceb79fef03 203
kevman 0:38ceb79fef03 204 return 0;
kevman 0:38ceb79fef03 205 }
kevman 0:38ceb79fef03 206
kevman 0:38ceb79fef03 207 int ChainingBlockDevice::erase(bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 208 {
kevman 0:38ceb79fef03 209 MBED_ASSERT(is_valid_erase(addr, size));
kevman 0:38ceb79fef03 210 if (!_is_initialized) {
kevman 0:38ceb79fef03 211 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 212 }
kevman 0:38ceb79fef03 213
kevman 0:38ceb79fef03 214 // Find block devices containing blocks, may span multiple block devices
kevman 0:38ceb79fef03 215 for (size_t i = 0; i < _bd_count && size > 0; i++) {
kevman 0:38ceb79fef03 216 bd_size_t bdsize = _bds[i]->size();
kevman 0:38ceb79fef03 217
kevman 0:38ceb79fef03 218 if (addr < bdsize) {
kevman 0:38ceb79fef03 219 bd_size_t erase = size;
kevman 0:38ceb79fef03 220 if (addr + erase > bdsize) {
kevman 0:38ceb79fef03 221 erase = bdsize - addr;
kevman 0:38ceb79fef03 222 }
kevman 0:38ceb79fef03 223
kevman 0:38ceb79fef03 224 int err = _bds[i]->erase(addr, erase);
kevman 0:38ceb79fef03 225 if (err) {
kevman 0:38ceb79fef03 226 return err;
kevman 0:38ceb79fef03 227 }
kevman 0:38ceb79fef03 228
kevman 0:38ceb79fef03 229 addr += erase;
kevman 0:38ceb79fef03 230 size -= erase;
kevman 0:38ceb79fef03 231 }
kevman 0:38ceb79fef03 232
kevman 0:38ceb79fef03 233 addr -= bdsize;
kevman 0:38ceb79fef03 234 }
kevman 0:38ceb79fef03 235
kevman 0:38ceb79fef03 236 return 0;
kevman 0:38ceb79fef03 237 }
kevman 0:38ceb79fef03 238
kevman 0:38ceb79fef03 239 bd_size_t ChainingBlockDevice::get_read_size() const
kevman 0:38ceb79fef03 240 {
kevman 0:38ceb79fef03 241 return _read_size;
kevman 0:38ceb79fef03 242 }
kevman 0:38ceb79fef03 243
kevman 0:38ceb79fef03 244 bd_size_t ChainingBlockDevice::get_program_size() const
kevman 0:38ceb79fef03 245 {
kevman 0:38ceb79fef03 246 return _program_size;
kevman 0:38ceb79fef03 247 }
kevman 0:38ceb79fef03 248
kevman 0:38ceb79fef03 249 bd_size_t ChainingBlockDevice::get_erase_size() const
kevman 0:38ceb79fef03 250 {
kevman 0:38ceb79fef03 251 return _erase_size;
kevman 0:38ceb79fef03 252 }
kevman 0:38ceb79fef03 253
kevman 0:38ceb79fef03 254 bd_size_t ChainingBlockDevice::get_erase_size(bd_addr_t addr) const
kevman 0:38ceb79fef03 255 {
kevman 0:38ceb79fef03 256 if (!_is_initialized) {
kevman 0:38ceb79fef03 257 return 0;
kevman 0:38ceb79fef03 258 }
kevman 0:38ceb79fef03 259
kevman 0:38ceb79fef03 260 bd_addr_t bd_start_addr = 0;
kevman 0:38ceb79fef03 261 for (size_t i = 0; i < _bd_count; i++) {
kevman 0:38ceb79fef03 262 bd_size_t bdsize = _bds[i]->size();
kevman 0:38ceb79fef03 263 if (addr < (bd_start_addr + bdsize)) {
kevman 0:38ceb79fef03 264 return _bds[i]->get_erase_size(addr - bd_start_addr);
kevman 0:38ceb79fef03 265 }
kevman 0:38ceb79fef03 266 bd_start_addr += bdsize;
kevman 0:38ceb79fef03 267 }
kevman 0:38ceb79fef03 268
kevman 0:38ceb79fef03 269 // Getting here implies an illegal address
kevman 0:38ceb79fef03 270 MBED_ASSERT(0);
kevman 0:38ceb79fef03 271 return 0; // satisfy compiler
kevman 0:38ceb79fef03 272 }
kevman 0:38ceb79fef03 273
kevman 0:38ceb79fef03 274 int ChainingBlockDevice::get_erase_value() const
kevman 0:38ceb79fef03 275 {
kevman 0:38ceb79fef03 276 return _erase_value;
kevman 0:38ceb79fef03 277 }
kevman 0:38ceb79fef03 278
kevman 0:38ceb79fef03 279 bd_size_t ChainingBlockDevice::size() const
kevman 0:38ceb79fef03 280 {
kevman 0:38ceb79fef03 281 return _size;
kevman 0:38ceb79fef03 282 }