[PATCH] ufs: ufs_trunc_indirect: infinite cycle
[pandora-kernel.git] / fs / ufs / util.h
1 /*
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 /*
20  * macros used for retyping
21  */
22 #define UCPI_UBH ((struct ufs_buffer_head *)ucpi)
23 #define USPI_UBH ((struct ufs_buffer_head *)uspi)
24
25
26
27 /*
28  * macros used for accessing structures
29  */
30 static inline s32
31 ufs_get_fs_state(struct super_block *sb, struct ufs_super_block_first *usb1,
32                  struct ufs_super_block_third *usb3)
33 {
34         switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
35         case UFS_ST_SUN:
36                 return fs32_to_cpu(sb, usb3->fs_u2.fs_sun.fs_state);
37         case UFS_ST_SUNx86:
38                 return fs32_to_cpu(sb, usb1->fs_u1.fs_sunx86.fs_state);
39         case UFS_ST_44BSD:
40         default:
41                 return fs32_to_cpu(sb, usb3->fs_u2.fs_44.fs_state);
42         }
43 }
44
45 static inline void
46 ufs_set_fs_state(struct super_block *sb, struct ufs_super_block_first *usb1,
47                  struct ufs_super_block_third *usb3, s32 value)
48 {
49         switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
50         case UFS_ST_SUN:
51                 usb3->fs_u2.fs_sun.fs_state = cpu_to_fs32(sb, value);
52                 break;
53         case UFS_ST_SUNx86:
54                 usb1->fs_u1.fs_sunx86.fs_state = cpu_to_fs32(sb, value);
55                 break;
56         case UFS_ST_44BSD:
57                 usb3->fs_u2.fs_44.fs_state = cpu_to_fs32(sb, value);
58                 break;
59         }
60 }
61
62 static inline u32
63 ufs_get_fs_npsect(struct super_block *sb, struct ufs_super_block_first *usb1,
64                   struct ufs_super_block_third *usb3)
65 {
66         if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
67                 return fs32_to_cpu(sb, usb3->fs_u2.fs_sunx86.fs_npsect);
68         else
69                 return fs32_to_cpu(sb, usb1->fs_u1.fs_sun.fs_npsect);
70 }
71
72 static inline u64
73 ufs_get_fs_qbmask(struct super_block *sb, struct ufs_super_block_third *usb3)
74 {
75         __fs64 tmp;
76
77         switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
78         case UFS_ST_SUN:
79                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_sun.fs_qbmask[0];
80                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_sun.fs_qbmask[1];
81                 break;
82         case UFS_ST_SUNx86:
83                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_sunx86.fs_qbmask[0];
84                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_sunx86.fs_qbmask[1];
85                 break;
86         case UFS_ST_44BSD:
87                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_44.fs_qbmask[0];
88                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_44.fs_qbmask[1];
89                 break;
90         }
91
92         return fs64_to_cpu(sb, tmp);
93 }
94
95 static inline u64
96 ufs_get_fs_qfmask(struct super_block *sb, struct ufs_super_block_third *usb3)
97 {
98         __fs64 tmp;
99
100         switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
101         case UFS_ST_SUN:
102                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_sun.fs_qfmask[0];
103                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_sun.fs_qfmask[1];
104                 break;
105         case UFS_ST_SUNx86:
106                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_sunx86.fs_qfmask[0];
107                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_sunx86.fs_qfmask[1];
108                 break;
109         case UFS_ST_44BSD:
110                 ((__fs32 *)&tmp)[0] = usb3->fs_u2.fs_44.fs_qfmask[0];
111                 ((__fs32 *)&tmp)[1] = usb3->fs_u2.fs_44.fs_qfmask[1];
112                 break;
113         }
114
115         return fs64_to_cpu(sb, tmp);
116 }
117
118 static inline u16
119 ufs_get_de_namlen(struct super_block *sb, struct ufs_dir_entry *de)
120 {
121         if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) == UFS_DE_OLD)
122                 return fs16_to_cpu(sb, de->d_u.d_namlen);
123         else
124                 return de->d_u.d_44.d_namlen; /* XXX this seems wrong */
125 }
126
127 static inline void
128 ufs_set_de_namlen(struct super_block *sb, struct ufs_dir_entry *de, u16 value)
129 {
130         if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) == UFS_DE_OLD)
131                 de->d_u.d_namlen = cpu_to_fs16(sb, value);
132         else
133                 de->d_u.d_44.d_namlen = value; /* XXX this seems wrong */
134 }
135
136 static inline void
137 ufs_set_de_type(struct super_block *sb, struct ufs_dir_entry *de, int mode)
138 {
139         if ((UFS_SB(sb)->s_flags & UFS_DE_MASK) != UFS_DE_44BSD)
140                 return;
141
142         /*
143          * TODO turn this into a table lookup
144          */
145         switch (mode & S_IFMT) {
146         case S_IFSOCK:
147                 de->d_u.d_44.d_type = DT_SOCK;
148                 break;
149         case S_IFLNK:
150                 de->d_u.d_44.d_type = DT_LNK;
151                 break;
152         case S_IFREG:
153                 de->d_u.d_44.d_type = DT_REG;
154                 break;
155         case S_IFBLK:
156                 de->d_u.d_44.d_type = DT_BLK;
157                 break;
158         case S_IFDIR:
159                 de->d_u.d_44.d_type = DT_DIR;
160                 break;
161         case S_IFCHR:
162                 de->d_u.d_44.d_type = DT_CHR;
163                 break;
164         case S_IFIFO:
165                 de->d_u.d_44.d_type = DT_FIFO;
166                 break;
167         default:
168                 de->d_u.d_44.d_type = DT_UNKNOWN;
169         }
170 }
171
172 static inline u32
173 ufs_get_inode_uid(struct super_block *sb, struct ufs_inode *inode)
174 {
175         switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
176         case UFS_UID_EFT:
177                 return fs32_to_cpu(sb, inode->ui_u3.ui_sun.ui_uid);
178         case UFS_UID_44BSD:
179                 return fs32_to_cpu(sb, inode->ui_u3.ui_44.ui_uid);
180         default:
181                 return fs16_to_cpu(sb, inode->ui_u1.oldids.ui_suid);
182         }
183 }
184
185 static inline void
186 ufs_set_inode_uid(struct super_block *sb, struct ufs_inode *inode, u32 value)
187 {
188         switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
189         case UFS_UID_EFT:
190                 inode->ui_u3.ui_sun.ui_uid = cpu_to_fs32(sb, value);
191                 break;
192         case UFS_UID_44BSD:
193                 inode->ui_u3.ui_44.ui_uid = cpu_to_fs32(sb, value);
194                 break;
195         }
196         inode->ui_u1.oldids.ui_suid = cpu_to_fs16(sb, value); 
197 }
198
199 static inline u32
200 ufs_get_inode_gid(struct super_block *sb, struct ufs_inode *inode)
201 {
202         switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
203         case UFS_UID_EFT:
204                 return fs32_to_cpu(sb, inode->ui_u3.ui_sun.ui_gid);
205         case UFS_UID_44BSD:
206                 return fs32_to_cpu(sb, inode->ui_u3.ui_44.ui_gid);
207         default:
208                 return fs16_to_cpu(sb, inode->ui_u1.oldids.ui_sgid);
209         }
210 }
211
212 static inline void
213 ufs_set_inode_gid(struct super_block *sb, struct ufs_inode *inode, u32 value)
214 {
215         switch (UFS_SB(sb)->s_flags & UFS_UID_MASK) {
216         case UFS_UID_EFT:
217                 inode->ui_u3.ui_sun.ui_gid = cpu_to_fs32(sb, value);
218                 break;
219         case UFS_UID_44BSD:
220                 inode->ui_u3.ui_44.ui_gid = cpu_to_fs32(sb, value);
221                 break;
222         }
223         inode->ui_u1.oldids.ui_sgid =  cpu_to_fs16(sb, value);
224 }
225
226 extern dev_t ufs_get_inode_dev(struct super_block *, struct ufs_inode_info *);
227 extern void ufs_set_inode_dev(struct super_block *, struct ufs_inode_info *, dev_t);
228
229 /*
230  * These functions manipulate ufs buffers
231  */
232 #define ubh_bread(sb,fragment,size) _ubh_bread_(uspi,sb,fragment,size)  
233 extern struct ufs_buffer_head * _ubh_bread_(struct ufs_sb_private_info *, struct super_block *, u64 , u64);
234 extern struct ufs_buffer_head * ubh_bread_uspi(struct ufs_sb_private_info *, struct super_block *, u64, u64);
235 extern void ubh_brelse (struct ufs_buffer_head *);
236 extern void ubh_brelse_uspi (struct ufs_sb_private_info *);
237 extern void ubh_mark_buffer_dirty (struct ufs_buffer_head *);
238 extern void ubh_mark_buffer_uptodate (struct ufs_buffer_head *, int);
239 extern void ubh_ll_rw_block (int, unsigned, struct ufs_buffer_head **);
240 extern void ubh_wait_on_buffer (struct ufs_buffer_head *);
241 extern void ubh_bforget (struct ufs_buffer_head *);
242 extern int  ubh_buffer_dirty (struct ufs_buffer_head *);
243 #define ubh_ubhcpymem(mem,ubh,size) _ubh_ubhcpymem_(uspi,mem,ubh,size)
244 extern void _ubh_ubhcpymem_(struct ufs_sb_private_info *, unsigned char *, struct ufs_buffer_head *, unsigned);
245 #define ubh_memcpyubh(ubh,mem,size) _ubh_memcpyubh_(uspi,ubh,mem,size)
246 extern void _ubh_memcpyubh_(struct ufs_sb_private_info *, struct ufs_buffer_head *, unsigned char *, unsigned);
247
248
249
250 /*
251  * macros and inline function to get important structures from ufs_sb_private_info
252  */
253
254 static inline void *get_usb_offset(struct ufs_sb_private_info *uspi,
255                                    unsigned int offset)
256 {
257         unsigned int index;
258         
259         index = offset >> uspi->s_fshift;
260         offset &= ~uspi->s_fmask;
261         return uspi->s_ubh.bh[index]->b_data + offset;
262 }
263
264 #define ubh_get_usb_first(uspi) \
265         ((struct ufs_super_block_first *)get_usb_offset((uspi), 0))
266
267 #define ubh_get_usb_second(uspi) \
268         ((struct ufs_super_block_second *)get_usb_offset((uspi), UFS_SECTOR_SIZE))
269
270 #define ubh_get_usb_third(uspi) \
271         ((struct ufs_super_block_third *)get_usb_offset((uspi), 2*UFS_SECTOR_SIZE))
272
273
274 #define ubh_get_ucg(ubh) \
275         ((struct ufs_cylinder_group *)((ubh)->bh[0]->b_data))
276
277
278 /*
279  * Extract byte from ufs_buffer_head
280  * Extract the bits for a block from a map inside ufs_buffer_head
281  */
282 #define ubh_get_addr8(ubh,begin) \
283         ((u8*)(ubh)->bh[(begin) >> uspi->s_fshift]->b_data + \
284         ((begin) & ~uspi->s_fmask))
285
286 #define ubh_get_addr16(ubh,begin) \
287         (((__fs16*)((ubh)->bh[(begin) >> (uspi->s_fshift-1)]->b_data)) + \
288         ((begin) & (uspi->fsize>>1) - 1)))
289
290 #define ubh_get_addr32(ubh,begin) \
291         (((__fs32*)((ubh)->bh[(begin) >> (uspi->s_fshift-2)]->b_data)) + \
292         ((begin) & ((uspi->s_fsize>>2) - 1)))
293
294 #define ubh_get_addr ubh_get_addr8
295
296 #define ubh_blkmap(ubh,begin,bit) \
297         ((*ubh_get_addr(ubh, (begin) + ((bit) >> 3)) >> ((bit) & 7)) & (0xff >> (UFS_MAXFRAG - uspi->s_fpb)))
298
299
300 /*
301  * Macros for access to superblock array structures
302  */
303 #define ubh_postbl(ubh,cylno,i) \
304         ((uspi->s_postblformat != UFS_DYNAMICPOSTBLFMT) \
305         ? (*(__s16*)(ubh_get_addr(ubh, \
306         (unsigned)(&((struct ufs_super_block *)0)->fs_opostbl) \
307         + (((cylno) * 16 + (i)) << 1) ) )) \
308         : (*(__s16*)(ubh_get_addr(ubh, \
309         uspi->s_postbloff + (((cylno) * uspi->s_nrpos + (i)) << 1) ))))
310
311 #define ubh_rotbl(ubh,i) \
312         ((uspi->s_postblformat != UFS_DYNAMICPOSTBLFMT) \
313         ? (*(__u8*)(ubh_get_addr(ubh, \
314         (unsigned)(&((struct ufs_super_block *)0)->fs_space) + (i)))) \
315         : (*(__u8*)(ubh_get_addr(ubh, uspi->s_rotbloff + (i)))))
316
317 /*
318  * Determine the number of available frags given a
319  * percentage to hold in reserve.
320  */
321 #define ufs_freespace(usb, percentreserved) \
322         (ufs_blkstofrags(fs32_to_cpu(sb, (usb)->fs_cstotal.cs_nbfree)) + \
323         fs32_to_cpu(sb, (usb)->fs_cstotal.cs_nffree) - (uspi->s_dsize * (percentreserved) / 100))
324
325 /*
326  * Macros to access cylinder group array structures
327  */
328 #define ubh_cg_blktot(ucpi,cylno) \
329         (*((__fs32*)ubh_get_addr(UCPI_UBH, (ucpi)->c_btotoff + ((cylno) << 2))))
330
331 #define ubh_cg_blks(ucpi,cylno,rpos) \
332         (*((__fs16*)ubh_get_addr(UCPI_UBH, \
333         (ucpi)->c_boff + (((cylno) * uspi->s_nrpos + (rpos)) << 1 ))))
334
335 /*
336  * Bitmap operations
337  * These functions work like classical bitmap operations.
338  * The difference is that we don't have the whole bitmap
339  * in one contiguous chunk of memory, but in several buffers.
340  * The parameters of each function are super_block, ufs_buffer_head and
341  * position of the beginning of the bitmap.
342  */
343 #define ubh_setbit(ubh,begin,bit) \
344         (*ubh_get_addr(ubh, (begin) + ((bit) >> 3)) |= (1 << ((bit) & 7)))
345
346 #define ubh_clrbit(ubh,begin,bit) \
347         (*ubh_get_addr (ubh, (begin) + ((bit) >> 3)) &= ~(1 << ((bit) & 7)))
348
349 #define ubh_isset(ubh,begin,bit) \
350         (*ubh_get_addr (ubh, (begin) + ((bit) >> 3)) & (1 << ((bit) & 7)))
351
352 #define ubh_isclr(ubh,begin,bit) (!ubh_isset(ubh,begin,bit))
353
354 #define ubh_find_first_zero_bit(ubh,begin,size) _ubh_find_next_zero_bit_(uspi,ubh,begin,size,0)
355
356 #define ubh_find_next_zero_bit(ubh,begin,size,offset) _ubh_find_next_zero_bit_(uspi,ubh,begin,size,offset)
357 static inline unsigned _ubh_find_next_zero_bit_(
358         struct ufs_sb_private_info * uspi, struct ufs_buffer_head * ubh,
359         unsigned begin, unsigned size, unsigned offset)
360 {
361         unsigned base, count, pos;
362
363         size -= offset;
364         begin <<= 3;
365         offset += begin;
366         base = offset >> uspi->s_bpfshift;
367         offset &= uspi->s_bpfmask;
368         for (;;) {
369                 count = min_t(unsigned int, size + offset, uspi->s_bpf);
370                 size -= count - offset;
371                 pos = ext2_find_next_zero_bit (ubh->bh[base]->b_data, count, offset);
372                 if (pos < count || !size)
373                         break;
374                 base++;
375                 offset = 0;
376         }
377         return (base << uspi->s_bpfshift) + pos - begin;
378 }       
379
380 static inline unsigned find_last_zero_bit (unsigned char * bitmap,
381         unsigned size, unsigned offset)
382 {
383         unsigned bit, i;
384         unsigned char * mapp;
385         unsigned char map;
386
387         mapp = bitmap + (size >> 3);
388         map = *mapp--;
389         bit = 1 << (size & 7);
390         for (i = size; i > offset; i--) {
391                 if ((map & bit) == 0)
392                         break;
393                 if ((i & 7) != 0) {
394                         bit >>= 1;
395                 } else {
396                         map = *mapp--;
397                         bit = 1 << 7;
398                 }
399         }
400         return i;
401 }
402
403 #define ubh_find_last_zero_bit(ubh,begin,size,offset) _ubh_find_last_zero_bit_(uspi,ubh,begin,size,offset)
404 static inline unsigned _ubh_find_last_zero_bit_(
405         struct ufs_sb_private_info * uspi, struct ufs_buffer_head * ubh,
406         unsigned begin, unsigned start, unsigned end)
407 {
408         unsigned base, count, pos, size;
409
410         size = start - end;
411         begin <<= 3;
412         start += begin;
413         base = start >> uspi->s_bpfshift;
414         start &= uspi->s_bpfmask;
415         for (;;) {
416                 count = min_t(unsigned int,
417                             size + (uspi->s_bpf - start), uspi->s_bpf)
418                         - (uspi->s_bpf - start);
419                 size -= count;
420                 pos = find_last_zero_bit (ubh->bh[base]->b_data,
421                         start, start - count);
422                 if (pos > start - count || !size)
423                         break;
424                 base--;
425                 start = uspi->s_bpf;
426         }
427         return (base << uspi->s_bpfshift) + pos - begin;
428 }       
429
430 #define ubh_isblockclear(ubh,begin,block) (!_ubh_isblockset_(uspi,ubh,begin,block))
431
432 #define ubh_isblockset(ubh,begin,block) _ubh_isblockset_(uspi,ubh,begin,block)
433 static inline int _ubh_isblockset_(struct ufs_sb_private_info * uspi,
434         struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
435 {
436         switch (uspi->s_fpb) {
437         case 8:
438                 return (*ubh_get_addr (ubh, begin + block) == 0xff);
439         case 4:
440                 return (*ubh_get_addr (ubh, begin + (block >> 1)) == (0x0f << ((block & 0x01) << 2)));
441         case 2:
442                 return (*ubh_get_addr (ubh, begin + (block >> 2)) == (0x03 << ((block & 0x03) << 1)));
443         case 1:
444                 return (*ubh_get_addr (ubh, begin + (block >> 3)) == (0x01 << (block & 0x07)));
445         }
446         return 0;       
447 }
448
449 #define ubh_clrblock(ubh,begin,block) _ubh_clrblock_(uspi,ubh,begin,block)
450 static inline void _ubh_clrblock_(struct ufs_sb_private_info * uspi,
451         struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
452 {
453         switch (uspi->s_fpb) {
454         case 8:
455                 *ubh_get_addr (ubh, begin + block) = 0x00;
456                 return; 
457         case 4:
458                 *ubh_get_addr (ubh, begin + (block >> 1)) &= ~(0x0f << ((block & 0x01) << 2));
459                 return;
460         case 2:
461                 *ubh_get_addr (ubh, begin + (block >> 2)) &= ~(0x03 << ((block & 0x03) << 1));
462                 return;
463         case 1:
464                 *ubh_get_addr (ubh, begin + (block >> 3)) &= ~(0x01 << ((block & 0x07)));
465                 return;
466         }
467 }
468
469 #define ubh_setblock(ubh,begin,block) _ubh_setblock_(uspi,ubh,begin,block)
470 static inline void _ubh_setblock_(struct ufs_sb_private_info * uspi,
471         struct ufs_buffer_head * ubh, unsigned begin, unsigned block)
472 {
473         switch (uspi->s_fpb) {
474         case 8:
475                 *ubh_get_addr(ubh, begin + block) = 0xff;
476                 return;
477         case 4:
478                 *ubh_get_addr(ubh, begin + (block >> 1)) |= (0x0f << ((block & 0x01) << 2));
479                 return;
480         case 2:
481                 *ubh_get_addr(ubh, begin + (block >> 2)) |= (0x03 << ((block & 0x03) << 1));
482                 return;
483         case 1:
484                 *ubh_get_addr(ubh, begin + (block >> 3)) |= (0x01 << ((block & 0x07)));
485                 return;
486         }
487 }
488
489 static inline void ufs_fragacct (struct super_block * sb, unsigned blockmap,
490         __fs32 * fraglist, int cnt)
491 {
492         struct ufs_sb_private_info * uspi;
493         unsigned fragsize, pos;
494         
495         uspi = UFS_SB(sb)->s_uspi;
496         
497         fragsize = 0;
498         for (pos = 0; pos < uspi->s_fpb; pos++) {
499                 if (blockmap & (1 << pos)) {
500                         fragsize++;
501                 }
502                 else if (fragsize > 0) {
503                         fs32_add(sb, &fraglist[fragsize], cnt);
504                         fragsize = 0;
505                 }
506         }
507         if (fragsize > 0 && fragsize < uspi->s_fpb)
508                 fs32_add(sb, &fraglist[fragsize], cnt);
509 }
510
511 #define ubh_scanc(ubh,begin,size,table,mask) _ubh_scanc_(uspi,ubh,begin,size,table,mask)
512 static inline unsigned _ubh_scanc_(struct ufs_sb_private_info * uspi, struct ufs_buffer_head * ubh, 
513         unsigned begin, unsigned size, unsigned char * table, unsigned char mask)
514 {
515         unsigned rest, offset;
516         unsigned char * cp;
517         
518
519         offset = begin & ~uspi->s_fmask;
520         begin >>= uspi->s_fshift;
521         for (;;) {
522                 if ((offset + size) < uspi->s_fsize)
523                         rest = size;
524                 else
525                         rest = uspi->s_fsize - offset;
526                 size -= rest;
527                 cp = ubh->bh[begin]->b_data + offset;
528                 while ((table[*cp++] & mask) == 0 && --rest);
529                 if (rest || !size)
530                         break;
531                 begin++;
532                 offset = 0;
533         }
534         return (size + rest);
535 }