Quelle  buffer.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0
/*
 *  linux/fs/hpfs/buffer.c
 *
 *  Mikulas Patocka (mikulas@artax.karlin.mff.cuni.cz), 1998-1999
 *
 *  general buffer i/o
 */
#include <linux/sched.h>
#include <linux/slab.h>
#include <linux/blkdev.h>
#include "hpfs_fn.h"

secno hpfs_search_hotfix_map(struct super_block *s, secno sec)
{
 unsigned i;
 struct hpfs_sb_info *sbi = hpfs_sb(s);
 for (i = 0; unlikely(i < sbi->n_hotfixes); i++) {
  if (sbi->hotfix_from[i] == sec) {
   return sbi->hotfix_to[i];
  }
 }
 return sec;
}

unsigned hpfs_search_hotfix_map_for_range(struct super_block *s, secno sec, unsigned n)
{
 unsigned i;
 struct hpfs_sb_info *sbi = hpfs_sb(s);
 for (i = 0; unlikely(i < sbi->n_hotfixes); i++) {
  if (sbi->hotfix_from[i] >= sec && sbi->hotfix_from[i] < sec + n) {
   n = sbi->hotfix_from[i] - sec;
  }
 }
 return n;
}

void hpfs_prefetch_sectors(struct super_block *s, unsigned secno, int n)
{
 struct buffer_head *bh;
 struct blk_plug plug;

 if (n <= 0 || unlikely(secno >= hpfs_sb(s)->sb_fs_size))
  return;

 if (unlikely(hpfs_search_hotfix_map_for_range(s, secno, n) != n))
  return;

 bh = sb_find_get_block(s, secno);
 if (bh) {
  if (buffer_uptodate(bh)) {
   brelse(bh);
   return;
  }
  brelse(bh);
 }

 blk_start_plug(&plug);
 while (n > 0) {
  if (unlikely(secno >= hpfs_sb(s)->sb_fs_size))
   break;
  sb_breadahead(s, secno);
  secno++;
  n--;
 }
 blk_finish_plug(&plug);
}

/* Map a sector into a buffer and return pointers to it and to the buffer. */

void *hpfs_map_sector(struct super_block *s, unsigned secno, struct buffer_head **bhp,
   int ahead)
{
 struct buffer_head *bh;

 hpfs_lock_assert(s);

 hpfs_prefetch_sectors(s, secno, ahead);

 cond_resched();

 *bhp = bh = sb_bread(s, hpfs_search_hotfix_map(s, secno));
 if (bh != NULL)
  return bh->b_data;
 else {
  pr_err("%s(): read error\n", __func__);
  return NULL;
 }
}

/* Like hpfs_map_sector but don't read anything */

void *hpfs_get_sector(struct super_block *s, unsigned secno, struct buffer_head **bhp)
{
 struct buffer_head *bh;
 /*return hpfs_map_sector(s, secno, bhp, 0);*/

 hpfs_lock_assert(s);

 cond_resched();

 if ((*bhp = bh = sb_getblk(s, hpfs_search_hotfix_map(s, secno))) != NULL) {
  if (!buffer_uptodate(bh)) wait_on_buffer(bh);
  set_buffer_uptodate(bh);
  return bh->b_data;
 } else {
  pr_err("%s(): getblk failed\n", __func__);
  return NULL;
 }
}

/* Map 4 sectors into a 4buffer and return pointers to it and to the buffer. */

