takashi kadono / Mbed OS Nucleo446_SSD1331

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   ssd1331

mbed-os/features/storage/blockdevice/HeapBlockDevice.cpp@0:8fdf9a60065b, 2018-10-10 (annotated)

Committer:
kadonotakashi
Date:
Wed Oct 10 00:33:53 2018 +0000
Revision:
0:8fdf9a60065b
how to make mbed librry

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kadonotakashi 0:8fdf9a60065b 1 /* mbed Microcontroller Library
kadonotakashi 0:8fdf9a60065b 2 * Copyright (c) 2017 ARM Limited
kadonotakashi 0:8fdf9a60065b 3 *
kadonotakashi 0:8fdf9a60065b 4 * Licensed under the Apache License, Version 2.0 (the "License");
kadonotakashi 0:8fdf9a60065b 5 * you may not use this file except in compliance with the License.
kadonotakashi 0:8fdf9a60065b 6 * You may obtain a copy of the License at
kadonotakashi 0:8fdf9a60065b 7 *
kadonotakashi 0:8fdf9a60065b 8 * http://www.apache.org/licenses/LICENSE-2.0
kadonotakashi 0:8fdf9a60065b 9 *
kadonotakashi 0:8fdf9a60065b 10 * Unless required by applicable law or agreed to in writing, software
kadonotakashi 0:8fdf9a60065b 11 * distributed under the License is distributed on an "AS IS" BASIS,
kadonotakashi 0:8fdf9a60065b 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
kadonotakashi 0:8fdf9a60065b 13 * See the License for the specific language governing permissions and
kadonotakashi 0:8fdf9a60065b 14 * limitations under the License.
kadonotakashi 0:8fdf9a60065b 15 */
kadonotakashi 0:8fdf9a60065b 16
kadonotakashi 0:8fdf9a60065b 17 #include "HeapBlockDevice.h"
kadonotakashi 0:8fdf9a60065b 18 #include "mbed_critical.h"
kadonotakashi 0:8fdf9a60065b 19
kadonotakashi 0:8fdf9a60065b 20
kadonotakashi 0:8fdf9a60065b 21 HeapBlockDevice::HeapBlockDevice(bd_size_t size, bd_size_t block)
kadonotakashi 0:8fdf9a60065b 22 : _read_size(block), _program_size(block), _erase_size(block)
kadonotakashi 0:8fdf9a60065b 23 , _count(size / block), _blocks(0), _init_ref_count(0), _is_initialized(false)
kadonotakashi 0:8fdf9a60065b 24 {
kadonotakashi 0:8fdf9a60065b 25 MBED_ASSERT(_count * _erase_size == size);
kadonotakashi 0:8fdf9a60065b 26 }
kadonotakashi 0:8fdf9a60065b 27
kadonotakashi 0:8fdf9a60065b 28 HeapBlockDevice::HeapBlockDevice(bd_size_t size, bd_size_t read, bd_size_t program, bd_size_t erase)
kadonotakashi 0:8fdf9a60065b 29 : _read_size(read), _program_size(program), _erase_size(erase)
kadonotakashi 0:8fdf9a60065b 30 , _count(size / erase), _blocks(0), _init_ref_count(0), _is_initialized(false)
kadonotakashi 0:8fdf9a60065b 31 {
kadonotakashi 0:8fdf9a60065b 32 MBED_ASSERT(_count * _erase_size == size);
kadonotakashi 0:8fdf9a60065b 33 }
kadonotakashi 0:8fdf9a60065b 34
kadonotakashi 0:8fdf9a60065b 35 HeapBlockDevice::~HeapBlockDevice()
kadonotakashi 0:8fdf9a60065b 36 {
kadonotakashi 0:8fdf9a60065b 37 if (_blocks) {
kadonotakashi 0:8fdf9a60065b 38 for (size_t i = 0; i < _count; i++) {
kadonotakashi 0:8fdf9a60065b 39 free(_blocks[i]);
kadonotakashi 0:8fdf9a60065b 40 }
kadonotakashi 0:8fdf9a60065b 41
kadonotakashi 0:8fdf9a60065b 42 delete[] _blocks;
kadonotakashi 0:8fdf9a60065b 43 _blocks = 0;
kadonotakashi 0:8fdf9a60065b 44 }
kadonotakashi 0:8fdf9a60065b 45 }
kadonotakashi 0:8fdf9a60065b 46
kadonotakashi 0:8fdf9a60065b 47 int HeapBlockDevice::init()
kadonotakashi 0:8fdf9a60065b 48 {
kadonotakashi 0:8fdf9a60065b 49 uint32_t val = core_util_atomic_incr_u32(&_init_ref_count, 1);
kadonotakashi 0:8fdf9a60065b 50
kadonotakashi 0:8fdf9a60065b 51 if (val != 1) {
kadonotakashi 0:8fdf9a60065b 52 return BD_ERROR_OK;
kadonotakashi 0:8fdf9a60065b 53 }
kadonotakashi 0:8fdf9a60065b 54
kadonotakashi 0:8fdf9a60065b 55 if (!_blocks) {
kadonotakashi 0:8fdf9a60065b 56 _blocks = new uint8_t*[_count];
kadonotakashi 0:8fdf9a60065b 57 for (size_t i = 0; i < _count; i++) {
kadonotakashi 0:8fdf9a60065b 58 _blocks[i] = 0;
kadonotakashi 0:8fdf9a60065b 59 }
kadonotakashi 0:8fdf9a60065b 60 }
kadonotakashi 0:8fdf9a60065b 61
kadonotakashi 0:8fdf9a60065b 62 _is_initialized = true;
kadonotakashi 0:8fdf9a60065b 63 return BD_ERROR_OK;
kadonotakashi 0:8fdf9a60065b 64 }
kadonotakashi 0:8fdf9a60065b 65
kadonotakashi 0:8fdf9a60065b 66 int HeapBlockDevice::deinit()
kadonotakashi 0:8fdf9a60065b 67 {
kadonotakashi 0:8fdf9a60065b 68 if (!_is_initialized) {
kadonotakashi 0:8fdf9a60065b 69 return BD_ERROR_OK;
kadonotakashi 0:8fdf9a60065b 70 }
kadonotakashi 0:8fdf9a60065b 71
kadonotakashi 0:8fdf9a60065b 72 uint32_t val = core_util_atomic_decr_u32(&_init_ref_count, 1);
kadonotakashi 0:8fdf9a60065b 73
kadonotakashi 0:8fdf9a60065b 74 if (val) {
kadonotakashi 0:8fdf9a60065b 75 return BD_ERROR_OK;
kadonotakashi 0:8fdf9a60065b 76 }
kadonotakashi 0:8fdf9a60065b 77
kadonotakashi 0:8fdf9a60065b 78 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 79 // Memory is lazily cleaned up in destructor to allow
kadonotakashi 0:8fdf9a60065b 80 // data to live across de/reinitialization
kadonotakashi 0:8fdf9a60065b 81 _is_initialized = false;
kadonotakashi 0:8fdf9a60065b 82 return BD_ERROR_OK;
kadonotakashi 0:8fdf9a60065b 83 }
kadonotakashi 0:8fdf9a60065b 84
kadonotakashi 0:8fdf9a60065b 85 bd_size_t HeapBlockDevice::get_read_size() const
kadonotakashi 0:8fdf9a60065b 86 {
kadonotakashi 0:8fdf9a60065b 87 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 88 return _read_size;
kadonotakashi 0:8fdf9a60065b 89 }
kadonotakashi 0:8fdf9a60065b 90
kadonotakashi 0:8fdf9a60065b 91 bd_size_t HeapBlockDevice::get_program_size() const
kadonotakashi 0:8fdf9a60065b 92 {
kadonotakashi 0:8fdf9a60065b 93 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 94 return _program_size;
kadonotakashi 0:8fdf9a60065b 95 }
kadonotakashi 0:8fdf9a60065b 96
kadonotakashi 0:8fdf9a60065b 97 bd_size_t HeapBlockDevice::get_erase_size() const
kadonotakashi 0:8fdf9a60065b 98 {
kadonotakashi 0:8fdf9a60065b 99 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 100 return _erase_size;
kadonotakashi 0:8fdf9a60065b 101 }
kadonotakashi 0:8fdf9a60065b 102
kadonotakashi 0:8fdf9a60065b 103 bd_size_t HeapBlockDevice::get_erase_size(bd_addr_t addr) const
kadonotakashi 0:8fdf9a60065b 104 {
kadonotakashi 0:8fdf9a60065b 105 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 106 return _erase_size;
kadonotakashi 0:8fdf9a60065b 107 }
kadonotakashi 0:8fdf9a60065b 108
kadonotakashi 0:8fdf9a60065b 109 bd_size_t HeapBlockDevice::size() const
kadonotakashi 0:8fdf9a60065b 110 {
kadonotakashi 0:8fdf9a60065b 111 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 112 return _count * _erase_size;
kadonotakashi 0:8fdf9a60065b 113 }
kadonotakashi 0:8fdf9a60065b 114
kadonotakashi 0:8fdf9a60065b 115 int HeapBlockDevice::read(void *b, bd_addr_t addr, bd_size_t size)
kadonotakashi 0:8fdf9a60065b 116 {
kadonotakashi 0:8fdf9a60065b 117 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 118 MBED_ASSERT(is_valid_read(addr, size));
kadonotakashi 0:8fdf9a60065b 119 if (!_is_initialized) {
kadonotakashi 0:8fdf9a60065b 120 return BD_ERROR_DEVICE_ERROR;
kadonotakashi 0:8fdf9a60065b 121 }
kadonotakashi 0:8fdf9a60065b 122
kadonotakashi 0:8fdf9a60065b 123 uint8_t *buffer = static_cast<uint8_t*>(b);
kadonotakashi 0:8fdf9a60065b 124
kadonotakashi 0:8fdf9a60065b 125 while (size > 0) {
kadonotakashi 0:8fdf9a60065b 126 bd_addr_t hi = addr / _erase_size;
kadonotakashi 0:8fdf9a60065b 127 bd_addr_t lo = addr % _erase_size;
kadonotakashi 0:8fdf9a60065b 128
kadonotakashi 0:8fdf9a60065b 129 if (_blocks[hi]) {
kadonotakashi 0:8fdf9a60065b 130 memcpy(buffer, &_blocks[hi][lo], _read_size);
kadonotakashi 0:8fdf9a60065b 131 } else {
kadonotakashi 0:8fdf9a60065b 132 memset(buffer, 0, _read_size);
kadonotakashi 0:8fdf9a60065b 133 }
kadonotakashi 0:8fdf9a60065b 134
kadonotakashi 0:8fdf9a60065b 135 buffer += _read_size;
kadonotakashi 0:8fdf9a60065b 136 addr += _read_size;
kadonotakashi 0:8fdf9a60065b 137 size -= _read_size;
kadonotakashi 0:8fdf9a60065b 138 }
kadonotakashi 0:8fdf9a60065b 139
kadonotakashi 0:8fdf9a60065b 140 return 0;
kadonotakashi 0:8fdf9a60065b 141 }
kadonotakashi 0:8fdf9a60065b 142
kadonotakashi 0:8fdf9a60065b 143 int HeapBlockDevice::program(const void *b, bd_addr_t addr, bd_size_t size)
kadonotakashi 0:8fdf9a60065b 144 {
kadonotakashi 0:8fdf9a60065b 145 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 146 MBED_ASSERT(is_valid_program(addr, size));
kadonotakashi 0:8fdf9a60065b 147 if (!_is_initialized) {
kadonotakashi 0:8fdf9a60065b 148 return BD_ERROR_DEVICE_ERROR;
kadonotakashi 0:8fdf9a60065b 149 }
kadonotakashi 0:8fdf9a60065b 150
kadonotakashi 0:8fdf9a60065b 151 const uint8_t *buffer = static_cast<const uint8_t*>(b);
kadonotakashi 0:8fdf9a60065b 152
kadonotakashi 0:8fdf9a60065b 153 while (size > 0) {
kadonotakashi 0:8fdf9a60065b 154 bd_addr_t hi = addr / _erase_size;
kadonotakashi 0:8fdf9a60065b 155 bd_addr_t lo = addr % _erase_size;
kadonotakashi 0:8fdf9a60065b 156
kadonotakashi 0:8fdf9a60065b 157 if (!_blocks[hi]) {
kadonotakashi 0:8fdf9a60065b 158 _blocks[hi] = (uint8_t*)malloc(_erase_size);
kadonotakashi 0:8fdf9a60065b 159 if (!_blocks[hi]) {
kadonotakashi 0:8fdf9a60065b 160 return BD_ERROR_DEVICE_ERROR;
kadonotakashi 0:8fdf9a60065b 161 }
kadonotakashi 0:8fdf9a60065b 162 }
kadonotakashi 0:8fdf9a60065b 163
kadonotakashi 0:8fdf9a60065b 164 memcpy(&_blocks[hi][lo], buffer, _program_size);
kadonotakashi 0:8fdf9a60065b 165
kadonotakashi 0:8fdf9a60065b 166 buffer += _program_size;
kadonotakashi 0:8fdf9a60065b 167 addr += _program_size;
kadonotakashi 0:8fdf9a60065b 168 size -= _program_size;
kadonotakashi 0:8fdf9a60065b 169 }
kadonotakashi 0:8fdf9a60065b 170
kadonotakashi 0:8fdf9a60065b 171 return 0;
kadonotakashi 0:8fdf9a60065b 172 }
kadonotakashi 0:8fdf9a60065b 173
kadonotakashi 0:8fdf9a60065b 174 int HeapBlockDevice::erase(bd_addr_t addr, bd_size_t size)
kadonotakashi 0:8fdf9a60065b 175 {
kadonotakashi 0:8fdf9a60065b 176 MBED_ASSERT(_blocks != NULL);
kadonotakashi 0:8fdf9a60065b 177 MBED_ASSERT(is_valid_erase(addr, size));
kadonotakashi 0:8fdf9a60065b 178 // TODO assert on programming unerased blocks
kadonotakashi 0:8fdf9a60065b 179
kadonotakashi 0:8fdf9a60065b 180 return 0;
kadonotakashi 0:8fdf9a60065b 181 }
kadonotakashi 0:8fdf9a60065b 182