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 } 233