source: mainline/uspace/lib/block/block.c@ f52ce72

Last change on this file since f52ce72 was 09ab0a9a, checked in by Jiri Svoboda <jiri@…>, 7 years ago

Fix vertical spacing with new Ccheck revision.

  • Property mode set to 100644
File size: 23.5 KB
Line 
1/*
2 * Copyright (c) 2008 Jakub Jermar
3 * Copyright (c) 2008 Martin Decky
4 * Copyright (c) 2011 Martin Sucha
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 *
11 * - Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * - Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * - The name of the author may not be used to endorse or promote products
17 * derived from this software without specific prior written permission.
18 *
19 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
20 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
21 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
22 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
23 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
24 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
25 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
26 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
27 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
28 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
29 */
30
31/** @addtogroup libblock
32 * @{
33 */
34/**
35 * @file
36 * @brief
37 */
38
39#include <ipc/loc.h>
40#include <ipc/services.h>
41#include <errno.h>
42#include <async.h>
43#include <as.h>
44#include <assert.h>
45#include <bd.h>
46#include <fibril_synch.h>
47#include <adt/list.h>
48#include <adt/hash_table.h>
49#include <macros.h>
50#include <mem.h>
51#include <stdlib.h>
52#include <stdio.h>
53#include <stacktrace.h>
54#include <str_error.h>
55#include <offset.h>
56#include <inttypes.h>
57#include "block.h"
58
59#define MAX_WRITE_RETRIES 10
60
61/** Lock protecting the device connection list */
62static FIBRIL_MUTEX_INITIALIZE(dcl_lock);
63/** Device connection list head. */
64static LIST_INITIALIZE(dcl);
65
66typedef struct {
67 fibril_mutex_t lock;
68 size_t lblock_size; /**< Logical block size. */
69 unsigned blocks_cluster; /**< Physical blocks per block_t */
70 unsigned block_count; /**< Total number of blocks. */
71 unsigned blocks_cached; /**< Number of cached blocks. */
72 hash_table_t block_hash;
73 list_t free_list;
74 enum cache_mode mode;
75} cache_t;
76
77typedef struct {
78 link_t link;
79 service_id_t service_id;
80 async_sess_t *sess;
81 bd_t *bd;
82 void *bb_buf;
83 aoff64_t bb_addr;
84 aoff64_t pblocks; /**< Number of physical blocks */
85 size_t pblock_size; /**< Physical block size. */
86 cache_t *cache;
87} devcon_t;
88
89static errno_t read_blocks(devcon_t *, aoff64_t, size_t, void *, size_t);
90static errno_t write_blocks(devcon_t *, aoff64_t, size_t, void *, size_t);
91static aoff64_t ba_ltop(devcon_t *, aoff64_t);
92
93static devcon_t *devcon_search(service_id_t service_id)
94{
95 fibril_mutex_lock(&dcl_lock);
96
97 list_foreach(dcl, link, devcon_t, devcon) {
98 if (devcon->service_id == service_id) {
99 fibril_mutex_unlock(&dcl_lock);
100 return devcon;
101 }
102 }
103
104 fibril_mutex_unlock(&dcl_lock);
105 return NULL;
106}
107
108static errno_t devcon_add(service_id_t service_id, async_sess_t *sess,
109 size_t bsize, aoff64_t dev_size, bd_t *bd)
110{
111 devcon_t *devcon;
112
113 devcon = malloc(sizeof(devcon_t));
114 if (!devcon)
115 return ENOMEM;
116
117 link_initialize(&devcon->link);
118 devcon->service_id = service_id;
119 devcon->sess = sess;
120 devcon->bd = bd;
121 devcon->bb_buf = NULL;
122 devcon->bb_addr = 0;
123 devcon->pblock_size = bsize;
124 devcon->pblocks = dev_size;
125 devcon->cache = NULL;
126
127 fibril_mutex_lock(&dcl_lock);
128 list_foreach(dcl, link, devcon_t, d) {
129 if (d->service_id == service_id) {
130 fibril_mutex_unlock(&dcl_lock);
131 free(devcon);
132 return EEXIST;
133 }
134 }
135 list_append(&devcon->link, &dcl);
136 fibril_mutex_unlock(&dcl_lock);
137 return EOK;
138}
139
140static void devcon_remove(devcon_t *devcon)
141{
142 fibril_mutex_lock(&dcl_lock);
143 list_remove(&devcon->link);
144 fibril_mutex_unlock(&dcl_lock);
145}
146
147errno_t block_init(service_id_t service_id, size_t comm_size)
148{
149 bd_t *bd;
150
151 async_sess_t *sess = loc_service_connect(service_id, INTERFACE_BLOCK,
152 IPC_FLAG_BLOCKING);
153 if (!sess) {
154 return ENOENT;
155 }
156
157 errno_t rc = bd_open(sess, &bd);
158 if (rc != EOK) {
159 async_hangup(sess);
160 return rc;
161 }
162
163 size_t bsize;
164 rc = bd_get_block_size(bd, &bsize);
165 if (rc != EOK) {
166 bd_close(bd);
167 async_hangup(sess);
168 return rc;
169 }
170
171 aoff64_t dev_size;
172 rc = bd_get_num_blocks(bd, &dev_size);
173 if (rc != EOK) {
174 bd_close(bd);
175 async_hangup(sess);
176 return rc;
177 }
178
179 rc = devcon_add(service_id, sess, bsize, dev_size, bd);
180 if (rc != EOK) {
181 bd_close(bd);
182 async_hangup(sess);
183 return rc;
184 }
185
186 return EOK;
187}
188
189void block_fini(service_id_t service_id)
190{
191 devcon_t *devcon = devcon_search(service_id);
192 assert(devcon);
193
194 if (devcon->cache)
195 (void) block_cache_fini(service_id);
196
197 (void)bd_sync_cache(devcon->bd, 0, 0);
198
199 devcon_remove(devcon);
200
201 if (devcon->bb_buf)
202 free(devcon->bb_buf);
203
204 bd_close(devcon->bd);
205 async_hangup(devcon->sess);
206
207 free(devcon);
208}
209
210errno_t block_bb_read(service_id_t service_id, aoff64_t ba)
211{
212 void *bb_buf;
213 errno_t rc;
214
215 devcon_t *devcon = devcon_search(service_id);
216 if (!devcon)
217 return ENOENT;
218 if (devcon->bb_buf)
219 return EEXIST;
220 bb_buf = malloc(devcon->pblock_size);
221 if (!bb_buf)
222 return ENOMEM;
223
224 rc = read_blocks(devcon, 0, 1, bb_buf, devcon->pblock_size);
225 if (rc != EOK) {
226 free(bb_buf);
227 return rc;
228 }
229
230 devcon->bb_buf = bb_buf;
231 devcon->bb_addr = ba;
232
233 return EOK;
234}
235
236void *block_bb_get(service_id_t service_id)
237{
238 devcon_t *devcon = devcon_search(service_id);
239 assert(devcon);
240 return devcon->bb_buf;
241}
242
243static size_t cache_key_hash(void *key)
244{
245 aoff64_t *lba = (aoff64_t *)key;
246 return *lba;
247}
248
249static size_t cache_hash(const ht_link_t *item)
250{
251 block_t *b = hash_table_get_inst(item, block_t, hash_link);
252 return b->lba;
253}
254
255static bool cache_key_equal(void *key, const ht_link_t *item)
256{
257 aoff64_t *lba = (aoff64_t *)key;
258 block_t *b = hash_table_get_inst(item, block_t, hash_link);
259 return b->lba == *lba;
260}
261
262static hash_table_ops_t cache_ops = {
263 .hash = cache_hash,
264 .key_hash = cache_key_hash,
265 .key_equal = cache_key_equal,
266 .equal = NULL,
267 .remove_callback = NULL
268};
269
270errno_t block_cache_init(service_id_t service_id, size_t size, unsigned blocks,
271 enum cache_mode mode)
272{
273 devcon_t *devcon = devcon_search(service_id);
274 cache_t *cache;
275 if (!devcon)
276 return ENOENT;
277 if (devcon->cache)
278 return EEXIST;
279 cache = malloc(sizeof(cache_t));
280 if (!cache)
281 return ENOMEM;
282
283 fibril_mutex_initialize(&cache->lock);
284 list_initialize(&cache->free_list);
285 cache->lblock_size = size;
286 cache->block_count = blocks;
287 cache->blocks_cached = 0;
288 cache->mode = mode;
289
290 /* Allow 1:1 or small-to-large block size translation */
291 if (cache->lblock_size % devcon->pblock_size != 0) {
292 free(cache);
293 return ENOTSUP;
294 }
295
296 cache->blocks_cluster = cache->lblock_size / devcon->pblock_size;
297
298 if (!hash_table_create(&cache->block_hash, 0, 0, &cache_ops)) {
299 free(cache);
300 return ENOMEM;
301 }
302
303 devcon->cache = cache;
304 return EOK;
305}
306
307errno_t block_cache_fini(service_id_t service_id)
308{
309 devcon_t *devcon = devcon_search(service_id);
310 cache_t *cache;
311 errno_t rc;
312
313 if (!devcon)
314 return ENOENT;
315 if (!devcon->cache)
316 return EOK;
317 cache = devcon->cache;
318
319 /*
320 * We are expecting to find all blocks for this device handle on the
321 * free list, i.e. the block reference count should be zero. Do not
322 * bother with the cache and block locks because we are single-threaded.
323 */
324 while (!list_empty(&cache->free_list)) {
325 block_t *b = list_get_instance(list_first(&cache->free_list),
326 block_t, free_link);
327
328 list_remove(&b->free_link);
329 if (b->dirty) {
330 rc = write_blocks(devcon, b->pba, cache->blocks_cluster,
331 b->data, b->size);
332 if (rc != EOK)
333 return rc;
334 }
335
336 hash_table_remove_item(&cache->block_hash, &b->hash_link);
337
338 free(b->data);
339 free(b);
340 }
341
342 hash_table_destroy(&cache->block_hash);
343 devcon->cache = NULL;
344 free(cache);
345
346 return EOK;
347}
348
349#define CACHE_LO_WATERMARK 10
350#define CACHE_HI_WATERMARK 20
351static bool cache_can_grow(cache_t *cache)
352{
353 if (cache->blocks_cached < CACHE_LO_WATERMARK)
354 return true;
355 if (!list_empty(&cache->free_list))
356 return false;
357 return true;
358}
359
360static void block_initialize(block_t *b)
361{
362 fibril_mutex_initialize(&b->lock);
363 b->refcnt = 1;
364 b->write_failures = 0;
365 b->dirty = false;
366 b->toxic = false;
367 fibril_rwlock_initialize(&b->contents_lock);
368 link_initialize(&b->free_link);
369}
370
371/** Instantiate a block in memory and get a reference to it.
372 *
373 * @param block Pointer to where the function will store the
374 * block pointer on success.
375 * @param service_id Service ID of the block device.
376 * @param ba Block address (logical).
377 * @param flags If BLOCK_FLAGS_NOREAD is specified, block_get()
378 * will not read the contents of the block from the
379 * device.
380 *
381 * @return EOK on success or an error code.
382 */
383errno_t block_get(block_t **block, service_id_t service_id, aoff64_t ba, int flags)
384{
385 devcon_t *devcon;
386 cache_t *cache;
387 block_t *b;
388 link_t *link;
389 aoff64_t p_ba;
390 errno_t rc;
391
392 devcon = devcon_search(service_id);
393
394 assert(devcon);
395 assert(devcon->cache);
396
397 cache = devcon->cache;
398
399 /*
400 * Check whether the logical block (or part of it) is beyond
401 * the end of the device or not.
402 */
403 p_ba = ba_ltop(devcon, ba);
404 p_ba += cache->blocks_cluster;
405 if (p_ba >= devcon->pblocks) {
406 /* This request cannot be satisfied */
407 return EIO;
408 }
409
410retry:
411 rc = EOK;
412 b = NULL;
413
414 fibril_mutex_lock(&cache->lock);
415 ht_link_t *hlink = hash_table_find(&cache->block_hash, &ba);
416 if (hlink) {
417 found:
418 /*
419 * We found the block in the cache.
420 */
421 b = hash_table_get_inst(hlink, block_t, hash_link);
422 fibril_mutex_lock(&b->lock);
423 if (b->refcnt++ == 0)
424 list_remove(&b->free_link);
425 if (b->toxic)
426 rc = EIO;
427 fibril_mutex_unlock(&b->lock);
428 fibril_mutex_unlock(&cache->lock);
429 } else {
430 /*
431 * The block was not found in the cache.
432 */
433 if (cache_can_grow(cache)) {
434 /*
435 * We can grow the cache by allocating new blocks.
436 * Should the allocation fail, we fail over and try to
437 * recycle a block from the cache.
438 */
439 b = malloc(sizeof(block_t));
440 if (!b)
441 goto recycle;
442 b->data = malloc(cache->lblock_size);
443 if (!b->data) {
444 free(b);
445 b = NULL;
446 goto recycle;
447 }
448 cache->blocks_cached++;
449 } else {
450 /*
451 * Try to recycle a block from the free list.
452 */
453 recycle:
454 if (list_empty(&cache->free_list)) {
455 fibril_mutex_unlock(&cache->lock);
456 rc = ENOMEM;
457 goto out;
458 }
459 link = list_first(&cache->free_list);
460 b = list_get_instance(link, block_t, free_link);
461
462 fibril_mutex_lock(&b->lock);
463 if (b->dirty) {
464 /*
465 * The block needs to be written back to the
466 * device before it changes identity. Do this
467 * while not holding the cache lock so that
468 * concurrency is not impeded. Also move the
469 * block to the end of the free list so that we
470 * do not slow down other instances of
471 * block_get() draining the free list.
472 */
473 list_remove(&b->free_link);
474 list_append(&b->free_link, &cache->free_list);
475 fibril_mutex_unlock(&cache->lock);
476 rc = write_blocks(devcon, b->pba,
477 cache->blocks_cluster, b->data, b->size);
478 if (rc != EOK) {
479 /*
480 * We did not manage to write the block
481 * to the device. Keep it around for
482 * another try. Hopefully, we will grab
483 * another block next time.
484 */
485 if (b->write_failures < MAX_WRITE_RETRIES) {
486 b->write_failures++;
487 fibril_mutex_unlock(&b->lock);
488 goto retry;
489 } else {
490 printf("Too many errors writing block %"
491 PRIuOFF64 "from device handle %" PRIun "\n"
492 "SEVERE DATA LOSS POSSIBLE\n",
493 b->lba, devcon->service_id);
494 }
495 } else
496 b->write_failures = 0;
497
498 b->dirty = false;
499 if (!fibril_mutex_trylock(&cache->lock)) {
500 /*
501 * Somebody is probably racing with us.
502 * Unlock the block and retry.
503 */
504 fibril_mutex_unlock(&b->lock);
505 goto retry;
506 }
507 hlink = hash_table_find(&cache->block_hash, &ba);
508 if (hlink) {
509 /*
510 * Someone else must have already
511 * instantiated the block while we were
512 * not holding the cache lock.
513 * Leave the recycled block on the
514 * freelist and continue as if we
515 * found the block of interest during
516 * the first try.
517 */
518 fibril_mutex_unlock(&b->lock);
519 goto found;
520 }
521
522 }
523 fibril_mutex_unlock(&b->lock);
524
525 /*
526 * Unlink the block from the free list and the hash
527 * table.
528 */
529 list_remove(&b->free_link);
530 hash_table_remove_item(&cache->block_hash, &b->hash_link);
531 }
532
533 block_initialize(b);
534 b->service_id = service_id;
535 b->size = cache->lblock_size;
536 b->lba = ba;
537 b->pba = ba_ltop(devcon, b->lba);
538 hash_table_insert(&cache->block_hash, &b->hash_link);
539
540 /*
541 * Lock the block before releasing the cache lock. Thus we don't
542 * kill concurrent operations on the cache while doing I/O on
543 * the block.
544 */
545 fibril_mutex_lock(&b->lock);
546 fibril_mutex_unlock(&cache->lock);
547
548 if (!(flags & BLOCK_FLAGS_NOREAD)) {
549 /*
550 * The block contains old or no data. We need to read
551 * the new contents from the device.
552 */
553 rc = read_blocks(devcon, b->pba, cache->blocks_cluster,
554 b->data, cache->lblock_size);
555 if (rc != EOK)
556 b->toxic = true;
557 } else
558 rc = EOK;
559
560 fibril_mutex_unlock(&b->lock);
561 }
562out:
563 if ((rc != EOK) && b) {
564 assert(b->toxic);
565 (void) block_put(b);
566 b = NULL;
567 }
568 *block = b;
569 return rc;
570}
571
572/** Release a reference to a block.
573 *
574 * If the last reference is dropped, the block is put on the free list.
575 *
576 * @param block Block of which a reference is to be released.
577 *
578 * @return EOK on success or an error code.
579 */
580errno_t block_put(block_t *block)
581{
582 devcon_t *devcon = devcon_search(block->service_id);
583 cache_t *cache;
584 unsigned blocks_cached;
585 enum cache_mode mode;
586 errno_t rc = EOK;
587
588 assert(devcon);
589 assert(devcon->cache);
590 assert(block->refcnt >= 1);
591
592 cache = devcon->cache;
593
594retry:
595 fibril_mutex_lock(&cache->lock);
596 blocks_cached = cache->blocks_cached;
597 mode = cache->mode;
598 fibril_mutex_unlock(&cache->lock);
599
600 /*
601 * Determine whether to sync the block. Syncing the block is best done
602 * when not holding the cache lock as it does not impede concurrency.
603 * Since the situation may have changed when we unlocked the cache, the
604 * blocks_cached and mode variables are mere hints. We will recheck the
605 * conditions later when the cache lock is held again.
606 */
607 fibril_mutex_lock(&block->lock);
608 if (block->toxic)
609 block->dirty = false; /* will not write back toxic block */
610 if (block->dirty && (block->refcnt == 1) &&
611 (blocks_cached > CACHE_HI_WATERMARK || mode != CACHE_MODE_WB)) {
612 rc = write_blocks(devcon, block->pba, cache->blocks_cluster,
613 block->data, block->size);
614 if (rc == EOK)
615 block->write_failures = 0;
616 block->dirty = false;
617 }
618 fibril_mutex_unlock(&block->lock);
619
620 fibril_mutex_lock(&cache->lock);
621 fibril_mutex_lock(&block->lock);
622 if (!--block->refcnt) {
623 /*
624 * Last reference to the block was dropped. Either free the
625 * block or put it on the free list. In case of an I/O error,
626 * free the block.
627 */
628 if ((cache->blocks_cached > CACHE_HI_WATERMARK) ||
629 (rc != EOK)) {
630 /*
631 * Currently there are too many cached blocks or there
632 * was an I/O error when writing the block back to the
633 * device.
634 */
635 if (block->dirty) {
636 /*
637 * We cannot sync the block while holding the
638 * cache lock. Release everything and retry.
639 */
640 block->refcnt++;
641
642 if (block->write_failures < MAX_WRITE_RETRIES) {
643 block->write_failures++;
644 fibril_mutex_unlock(&block->lock);
645 fibril_mutex_unlock(&cache->lock);
646 goto retry;
647 } else {
648 printf("Too many errors writing block %"
649 PRIuOFF64 "from device handle %" PRIun "\n"
650 "SEVERE DATA LOSS POSSIBLE\n",
651 block->lba, devcon->service_id);
652 }
653 }
654 /*
655 * Take the block out of the cache and free it.
656 */
657 hash_table_remove_item(&cache->block_hash, &block->hash_link);
658 fibril_mutex_unlock(&block->lock);
659 free(block->data);
660 free(block);
661 cache->blocks_cached--;
662 fibril_mutex_unlock(&cache->lock);
663 return rc;
664 }
665 /*
666 * Put the block on the free list.
667 */
668 if (cache->mode != CACHE_MODE_WB && block->dirty) {
669 /*
670 * We cannot sync the block while holding the cache
671 * lock. Release everything and retry.
672 */
673 block->refcnt++;
674 fibril_mutex_unlock(&block->lock);
675 fibril_mutex_unlock(&cache->lock);
676 goto retry;
677 }
678 list_append(&block->free_link, &cache->free_list);
679 }
680 fibril_mutex_unlock(&block->lock);
681 fibril_mutex_unlock(&cache->lock);
682
683 return rc;
684}
685
686/** Read sequential data from a block device.
687 *
688 * @param service_id Service ID of the block device.
689 * @param buf Buffer for holding one block
690 * @param bufpos Pointer to the first unread valid offset within the
691 * communication buffer.
692 * @param buflen Pointer to the number of unread bytes that are ready in
693 * the communication buffer.
694 * @param pos Device position to be read.
695 * @param dst Destination buffer.
696 * @param size Size of the destination buffer.
697 * @param block_size Block size to be used for the transfer.
698 *
699 * @return EOK on success or an error code on failure.
700 */
701errno_t block_seqread(service_id_t service_id, void *buf, size_t *bufpos,
702 size_t *buflen, aoff64_t *pos, void *dst, size_t size)
703{
704 size_t offset = 0;
705 size_t left = size;
706 size_t block_size;
707 devcon_t *devcon;
708
709 devcon = devcon_search(service_id);
710 assert(devcon);
711 block_size = devcon->pblock_size;
712
713 while (left > 0) {
714 size_t rd;
715
716 if (*bufpos + left < *buflen)
717 rd = left;
718 else
719 rd = *buflen - *bufpos;
720
721 if (rd > 0) {
722 /*
723 * Copy the contents of the communication buffer to the
724 * destination buffer.
725 */
726 memcpy(dst + offset, buf + *bufpos, rd);
727 offset += rd;
728 *bufpos += rd;
729 *pos += rd;
730 left -= rd;
731 }
732
733 if (*bufpos == *buflen) {
734 /* Refill the communication buffer with a new block. */
735 errno_t rc;
736
737 rc = read_blocks(devcon, *pos / block_size, 1, buf,
738 devcon->pblock_size);
739 if (rc != EOK) {
740 return rc;
741 }
742
743 *bufpos = 0;
744 *buflen = block_size;
745 }
746 }
747
748 return EOK;
749}
750
751/** Read blocks directly from device (bypass cache).
752 *
753 * @param service_id Service ID of the block device.
754 * @param ba Address of first block (physical).
755 * @param cnt Number of blocks.
756 * @param src Buffer for storing the data.
757 *
758 * @return EOK on success or an error code on failure.
759 */
760errno_t block_read_direct(service_id_t service_id, aoff64_t ba, size_t cnt, void *buf)
761{
762 devcon_t *devcon;
763
764 devcon = devcon_search(service_id);
765 assert(devcon);
766
767 return read_blocks(devcon, ba, cnt, buf, devcon->pblock_size * cnt);
768}
769
770/** Write blocks directly to device (bypass cache).
771 *
772 * @param service_id Service ID of the block device.
773 * @param ba Address of first block (physical).
774 * @param cnt Number of blocks.
775 * @param src The data to be written.
776 *
777 * @return EOK on success or an error code on failure.
778 */
779errno_t block_write_direct(service_id_t service_id, aoff64_t ba, size_t cnt,
780 const void *data)
781{
782 devcon_t *devcon;
783
784 devcon = devcon_search(service_id);
785 assert(devcon);
786
787 return write_blocks(devcon, ba, cnt, (void *)data, devcon->pblock_size * cnt);
788}
789
790/** Synchronize blocks to persistent storage.
791 *
792 * @param service_id Service ID of the block device.
793 * @param ba Address of first block (physical).
794 * @param cnt Number of blocks.
795 *
796 * @return EOK on success or an error code on failure.
797 */
798errno_t block_sync_cache(service_id_t service_id, aoff64_t ba, size_t cnt)
799{
800 devcon_t *devcon;
801
802 devcon = devcon_search(service_id);
803 assert(devcon);
804
805 return bd_sync_cache(devcon->bd, ba, cnt);
806}
807
808/** Get device block size.
809 *
810 * @param service_id Service ID of the block device.
811 * @param bsize Output block size.
812 *
813 * @return EOK on success or an error code on failure.
814 */
815errno_t block_get_bsize(service_id_t service_id, size_t *bsize)
816{
817 devcon_t *devcon;
818
819 devcon = devcon_search(service_id);
820 assert(devcon);
821
822 return bd_get_block_size(devcon->bd, bsize);
823}
824
825/** Get number of blocks on device.
826 *
827 * @param service_id Service ID of the block device.
828 * @param nblocks Output number of blocks.
829 *
830 * @return EOK on success or an error code on failure.
831 */
832errno_t block_get_nblocks(service_id_t service_id, aoff64_t *nblocks)
833{
834 devcon_t *devcon = devcon_search(service_id);
835 assert(devcon);
836
837 return bd_get_num_blocks(devcon->bd, nblocks);
838}
839
840/** Read bytes directly from the device (bypass cache)
841 *
842 * @param service_id Service ID of the block device.
843 * @param abs_offset Absolute offset in bytes where to start reading
844 * @param bytes Number of bytes to read
845 * @param data Buffer that receives the data
846 *
847 * @return EOK on success or an error code on failure.
848 */
849errno_t block_read_bytes_direct(service_id_t service_id, aoff64_t abs_offset,
850 size_t bytes, void *data)
851{
852 errno_t rc;
853 size_t phys_block_size;
854 size_t buf_size;
855 void *buffer;
856 aoff64_t first_block;
857 aoff64_t last_block;
858 size_t blocks;
859 size_t offset;
860
861 rc = block_get_bsize(service_id, &phys_block_size);
862 if (rc != EOK) {
863 return rc;
864 }
865
866 /* calculate data position and required space */
867 first_block = abs_offset / phys_block_size;
868 offset = abs_offset % phys_block_size;
869 last_block = (abs_offset + bytes - 1) / phys_block_size;
870 blocks = last_block - first_block + 1;
871 buf_size = blocks * phys_block_size;
872
873 /* read the data into memory */
874 buffer = malloc(buf_size);
875 if (buffer == NULL) {
876 return ENOMEM;
877 }
878
879 rc = block_read_direct(service_id, first_block, blocks, buffer);
880 if (rc != EOK) {
881 free(buffer);
882 return rc;
883 }
884
885 /* copy the data from the buffer */
886 memcpy(data, buffer + offset, bytes);
887 free(buffer);
888
889 return EOK;
890}
891
892/** Get TOC from device.
893 *
894 * @param service_id Service ID of the block device.
895 * @param session Starting session.
896 *
897 * @return Allocated TOC structure.
898 * @return EOK on success or an error code.
899 *
900 */
901errno_t block_read_toc(service_id_t service_id, uint8_t session, void *buf,
902 size_t bufsize)
903{
904 devcon_t *devcon = devcon_search(service_id);
905
906 assert(devcon);
907 return bd_read_toc(devcon->bd, session, buf, bufsize);
908}
909
910/** Read blocks from block device.
911 *
912 * @param devcon Device connection.
913 * @param ba Address of first block.
914 * @param cnt Number of blocks.
915 * @param src Buffer for storing the data.
916 *
917 * @return EOK on success or an error code on failure.
918 */
919static errno_t read_blocks(devcon_t *devcon, aoff64_t ba, size_t cnt, void *buf,
920 size_t size)
921{
922 assert(devcon);
923
924 errno_t rc = bd_read_blocks(devcon->bd, ba, cnt, buf, size);
925 if (rc != EOK) {
926 printf("Error %s reading %zu blocks starting at block %" PRIuOFF64
927 " from device handle %" PRIun "\n", str_error_name(rc), cnt, ba,
928 devcon->service_id);
929#ifndef NDEBUG
930 stacktrace_print();
931#endif
932 }
933
934 return rc;
935}
936
937/** Write block to block device.
938 *
939 * @param devcon Device connection.
940 * @param ba Address of first block.
941 * @param cnt Number of blocks.
942 * @param src Buffer containing the data to write.
943 *
944 * @return EOK on success or an error code on failure.
945 */
946static errno_t write_blocks(devcon_t *devcon, aoff64_t ba, size_t cnt, void *data,
947 size_t size)
948{
949 assert(devcon);
950
951 errno_t rc = bd_write_blocks(devcon->bd, ba, cnt, data, size);
952 if (rc != EOK) {
953 printf("Error %s writing %zu blocks starting at block %" PRIuOFF64
954 " to device handle %" PRIun "\n", str_error_name(rc), cnt, ba, devcon->service_id);
955#ifndef NDEBUG
956 stacktrace_print();
957#endif
958 }
959
960 return rc;
961}
962
963/** Convert logical block address to physical block address. */
964static aoff64_t ba_ltop(devcon_t *devcon, aoff64_t lba)
965{
966 assert(devcon->cache != NULL);
967 return lba * devcon->cache->blocks_cluster;
968}
969
970/** @}
971 */
Note: See TracBrowser for help on using the repository browser.