void *hpfs_map_4sectors(struct super_block *s, unsigned secno, struct quad_buffer_head *qbh,
     int ahead)
{
 char *data;

 hpfs_lock_assert(s);

 cond_resched();

 if (secno & 3) {
  pr_err("%s(): unaligned read\n", __func__);
  return NULL;
 }

 hpfs_prefetch_sectors(s, secno, 4 + ahead);

 if (!hpfs_map_sector(s, secno + 0, &qbh->bh[0], 0)) goto bail0;
 if (!hpfs_map_sector(s, secno + 1, &qbh->bh[1], 0)) goto bail1;
 if (!hpfs_map_sector(s, secno + 2, &qbh->bh[2], 0)) goto bail2;
 if (!hpfs_map_sector(s, secno + 3, &qbh->bh[3], 0)) goto bail3;

 if (likely(qbh->bh[1]->b_data == qbh->bh[0]->b_data + 1 * 512) &&
     likely(qbh->bh[2]->b_data == qbh->bh[0]->b_data + 2 * 512) &&
     likely(qbh->bh[3]->b_data == qbh->bh[0]->b_data + 3 * 512)) {
  return qbh->data = qbh->bh[0]->b_data;
 }

 qbh->data = data = kmalloc(2048, GFP_NOFS);
 if (!data) {
  pr_err("%s(): out of memory\n", __func__);
  goto bail4;
 }

 memcpy(data + 0 * 512, qbh->bh[0]->b_data, 512);
 memcpy(data + 1 * 512, qbh->bh[1]->b_data, 512);
 memcpy(data + 2 * 512, qbh->bh[2]->b_data, 512);
 memcpy(data + 3 * 512, qbh->bh[3]->b_data, 512);

 return data;

 bail4:
 brelse(qbh->bh[3]);
 bail3:
 brelse(qbh->bh[2]);
 bail2:
 brelse(qbh->bh[1]);
 bail1:
 brelse(qbh->bh[0]);
 bail0:
 return NULL;
}

/* Don't read sectors */

void *hpfs_get_4sectors(struct super_block *s, unsigned secno,
                          struct quad_buffer_head *qbh)
{
 cond_resched();

 hpfs_lock_assert(s);

 if (secno & 3) {
  pr_err("%s(): unaligned read\n", __func__);
  return NULL;
 }

 if (!hpfs_get_sector(s, secno + 0, &qbh->bh[0])) goto bail0;
 if (!hpfs_get_sector(s, secno + 1, &qbh->bh[1])) goto bail1;
 if (!hpfs_get_sector(s, secno + 2, &qbh->bh[2])) goto bail2;
 if (!hpfs_get_sector(s, secno + 3, &qbh->bh[3])) goto bail3;

 if (likely(qbh->bh[1]->b_data == qbh->bh[0]->b_data + 1 * 512) &&
     likely(qbh->bh[2]->b_data == qbh->bh[0]->b_data + 2 * 512) &&
     likely(qbh->bh[3]->b_data == qbh->bh[0]->b_data + 3 * 512)) {
  return qbh->data = qbh->bh[0]->b_data;
 }

 if (!(qbh->data = kmalloc(2048, GFP_NOFS))) {
  pr_err("%s(): out of memory\n", __func__);
  goto bail4;
 }
 return qbh->data;

bail4:
 brelse(qbh->bh[3]);
bail3:
 brelse(qbh->bh[2]);
bail2:
 brelse(qbh->bh[1]);
bail1:
 brelse(qbh->bh[0]);
bail0:
 return NULL;
}
 

void hpfs_brelse4(struct quad_buffer_head *qbh)
{
 if (unlikely(qbh->data != qbh->bh[0]->b_data))
  kfree(qbh->data);
 brelse(qbh->bh[0]);
 brelse(qbh->bh[1]);
 brelse(qbh->bh[2]);
 brelse(qbh->bh[3]);
} 

void hpfs_mark_4buffers_dirty(struct quad_buffer_head *qbh)
{
 if (unlikely(qbh->data != qbh->bh[0]->b_data)) {
  memcpy(qbh->bh[0]->b_data, qbh->data + 0 * 512, 512);
  memcpy(qbh->bh[1]->b_data, qbh->data + 1 * 512, 512);
  memcpy(qbh->bh[2]->b_data, qbh->data + 2 * 512, 512);
  memcpy(qbh->bh[3]->b_data, qbh->data + 3 * 512, 512);
 }
 mark_buffer_dirty(qbh->bh[0]);
 mark_buffer_dirty(qbh->bh[1]);
 mark_buffer_dirty(qbh->bh[2]);
 mark_buffer_dirty(qbh->bh[3]);
}