blob: 23ceed8c8fb9d42bbadb2166c4a99625a19afed9 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/fs/ufs/util.h
3 *
4 * Copyright (C) 1998
5 * Daniel Pirkl <daniel.pirkl@email.cz>
6 * Charles University, Faculty of Mathematics and Physics
7 */
8
9#include <linux/buffer_head.h>
10#include <linux/fs.h>
11#include "swab.h"
12
13
14/*
15 * some useful macros
16 */
17#define in_range(b,first,len) ((b)>=(first)&&(b)<(first)+(len))
18
19/*
Evgeniy Dushistov9695ef12006-06-25 05:47:22 -070020 * functions used for retyping
Linus Torvalds1da177e2005-04-16 15:20:36 -070021 */
Evgeniy Dushistov9695ef12006-06-25 05:47:22 -070022static inline struct ufs_buffer_head *UCPI_UBH(struct ufs_cg_private_info *cpi)
23{
24 return &cpi->c_ubh;
25}
26static inline struct ufs_buffer_head *USPI_UBH(struct ufs_sb_private_info *spi)
27{
28 return &spi->s_ubh;
29}
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
31
32
33/*
34 * macros used for accessing structures
35 */
36static inline s32
37ufs_get_fs_state(struct super_block *sb, struct ufs_super_block_first *usb1,
38 struct ufs_super_block_third *usb3)
39{
40 switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
Mark Fortescue252e2112007-10-16 23:26:31 -070041 case UFS_ST_SUNOS:
42 if (fs32_to_cpu(sb, usb3->fs_postblformat) == UFS_42POSTBLFMT)
43 return fs32_to_cpu(sb, usb1->fs_u0.fs_sun.fs_state);
44 /* Fall Through to UFS_ST_SUN */
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 case UFS_ST_SUN:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070046 return fs32_to_cpu(sb, usb3->fs_un2.fs_sun.fs_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -070047 case UFS_ST_SUNx86:
48 return fs32_to_cpu(sb, usb1->fs_u1.fs_sunx86.fs_state);
49 case UFS_ST_44BSD:
50 default:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070051 return fs32_to_cpu(sb, usb3->fs_un2.fs_44.fs_state);
Linus Torvalds1da177e2005-04-16 15:20:36 -070052 }
53}
54
55static inline void
56ufs_set_fs_state(struct super_block *sb, struct ufs_super_block_first *usb1,
57 struct ufs_super_block_third *usb3, s32 value)
58{
59 switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
Mark Fortescue252e2112007-10-16 23:26:31 -070060 case UFS_ST_SUNOS:
Roel Kluinf81e8a42008-02-23 15:23:29 -080061 if (fs32_to_cpu(sb, usb3->fs_postblformat) == UFS_42POSTBLFMT) {
Mark Fortescue252e2112007-10-16 23:26:31 -070062 usb1->fs_u0.fs_sun.fs_state = cpu_to_fs32(sb, value);
63 break;
64 }
65 /* Fall Through to UFS_ST_SUN */
Linus Torvalds1da177e2005-04-16 15:20:36 -070066 case UFS_ST_SUN:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070067 usb3->fs_un2.fs_sun.fs_state = cpu_to_fs32(sb, value);
Linus Torvalds1da177e2005-04-16 15:20:36 -070068 break;
69 case UFS_ST_SUNx86:
70 usb1->fs_u1.fs_sunx86.fs_state = cpu_to_fs32(sb, value);
71 break;
72 case UFS_ST_44BSD:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070073 usb3->fs_un2.fs_44.fs_state = cpu_to_fs32(sb, value);
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 break;
75 }
76}
77
78static inline u32
79ufs_get_fs_npsect(struct super_block *sb, struct ufs_super_block_first *usb1,
80 struct ufs_super_block_third *usb3)
81{
82 if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070083 return fs32_to_cpu(sb, usb3->fs_un2.fs_sunx86.fs_npsect);
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 else
85 return fs32_to_cpu(sb, usb1->fs_u1.fs_sun.fs_npsect);
86}
87
88static inline u64
89ufs_get_fs_qbmask(struct super_block *sb, struct ufs_super_block_third *usb3)
90{
91 __fs64 tmp;
92
93 switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
Mark Fortescue252e2112007-10-16 23:26:31 -070094 case UFS_ST_SUNOS:
Linus Torvalds1da177e2005-04-16 15:20:36 -070095 case UFS_ST_SUN:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -070096 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_sun.fs_qbmask[0];
97 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_sun.fs_qbmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -070098 break;
99 case UFS_ST_SUNx86:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -0700100 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_sunx86.fs_qbmask[0];
101 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_sunx86.fs_qbmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 break;
103 case UFS_ST_44BSD:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -0700104 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_44.fs_qbmask[0];
105 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_44.fs_qbmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106 break;
107 }
108
109 return fs64_to_cpu(sb, tmp);
110}
111
112static inline u64
113ufs_get_fs_qfmask(struct super_block *sb, struct ufs_super_block_third *usb3)
114{
115 __fs64 tmp;
116
117 switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
Mark Fortescue252e2112007-10-16 23:26:31 -0700118 case UFS_ST_SUNOS:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119 case UFS_ST_SUN:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -0700120 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_sun.fs_qfmask[0];
121 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_sun.fs_qfmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 break;
123 case UFS_ST_SUNx86:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -0700124 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_sunx86.fs_qfmask[0];
125 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_sunx86.fs_qfmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126 break;
127 case UFS_ST_44BSD:
Evgeniy Dushistov647b7e82006-06-25 05:47:29 -0700128 ((__fs32 *)&tmp)[0] = usb3->fs_un2.fs_44.fs_qfmask[0];
129 ((__fs32 *)&tmp)[1] = usb3->fs_un2.fs_44.fs_qfmask[1];
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 break;
131 }
132
133 return fs64_to_cpu(sb, tmp);
134}
135
136static inline u16
137ufs_get_de_namlen(struct super_block *sb, struct ufs_dir_entry *de)
138{
139 if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) == UFS_DE_OLD)
140 return fs16_to_cpu(sb, de->d_u.d_namlen);
141 else
142 return de->d_u.d_44.d_namlen; /* XXX this seems wrong */
143}
144
145static inline void
146ufs_set_de_namlen(struct super_block *sb, struct ufs_dir_entry *de, u16 value)
147{
148 if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) == UFS_DE_OLD)
149 de->d_u.d_namlen = cpu_to_fs16(sb, value);
150 else
151 de->d_u.d_44.d_namlen = value; /* XXX this seems wrong */
152}
153
154static inline void
155ufs_set_de_type(struct super_block *sb, struct ufs_dir_entry *de, int mode)
156{
157 if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) != UFS_DE_44BSD)
158 return;
159
160 /*
161 * TODO turn this into a table lookup
162 */
163 switch (mode & S_IFMT) {
164 case S_IFSOCK:
165 de->d_u.d_44.d_type = DT_SOCK;
166 break;
167 case S_IFLNK:
168 de->d_u.d_44.d_type = DT_LNK;
169 break;
170 case S_IFREG:
171 de->d_u.d_44.d_type = DT_REG;
172 break;
173 case S_IFBLK:
174 de->d_u.d_44.d_type = DT_BLK;
175 break;
176 case S_IFDIR:
177 de->d_u.d_44.d_type = DT_DIR;
178 break;
179 case S_IFCHR:
180 de->d_u.d_44.d_type = DT_CHR;
181 break;
182 case S_IFIFO:
183 de->d_u.d_44.d_type = DT_FIFO;
184 break;
185 default:
186 de->d_u.d_44.d_type = DT_UNKNOWN;
187 }
188}
189
190static inline u32
191ufs_get_inode_uid(struct super_block *sb, struct ufs_inode *inode)
192{
193 switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194 case UFS_UID_44BSD:
195 return fs32_to_cpu(sb, inode->ui_u3.ui_44.ui_uid);
Mark Fortescue252e2112007-10-16 23:26:31 -0700196 case UFS_UID_EFT:
197 if (inode->ui_u1.oldids.ui_suid == 0xFFFF)
198 return fs32_to_cpu(sb, inode->ui_u3.ui_sun.ui_uid);
199 /* Fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 default:
201 return fs16_to_cpu(sb, inode->ui_u1.oldids.ui_suid);
202 }
203}
204
205static inline void
206ufs_set_inode_uid(struct super_block *sb, struct ufs_inode *inode, u32 value)
207{
208 switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209 case UFS_UID_44BSD:
210 inode->ui_u3.ui_44.ui_uid = cpu_to_fs32(sb, value);
Mark Fortescue252e2112007-10-16 23:26:31 -0700211 inode->ui_u1.oldids.ui_suid = cpu_to_fs16(sb, value);
212 break;
213 case UFS_UID_EFT:
214 inode->ui_u3.ui_sun.ui_uid = cpu_to_fs32(sb, value);
215 if (value > 0xFFFF)
216 value = 0xFFFF;
217 /* Fall through */
218 default:
219 inode->ui_u1.oldids.ui_suid = cpu_to_fs16(sb, value);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220 break;
221 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222}
223
224static inline u32
225ufs_get_inode_gid(struct super_block *sb, struct ufs_inode *inode)
226{
227 switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 case UFS_UID_44BSD:
229 return fs32_to_cpu(sb, inode->ui_u3.ui_44.ui_gid);
Mark Fortescue252e2112007-10-16 23:26:31 -0700230 case UFS_UID_EFT:
231 if (inode->ui_u1.oldids.ui_suid == 0xFFFF)
232 return fs32_to_cpu(sb, inode->ui_u3.ui_sun.ui_gid);
233 /* Fall through */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 default:
235 return fs16_to_cpu(sb, inode->ui_u1.oldids.ui_sgid);
236 }
237}
238
239static inline void
240ufs_set_inode_gid(struct super_block *sb, struct ufs_inode *inode, u32 value)
241{
242 switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700243 case UFS_UID_44BSD:
244 inode->ui_u3.ui_44.ui_gid = cpu_to_fs32(sb, value);
Mark Fortescue252e2112007-10-16 23:26:31 -0700245 inode->ui_u1.oldids.ui_sgid = cpu_to_fs16(sb, value);
246 break;
247 case UFS_UID_EFT:
248 inode->ui_u3.ui_sun.ui_gid = cpu_to_fs32(sb, value);
249 if (value > 0xFFFF)
250 value = 0xFFFF;
251 /* Fall through */
252 default:
253 inode->ui_u1.oldids.ui_sgid = cpu_to_fs16(sb, value);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700254 break;
255 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256}
257
258extern dev_t ufs_get_inode_dev(struct super_block *, struct ufs_inode_info *);
259extern void ufs_set_inode_dev(struct super_block *, struct ufs_inode_info *, dev_t);
Nick Piggin82b9d1d2007-10-16 01:25:19 -0700260extern int __ufs_write_begin(struct file *file, struct address_space *mapping,
261 loff_t pos, unsigned len, unsigned flags,
262 struct page **pagep, void **fsdata);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263
264/*
265 * These functions manipulate ufs buffers
266 */
267#define ubh_bread(sb,fragment,size) _ubh_bread_(uspi,sb,fragment,size)
268extern struct ufs_buffer_head * _ubh_bread_(struct ufs_sb_private_info *, struct super_block *, u64 , u64);
269extern struct ufs_buffer_head * ubh_bread_uspi(struct ufs_sb_private_info *, struct super_block *, u64, u64);
270extern void ubh_brelse (struct ufs_buffer_head *);
271extern void ubh_brelse_uspi (struct ufs_sb_private_info *);
272extern void ubh_mark_buffer_dirty (struct ufs_buffer_head *);
273extern void ubh_mark_buffer_uptodate (struct ufs_buffer_head *, int);
Evgeniy Dushistov098d5af2006-06-25 05:47:31 -0700274extern void ubh_ll_rw_block(int, struct ufs_buffer_head *);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275extern void ubh_wait_on_buffer (struct ufs_buffer_head *);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276extern void ubh_bforget (struct ufs_buffer_head *);
277extern int ubh_buffer_dirty (struct ufs_buffer_head *);
278#define ubh_ubhcpymem(mem,ubh,size) _ubh_ubhcpymem_(uspi,mem,ubh,size)
279extern void _ubh_ubhcpymem_(struct ufs_sb_private_info *, unsigned char *, struct ufs_buffer_head *, unsigned);
280#define ubh_memcpyubh(ubh,mem,size) _ubh_memcpyubh_(uspi,ubh,mem,size)
281extern void _ubh_memcpyubh_(struct ufs_sb_private_info *, struct ufs_buffer_head *, unsigned char *, unsigned);
282
Evgeniy Dushistov10e5dce2006-07-01 04:36:24 -0700283/* This functions works with cache pages*/
284extern struct page *ufs_get_locked_page(struct address_space *mapping,
285 pgoff_t index);
286static inline void ufs_put_locked_page(struct page *page)
287{
288 unlock_page(page);
289 page_cache_release(page);
290}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291
292
293/*
Evgeniy7b4ee732006-01-14 11:42:06 +0300294 * macros and inline function to get important structures from ufs_sb_private_info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700296
Evgeniy7b4ee732006-01-14 11:42:06 +0300297static inline void *get_usb_offset(struct ufs_sb_private_info *uspi,
298 unsigned int offset)
299{
300 unsigned int index;
301
302 index = offset >> uspi->s_fshift;
303 offset &= ~uspi->s_fmask;
304 return uspi->s_ubh.bh[index]->b_data + offset;
305}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306
Evgeniy7b4ee732006-01-14 11:42:06 +0300307#define ubh_get_usb_first(uspi) \
308 ((struct ufs_super_block_first *)get_usb_offset((uspi), 0))
309
310#define ubh_get_usb_second(uspi) \
311 ((struct ufs_super_block_second *)get_usb_offset((uspi), UFS_SECTOR_SIZE))
312
313#define ubh_get_usb_third(uspi) \
314 ((struct ufs_super_block_third *)get_usb_offset((uspi), 2*UFS_SECTOR_SIZE))
315
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316
317#define ubh_get_ucg(ubh) \
318 ((struct ufs_cylinder_group *)((ubh)->bh[0]->b_data))
319
320
321/*
322 * Extract byte from ufs_buffer_head
323 * Extract the bits for a block from a map inside ufs_buffer_head
324 */
325#define ubh_get_addr8(ubh,begin) \
326 ((u8*)(ubh)->bh[(begin) >> uspi->s_fshift]->b_data + \
327 ((begin) & ~uspi->s_fmask))
328
329#define ubh_get_addr16(ubh,begin) \
330 (((__fs16*)((ubh)->bh[(begin) >> (uspi->s_fshift-1)]->b_data)) + \
Mariusz Kozlowski71a3d1b2006-12-06 20:40:09 -0800331 ((begin) & ((uspi->fsize>>1) - 1)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700332
333#define ubh_get_addr32(ubh,begin) \
334 (((__fs32*)((ubh)->bh[(begin) >> (uspi->s_fshift-2)]->b_data)) + \
335 ((begin) & ((uspi->s_fsize>>2) - 1)))
336
Evgeniy Dushistov54fb9962007-02-12 00:54:32 -0800337#define ubh_get_addr64(ubh,begin) \
338 (((__fs64*)((ubh)->bh[(begin) >> (uspi->s_fshift-3)]->b_data)) + \
339 ((begin) & ((uspi->s_fsize>>3) - 1)))
340
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341#define ubh_get_addr ubh_get_addr8
342
Evgeniy Dushistov54fb9962007-02-12 00:54:32 -0800343static inline void *ubh_get_data_ptr(struct ufs_sb_private_info *uspi,
344 struct ufs_buffer_head *ubh,
345 u64 blk)
346{
347 if (uspi->fs_magic == UFS2_MAGIC)
348 return ubh_get_addr64(ubh, blk);
349 else
350 return ubh_get_addr32(ubh, blk);
351}
352
Linus Torvalds1da177e2005-04-16 15:20:36 -0700353#define ubh_blkmap(ubh,begin,bit) \
354 ((*ubh_get_addr(ubh, (begin) + ((bit) >> 3)) >> ((bit) & 7)) & (0xff >> (UFS_MAXFRAG - uspi->s_fpb)))
355
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356/*
357 * Determine the number of available frags given a
358 * percentage to hold in reserve.
359 */
Evgeniy Dushistovee3ffd62006-06-25 05:47:30 -0700360static inline u64
361ufs_freespace(struct ufs_sb_private_info *uspi, int percentreserved)
362{
363 return ufs_blkstofrags(uspi->cs_total.cs_nbfree) +
364 uspi->cs_total.cs_nffree -
365 (uspi->s_dsize * (percentreserved) / 100);
366}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367
368/*
369 * Macros to access cylinder group array structures
370 */
371#define ubh_cg_blktot(ucpi,cylno) \
Evgeniy Dushistov9695ef12006-06-25 05:47:22 -0700372 (*((__fs32*)ubh_get_addr(UCPI_UBH(ucpi), (ucpi)->c_btotoff + ((cylno) << 2))))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700373
374#define ubh_cg_blks(ucpi,cylno,rpos) \
Evgeniy Dushistov9695ef12006-06-25 05:47:22 -0700375 (*((__fs16*)ubh_get_addr(UCPI_UBH(ucpi), \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 (ucpi)->c_boff + (((cylno) * uspi->s_nrpos + (rpos)) << 1 ))))
377
378/*
379 * Bitmap operations
380 * These functions work like classical bitmap operations.
381 * The difference is that we don't have the whole bitmap
382 * in one contiguous chunk of memory, but in several buffers.
383 * The parameters of each function are super_block, ufs_buffer_head and
384 * position of the beginning of the bitmap.
385 */
386#define ubh_setbit(ubh,begin,bit) \
387 (*ubh_get_addr(ubh, (begin) + ((bit) >> 3)) |= (1 << ((bit) & 7)))
388
389#define ubh_clrbit(ubh,begin,bit) \
390 (*ubh_get_addr (ubh, (begin) + ((bit) >> 3)) &= ~(1 << ((bit) & 7)))
391
392#define ubh_isset(ubh,begin,bit) \
393 (*ubh_get_addr (ubh, (begin) + ((bit) >> 3)) & (1 << ((bit) & 7)))
394
395#define ubh_isclr(ubh,begin,bit) (!ubh_isset(ubh,begin,bit))
396
397#define ubh_find_first_zero_bit(ubh,begin,size) _ubh_find_next_zero_bit_(uspi,ubh,begin,size,0)
398
399#define ubh_find_next_zero_bit(ubh,begin,size,offset) _ubh_find_next_zero_bit_(uspi,ubh,begin,size,offset)
400static inline unsigned _ubh_find_next_zero_bit_(
401 struct ufs_sb_private_info * uspi, struct ufs_buffer_head * ubh,
402 unsigned begin, unsigned size, unsigned offset)
403{
404 unsigned base, count, pos;
405
406 size -= offset;
407 begin <<= 3;
408 offset += begin;
409 base = offset >> uspi->s_bpfshift;
410 offset &= uspi->s_bpfmask;
411 for (;;) {
412 count = min_t(unsigned int, size + offset, uspi->s_bpf);
413 size -= count - offset;
414 pos = ext2_find_next_zero_bit (ubh->bh[base]->b_data, count, offset);
415 if (pos < count || !size)
416 break;
417 base++;
418 offset = 0;
419 }
420 return (base << uspi->s_bpfshift) + pos - begin;
421}
422
423static inline unsigned find_last_zero_bit (unsigned char * bitmap,
424 unsigned size, unsigned offset)
425{
426 unsigned bit, i;
427 unsigned char * mapp;
428 unsigned char map;
429
430 mapp = bitmap + (size >> 3);
431 map = *mapp--;
432 bit = 1 << (size & 7);
433 for (i = size; i > offset; i--) {
434 if ((map & bit) == 0)
435 break;
436 if ((i & 7) != 0) {
437 bit >>= 1;
438 } else {
439 map = *mapp--;
440 bit = 1 << 7;
441 }
442 }
443 return i;
444}
445
446#define ubh_find_last_zero_bit(ubh,begin,size,offset) _ubh_find_last_zero_bit_(uspi,ubh,begin,size,offset)
447static inline unsigned _ubh_find_last_zero_bit_(
448 struct ufs_sb_private_info * uspi, struct ufs_buffer_head * ubh,
449 unsigned begin, unsigned start, unsigned end)
450{
451 unsigned base, count, pos, size;
452
453 size = start - end;
454 begin <<= 3;
455 start += begin;
456 base = start >> uspi->s_bpfshift;
457 start &= uspi->s_bpfmask;
458 for (;;) {
459 count = min_t(unsigned int,
460 size + (uspi->s_bpf - start), uspi->s_bpf)
461 - (uspi->s_bpf - start);
462 size -= count;
463 pos = find_last_zero_bit (ubh->bh[base]->b_data,
464 start, start - count);
465 if (pos > start - count || !size)
466 break;
467 base--;
468 start = uspi->s_bpf;
469 }
470 return (base << uspi->s_bpfshift) + pos - begin;
471}
472
473#define ubh_isblockclear(ubh,begin,block) (!_ubh_isblockset_(uspi,ubh,begin,block))
474
475#define ubh_isblockset(ubh,begin,block) _ubh_isblockset_(uspi,ubh,begin,block)
476static inline int _ubh_isblockset_(struct ufs_sb_private_info * uspi,
477 struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
478{
479 switch (uspi->s_fpb) {
480 case 8:
481 return (*ubh_get_addr (ubh, begin + block) == 0xff);
482 case 4:
483 return (*ubh_get_addr (ubh, begin + (block >> 1)) == (0x0f << ((block & 0x01) << 2)));
484 case 2:
485 return (*ubh_get_addr (ubh, begin + (block >> 2)) == (0x03 << ((block & 0x03) << 1)));
486 case 1:
487 return (*ubh_get_addr (ubh, begin + (block >> 3)) == (0x01 << (block & 0x07)));
488 }
489 return 0;
490}
491
492#define ubh_clrblock(ubh,begin,block) _ubh_clrblock_(uspi,ubh,begin,block)
493static inline void _ubh_clrblock_(struct ufs_sb_private_info * uspi,
494 struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
495{
496 switch (uspi->s_fpb) {
497 case 8:
498 *ubh_get_addr (ubh, begin + block) = 0x00;
499 return;
500 case 4:
501 *ubh_get_addr (ubh, begin + (block >> 1)) &= ~(0x0f << ((block & 0x01) << 2));
502 return;
503 case 2:
504 *ubh_get_addr (ubh, begin + (block >> 2)) &= ~(0x03 << ((block & 0x03) << 1));
505 return;
506 case 1:
507 *ubh_get_addr (ubh, begin + (block >> 3)) &= ~(0x01 << ((block & 0x07)));
508 return;
509 }
510}
511
512#define ubh_setblock(ubh,begin,block) _ubh_setblock_(uspi,ubh,begin,block)
513static inline void _ubh_setblock_(struct ufs_sb_private_info * uspi,
514 struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
515{
516 switch (uspi->s_fpb) {
517 case 8:
518 *ubh_get_addr(ubh, begin + block) = 0xff;
519 return;
520 case 4:
521 *ubh_get_addr(ubh, begin + (block >> 1)) |= (0x0f << ((block & 0x01) << 2));
522 return;
523 case 2:
524 *ubh_get_addr(ubh, begin + (block >> 2)) |= (0x03 << ((block & 0x03) << 1));
525 return;
526 case 1:
527 *ubh_get_addr(ubh, begin + (block >> 3)) |= (0x01 << ((block & 0x07)));
528 return;
529 }
530}
531
532static inline void ufs_fragacct (struct super_block * sb, unsigned blockmap,
533 __fs32 * fraglist, int cnt)
534{
535 struct ufs_sb_private_info * uspi;
536 unsigned fragsize, pos;
537
538 uspi = UFS_SB(sb)->s_uspi;
539
540 fragsize = 0;
541 for (pos = 0; pos < uspi->s_fpb; pos++) {
542 if (blockmap & (1 << pos)) {
543 fragsize++;
544 }
545 else if (fragsize > 0) {
546 fs32_add(sb, &fraglist[fragsize], cnt);
547 fragsize = 0;
548 }
549 }
550 if (fragsize > 0 && fragsize < uspi->s_fpb)
551 fs32_add(sb, &fraglist[fragsize], cnt);
552}
Evgeniy Dushistov54fb9962007-02-12 00:54:32 -0800553
554static inline void *ufs_get_direct_data_ptr(struct ufs_sb_private_info *uspi,
555 struct ufs_inode_info *ufsi,
556 unsigned blk)
557{
558 BUG_ON(blk > UFS_TIND_BLOCK);
559 return uspi->fs_magic == UFS2_MAGIC ?
560 (void *)&ufsi->i_u1.u2_i_data[blk] :
561 (void *)&ufsi->i_u1.i_data[blk];
562}
563
564static inline u64 ufs_data_ptr_to_cpu(struct super_block *sb, void *p)
565{
566 return UFS_SB(sb)->s_uspi->fs_magic == UFS2_MAGIC ?
567 fs64_to_cpu(sb, *(__fs64 *)p) :
568 fs32_to_cpu(sb, *(__fs32 *)p);
569}
570
571static inline void ufs_cpu_to_data_ptr(struct super_block *sb, void *p, u64 val)
572{
573 if (UFS_SB(sb)->s_uspi->fs_magic == UFS2_MAGIC)
574 *(__fs64 *)p = cpu_to_fs64(sb, val);
575 else
576 *(__fs32 *)p = cpu_to_fs32(sb, val);
577}
578
579static inline void ufs_data_ptr_clear(struct ufs_sb_private_info *uspi,
580 void *p)
581{
582 if (uspi->fs_magic == UFS2_MAGIC)
583 *(__fs64 *)p = 0;
584 else
585 *(__fs32 *)p = 0;
586}
587
588static inline int ufs_is_data_ptr_zero(struct ufs_sb_private_info *uspi,
589 void *p)
590{
591 if (uspi->fs_magic == UFS2_MAGIC)
592 return *(__fs64 *)p == 0;
593 else
594 return *(__fs32 *)p == 0;
595}