Daiki Kato / mbed-os-lychee

mbed-os for GR-LYCHEE

Dependents:   mbed-os-example-blinky-gr-lychee GR-Boads_Camera_sample GR-Boards_Audio_Recoder GR-Boads_Camera_DisplayApp ... more

features/filesystem/bd/ChainingBlockDevice.cpp@0:f782d9c66c49, 2018-02-02 (annotated)

Committer:
dkato
Date:
Fri Feb 02 05:42:23 2018 +0000
Revision:
0:f782d9c66c49
mbed-os for GR-LYCHEE

Who changed what in which revision?

UserRevisionLine numberNew contents of line
dkato 0:f782d9c66c49 1 /* mbed Microcontroller Library
dkato 0:f782d9c66c49 2 * Copyright (c) 2017 ARM Limited
dkato 0:f782d9c66c49 3 *
dkato 0:f782d9c66c49 4 * Licensed under the Apache License, Version 2.0 (the "License");
dkato 0:f782d9c66c49 5 * you may not use this file except in compliance with the License.
dkato 0:f782d9c66c49 6 * You may obtain a copy of the License at
dkato 0:f782d9c66c49 7 *
dkato 0:f782d9c66c49 8 * http://www.apache.org/licenses/LICENSE-2.0
dkato 0:f782d9c66c49 9 *
dkato 0:f782d9c66c49 10 * Unless required by applicable law or agreed to in writing, software
dkato 0:f782d9c66c49 11 * distributed under the License is distributed on an "AS IS" BASIS,
dkato 0:f782d9c66c49 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
dkato 0:f782d9c66c49 13 * See the License for the specific language governing permissions and
dkato 0:f782d9c66c49 14 * limitations under the License.
dkato 0:f782d9c66c49 15 */
dkato 0:f782d9c66c49 16
dkato 0:f782d9c66c49 17 #include "ChainingBlockDevice.h"
dkato 0:f782d9c66c49 18
dkato 0:f782d9c66c49 19
dkato 0:f782d9c66c49 20 ChainingBlockDevice::ChainingBlockDevice(BlockDevice **bds, size_t bd_count)
dkato 0:f782d9c66c49 21 : _bds(bds), _bd_count(bd_count)
dkato 0:f782d9c66c49 22 , _read_size(0), _program_size(0), _erase_size(0), _size(0)
dkato 0:f782d9c66c49 23 {
dkato 0:f782d9c66c49 24 }
dkato 0:f782d9c66c49 25
dkato 0:f782d9c66c49 26 static bool is_aligned(uint64_t x, uint64_t alignment)
dkato 0:f782d9c66c49 27 {
dkato 0:f782d9c66c49 28 return (x / alignment) * alignment == x;
dkato 0:f782d9c66c49 29 }
dkato 0:f782d9c66c49 30
dkato 0:f782d9c66c49 31 int ChainingBlockDevice::init()
dkato 0:f782d9c66c49 32 {
dkato 0:f782d9c66c49 33 _read_size = 0;
dkato 0:f782d9c66c49 34 _program_size = 0;
dkato 0:f782d9c66c49 35 _erase_size = 0;
dkato 0:f782d9c66c49 36 _size = 0;
dkato 0:f782d9c66c49 37
dkato 0:f782d9c66c49 38 // Initialize children block devices, find all sizes and
dkato 0:f782d9c66c49 39 // assert that block sizes are similar. We can't do this in
dkato 0:f782d9c66c49 40 // the constructor since some block devices may need to be
dkato 0:f782d9c66c49 41 // initialized before they know their block size/count
dkato 0:f782d9c66c49 42 for (size_t i = 0; i < _bd_count; i++) {
dkato 0:f782d9c66c49 43 int err = _bds[i]->init();
dkato 0:f782d9c66c49 44 if (err) {
dkato 0:f782d9c66c49 45 return err;
dkato 0:f782d9c66c49 46 }
dkato 0:f782d9c66c49 47
dkato 0:f782d9c66c49 48 bd_size_t read = _bds[i]->get_read_size();
dkato 0:f782d9c66c49 49 if (i == 0 || (read >= _read_size && is_aligned(read, _read_size))) {
dkato 0:f782d9c66c49 50 _read_size = read;
dkato 0:f782d9c66c49 51 } else {
dkato 0:f782d9c66c49 52 MBED_ASSERT(_read_size > read && is_aligned(_read_size, read));
dkato 0:f782d9c66c49 53 }
dkato 0:f782d9c66c49 54
dkato 0:f782d9c66c49 55 bd_size_t program = _bds[i]->get_program_size();
dkato 0:f782d9c66c49 56 if (i == 0 || (program >= _program_size && is_aligned(program, _program_size))) {
dkato 0:f782d9c66c49 57 _program_size = program;
dkato 0:f782d9c66c49 58 } else {
dkato 0:f782d9c66c49 59 MBED_ASSERT(_program_size > program && is_aligned(_program_size, program));
dkato 0:f782d9c66c49 60 }
dkato 0:f782d9c66c49 61
dkato 0:f782d9c66c49 62 bd_size_t erase = _bds[i]->get_erase_size();
dkato 0:f782d9c66c49 63 if (i == 0 || (erase >= _erase_size && is_aligned(erase, _erase_size))) {
dkato 0:f782d9c66c49 64 _erase_size = erase;
dkato 0:f782d9c66c49 65 } else {
dkato 0:f782d9c66c49 66 MBED_ASSERT(_erase_size > erase && is_aligned(_erase_size, erase));
dkato 0:f782d9c66c49 67 }
dkato 0:f782d9c66c49 68
dkato 0:f782d9c66c49 69 _size += _bds[i]->size();
dkato 0:f782d9c66c49 70 }
dkato 0:f782d9c66c49 71
dkato 0:f782d9c66c49 72 return 0;
dkato 0:f782d9c66c49 73 }
dkato 0:f782d9c66c49 74
dkato 0:f782d9c66c49 75 int ChainingBlockDevice::deinit()
dkato 0:f782d9c66c49 76 {
dkato 0:f782d9c66c49 77 for (size_t i = 0; i < _bd_count; i++) {
dkato 0:f782d9c66c49 78 int err = _bds[i]->deinit();
dkato 0:f782d9c66c49 79 if (err) {
dkato 0:f782d9c66c49 80 return err;
dkato 0:f782d9c66c49 81 }
dkato 0:f782d9c66c49 82 }
dkato 0:f782d9c66c49 83
dkato 0:f782d9c66c49 84 return 0;
dkato 0:f782d9c66c49 85 }
dkato 0:f782d9c66c49 86
dkato 0:f782d9c66c49 87 int ChainingBlockDevice::read(void *b, bd_addr_t addr, bd_size_t size)
dkato 0:f782d9c66c49 88 {
dkato 0:f782d9c66c49 89 MBED_ASSERT(is_valid_read(addr, size));
dkato 0:f782d9c66c49 90 uint8_t *buffer = static_cast<uint8_t*>(b);
dkato 0:f782d9c66c49 91
dkato 0:f782d9c66c49 92 // Find block devices containing blocks, may span multiple block devices
dkato 0:f782d9c66c49 93 for (size_t i = 0; i < _bd_count && size > 0; i++) {
dkato 0:f782d9c66c49 94 bd_size_t bdsize = _bds[i]->size();
dkato 0:f782d9c66c49 95
dkato 0:f782d9c66c49 96 if (addr < bdsize) {
dkato 0:f782d9c66c49 97 bd_size_t read = size;
dkato 0:f782d9c66c49 98 if (addr + read > bdsize) {
dkato 0:f782d9c66c49 99 read = bdsize - addr;
dkato 0:f782d9c66c49 100 }
dkato 0:f782d9c66c49 101
dkato 0:f782d9c66c49 102 int err = _bds[i]->read(buffer, addr, read);
dkato 0:f782d9c66c49 103 if (err) {
dkato 0:f782d9c66c49 104 return err;
dkato 0:f782d9c66c49 105 }
dkato 0:f782d9c66c49 106
dkato 0:f782d9c66c49 107 buffer += read;
dkato 0:f782d9c66c49 108 addr += read;
dkato 0:f782d9c66c49 109 size -= read;
dkato 0:f782d9c66c49 110 }
dkato 0:f782d9c66c49 111
dkato 0:f782d9c66c49 112 addr -= size;
dkato 0:f782d9c66c49 113 }
dkato 0:f782d9c66c49 114
dkato 0:f782d9c66c49 115 return 0;
dkato 0:f782d9c66c49 116 }
dkato 0:f782d9c66c49 117
dkato 0:f782d9c66c49 118 int ChainingBlockDevice::program(const void *b, bd_addr_t addr, bd_size_t size)
dkato 0:f782d9c66c49 119 {
dkato 0:f782d9c66c49 120 MBED_ASSERT(is_valid_program(addr, size));
dkato 0:f782d9c66c49 121 const uint8_t *buffer = static_cast<const uint8_t*>(b);
dkato 0:f782d9c66c49 122
dkato 0:f782d9c66c49 123 // Find block devices containing blocks, may span multiple block devices
dkato 0:f782d9c66c49 124 for (size_t i = 0; i < _bd_count && size > 0; i++) {
dkato 0:f782d9c66c49 125 bd_size_t bdsize = _bds[i]->size();
dkato 0:f782d9c66c49 126
dkato 0:f782d9c66c49 127 if (addr < bdsize) {
dkato 0:f782d9c66c49 128 bd_size_t program = size;
dkato 0:f782d9c66c49 129 if (addr + program > bdsize) {
dkato 0:f782d9c66c49 130 program = bdsize - addr;
dkato 0:f782d9c66c49 131 }
dkato 0:f782d9c66c49 132
dkato 0:f782d9c66c49 133 int err = _bds[i]->program(buffer, addr, program);
dkato 0:f782d9c66c49 134 if (err) {
dkato 0:f782d9c66c49 135 return err;
dkato 0:f782d9c66c49 136 }
dkato 0:f782d9c66c49 137
dkato 0:f782d9c66c49 138 buffer += program;
dkato 0:f782d9c66c49 139 addr += program;
dkato 0:f782d9c66c49 140 size -= program;
dkato 0:f782d9c66c49 141 }
dkato 0:f782d9c66c49 142
dkato 0:f782d9c66c49 143 addr -= size;
dkato 0:f782d9c66c49 144 }
dkato 0:f782d9c66c49 145
dkato 0:f782d9c66c49 146 return 0;
dkato 0:f782d9c66c49 147 }
dkato 0:f782d9c66c49 148
dkato 0:f782d9c66c49 149 int ChainingBlockDevice::erase(bd_addr_t addr, bd_size_t size)
dkato 0:f782d9c66c49 150 {
dkato 0:f782d9c66c49 151 MBED_ASSERT(is_valid_erase(addr, size));
dkato 0:f782d9c66c49 152
dkato 0:f782d9c66c49 153 // Find block devices containing blocks, may span multiple block devices
dkato 0:f782d9c66c49 154 for (size_t i = 0; i < _bd_count && size > 0; i++) {
dkato 0:f782d9c66c49 155 bd_size_t bdsize = _bds[i]->size();
dkato 0:f782d9c66c49 156
dkato 0:f782d9c66c49 157 if (addr < bdsize) {
dkato 0:f782d9c66c49 158 bd_size_t erase = size;
dkato 0:f782d9c66c49 159 if (addr + erase > bdsize) {
dkato 0:f782d9c66c49 160 erase = bdsize - addr;
dkato 0:f782d9c66c49 161 }
dkato 0:f782d9c66c49 162
dkato 0:f782d9c66c49 163 int err = _bds[i]->erase(addr, erase);
dkato 0:f782d9c66c49 164 if (err) {
dkato 0:f782d9c66c49 165 return err;
dkato 0:f782d9c66c49 166 }
dkato 0:f782d9c66c49 167
dkato 0:f782d9c66c49 168 addr += erase;
dkato 0:f782d9c66c49 169 size -= erase;
dkato 0:f782d9c66c49 170 }
dkato 0:f782d9c66c49 171
dkato 0:f782d9c66c49 172 addr -= size;
dkato 0:f782d9c66c49 173 }
dkato 0:f782d9c66c49 174
dkato 0:f782d9c66c49 175 return 0;
dkato 0:f782d9c66c49 176 }
dkato 0:f782d9c66c49 177
dkato 0:f782d9c66c49 178 bd_size_t ChainingBlockDevice::get_read_size() const
dkato 0:f782d9c66c49 179 {
dkato 0:f782d9c66c49 180 return _read_size;
dkato 0:f782d9c66c49 181 }
dkato 0:f782d9c66c49 182
dkato 0:f782d9c66c49 183 bd_size_t ChainingBlockDevice::get_program_size() const
dkato 0:f782d9c66c49 184 {
dkato 0:f782d9c66c49 185 return _program_size;
dkato 0:f782d9c66c49 186 }
dkato 0:f782d9c66c49 187
dkato 0:f782d9c66c49 188 bd_size_t ChainingBlockDevice::get_erase_size() const
dkato 0:f782d9c66c49 189 {
dkato 0:f782d9c66c49 190 return _erase_size;
dkato 0:f782d9c66c49 191 }
dkato 0:f782d9c66c49 192
dkato 0:f782d9c66c49 193 bd_size_t ChainingBlockDevice::size() const
dkato 0:f782d9c66c49 194 {
dkato 0:f782d9c66c49 195 return _size;
dkato 0:f782d9c66c49 196 }