Marco Zecchini / Mbed OS Example_RTOS

Rtos API example

mbed-os/features/filesystem/bd/HeapBlockDevice.cpp@0:9fca2b23d0ba, 2019-02-23 (annotated)

Committer:
marcozecchini
Date:
Sat Feb 23 12:13:36 2019 +0000
Revision:
0:9fca2b23d0ba
final commit

Who changed what in which revision?

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