2 * Copyright (c) 2013 Grzegorz Kostka (kostka.grzegorz@gmail.com)
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 /** @addtogroup lwext4
33 * @file ext4_blockdev.c
34 * @brief Block device module.
37 #include "ext4_config.h"
38 #include "ext4_blockdev.h"
39 #include "ext4_errno.h"
40 #include "ext4_debug.h"
45 int ext4_block_init(struct ext4_blockdev *bdev)
50 ext4_assert(bdev->open && bdev->close && bdev->bread && bdev->bwrite);
52 /*Low level block init*/
53 rc = bdev->open(bdev);
57 bdev->flags |= EXT4_BDEV_INITIALIZED;
62 int ext4_block_bind_bcache(struct ext4_blockdev *bdev, struct ext4_bcache *bc)
64 ext4_assert(bdev && bc);
70 void ext4_block_set_lb_size(struct ext4_blockdev *bdev, uint64_t lb_bsize)
72 /*Logical block size has to be multiply of physical */
73 ext4_assert(!(lb_bsize % bdev->ph_bsize));
75 bdev->lg_bsize = lb_bsize;
76 bdev->lg_bcnt = (bdev->ph_bcnt * bdev->ph_bsize) / lb_bsize;
79 int ext4_block_fini(struct ext4_blockdev *bdev)
83 bdev->flags &= ~(EXT4_BDEV_INITIALIZED);
85 /*Low level block fini*/
86 return bdev->close(bdev);
89 int ext4_block_flush_buf(struct ext4_blockdev *bdev, struct ext4_buf *buf)
92 struct ext4_bcache *bc = bdev->bc;
93 /*Only flushing unreferenced buffer is allowed.*/
94 ext4_assert(!buf->refctr);
96 if (ext4_bcache_test_flag(buf, BC_DIRTY)) {
97 r = ext4_blocks_set_direct(bdev, buf->data, buf->lba, 1);
101 ext4_bcache_remove_dirty_node(bc, buf);
102 ext4_bcache_clear_flag(buf, BC_DIRTY);
107 int ext4_block_cache_shake(struct ext4_blockdev *bdev)
109 struct ext4_buf *buf;
110 while (!RB_EMPTY(&bdev->bc->lru_root) &&
111 ext4_bcache_is_full(bdev->bc)) {
113 buf = ext4_buf_lowest_lru(bdev->bc);
115 if (ext4_bcache_test_flag(buf, BC_DIRTY)) {
116 int r = ext4_block_flush_buf(bdev, buf);
122 ext4_bcache_drop_buf(bdev->bc, buf);
127 int ext4_block_get_noread(struct ext4_blockdev *bdev, struct ext4_block *b,
133 ext4_assert(bdev && b);
135 if (!(bdev->flags & EXT4_BDEV_INITIALIZED))
138 if (!(lba < bdev->lg_bcnt))
144 /*If cache is full we have to (flush and) drop it anyway :(*/
145 r = ext4_block_cache_shake(bdev);
149 r = ext4_bcache_alloc(bdev->bc, b, &is_new);
159 int ext4_block_get(struct ext4_blockdev *bdev, struct ext4_block *b,
164 int r = ext4_block_get_noread(bdev, b, lba);
169 /* Data in the cache is up-to-date.
170 * Reading from physical device is not required */
174 pba = (lba * bdev->lg_bsize) / bdev->ph_bsize;
175 pb_cnt = bdev->lg_bsize / bdev->ph_bsize;
177 r = bdev->bread(bdev, b->data, pba, pb_cnt);
180 ext4_bcache_free(bdev->bc, b);
185 /* Mark buffer up-to-date, since
186 * fresh data is read from physical device just now. */
187 ext4_bcache_set_flag(b->buf, BC_UPTODATE);
193 int ext4_block_set(struct ext4_blockdev *bdev, struct ext4_block *b)
195 ext4_assert(bdev && b);
198 if (!(bdev->flags & EXT4_BDEV_INITIALIZED))
201 return ext4_bcache_free(bdev->bc, b);
204 int ext4_blocks_get_direct(struct ext4_blockdev *bdev, void *buf, uint64_t lba,
210 ext4_assert(bdev && buf);
212 pba = (lba * bdev->lg_bsize) / bdev->ph_bsize;
213 pb_cnt = bdev->lg_bsize / bdev->ph_bsize;
216 return bdev->bread(bdev, buf, pba, pb_cnt * cnt);
219 int ext4_blocks_set_direct(struct ext4_blockdev *bdev, const void *buf,
220 uint64_t lba, uint32_t cnt)
225 ext4_assert(bdev && buf);
227 pba = (lba * bdev->lg_bsize) / bdev->ph_bsize;
228 pb_cnt = bdev->lg_bsize / bdev->ph_bsize;
232 return bdev->bwrite(bdev, buf, pba, pb_cnt * cnt);
235 int ext4_block_writebytes(struct ext4_blockdev *bdev, uint64_t off,
236 const void *buf, uint32_t len)
244 const uint8_t *p = (void *)buf;
246 ext4_assert(bdev && buf);
248 if (!(bdev->flags & EXT4_BDEV_INITIALIZED))
251 block_idx = off / bdev->ph_bsize;
252 block_end = block_idx + len / bdev->ph_bsize;
254 if (!(block_end < bdev->ph_bcnt))
255 return EINVAL; /*Ups. Out of range operation*/
257 /*OK lets deal with the first possible unaligned block*/
258 unalg = (off & (bdev->ph_bsize - 1));
261 uint32_t wlen = (bdev->ph_bsize - unalg) > len
263 : (bdev->ph_bsize - unalg);
265 r = bdev->bread(bdev, bdev->ph_bbuf, block_idx, 1);
269 memcpy(bdev->ph_bbuf + unalg, p, wlen);
271 r = bdev->bwrite(bdev, bdev->ph_bbuf, block_idx, 1);
281 blen = len / bdev->ph_bsize;
282 r = bdev->bwrite(bdev, p, block_idx, blen);
286 p += bdev->ph_bsize * blen;
287 len -= bdev->ph_bsize * blen;
293 r = bdev->bread(bdev, bdev->ph_bbuf, block_idx, 1);
297 memcpy(bdev->ph_bbuf, p, len);
299 r = bdev->bwrite(bdev, bdev->ph_bbuf, block_idx, 1);
307 int ext4_block_readbytes(struct ext4_blockdev *bdev, uint64_t off, void *buf,
316 uint8_t *p = (void *)buf;
318 ext4_assert(bdev && buf);
320 if (!(bdev->flags & EXT4_BDEV_INITIALIZED))
323 block_idx = off / bdev->ph_bsize;
324 block_end = block_idx + len / bdev->ph_bsize;
326 if (!(block_end < bdev->ph_bcnt))
327 return EINVAL; /*Ups. Out of range operation*/
329 /*OK lets deal with the first possible unaligned block*/
330 unalg = (off & (bdev->ph_bsize - 1));
333 uint32_t rlen = (bdev->ph_bsize - unalg) > len
335 : (bdev->ph_bsize - unalg);
337 r = bdev->bread(bdev, bdev->ph_bbuf, block_idx, 1);
341 memcpy(p, bdev->ph_bbuf + unalg, rlen);
349 blen = len / bdev->ph_bsize;
351 r = bdev->bread(bdev, p, block_idx, blen);
355 p += bdev->ph_bsize * blen;
356 len -= bdev->ph_bsize * blen;
362 r = bdev->bread(bdev, bdev->ph_bbuf, block_idx, 1);
366 memcpy(p, bdev->ph_bbuf, len);
372 int ext4_block_cache_write_back(struct ext4_blockdev *bdev, uint8_t on_off)
375 struct ext4_buf *buf;
378 bdev->cache_write_back++;
380 if (!on_off && bdev->cache_write_back)
381 bdev->cache_write_back--;
383 if (bdev->cache_write_back)
386 /*Flush all delayed cache blocks*/
387 while (!SLIST_EMPTY(&bdev->bc->dirty_list)) {
389 buf = SLIST_FIRST(&bdev->bc->dirty_list);
391 r = ext4_block_flush_buf(bdev, buf);