Kev Mann / mbed-dev-OS5_10_4

RTC auf true

features/storage/blockdevice/ExhaustibleBlockDevice.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 "ExhaustibleBlockDevice.h"
kevman 0:38ceb79fef03 18 #include "platform/mbed_critical.h"
kevman 0:38ceb79fef03 19 #include "platform/mbed_assert.h"
kevman 0:38ceb79fef03 20
kevman 0:38ceb79fef03 21 ExhaustibleBlockDevice::ExhaustibleBlockDevice(BlockDevice *bd, uint32_t erase_cycles)
kevman 0:38ceb79fef03 22 : _bd(bd), _erase_array(NULL), _erase_cycles(erase_cycles), _init_ref_count(0), _is_initialized(false)
kevman 0:38ceb79fef03 23 {
kevman 0:38ceb79fef03 24 }
kevman 0:38ceb79fef03 25
kevman 0:38ceb79fef03 26 ExhaustibleBlockDevice::~ExhaustibleBlockDevice()
kevman 0:38ceb79fef03 27 {
kevman 0:38ceb79fef03 28 delete[] _erase_array;
kevman 0:38ceb79fef03 29 }
kevman 0:38ceb79fef03 30
kevman 0:38ceb79fef03 31 int ExhaustibleBlockDevice::init()
kevman 0:38ceb79fef03 32 {
kevman 0:38ceb79fef03 33 int err;
kevman 0:38ceb79fef03 34 uint32_t val = core_util_atomic_incr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 35
kevman 0:38ceb79fef03 36 if (val != 1) {
kevman 0:38ceb79fef03 37 return BD_ERROR_OK;
kevman 0:38ceb79fef03 38 }
kevman 0:38ceb79fef03 39
kevman 0:38ceb79fef03 40 err = _bd->init();
kevman 0:38ceb79fef03 41 if (err) {
kevman 0:38ceb79fef03 42 goto fail;
kevman 0:38ceb79fef03 43 }
kevman 0:38ceb79fef03 44
kevman 0:38ceb79fef03 45 if (!_erase_array) {
kevman 0:38ceb79fef03 46 // can only be allocated after initialization
kevman 0:38ceb79fef03 47 _erase_array = new uint32_t[_bd->size() / _bd->get_erase_size()];
kevman 0:38ceb79fef03 48 for (size_t i = 0; i < _bd->size() / _bd->get_erase_size(); i++) {
kevman 0:38ceb79fef03 49 _erase_array[i] = _erase_cycles;
kevman 0:38ceb79fef03 50 }
kevman 0:38ceb79fef03 51 }
kevman 0:38ceb79fef03 52
kevman 0:38ceb79fef03 53 _is_initialized = true;
kevman 0:38ceb79fef03 54 return BD_ERROR_OK;
kevman 0:38ceb79fef03 55
kevman 0:38ceb79fef03 56 fail:
kevman 0:38ceb79fef03 57 _is_initialized = false;
kevman 0:38ceb79fef03 58 _init_ref_count = 0;
kevman 0:38ceb79fef03 59 return err;
kevman 0:38ceb79fef03 60 }
kevman 0:38ceb79fef03 61
kevman 0:38ceb79fef03 62 int ExhaustibleBlockDevice::deinit()
kevman 0:38ceb79fef03 63 {
kevman 0:38ceb79fef03 64 if (!_is_initialized) {
kevman 0:38ceb79fef03 65 return BD_ERROR_OK;
kevman 0:38ceb79fef03 66 }
kevman 0:38ceb79fef03 67
kevman 0:38ceb79fef03 68 core_util_atomic_decr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 69
kevman 0:38ceb79fef03 70 if (_init_ref_count) {
kevman 0:38ceb79fef03 71 return BD_ERROR_OK;
kevman 0:38ceb79fef03 72 }
kevman 0:38ceb79fef03 73
kevman 0:38ceb79fef03 74 // _erase_array is lazily cleaned up in destructor to allow
kevman 0:38ceb79fef03 75 // data to live across de/reinitialization
kevman 0:38ceb79fef03 76 _is_initialized = false;
kevman 0:38ceb79fef03 77 return _bd->deinit();
kevman 0:38ceb79fef03 78 }
kevman 0:38ceb79fef03 79
kevman 0:38ceb79fef03 80 int ExhaustibleBlockDevice::sync()
kevman 0:38ceb79fef03 81 {
kevman 0:38ceb79fef03 82 if (!_is_initialized) {
kevman 0:38ceb79fef03 83 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 84 }
kevman 0:38ceb79fef03 85
kevman 0:38ceb79fef03 86 return _bd->sync();
kevman 0:38ceb79fef03 87 }
kevman 0:38ceb79fef03 88
kevman 0:38ceb79fef03 89 int ExhaustibleBlockDevice::read(void *buffer, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 90 {
kevman 0:38ceb79fef03 91 if (!_is_initialized) {
kevman 0:38ceb79fef03 92 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 93 }
kevman 0:38ceb79fef03 94
kevman 0:38ceb79fef03 95 return _bd->read(buffer, addr, size);
kevman 0:38ceb79fef03 96 }
kevman 0:38ceb79fef03 97
kevman 0:38ceb79fef03 98 int ExhaustibleBlockDevice::program(const void *buffer, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 99 {
kevman 0:38ceb79fef03 100 MBED_ASSERT(is_valid_program(addr, size));
kevman 0:38ceb79fef03 101
kevman 0:38ceb79fef03 102 if (!_is_initialized) {
kevman 0:38ceb79fef03 103 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 104 }
kevman 0:38ceb79fef03 105
kevman 0:38ceb79fef03 106 if (_erase_array[addr / get_erase_size()] == 0) {
kevman 0:38ceb79fef03 107 return 0;
kevman 0:38ceb79fef03 108 }
kevman 0:38ceb79fef03 109
kevman 0:38ceb79fef03 110 return _bd->program(buffer, addr, size);
kevman 0:38ceb79fef03 111 }
kevman 0:38ceb79fef03 112
kevman 0:38ceb79fef03 113 int ExhaustibleBlockDevice::erase(bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 114 {
kevman 0:38ceb79fef03 115 MBED_ASSERT(is_valid_erase(addr, size));
kevman 0:38ceb79fef03 116 if (!_is_initialized) {
kevman 0:38ceb79fef03 117 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 118 }
kevman 0:38ceb79fef03 119
kevman 0:38ceb79fef03 120 bd_size_t eu_size = get_erase_size();
kevman 0:38ceb79fef03 121 while (size) {
kevman 0:38ceb79fef03 122 // use an erase cycle
kevman 0:38ceb79fef03 123 if (_erase_array[addr / eu_size] > 0) {
kevman 0:38ceb79fef03 124 _erase_array[addr / eu_size] -= 1;
kevman 0:38ceb79fef03 125 }
kevman 0:38ceb79fef03 126
kevman 0:38ceb79fef03 127 if (_erase_array[addr / eu_size] > 0) {
kevman 0:38ceb79fef03 128 int err = _bd->erase(addr, eu_size);
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 addr += eu_size;
kevman 0:38ceb79fef03 135 size -= eu_size;
kevman 0:38ceb79fef03 136 }
kevman 0:38ceb79fef03 137
kevman 0:38ceb79fef03 138 return 0;
kevman 0:38ceb79fef03 139 }
kevman 0:38ceb79fef03 140
kevman 0:38ceb79fef03 141 bd_size_t ExhaustibleBlockDevice::get_read_size() const
kevman 0:38ceb79fef03 142 {
kevman 0:38ceb79fef03 143 if (!_is_initialized) {
kevman 0:38ceb79fef03 144 return 0;
kevman 0:38ceb79fef03 145 }
kevman 0:38ceb79fef03 146
kevman 0:38ceb79fef03 147 return _bd->get_read_size();
kevman 0:38ceb79fef03 148 }
kevman 0:38ceb79fef03 149
kevman 0:38ceb79fef03 150 bd_size_t ExhaustibleBlockDevice::get_program_size() const
kevman 0:38ceb79fef03 151 {
kevman 0:38ceb79fef03 152 if (!_is_initialized) {
kevman 0:38ceb79fef03 153 return 0;
kevman 0:38ceb79fef03 154 }
kevman 0:38ceb79fef03 155
kevman 0:38ceb79fef03 156 return _bd->get_program_size();
kevman 0:38ceb79fef03 157 }
kevman 0:38ceb79fef03 158
kevman 0:38ceb79fef03 159 bd_size_t ExhaustibleBlockDevice::get_erase_size() const
kevman 0:38ceb79fef03 160 {
kevman 0:38ceb79fef03 161 if (!_is_initialized) {
kevman 0:38ceb79fef03 162 return 0;
kevman 0:38ceb79fef03 163 }
kevman 0:38ceb79fef03 164
kevman 0:38ceb79fef03 165 return _bd->get_erase_size();
kevman 0:38ceb79fef03 166 }
kevman 0:38ceb79fef03 167
kevman 0:38ceb79fef03 168 bd_size_t ExhaustibleBlockDevice::get_erase_size(bd_addr_t addr) const
kevman 0:38ceb79fef03 169 {
kevman 0:38ceb79fef03 170 if (!_is_initialized) {
kevman 0:38ceb79fef03 171 return 0;
kevman 0:38ceb79fef03 172 }
kevman 0:38ceb79fef03 173
kevman 0:38ceb79fef03 174 return _bd->get_erase_size(addr);
kevman 0:38ceb79fef03 175 }
kevman 0:38ceb79fef03 176
kevman 0:38ceb79fef03 177 int ExhaustibleBlockDevice::get_erase_value() const
kevman 0:38ceb79fef03 178 {
kevman 0:38ceb79fef03 179 if (!_is_initialized) {
kevman 0:38ceb79fef03 180 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 181 }
kevman 0:38ceb79fef03 182
kevman 0:38ceb79fef03 183 return _bd->get_erase_value();
kevman 0:38ceb79fef03 184 }
kevman 0:38ceb79fef03 185
kevman 0:38ceb79fef03 186 bd_size_t ExhaustibleBlockDevice::size() const
kevman 0:38ceb79fef03 187 {
kevman 0:38ceb79fef03 188 if (!_is_initialized) {
kevman 0:38ceb79fef03 189 return 0;
kevman 0:38ceb79fef03 190 }
kevman 0:38ceb79fef03 191
kevman 0:38ceb79fef03 192 return _bd->size();
kevman 0:38ceb79fef03 193 }