util.h
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:15k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

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