Marco Mayer / Mbed OS Queue

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.

mbed-os/features/filesystem/bd/HeapBlockDevice.cpp@0:6bf0743ece18, 2020-03-28 (annotated)

Committer:
demayer
Date:
Sat Mar 28 15:28:19 2020 +0000
Revision:
0:6bf0743ece18
IMU Thread with an event-queue running parallel to handle tasks like a 5 times blinking LED. Button with interrupt detected.

Who changed what in which revision?

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