Kev Mann / mbed-dev-OS5_10_4

RTC auf true

features/storage/blockdevice/HeapBlockDevice.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 "HeapBlockDevice.h"
kevman 0:38ceb79fef03 18 #include "platform/mbed_critical.h"
kevman 0:38ceb79fef03 19
kevman 0:38ceb79fef03 20
kevman 0:38ceb79fef03 21 HeapBlockDevice::HeapBlockDevice(bd_size_t size, bd_size_t block)
kevman 0:38ceb79fef03 22 : _read_size(block), _program_size(block), _erase_size(block)
kevman 0:38ceb79fef03 23 , _count(size / block), _blocks(0), _init_ref_count(0), _is_initialized(false)
kevman 0:38ceb79fef03 24 {
kevman 0:38ceb79fef03 25 MBED_ASSERT(_count * _erase_size == size);
kevman 0:38ceb79fef03 26 }
kevman 0:38ceb79fef03 27
kevman 0:38ceb79fef03 28 HeapBlockDevice::HeapBlockDevice(bd_size_t size, bd_size_t read, bd_size_t program, bd_size_t erase)
kevman 0:38ceb79fef03 29 : _read_size(read), _program_size(program), _erase_size(erase)
kevman 0:38ceb79fef03 30 , _count(size / erase), _blocks(0), _init_ref_count(0), _is_initialized(false)
kevman 0:38ceb79fef03 31 {
kevman 0:38ceb79fef03 32 MBED_ASSERT(_count * _erase_size == size);
kevman 0:38ceb79fef03 33 }
kevman 0:38ceb79fef03 34
kevman 0:38ceb79fef03 35 HeapBlockDevice::~HeapBlockDevice()
kevman 0:38ceb79fef03 36 {
kevman 0:38ceb79fef03 37 if (_blocks) {
kevman 0:38ceb79fef03 38 for (size_t i = 0; i < _count; i++) {
kevman 0:38ceb79fef03 39 free(_blocks[i]);
kevman 0:38ceb79fef03 40 }
kevman 0:38ceb79fef03 41
kevman 0:38ceb79fef03 42 delete[] _blocks;
kevman 0:38ceb79fef03 43 _blocks = 0;
kevman 0:38ceb79fef03 44 }
kevman 0:38ceb79fef03 45 }
kevman 0:38ceb79fef03 46
kevman 0:38ceb79fef03 47 int HeapBlockDevice::init()
kevman 0:38ceb79fef03 48 {
kevman 0:38ceb79fef03 49 uint32_t val = core_util_atomic_incr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 50
kevman 0:38ceb79fef03 51 if (val != 1) {
kevman 0:38ceb79fef03 52 return BD_ERROR_OK;
kevman 0:38ceb79fef03 53 }
kevman 0:38ceb79fef03 54
kevman 0:38ceb79fef03 55 if (!_blocks) {
kevman 0:38ceb79fef03 56 _blocks = new uint8_t*[_count];
kevman 0:38ceb79fef03 57 for (size_t i = 0; i < _count; i++) {
kevman 0:38ceb79fef03 58 _blocks[i] = 0;
kevman 0:38ceb79fef03 59 }
kevman 0:38ceb79fef03 60 }
kevman 0:38ceb79fef03 61
kevman 0:38ceb79fef03 62 _is_initialized = true;
kevman 0:38ceb79fef03 63 return BD_ERROR_OK;
kevman 0:38ceb79fef03 64 }
kevman 0:38ceb79fef03 65
kevman 0:38ceb79fef03 66 int HeapBlockDevice::deinit()
kevman 0:38ceb79fef03 67 {
kevman 0:38ceb79fef03 68 if (!_is_initialized) {
kevman 0:38ceb79fef03 69 return BD_ERROR_OK;
kevman 0:38ceb79fef03 70 }
kevman 0:38ceb79fef03 71
kevman 0:38ceb79fef03 72 uint32_t val = core_util_atomic_decr_u32(&_init_ref_count, 1);
kevman 0:38ceb79fef03 73
kevman 0:38ceb79fef03 74 if (val) {
kevman 0:38ceb79fef03 75 return BD_ERROR_OK;
kevman 0:38ceb79fef03 76 }
kevman 0:38ceb79fef03 77
kevman 0:38ceb79fef03 78 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 79 // Memory is lazily cleaned up in destructor to allow
kevman 0:38ceb79fef03 80 // data to live across de/reinitialization
kevman 0:38ceb79fef03 81 _is_initialized = false;
kevman 0:38ceb79fef03 82 return BD_ERROR_OK;
kevman 0:38ceb79fef03 83 }
kevman 0:38ceb79fef03 84
kevman 0:38ceb79fef03 85 bd_size_t HeapBlockDevice::get_read_size() const
kevman 0:38ceb79fef03 86 {
kevman 0:38ceb79fef03 87 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 88 return _read_size;
kevman 0:38ceb79fef03 89 }
kevman 0:38ceb79fef03 90
kevman 0:38ceb79fef03 91 bd_size_t HeapBlockDevice::get_program_size() const
kevman 0:38ceb79fef03 92 {
kevman 0:38ceb79fef03 93 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 94 return _program_size;
kevman 0:38ceb79fef03 95 }
kevman 0:38ceb79fef03 96
kevman 0:38ceb79fef03 97 bd_size_t HeapBlockDevice::get_erase_size() const
kevman 0:38ceb79fef03 98 {
kevman 0:38ceb79fef03 99 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 100 return _erase_size;
kevman 0:38ceb79fef03 101 }
kevman 0:38ceb79fef03 102
kevman 0:38ceb79fef03 103 bd_size_t HeapBlockDevice::get_erase_size(bd_addr_t addr) const
kevman 0:38ceb79fef03 104 {
kevman 0:38ceb79fef03 105 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 106 return _erase_size;
kevman 0:38ceb79fef03 107 }
kevman 0:38ceb79fef03 108
kevman 0:38ceb79fef03 109 bd_size_t HeapBlockDevice::size() const
kevman 0:38ceb79fef03 110 {
kevman 0:38ceb79fef03 111 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 112 return _count * _erase_size;
kevman 0:38ceb79fef03 113 }
kevman 0:38ceb79fef03 114
kevman 0:38ceb79fef03 115 int HeapBlockDevice::read(void *b, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 116 {
kevman 0:38ceb79fef03 117 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 118 MBED_ASSERT(is_valid_read(addr, size));
kevman 0:38ceb79fef03 119 if (!_is_initialized) {
kevman 0:38ceb79fef03 120 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 121 }
kevman 0:38ceb79fef03 122
kevman 0:38ceb79fef03 123 uint8_t *buffer = static_cast<uint8_t*>(b);
kevman 0:38ceb79fef03 124
kevman 0:38ceb79fef03 125 while (size > 0) {
kevman 0:38ceb79fef03 126 bd_addr_t hi = addr / _erase_size;
kevman 0:38ceb79fef03 127 bd_addr_t lo = addr % _erase_size;
kevman 0:38ceb79fef03 128
kevman 0:38ceb79fef03 129 if (_blocks[hi]) {
kevman 0:38ceb79fef03 130 memcpy(buffer, &_blocks[hi][lo], _read_size);
kevman 0:38ceb79fef03 131 } else {
kevman 0:38ceb79fef03 132 memset(buffer, 0, _read_size);
kevman 0:38ceb79fef03 133 }
kevman 0:38ceb79fef03 134
kevman 0:38ceb79fef03 135 buffer += _read_size;
kevman 0:38ceb79fef03 136 addr += _read_size;
kevman 0:38ceb79fef03 137 size -= _read_size;
kevman 0:38ceb79fef03 138 }
kevman 0:38ceb79fef03 139
kevman 0:38ceb79fef03 140 return 0;
kevman 0:38ceb79fef03 141 }
kevman 0:38ceb79fef03 142
kevman 0:38ceb79fef03 143 int HeapBlockDevice::program(const void *b, bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 144 {
kevman 0:38ceb79fef03 145 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 146 MBED_ASSERT(is_valid_program(addr, size));
kevman 0:38ceb79fef03 147 if (!_is_initialized) {
kevman 0:38ceb79fef03 148 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 149 }
kevman 0:38ceb79fef03 150
kevman 0:38ceb79fef03 151 const uint8_t *buffer = static_cast<const uint8_t*>(b);
kevman 0:38ceb79fef03 152
kevman 0:38ceb79fef03 153 while (size > 0) {
kevman 0:38ceb79fef03 154 bd_addr_t hi = addr / _erase_size;
kevman 0:38ceb79fef03 155 bd_addr_t lo = addr % _erase_size;
kevman 0:38ceb79fef03 156
kevman 0:38ceb79fef03 157 if (!_blocks[hi]) {
kevman 0:38ceb79fef03 158 _blocks[hi] = (uint8_t*)malloc(_erase_size);
kevman 0:38ceb79fef03 159 if (!_blocks[hi]) {
kevman 0:38ceb79fef03 160 return BD_ERROR_DEVICE_ERROR;
kevman 0:38ceb79fef03 161 }
kevman 0:38ceb79fef03 162 }
kevman 0:38ceb79fef03 163
kevman 0:38ceb79fef03 164 memcpy(&_blocks[hi][lo], buffer, _program_size);
kevman 0:38ceb79fef03 165
kevman 0:38ceb79fef03 166 buffer += _program_size;
kevman 0:38ceb79fef03 167 addr += _program_size;
kevman 0:38ceb79fef03 168 size -= _program_size;
kevman 0:38ceb79fef03 169 }
kevman 0:38ceb79fef03 170
kevman 0:38ceb79fef03 171 return 0;
kevman 0:38ceb79fef03 172 }
kevman 0:38ceb79fef03 173
kevman 0:38ceb79fef03 174 int HeapBlockDevice::erase(bd_addr_t addr, bd_size_t size)
kevman 0:38ceb79fef03 175 {
kevman 0:38ceb79fef03 176 MBED_ASSERT(_blocks != NULL);
kevman 0:38ceb79fef03 177 MBED_ASSERT(is_valid_erase(addr, size));
kevman 0:38ceb79fef03 178 // TODO assert on programming unerased blocks
kevman 0:38ceb79fef03 179
kevman 0:38ceb79fef03 180 return 0;
kevman 0:38ceb79fef03 181 }
kevman 0:38ceb79fef03 182