kernel/fs/hpfs/buffer.c

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