开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
util.h
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：15k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

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