fs/hpfs/buffer.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  *  linux/fs/hpfs/buffer.c
   4  *
   5  *  Mikulas Patocka (mikulas@artax.karlin.mff.cuni.cz), 1998-1999
   6  *
   7  *  general buffer i/o
   8  */
   9 #include <linux/sched.h>
  10 #include <linux/slab.h>
  11 #include <linux/blkdev.h>
  12 #include "hpfs_fn.h"
  13
  14 secno hpfs_search_hotfix_map(struct super_block *s, secno sec)
  15 {
  16         unsigned i;
  17         struct hpfs_sb_info *sbi = hpfs_sb(s);
  18         for (i = 0; unlikely(i < sbi->n_hotfixes); i++) {
  19                 if (sbi->hotfix_from[i] == sec) {
  20                         return sbi->hotfix_to[i];
  21                 }
  22         }
  23         return sec;
  24 }
  25
  26 unsigned hpfs_search_hotfix_map_for_range(struct super_block *s, secno sec, unsigned n)
  27 {
  28         unsigned i;
  29         struct hpfs_sb_info *sbi = hpfs_sb(s);
  30         for (i = 0; unlikely(i < sbi->n_hotfixes); i++) {
  31                 if (sbi->hotfix_from[i] >= sec && sbi->hotfix_from[i] < sec + n) {
  32                         n = sbi->hotfix_from[i] - sec;
  33                 }
  34         }
  35         return n;
  36 }
  37
  38 void hpfs_prefetch_sectors(struct super_block *s, unsigned secno, int n)
  39 {
  40         struct buffer_head *bh;
  41         struct blk_plug plug;
  42
  43         if (n <= 0 || unlikely(secno >= hpfs_sb(s)->sb_fs_size))
  44                 return;
  45
  46         if (unlikely(hpfs_search_hotfix_map_for_range(s, secno, n) != n))
  47                 return;
  48
  49         bh = sb_find_get_block(s, secno);
  50         if (bh) {
  51                 if (buffer_uptodate(bh)) {
  52                         brelse(bh);
  53                         return;
  54                 }
  55                 brelse(bh);
  56         }
  57
  58         blk_start_plug(&plug);
  59         while (n > 0) {
  60                 if (unlikely(secno >= hpfs_sb(s)->sb_fs_size))
  61                         break;
  62                 sb_breadahead(s, secno);
  63                 secno++;
  64                 n--;
  65         }
  66         blk_finish_plug(&plug);
  67 }
  68
  69 /* Map a sector into a buffer and return pointers to it and to the buffer. */
  70
  71 void *hpfs_map_sector(struct super_block *s, unsigned secno, struct buffer_head **bhp,
  72                  int ahead)
  73 {
  74         struct buffer_head *bh;
  75
  76         hpfs_lock_assert(s);
  77
  78         hpfs_prefetch_sectors(s, secno, ahead);
  79
  80         cond_resched();
  81
  82         *bhp = bh = sb_bread(s, hpfs_search_hotfix_map(s, secno));
  83         if (bh != NULL)
  84                 return bh->b_data;
  85         else {
  86                 pr_err("%s(): read error\n", __func__);
  87                 return NULL;
  88         }
  89 }
  90
  91 /* Like hpfs_map_sector but don't read anything */
  92
  93 void *hpfs_get_sector(struct super_block *s, unsigned secno, struct buffer_head **bhp)
  94 {
  95         struct buffer_head *bh;
  96         /*return hpfs_map_sector(s, secno, bhp, 0);*/
  97
  98         hpfs_lock_assert(s);
  99
 100         cond_resched();
 101
 102         if ((*bhp = bh = sb_getblk(s, hpfs_search_hotfix_map(s, secno))) != NULL) {
 103                 if (!buffer_uptodate(bh)) wait_on_buffer(bh);
 104                 set_buffer_uptodate(bh);
 105                 return bh->b_data;
 106         } else {
 107                 pr_err("%s(): getblk failed\n", __func__);
 108                 return NULL;
 109         }
 110 }
 111
 112 /* Map 4 sectors into a 4buffer and return pointers to it and to the buffer. */
 113
 114 void *hpfs_map_4sectors(struct super_block *s, unsigned secno, struct quad_buffer_head *qbh,
 115                    int ahead)
 116 {
 117         char *data;
 118
 119         hpfs_lock_assert(s);
 120
 121         cond_resched();
 122
 123         if (secno & 3) {
 124                 pr_err("%s(): unaligned read\n", __func__);
 125                 return NULL;
 126         }
 127
 128         hpfs_prefetch_sectors(s, secno, 4 + ahead);
 129
 130         if (!hpfs_map_sector(s, secno + 0, &qbh->bh[0], 0)) goto bail0;
 131         if (!hpfs_map_sector(s, secno + 1, &qbh->bh[1], 0)) goto bail1;
 132         if (!hpfs_map_sector(s, secno + 2, &qbh->bh[2], 0)) goto bail2;
 133         if (!hpfs_map_sector(s, secno + 3, &qbh->bh[3], 0)) goto bail3;
 134
 135         if (likely(qbh->bh[1]->b_data == qbh->bh[0]->b_data + 1 * 512) &&
 136             likely(qbh->bh[2]->b_data == qbh->bh[0]->b_data + 2 * 512) &&
 137             likely(qbh->bh[3]->b_data == qbh->bh[0]->b_data + 3 * 512)) {
 138                 return qbh->data = qbh->bh[0]->b_data;
 139         }
 140
 141         qbh->data = data = kmalloc(2048, GFP_NOFS);
 142         if (!data) {
 143                 pr_err("%s(): out of memory\n", __func__);
 144                 goto bail4;
 145         }
 146
 147         memcpy(data + 0 * 512, qbh->bh[0]->b_data, 512);
 148         memcpy(data + 1 * 512, qbh->bh[1]->b_data, 512);
 149         memcpy(data + 2 * 512, qbh->bh[2]->b_data, 512);
 150         memcpy(data + 3 * 512, qbh->bh[3]->b_data, 512);
 151
 152         return data;
 153
 154  bail4:
 155         brelse(qbh->bh[3]);
 156  bail3:
 157         brelse(qbh->bh[2]);
 158  bail2:
 159         brelse(qbh->bh[1]);
 160  bail1:
 161         brelse(qbh->bh[0]);
 162  bail0:
 163         return NULL;
 164 }
 165
 166 /* Don't read sectors */
 167
 168 void *hpfs_get_4sectors(struct super_block *s, unsigned secno,
 169                           struct quad_buffer_head *qbh)
 170 {
 171         cond_resched();
 172
 173         hpfs_lock_assert(s);
 174
 175         if (secno & 3) {
 176                 pr_err("%s(): unaligned read\n", __func__);
 177                 return NULL;
 178         }
 179
 180         if (!hpfs_get_sector(s, secno + 0, &qbh->bh[0])) goto bail0;
 181         if (!hpfs_get_sector(s, secno + 1, &qbh->bh[1])) goto bail1;
 182         if (!hpfs_get_sector(s, secno + 2, &qbh->bh[2])) goto bail2;
 183         if (!hpfs_get_sector(s, secno + 3, &qbh->bh[3])) goto bail3;
 184
 185         if (likely(qbh->bh[1]->b_data == qbh->bh[0]->b_data + 1 * 512) &&
 186             likely(qbh->bh[2]->b_data == qbh->bh[0]->b_data + 2 * 512) &&
 187             likely(qbh->bh[3]->b_data == qbh->bh[0]->b_data + 3 * 512)) {
 188                 return qbh->data = qbh->bh[0]->b_data;
 189         }
 190
 191         if (!(qbh->data = kmalloc(2048, GFP_NOFS))) {
 192                 pr_err("%s(): out of memory\n", __func__);
 193                 goto bail4;
 194         }
 195         return qbh->data;
 196
 197 bail4:
 198         brelse(qbh->bh[3]);
 199 bail3:
 200         brelse(qbh->bh[2]);
 201 bail2:
 202         brelse(qbh->bh[1]);
 203 bail1:
 204         brelse(qbh->bh[0]);
 205 bail0:
 206         return NULL;
 207 }
 208
 209
 210 void hpfs_brelse4(struct quad_buffer_head *qbh)
 211 {
 212         if (unlikely(qbh->data != qbh->bh[0]->b_data))
 213                 kfree(qbh->data);
 214         brelse(qbh->bh[0]);
 215         brelse(qbh->bh[1]);
 216         brelse(qbh->bh[2]);
 217         brelse(qbh->bh[3]);
 218 }
 219
 220 void hpfs_mark_4buffers_dirty(struct quad_buffer_head *qbh)
 221 {
 222         if (unlikely(qbh->data != qbh->bh[0]->b_data)) {
 223                 memcpy(qbh->bh[0]->b_data, qbh->data + 0 * 512, 512);
 224                 memcpy(qbh->bh[1]->b_data, qbh->data + 1 * 512, 512);
 225                 memcpy(qbh->bh[2]->b_data, qbh->data + 2 * 512, 512);
 226                 memcpy(qbh->bh[3]->b_data, qbh->data + 3 * 512, 512);
 227         }
 228         mark_buffer_dirty(qbh->bh[0]);
 229         mark_buffer_dirty(qbh->bh[1]);
 230         mark_buffer_dirty(qbh->bh[2]);
 231         mark_buffer_dirty(qbh->bh[3]);
 232 }