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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/fs/hpfs/alloc.c
  3.  *
  4.  *  Mikulas Patocka (mikulas@artax.karlin.mff.cuni.cz), 1998-1999
  5.  *
  6.  *  HPFS bitmap operations
  7.  */
  8. #include "hpfs_fn.h"
  9. /*
  10.  * Check if a sector is allocated in bitmap
  11.  * This is really slow. Turned on only if chk==2
  12.  */
  13. static int chk_if_allocated(struct super_block *s, secno sec, char *msg)
  14. {
  15. struct quad_buffer_head qbh;
  16. unsigned *bmp;
  17. if (!(bmp = hpfs_map_bitmap(s, sec >> 14, &qbh, "chk"))) goto fail;
  18. if ((bmp[(sec & 0x3fff) >> 5] >> (sec & 0x1f)) & 1) {
  19. hpfs_error(s, "sector '%s' - %08x not allocated in bitmap", msg, sec);
  20. goto fail1;
  21. }
  22. hpfs_brelse4(&qbh);
  23. if (sec >= s->s_hpfs_dirband_start && sec < s->s_hpfs_dirband_start + s->s_hpfs_dirband_size) {
  24. unsigned ssec = (sec - s->s_hpfs_dirband_start) / 4;
  25. if (!(bmp = hpfs_map_dnode_bitmap(s, &qbh))) goto fail;
  26. if ((bmp[ssec >> 5] >> (ssec & 0x1f)) & 1) {
  27. hpfs_error(s, "sector '%s' - %08x not allocated in directory bitmap", msg, sec);
  28. goto fail1;
  29. }
  30. hpfs_brelse4(&qbh);
  31. }
  32. return 0;
  33. fail1:
  34. hpfs_brelse4(&qbh);
  35. fail:
  36. return 1;
  37. }
  38. /*
  39.  * Check if sector(s) have proper number and additionally check if they're
  40.  * allocated in bitmap.
  41.  */
  42. int hpfs_chk_sectors(struct super_block *s, secno start, int len, char *msg)
  43. {
  44. if (start + len < start || start < 0x12 ||
  45.     start + len > s->s_hpfs_fs_size) {
  46.      hpfs_error(s, "sector(s) '%s' badly placed at %08x", msg, start);
  47. return 1;
  48. }
  49. if (s->s_hpfs_chk>=2) {
  50. int i;
  51. for (i = 0; i < len; i++)
  52. if (chk_if_allocated(s, start + i, msg)) return 1;
  53. }
  54. return 0;
  55. }
  56. static secno alloc_in_bmp(struct super_block *s, secno near, unsigned n, unsigned forward)
  57. {
  58. struct quad_buffer_head qbh;
  59. unsigned *bmp;
  60. unsigned bs = near & ~0x3fff;
  61. unsigned nr = (near & 0x3fff) & ~(n - 1);
  62. /*unsigned mnr;*/
  63. unsigned i, q;
  64. int a, b;
  65. secno ret = 0;
  66. if (n != 1 && n != 4) {
  67. hpfs_error(s, "Bad allocation size: %d", n);
  68. return 0;
  69. }
  70. lock_super(s);
  71. if (bs != ~0x3fff) {
  72. if (!(bmp = hpfs_map_bitmap(s, near >> 14, &qbh, "aib"))) goto uls;
  73. } else {
  74. if (!(bmp = hpfs_map_dnode_bitmap(s, &qbh))) goto uls;
  75. }
  76. /*if (!tstbits(bmp, nr + n, n + forward)) {
  77. ret = bs + nr;
  78. goto rt;
  79. }
  80. if (!tstbits(bmp, nr + 2*n, n + forward)) {
  81. ret = bs + nr + n;
  82. goto rt;
  83. }*/
  84. q = nr + n; b = 0;
  85. while ((a = tstbits(bmp, q, n + forward))) {
  86. q += a;
  87. if (n != 1) q = ((q-1)&~(n-1))+n;
  88. if (!b) {
  89. if (q>>5 != nr>>5) {
  90. b = 1;
  91. q = nr & 0x1f;
  92. }
  93. } else if (q > nr) break;
  94. }
  95. if (!a) {
  96. ret = bs + q;
  97. goto rt;
  98. }
  99. nr >>= 5;
  100. for (i = nr + 1; i != nr; i++, i &= 0x1ff) {
  101. if (!bmp[i]) continue;
  102. if (n + forward >= 0x3f && bmp[i] != -1) continue;
  103. q = i<<5;
  104. if (i > 0) {
  105. unsigned k = bmp[i-1];
  106. while (k & 0x80000000) {
  107. q--; k <<= 1;
  108. }
  109. }
  110. if (n != 1) q = ((q-1)&~(n-1))+n;
  111. while ((a = tstbits(bmp, q, n + forward))) {
  112. q += a;
  113. if (n != 1) q = ((q-1)&~(n-1))+n;
  114. if (q>>5 > i) break;
  115. }
  116. if (!a) {
  117. ret = bs + q;
  118. goto rt;
  119. }
  120. }
  121. rt:
  122. if (ret) {
  123. if (s->s_hpfs_chk && ((ret >> 14) != (bs >> 14) || (bmp[(ret & 0x3fff) >> 5] | ~(((1 << n) - 1) << (ret & 0x1f))) != 0xffffffff)) {
  124. hpfs_error(s, "Allocation doesn't work! Wanted %d, allocated at %08x", n, ret);
  125. ret = 0;
  126. goto b;
  127. }
  128. bmp[(ret & 0x3fff) >> 5] &= ~(((1 << n) - 1) << (ret & 0x1f));
  129. hpfs_mark_4buffers_dirty(&qbh);
  130. }
  131. b:
  132. hpfs_brelse4(&qbh);
  133. uls:
  134. unlock_super(s);
  135. return ret;
  136. }
  137. /*
  138.  * Allocation strategy: 1) search place near the sector specified
  139.  * 2) search bitmap where free sectors last found
  140.  * 3) search all bitmaps
  141.  * 4) search all bitmaps ignoring number of pre-allocated
  142.  * sectors
  143.  */
  144. secno hpfs_alloc_sector(struct super_block *s, secno near, unsigned n, int forward, int lock)
  145. {
  146. secno sec;
  147. unsigned i;
  148. unsigned n_bmps;
  149. int b = s->s_hpfs_c_bitmap;
  150. int f_p = 0;
  151. if (forward < 0) {
  152. forward = -forward;
  153. f_p = 1;
  154. }
  155. if (lock) hpfs_lock_creation(s);
  156. if (near && near < s->s_hpfs_fs_size)
  157. if ((sec = alloc_in_bmp(s, near, n, f_p ? forward : forward/4))) goto ret;
  158. if (b != -1) {
  159. if ((sec = alloc_in_bmp(s, b<<14, n, f_p ? forward : forward/2))) {
  160. b &= 0x0fffffff;
  161. goto ret;
  162. }
  163. if (b > 0x10000000) if ((sec = alloc_in_bmp(s, (b&0xfffffff)<<14, n, f_p ? forward : 0))) goto ret;
  164. }
  165. n_bmps = (s->s_hpfs_fs_size + 0x4000 - 1) >> 14;
  166. for (i = 0; i < n_bmps / 2; i++) {
  167. if ((sec = alloc_in_bmp(s, (n_bmps/2+i) << 14, n, forward))) {
  168. s->s_hpfs_c_bitmap = n_bmps/2+i;
  169. goto ret;
  170. }
  171. if ((sec = alloc_in_bmp(s, (n_bmps/2-i-1) << 14, n, forward))) {
  172. s->s_hpfs_c_bitmap = n_bmps/2-i-1;
  173. goto ret;
  174. }
  175. }
  176. if ((sec = alloc_in_bmp(s, (n_bmps-1) << 14, n, forward))) {
  177. s->s_hpfs_c_bitmap = n_bmps-1;
  178. goto ret;
  179. }
  180. if (!f_p) {
  181. for (i = 0; i < n_bmps; i++)
  182. if ((sec = alloc_in_bmp(s, i << 14, n, 0))) {
  183. s->s_hpfs_c_bitmap = 0x10000000 + i;
  184. goto ret;
  185. }
  186. }
  187. sec = 0;
  188. ret:
  189. if (sec && f_p) {
  190. for (i = 0; i < forward; i++) {
  191. if (!hpfs_alloc_if_possible_nolock(s, sec + i + 1)) {
  192. hpfs_error(s, "Prealloc doesn't work! Wanted %d, allocated at %08x, can't allocate %d", forward, sec, i);
  193. sec = 0;
  194. break;
  195. }
  196. }
  197. }
  198. if (lock) hpfs_unlock_creation(s);
  199. return sec;
  200. }
  201. static secno alloc_in_dirband(struct super_block *s, secno near, int lock)
  202. {
  203. unsigned nr = near;
  204. secno sec;
  205. if (nr < s->s_hpfs_dirband_start)
  206. nr = s->s_hpfs_dirband_start;
  207. if (nr >= s->s_hpfs_dirband_start + s->s_hpfs_dirband_size)
  208. nr = s->s_hpfs_dirband_start + s->s_hpfs_dirband_size - 4;
  209. nr -= s->s_hpfs_dirband_start;
  210. nr >>= 2;
  211. if (lock) hpfs_lock_creation(s);
  212. sec = alloc_in_bmp(s, (~0x3fff) | nr, 1, 0);
  213. if (lock) hpfs_unlock_creation(s);
  214. if (!sec) return 0;
  215. return ((sec & 0x3fff) << 2) + s->s_hpfs_dirband_start;
  216. }
  217. /* Alloc sector if it's free */
  218. int hpfs_alloc_if_possible_nolock(struct super_block *s, secno sec)
  219. {
  220. struct quad_buffer_head qbh;
  221. unsigned *bmp;
  222. lock_super(s);
  223. if (!(bmp = hpfs_map_bitmap(s, sec >> 14, &qbh, "aip"))) goto end;
  224. if (bmp[(sec & 0x3fff) >> 5] & (1 << (sec & 0x1f))) {
  225. bmp[(sec & 0x3fff) >> 5] &= ~(1 << (sec & 0x1f));
  226. hpfs_mark_4buffers_dirty(&qbh);
  227. hpfs_brelse4(&qbh);
  228. unlock_super(s);
  229. return 1;
  230. }
  231. hpfs_brelse4(&qbh);
  232. end:
  233. unlock_super(s);
  234. return 0;
  235. }
  236. int hpfs_alloc_if_possible(struct super_block *s, secno sec)
  237. {
  238. int r;
  239. hpfs_lock_creation(s);
  240. r = hpfs_alloc_if_possible_nolock(s, sec);
  241. hpfs_unlock_creation(s);
  242. return r;
  243. }
  244. /* Free sectors in bitmaps */
  245. void hpfs_free_sectors(struct super_block *s, secno sec, unsigned n)
  246. {
  247. struct quad_buffer_head qbh;
  248. unsigned *bmp;
  249. /*printk("2 - ");*/
  250. if (!n) return;
  251. if (sec < 0x12) {
  252. hpfs_error(s, "Trying to free reserved sector %08x", sec);
  253. return;
  254. }
  255. lock_super(s);
  256. new_map:
  257. if (!(bmp = hpfs_map_bitmap(s, sec >> 14, &qbh, "free"))) {
  258. unlock_super(s);
  259. return;
  260. }
  261. new_tst:
  262. if ((bmp[(sec & 0x3fff) >> 5] >> (sec & 0x1f) & 1)) {
  263. hpfs_error(s, "sector %08x not allocated", sec);
  264. hpfs_brelse4(&qbh);
  265. unlock_super(s);
  266. return;
  267. }
  268. bmp[(sec & 0x3fff) >> 5] |= 1 << (sec & 0x1f);
  269. if (!--n) {
  270. hpfs_mark_4buffers_dirty(&qbh);
  271. hpfs_brelse4(&qbh);
  272. unlock_super(s);
  273. return;
  274. }
  275. if (!(++sec & 0x3fff)) {
  276. hpfs_mark_4buffers_dirty(&qbh);
  277. hpfs_brelse4(&qbh);
  278. goto new_map;
  279. }
  280. goto new_tst;
  281. }
  282. /*
  283.  * Check if there are at least n free dnodes on the filesystem.
  284.  * Called before adding to dnode. If we run out of space while
  285.  * splitting dnodes, it would corrupt dnode tree.
  286.  */
  287. int hpfs_check_free_dnodes(struct super_block *s, int n)
  288. {
  289. int n_bmps = (s->s_hpfs_fs_size + 0x4000 - 1) >> 14;
  290. int b = s->s_hpfs_c_bitmap & 0x0fffffff;
  291. int i, j;
  292. unsigned *bmp;
  293. struct quad_buffer_head qbh;
  294. if ((bmp = hpfs_map_dnode_bitmap(s, &qbh))) {
  295. for (j = 0; j < 512; j++) {
  296. unsigned k;
  297. if (!bmp[j]) continue;
  298. for (k = bmp[j]; k; k >>= 1) if (k & 1) if (!--n) {
  299. hpfs_brelse4(&qbh);
  300. return 0;
  301. }
  302. }
  303. }
  304. hpfs_brelse4(&qbh);
  305. i = 0;
  306. if (s->s_hpfs_c_bitmap != -1 ) {
  307. bmp = hpfs_map_bitmap(s, b, &qbh, "chkdn1");
  308. goto chk_bmp;
  309. }
  310. chk_next:
  311. if (i == b) i++;
  312. if (i >= n_bmps) return 1;
  313. bmp = hpfs_map_bitmap(s, i, &qbh, "chkdn2");
  314. chk_bmp:
  315. if (bmp) {
  316. for (j = 0; j < 512; j++) {
  317. unsigned k;
  318. if (!bmp[j]) continue;
  319. for (k = 0xf; k; k <<= 4)
  320. if ((bmp[j] & k) == k) {
  321. if (!--n) {
  322. hpfs_brelse4(&qbh);
  323. return 0;
  324. }
  325. }
  326. }
  327. hpfs_brelse4(&qbh);
  328. }
  329. i++;
  330. goto chk_next;
  331. }
  332. void hpfs_free_dnode(struct super_block *s, dnode_secno dno)
  333. {
  334. if (s->s_hpfs_chk) if (dno & 3) {
  335. hpfs_error(s, "hpfs_free_dnode: dnode %08x not aligned", dno);
  336. return;
  337. }
  338. if (dno < s->s_hpfs_dirband_start ||
  339.     dno >= s->s_hpfs_dirband_start + s->s_hpfs_dirband_size) {
  340. hpfs_free_sectors(s, dno, 4);
  341. } else {
  342. struct quad_buffer_head qbh;
  343. unsigned *bmp;
  344. unsigned ssec = (dno - s->s_hpfs_dirband_start) / 4;
  345. lock_super(s);
  346. if (!(bmp = hpfs_map_dnode_bitmap(s, &qbh))) {
  347. unlock_super(s);
  348. return;
  349. }
  350. bmp[ssec >> 5] |= 1 << (ssec & 0x1f);
  351. hpfs_mark_4buffers_dirty(&qbh);
  352. hpfs_brelse4(&qbh);
  353. unlock_super(s);
  354. }
  355. }
  356. struct dnode *hpfs_alloc_dnode(struct super_block *s, secno near,
  357.  dnode_secno *dno, struct quad_buffer_head *qbh,
  358.  int lock)
  359. {
  360. struct dnode *d;
  361. if (hpfs_count_one_bitmap(s, s->s_hpfs_dmap) > FREE_DNODES_ADD) {
  362. if (!(*dno = alloc_in_dirband(s, near, lock)))
  363. if (!(*dno = hpfs_alloc_sector(s, near, 4, 0, lock))) return NULL;
  364. } else {
  365. if (!(*dno = hpfs_alloc_sector(s, near, 4, 0, lock)))
  366. if (!(*dno = alloc_in_dirband(s, near, lock))) return NULL;
  367. }
  368. if (!(d = hpfs_get_4sectors(s, *dno, qbh))) {
  369. hpfs_free_dnode(s, *dno);
  370. return NULL;
  371. }
  372. memset(d, 0, 2048);
  373. d->magic = DNODE_MAGIC;
  374. d->first_free = 52;
  375. d->dirent[0] = 32;
  376. d->dirent[2] = 8;
  377. d->dirent[30] = 1;
  378. d->dirent[31] = 255;
  379. d->self = *dno;
  380. return d;
  381. }
  382. struct fnode *hpfs_alloc_fnode(struct super_block *s, secno near, fnode_secno *fno,
  383.   struct buffer_head **bh)
  384. {
  385. struct fnode *f;
  386. if (!(*fno = hpfs_alloc_sector(s, near, 1, FNODE_ALLOC_FWD, 1))) return NULL;
  387. if (!(f = hpfs_get_sector(s, *fno, bh))) {
  388. hpfs_free_sectors(s, *fno, 1);
  389. return NULL;
  390. }
  391. memset(f, 0, 512);
  392. f->magic = FNODE_MAGIC;
  393. f->ea_offs = 0xc4;
  394. f->btree.n_free_nodes = 8;
  395. f->btree.first_free = 8;
  396. return f;
  397. }
  398. struct anode *hpfs_alloc_anode(struct super_block *s, secno near, anode_secno *ano,
  399.   struct buffer_head **bh)
  400. {
  401. struct anode *a;
  402. if (!(*ano = hpfs_alloc_sector(s, near, 1, ANODE_ALLOC_FWD, 1))) return NULL;
  403. if (!(a = hpfs_get_sector(s, *ano, bh))) {
  404. hpfs_free_sectors(s, *ano, 1);
  405. return NULL;
  406. }
  407. memset(a, 0, 512);
  408. a->magic = ANODE_MAGIC;
  409. a->self = *ano;
  410. a->btree.n_free_nodes = 40;
  411. a->btree.n_used_nodes = 0;
  412. a->btree.first_free = 8;
  413. return a;
  414. }