xref: /csrg-svn/sys/ufs/lfs/lfs_alloc.c (revision 4948)
14359Smckusick /* Copyright (c) 1981 Regents of the University of California */
24359Smckusick 
3*4948Smckusic static char vers[] = "@(#)lfs_alloc.c 1.9 11/19/81";
44359Smckusick 
54359Smckusick /*	alloc.c	4.8	81/03/08	*/
64359Smckusick 
74359Smckusick #include "../h/param.h"
84359Smckusick #include "../h/systm.h"
94359Smckusick #include "../h/mount.h"
104359Smckusick #include "../h/fs.h"
114359Smckusick #include "../h/conf.h"
124359Smckusick #include "../h/buf.h"
134359Smckusick #include "../h/inode.h"
144359Smckusick #include "../h/dir.h"
154359Smckusick #include "../h/user.h"
164359Smckusick 
174607Smckusic extern long		hashalloc();
184607Smckusic extern long		ialloccg();
194651Smckusic extern daddr_t		alloccg();
204651Smckusic extern daddr_t		alloccgblk();
214651Smckusic extern daddr_t		fragextend();
224651Smckusic extern daddr_t		blkpref();
234651Smckusic extern daddr_t		mapsearch();
244607Smckusic extern int		inside[], around[];
254607Smckusic extern unsigned char	fragtbl[];
264359Smckusick 
274359Smckusick struct buf *
284359Smckusick alloc(dev, ip, bpref, size)
294359Smckusick 	dev_t dev;
304463Smckusic 	register struct inode *ip;
314359Smckusick 	daddr_t bpref;
324359Smckusick 	int size;
334359Smckusick {
344359Smckusick 	daddr_t bno;
354359Smckusick 	register struct fs *fs;
364463Smckusic 	register struct buf *bp;
374359Smckusick 	int cg;
384359Smckusick 
394463Smckusic 	if ((unsigned)size > BSIZE || size % FSIZE != 0)
404463Smckusic 		panic("alloc: bad size");
414359Smckusick 	fs = getfs(dev);
424792Smckusic 	if (size == BSIZE && fs->fs_cstotal.cs_nbfree == 0)
434359Smckusick 		goto nospace;
444792Smckusic 	if (u.u_uid != 0 &&
454792Smckusic 	    fs->fs_cstotal.cs_nbfree * FRAG + fs->fs_cstotal.cs_nffree <
464792Smckusic 	      fs->fs_dsize * minfree / 100)
474792Smckusic 		goto nospace;
48*4948Smckusic 	if (bpref >= fs->fs_size)
49*4948Smckusic 		bpref = 0;
504359Smckusick 	if (bpref == 0)
514359Smckusick 		cg = itog(ip->i_number, fs);
524359Smckusick 	else
534359Smckusick 		cg = dtog(bpref, fs);
544359Smckusick 	bno = hashalloc(dev, fs, cg, (long)bpref, size, alloccg);
554359Smckusick 	if (bno == 0)
564359Smckusick 		goto nospace;
574426Smckusic 	bp = getblk(dev, bno, size);
584359Smckusick 	clrbuf(bp);
594359Smckusick 	return (bp);
604359Smckusick nospace:
614359Smckusick 	fserr(fs, "file system full");
624359Smckusick 	uprintf("\n%s: write failed, file system is full\n", fs->fs_fsmnt);
634359Smckusick 	u.u_error = ENOSPC;
644359Smckusick 	return (NULL);
654359Smckusick }
664359Smckusick 
674426Smckusic struct buf *
684651Smckusic realloccg(dev, ip, bprev, bpref, osize, nsize)
694426Smckusic 	dev_t dev;
704463Smckusic 	register struct inode *ip;
714651Smckusic 	daddr_t bprev, bpref;
724426Smckusic 	int osize, nsize;
734426Smckusic {
744426Smckusic 	daddr_t bno;
754426Smckusic 	register struct fs *fs;
764463Smckusic 	register struct buf *bp, *obp;
774463Smckusic 	caddr_t cp;
784426Smckusic 	int cg;
794426Smckusic 
804463Smckusic 	if ((unsigned)osize > BSIZE || osize % FSIZE != 0 ||
814463Smckusic 	    (unsigned)nsize > BSIZE || nsize % FSIZE != 0)
824463Smckusic 		panic("realloccg: bad size");
834426Smckusic 	fs = getfs(dev);
844792Smckusic 	if (u.u_uid != 0 &&
854792Smckusic 	    fs->fs_cstotal.cs_nbfree * FRAG + fs->fs_cstotal.cs_nffree <
864792Smckusic 	      fs->fs_dsize * minfree / 100)
874792Smckusic 		goto nospace;
884463Smckusic 	if (bprev == 0)
894463Smckusic 		panic("realloccg: bad bprev");
904426Smckusic 	else
914463Smckusic 		cg = dtog(bprev, fs);
924463Smckusic 	bno = fragextend(dev, fs, cg, (long)bprev, osize, nsize);
934463Smckusic 	if (bno != 0) {
944463Smckusic 		bp = bread(dev, bno, osize);
954463Smckusic 		bp->b_bcount = nsize;
964463Smckusic 		blkclr(bp->b_un.b_addr + osize, nsize - osize);
974463Smckusic 		return (bp);
984463Smckusic 	}
99*4948Smckusic 	if (bpref >= fs->fs_size)
100*4948Smckusic 		bpref = 0;
1014651Smckusic 	bno = hashalloc(dev, fs, cg, (long)bpref, nsize, alloccg);
1024463Smckusic 	if (bno != 0) {
1034463Smckusic 		/*
1044463Smckusic 		 * make a new copy
1054463Smckusic 		 */
1064463Smckusic 		obp = bread(dev, bprev, osize);
1074463Smckusic 		bp = getblk(dev, bno, nsize);
1084463Smckusic 		cp = bp->b_un.b_addr;
1094463Smckusic 		bp->b_un.b_addr = obp->b_un.b_addr;
1104463Smckusic 		obp->b_un.b_addr = cp;
1114463Smckusic 		obp->b_flags |= B_INVAL;
1124463Smckusic 		brelse(obp);
1134463Smckusic 		fre(dev, bprev, osize);
1144463Smckusic 		blkclr(bp->b_un.b_addr + osize, nsize - osize);
1154463Smckusic 		return(bp);
1164463Smckusic 	}
1174792Smckusic nospace:
1184463Smckusic 	/*
1194463Smckusic 	 * no space available
1204463Smckusic 	 */
1214426Smckusic 	fserr(fs, "file system full");
1224426Smckusic 	uprintf("\n%s: write failed, file system is full\n", fs->fs_fsmnt);
1234426Smckusic 	u.u_error = ENOSPC;
1244426Smckusic 	return (NULL);
1254426Smckusic }
1264426Smckusic 
1274359Smckusick struct inode *
1284359Smckusick ialloc(dev, ipref, mode)
1294359Smckusick 	dev_t dev;
1304359Smckusick 	ino_t ipref;
1314359Smckusick 	int mode;
1324359Smckusick {
1334359Smckusick 	daddr_t ino;
1344359Smckusick 	register struct fs *fs;
1354359Smckusick 	register struct inode *ip;
1364359Smckusick 	int cg;
1374359Smckusick 
1384359Smckusick 	fs = getfs(dev);
1394792Smckusic 	if (fs->fs_cstotal.cs_nifree == 0)
1404359Smckusick 		goto noinodes;
141*4948Smckusic 	if (ipref >= fs->fs_ncg * fs->fs_ipg)
142*4948Smckusic 		ipref = 0;
1434359Smckusick 	cg = itog(ipref, fs);
1444359Smckusick 	ino = hashalloc(dev, fs, cg, (long)ipref, mode, ialloccg);
1454359Smckusick 	if (ino == 0)
1464359Smckusick 		goto noinodes;
1474359Smckusick 	ip = iget(dev, ino);
1484359Smckusick 	if (ip == NULL) {
1494359Smckusick 		ifree(dev, ino);
1504359Smckusick 		return (NULL);
1514359Smckusick 	}
1524359Smckusick 	if (ip->i_mode)
1534359Smckusick 		panic("ialloc: dup alloc");
1544359Smckusick 	return (ip);
1554359Smckusick noinodes:
1564359Smckusick 	fserr(fs, "out of inodes");
1574359Smckusick 	uprintf("\n%s: create failed, no inodes free\n", fs->fs_fsmnt);
1584359Smckusick 	u.u_error = ENOSPC;
1594359Smckusick 	return (NULL);
1604359Smckusick }
1614359Smckusick 
1624651Smckusic /*
1634651Smckusic  * find a cylinder to place a directory
1644651Smckusic  */
1654651Smckusic dirpref(dev)
1664359Smckusick 	dev_t dev;
1674359Smckusick {
1684359Smckusick 	register struct fs *fs;
1694651Smckusic 	int cg, minndir, mincg, avgifree;
1704359Smckusick 
1714359Smckusick 	fs = getfs(dev);
1724792Smckusic 	avgifree = fs->fs_cstotal.cs_nifree / fs->fs_ncg;
1734651Smckusic 	minndir = fs->fs_ipg;
1744359Smckusick 	mincg = 0;
1754651Smckusic 	for (cg = 0; cg < fs->fs_ncg; cg++)
1764651Smckusic 		if (fs->fs_cs(cg).cs_ndir < minndir &&
1774651Smckusic 		    fs->fs_cs(cg).cs_nifree >= avgifree) {
1784359Smckusick 			mincg = cg;
1794651Smckusic 			minndir = fs->fs_cs(cg).cs_ndir;
1804359Smckusick 		}
1814359Smckusick 	return (fs->fs_ipg * mincg);
1824359Smckusick }
1834359Smckusick 
1844651Smckusic /*
1854651Smckusic  * select a cylinder to place a large block of data
1864651Smckusic  */
1874651Smckusic blkpref(dev)
1884651Smckusic 	dev_t dev;
1894651Smckusic {
1904651Smckusic 	register struct fs *fs;
1914651Smckusic 	int cg, avgbfree;
1924651Smckusic 
1934651Smckusic 	fs = getfs(dev);
1944792Smckusic 	avgbfree = fs->fs_cstotal.cs_nbfree / fs->fs_ncg;
1954651Smckusic 	for (cg = fs->fs_cgrotor + 1; cg < fs->fs_ncg; cg++)
1964651Smckusic 		if (fs->fs_cs(cg).cs_nbfree >= avgbfree) {
1974651Smckusic 			fs->fs_cgrotor = cg;
1984651Smckusic 			return (fs->fs_fpg * cg + FRAG);
1994651Smckusic 		}
2004651Smckusic 	for (cg = 0; cg <= fs->fs_cgrotor; cg++)
2014651Smckusic 		if (fs->fs_cs(cg).cs_nbfree >= avgbfree) {
2024651Smckusic 			fs->fs_cgrotor = cg;
2034651Smckusic 			return (fs->fs_fpg * cg + FRAG);
2044651Smckusic 		}
2054651Smckusic 	return (0);
2064651Smckusic }
2074651Smckusic 
2084359Smckusick long
2094359Smckusick hashalloc(dev, fs, cg, pref, size, allocator)
2104359Smckusick 	dev_t dev;
2114359Smckusick 	register struct fs *fs;
2124359Smckusick 	int cg;
2134359Smckusick 	long pref;
2144359Smckusick 	int size;	/* size for data blocks, mode for inodes */
2154359Smckusick 	long (*allocator)();
2164359Smckusick {
2174359Smckusick 	long result;
2184359Smckusick 	int i, icg = cg;
2194359Smckusick 
2204359Smckusick 	/*
2214359Smckusick 	 * 1: preferred cylinder group
2224359Smckusick 	 */
2234359Smckusick 	result = (*allocator)(dev, fs, cg, pref, size);
2244359Smckusick 	if (result)
2254359Smckusick 		return (result);
2264359Smckusick 	/*
2274359Smckusick 	 * 2: quadratic rehash
2284359Smckusick 	 */
2294359Smckusick 	for (i = 1; i < fs->fs_ncg; i *= 2) {
2304359Smckusick 		cg += i;
2314359Smckusick 		if (cg >= fs->fs_ncg)
2324359Smckusick 			cg -= fs->fs_ncg;
2334359Smckusick 		result = (*allocator)(dev, fs, cg, 0, size);
2344359Smckusick 		if (result)
2354359Smckusick 			return (result);
2364359Smckusick 	}
2374359Smckusick 	/*
2384359Smckusick 	 * 3: brute force search
2394359Smckusick 	 */
2404359Smckusick 	cg = icg;
2414359Smckusick 	for (i = 0; i < fs->fs_ncg; i++) {
2424359Smckusick 		result = (*allocator)(dev, fs, cg, 0, size);
2434359Smckusick 		if (result)
2444359Smckusick 			return (result);
2454359Smckusick 		cg++;
2464359Smckusick 		if (cg == fs->fs_ncg)
2474359Smckusick 			cg = 0;
2484359Smckusick 	}
2494359Smckusick 	return (0);
2504359Smckusick }
2514359Smckusick 
2524359Smckusick daddr_t
2534463Smckusic fragextend(dev, fs, cg, bprev, osize, nsize)
2544426Smckusic 	dev_t dev;
2554426Smckusic 	register struct fs *fs;
2564426Smckusic 	int cg;
2574463Smckusic 	long bprev;
2584426Smckusic 	int osize, nsize;
2594426Smckusic {
2604463Smckusic 	register struct buf *bp;
2614463Smckusic 	register struct cg *cgp;
2624463Smckusic 	long bno;
2634463Smckusic 	int frags, bbase;
2644426Smckusic 	int i;
2654426Smckusic 
2664463Smckusic 	frags = nsize / FSIZE;
2674463Smckusic 	bbase = bprev % FRAG;
2684463Smckusic 	if (bbase > (bprev + frags - 1) % FRAG) {
2694463Smckusic 		/* cannot extend across a block boundry */
2704463Smckusic 		return (0);
2714463Smckusic 	}
2724426Smckusic 	bp = bread(dev, cgtod(cg, fs), BSIZE);
2734426Smckusic 	if (bp->b_flags & B_ERROR)
2744426Smckusic 		return (0);
2754426Smckusic 	cgp = bp->b_un.b_cg;
2764463Smckusic 	bno = bprev % fs->fs_fpg;
2774463Smckusic 	for (i = osize / FSIZE; i < frags; i++) {
2784463Smckusic 		if (isclr(cgp->cg_free, bno + i))
2794463Smckusic 			break;
2804463Smckusic 	}
2814463Smckusic 	if (i == frags) {
2824463Smckusic 		/*
2834463Smckusic 		 * the current fragment can be extended
2844463Smckusic 		 * deduct the count on fragment being extended into
2854463Smckusic 		 * increase the count on the remaining fragment (if any)
2864463Smckusic 		 * allocate the extended piece
2874463Smckusic 		 */
2884463Smckusic 		for (i = frags; i < FRAG - bbase; i++)
2894463Smckusic 			if (isclr(cgp->cg_free, bno + i))
2904426Smckusic 				break;
2914463Smckusic 		cgp->cg_frsum[i - osize / FSIZE]--;
2924463Smckusic 		if (i != frags)
2934463Smckusic 			cgp->cg_frsum[i - frags]++;
2944463Smckusic 		for (i = osize / FSIZE; i < frags; i++) {
2954463Smckusic 			clrbit(cgp->cg_free, bno + i);
2964792Smckusic 			cgp->cg_cs.cs_nffree--;
2974792Smckusic 			fs->fs_cstotal.cs_nffree--;
2984792Smckusic 			fs->fs_cs(cg).cs_nffree--;
2994426Smckusic 		}
3004463Smckusic 		fs->fs_fmod++;
3014463Smckusic 		bdwrite(bp);
3024463Smckusic 		return (bprev);
3034426Smckusic 	}
3044426Smckusic 	brelse(bp);
3054426Smckusic 	return (0);
3064426Smckusic }
3074426Smckusic 
3084426Smckusic daddr_t
3094359Smckusick alloccg(dev, fs, cg, bpref, size)
3104359Smckusick 	dev_t dev;
3114463Smckusic 	register struct fs *fs;
3124359Smckusick 	int cg;
3134359Smckusick 	daddr_t bpref;
3144359Smckusick 	int size;
3154359Smckusick {
3164463Smckusic 	register struct buf *bp;
3174463Smckusic 	register struct cg *cgp;
3184463Smckusic 	int bno, frags;
3194463Smckusic 	int allocsiz;
3204463Smckusic 	register int i;
3214359Smckusick 
3224792Smckusic 	if (fs->fs_cs(cg).cs_nbfree == 0 && size == BSIZE)
3234792Smckusic 		return (0);
3244426Smckusic 	bp = bread(dev, cgtod(cg, fs), BSIZE);
3254359Smckusick 	if (bp->b_flags & B_ERROR)
3264359Smckusick 		return (0);
3274359Smckusick 	cgp = bp->b_un.b_cg;
3284463Smckusic 	if (size == BSIZE) {
3294463Smckusic 		bno = alloccgblk(dev, fs, cgp, bpref);
3304463Smckusic 		bdwrite(bp);
3314463Smckusic 		return (bno);
3324463Smckusic 	}
3334463Smckusic 	/*
3344463Smckusic 	 * check to see if any fragments are already available
3354463Smckusic 	 * allocsiz is the size which will be allocated, hacking
3364463Smckusic 	 * it down to a smaller size if necessary
3374463Smckusic 	 */
3384463Smckusic 	frags = size / FSIZE;
3394463Smckusic 	for (allocsiz = frags; allocsiz < FRAG; allocsiz++)
3404463Smckusic 		if (cgp->cg_frsum[allocsiz] != 0)
3414463Smckusic 			break;
3424463Smckusic 	if (allocsiz == FRAG) {
3434463Smckusic 		/*
3444463Smckusic 		 * no fragments were available, so a block will be
3454463Smckusic 		 * allocated, and hacked up
3464463Smckusic 		 */
3474792Smckusic 		if (cgp->cg_cs.cs_nbfree == 0) {
3484463Smckusic 			brelse(bp);
3494463Smckusic 			return (0);
3504463Smckusic 		}
3514463Smckusic 		bno = alloccgblk(dev, fs, cgp, bpref);
3524463Smckusic 		bpref = bno % fs->fs_fpg;
3534463Smckusic 		for (i = frags; i < FRAG; i++)
3544463Smckusic 			setbit(cgp->cg_free, bpref + i);
3554463Smckusic 		i = FRAG - frags;
3564792Smckusic 		cgp->cg_cs.cs_nffree += i;
3574792Smckusic 		fs->fs_cstotal.cs_nffree += i;
3584792Smckusic 		fs->fs_cs(cg).cs_nffree += i;
3594463Smckusic 		cgp->cg_frsum[i]++;
3604463Smckusic 		bdwrite(bp);
3614463Smckusic 		return (bno);
3624463Smckusic 	}
3634651Smckusic 	bno = mapsearch(fs, cgp, bpref, allocsiz);
3644651Smckusic 	if (bno == 0)
3654651Smckusic 		return (0);
3664463Smckusic 	for (i = 0; i < frags; i++)
3674463Smckusic 		clrbit(cgp->cg_free, bno + i);
3684792Smckusic 	cgp->cg_cs.cs_nffree -= frags;
3694792Smckusic 	fs->fs_cstotal.cs_nffree -= frags;
3704792Smckusic 	fs->fs_cs(cg).cs_nffree -= frags;
3714463Smckusic 	cgp->cg_frsum[allocsiz]--;
3724463Smckusic 	if (frags != allocsiz)
3734463Smckusic 		cgp->cg_frsum[allocsiz - frags]++;
3744463Smckusic 	bdwrite(bp);
3754463Smckusic 	return (cg * fs->fs_fpg + bno);
3764463Smckusic }
3774463Smckusic 
3784463Smckusic daddr_t
3794463Smckusic alloccgblk(dev, fs, cgp, bpref)
3804463Smckusic 	dev_t dev;
3814463Smckusic 	struct fs *fs;
3824463Smckusic 	register struct cg *cgp;
3834463Smckusic 	daddr_t bpref;
3844463Smckusic {
3854651Smckusic 	daddr_t bno;
3864651Smckusic 	int cylno, pos;
3874651Smckusic 	short *cylbp;
3884651Smckusic 	int i, j;
3894463Smckusic 
3904651Smckusic 	if (bpref == 0) {
3914651Smckusic 		bpref = cgp->cg_rotor;
3924651Smckusic 	} else {
3934463Smckusic 		bpref &= ~(FRAG - 1);
3944359Smckusick 		bpref %= fs->fs_fpg;
3954651Smckusic 		/*
3964651Smckusic 		 * if the requested block is available, use it
3974651Smckusic 		 */
3984359Smckusick 		if (isblock(cgp->cg_free, bpref/FRAG)) {
3994651Smckusic 			bno = bpref;
4004359Smckusick 			goto gotit;
4014359Smckusick 		}
4024651Smckusic 		/*
4034651Smckusic 		 * check for a block available on the same cylinder
4044651Smckusic 		 * beginning with one which is rotationally optimal
4054651Smckusic 		 */
4064651Smckusic 		i = bpref * NSPF;
4074651Smckusic 		cylno = i / fs->fs_spc;
4084651Smckusic 		cylbp = cgp->cg_b[cylno];
4094651Smckusic 		pos = (i + (ROTDELAY == 0) ?
4104651Smckusic 			0 : 1 + ROTDELAY * HZ * fs->fs_nsect / (NSPF * 1000)) %
4114651Smckusic 			fs->fs_nsect * NRPOS / fs->fs_nsect;
4124651Smckusic 		for (i = pos; i < NRPOS; i++)
4134651Smckusic 			if (cylbp[i] > 0)
4144651Smckusic 				break;
4154651Smckusic 		if (i == NRPOS)
4164651Smckusic 			for (i = 0; i < pos; i++)
4174651Smckusic 				if (cylbp[i] > 0)
4184651Smckusic 					break;
4194651Smckusic 		if (cylbp[i] > 0) {
4204651Smckusic 			bpref = cylno * fs->fs_spc / (NSPF * FRAG);
4214651Smckusic 			for (j = fs->fs_postbl[i]; j > -1; j = fs->fs_rotbl[j]) {
4224651Smckusic 				if (isblock(cgp->cg_free, bpref + j)) {
4234651Smckusic 					bno = (bpref + j) * FRAG;
4244651Smckusic 					goto gotit;
4254651Smckusic 				}
4264651Smckusic 			}
4274651Smckusic 			panic("alloccgblk: can't find blk in cyl");
4284651Smckusic 		}
4294359Smckusick 	}
4304651Smckusic 	bno = mapsearch(fs, cgp, bpref, FRAG);
4314651Smckusic 	if (bno == 0)
4324651Smckusic 		return (0);
4334651Smckusic 	cgp->cg_rotor = bno;
4344359Smckusick gotit:
4354651Smckusic 	clrblock(cgp->cg_free, bno/FRAG);
4364792Smckusic 	cgp->cg_cs.cs_nbfree--;
4374792Smckusic 	fs->fs_cstotal.cs_nbfree--;
4384651Smckusic 	fs->fs_cs(cgp->cg_cgx).cs_nbfree--;
4394651Smckusic 	i = bno * NSPF;
4404463Smckusic 	cgp->cg_b[i/fs->fs_spc][i%fs->fs_nsect*NRPOS/fs->fs_nsect]--;
4414359Smckusick 	fs->fs_fmod++;
4424651Smckusic 	return (cgp->cg_cgx * fs->fs_fpg + bno);
4434359Smckusick }
4444359Smckusick 
4454359Smckusick long
4464359Smckusick ialloccg(dev, fs, cg, ipref, mode)
4474359Smckusick 	dev_t dev;
4484463Smckusic 	register struct fs *fs;
4494359Smckusick 	int cg;
4504359Smckusick 	daddr_t ipref;
4514359Smckusick 	int mode;
4524359Smckusick {
4534463Smckusic 	register struct buf *bp;
4544463Smckusic 	register struct cg *cgp;
4554359Smckusick 	int i;
4564359Smckusick 
4574792Smckusic 	if (fs->fs_cs(cg).cs_nifree == 0)
4584792Smckusic 		return (0);
4594426Smckusic 	bp = bread(dev, cgtod(cg, fs), BSIZE);
4604359Smckusick 	if (bp->b_flags & B_ERROR)
4614359Smckusick 		return (0);
4624359Smckusick 	cgp = bp->b_un.b_cg;
4634359Smckusick 	if (ipref) {
4644359Smckusick 		ipref %= fs->fs_ipg;
4654359Smckusick 		if (isclr(cgp->cg_iused, ipref))
4664359Smckusick 			goto gotit;
4674359Smckusick 	} else
4684359Smckusick 		ipref = cgp->cg_irotor;
4694359Smckusick 	for (i = 0; i < fs->fs_ipg; i++) {
4704359Smckusick 		ipref++;
4714359Smckusick 		if (ipref >= fs->fs_ipg)
4724359Smckusick 			ipref = 0;
4734359Smckusick 		if (isclr(cgp->cg_iused, ipref)) {
4744359Smckusick 			cgp->cg_irotor = ipref;
4754359Smckusick 			goto gotit;
4764359Smckusick 		}
4774359Smckusick 	}
4784359Smckusick 	brelse(bp);
4794359Smckusick 	return (0);
4804359Smckusick gotit:
4814359Smckusick 	setbit(cgp->cg_iused, ipref);
4824792Smckusic 	cgp->cg_cs.cs_nifree--;
4834792Smckusic 	fs->fs_cstotal.cs_nifree--;
4844651Smckusic 	fs->fs_cs(cg).cs_nifree--;
4854359Smckusick 	fs->fs_fmod++;
4864359Smckusick 	if ((mode & IFMT) == IFDIR) {
4874792Smckusic 		cgp->cg_cs.cs_ndir++;
4884792Smckusic 		fs->fs_cstotal.cs_ndir++;
4894651Smckusic 		fs->fs_cs(cg).cs_ndir++;
4904359Smckusick 	}
4914359Smckusick 	bdwrite(bp);
4924359Smckusick 	return (cg * fs->fs_ipg + ipref);
4934359Smckusick }
4944359Smckusick 
4954359Smckusick fre(dev, bno, size)
4964359Smckusick 	dev_t dev;
4974359Smckusick 	daddr_t bno;
4984359Smckusick 	int size;
4994359Smckusick {
5004359Smckusick 	register struct fs *fs;
5014359Smckusick 	register struct cg *cgp;
5024359Smckusick 	register struct buf *bp;
5034463Smckusic 	int cg, blk, frags, bbase;
5044463Smckusic 	register int i;
5054359Smckusick 
5064426Smckusic 	if ((unsigned)size > BSIZE || size % FSIZE != 0)
5074426Smckusic 		panic("free: bad size");
5084359Smckusick 	fs = getfs(dev);
5094359Smckusick 	cg = dtog(bno, fs);
5104359Smckusick 	if (badblock(fs, bno))
5114359Smckusick 		return;
5124426Smckusic 	bp = bread(dev, cgtod(cg, fs), BSIZE);
5134359Smckusick 	if (bp->b_flags & B_ERROR)
5144359Smckusick 		return;
5154359Smckusick 	cgp = bp->b_un.b_cg;
5164359Smckusick 	bno %= fs->fs_fpg;
5174426Smckusic 	if (size == BSIZE) {
5184426Smckusic 		if (isblock(cgp->cg_free, bno/FRAG))
5194426Smckusic 			panic("free: freeing free block");
5204426Smckusic 		setblock(cgp->cg_free, bno/FRAG);
5214792Smckusic 		cgp->cg_cs.cs_nbfree++;
5224792Smckusic 		fs->fs_cstotal.cs_nbfree++;
5234651Smckusic 		fs->fs_cs(cg).cs_nbfree++;
5244426Smckusic 		i = bno * NSPF;
5254426Smckusic 		cgp->cg_b[i/fs->fs_spc][i%fs->fs_nsect*NRPOS/fs->fs_nsect]++;
5264426Smckusic 	} else {
5274463Smckusic 		bbase = bno - (bno % FRAG);
5284463Smckusic 		/*
5294463Smckusic 		 * decrement the counts associated with the old frags
5304463Smckusic 		 */
5314463Smckusic 		blk = ((cgp->cg_free[bbase / NBBY] >> (bbase % NBBY)) &
5324463Smckusic 		       (0xff >> (NBBY - FRAG)));
5334463Smckusic 		fragacct(blk, cgp->cg_frsum, -1);
5344463Smckusic 		/*
5354463Smckusic 		 * deallocate the fragment
5364463Smckusic 		 */
5374463Smckusic 		frags = size / FSIZE;
5384463Smckusic 		for (i = 0; i < frags; i++) {
5394426Smckusic 			if (isset(cgp->cg_free, bno + i))
5404426Smckusic 				panic("free: freeing free frag");
5414426Smckusic 			setbit(cgp->cg_free, bno + i);
5424792Smckusic 			cgp->cg_cs.cs_nffree++;
5434792Smckusic 			fs->fs_cstotal.cs_nffree++;
5444792Smckusic 			fs->fs_cs(cg).cs_nffree++;
5454426Smckusic 		}
5464463Smckusic 		/*
5474463Smckusic 		 * add back in counts associated with the new frags
5484463Smckusic 		 */
5494463Smckusic 		blk = ((cgp->cg_free[bbase / NBBY] >> (bbase % NBBY)) &
5504463Smckusic 		       (0xff >> (NBBY - FRAG)));
5514463Smckusic 		fragacct(blk, cgp->cg_frsum, 1);
5524463Smckusic 		/*
5534463Smckusic 		 * if a complete block has been reassembled, account for it
5544463Smckusic 		 */
5554463Smckusic 		if (isblock(cgp->cg_free, bbase / FRAG)) {
5564792Smckusic 			cgp->cg_cs.cs_nffree -= FRAG;
5574792Smckusic 			fs->fs_cstotal.cs_nffree -= FRAG;
5584792Smckusic 			fs->fs_cs(cg).cs_nffree -= FRAG;
5594792Smckusic 			cgp->cg_cs.cs_nbfree++;
5604792Smckusic 			fs->fs_cstotal.cs_nbfree++;
5614651Smckusic 			fs->fs_cs(cg).cs_nbfree++;
5624463Smckusic 			i = bbase * NSPF;
5634426Smckusic 			cgp->cg_b[i / fs->fs_spc]
5644426Smckusic 				 [i % fs->fs_nsect * NRPOS / fs->fs_nsect]++;
5654426Smckusic 		}
5664426Smckusic 	}
5674359Smckusick 	fs->fs_fmod++;
5684359Smckusick 	bdwrite(bp);
5694359Smckusick }
5704359Smckusick 
5714359Smckusick ifree(dev, ino, mode)
5724359Smckusick 	dev_t dev;
5734359Smckusick 	ino_t ino;
5744359Smckusick 	int mode;
5754359Smckusick {
5764359Smckusick 	register struct fs *fs;
5774359Smckusick 	register struct cg *cgp;
5784359Smckusick 	register struct buf *bp;
5794359Smckusick 	int i;
5804359Smckusick 	int cg;
5814359Smckusick 
5824359Smckusick 	fs = getfs(dev);
5834359Smckusick 	if ((unsigned)ino >= fs->fs_ipg*fs->fs_ncg)
5844359Smckusick 		panic("ifree: range");
5854359Smckusick 	cg = itog(ino, fs);
5864426Smckusic 	bp = bread(dev, cgtod(cg, fs), BSIZE);
5874359Smckusick 	if (bp->b_flags & B_ERROR)
5884359Smckusick 		return;
5894359Smckusick 	cgp = bp->b_un.b_cg;
5904359Smckusick 	ino %= fs->fs_ipg;
5914359Smckusick 	if (isclr(cgp->cg_iused, ino))
5924359Smckusick 		panic("ifree: freeing free inode");
5934359Smckusick 	clrbit(cgp->cg_iused, ino);
5944792Smckusic 	cgp->cg_cs.cs_nifree++;
5954792Smckusic 	fs->fs_cstotal.cs_nifree++;
5964651Smckusic 	fs->fs_cs(cg).cs_nifree++;
5974359Smckusick 	if ((mode & IFMT) == IFDIR) {
5984792Smckusic 		cgp->cg_cs.cs_ndir--;
5994792Smckusic 		fs->fs_cstotal.cs_ndir--;
6004651Smckusic 		fs->fs_cs(cg).cs_ndir--;
6014359Smckusick 	}
6024359Smckusick 	fs->fs_fmod++;
6034359Smckusick 	bdwrite(bp);
6044359Smckusick }
6054359Smckusick 
6064463Smckusic /*
6074651Smckusic  * find a block of the specified size in the specified cylinder group
6084651Smckusic  * It is a panic if a request is made to find a block if none are
6094651Smckusic  * available.
6104651Smckusic  */
6114651Smckusic daddr_t
6124651Smckusic mapsearch(fs, cgp, bpref, allocsiz)
6134651Smckusic 	register struct fs *fs;
6144651Smckusic 	register struct cg *cgp;
6154651Smckusic 	daddr_t bpref;
6164651Smckusic 	int allocsiz;
6174651Smckusic {
6184651Smckusic 	daddr_t bno;
6194651Smckusic 	int start, len, loc, i;
6204651Smckusic 	int blk, field, subfield, pos;
6214651Smckusic 
6224651Smckusic 	/*
6234651Smckusic 	 * find the fragment by searching through the free block
6244651Smckusic 	 * map for an appropriate bit pattern
6254651Smckusic 	 */
6264651Smckusic 	if (bpref)
6274651Smckusic 		start = bpref % fs->fs_fpg / NBBY;
6284651Smckusic 	else
6294651Smckusic 		start = cgp->cg_frotor / NBBY;
6304651Smckusic 	len = roundup(fs->fs_fpg - 1, NBBY) / NBBY - start;
6314651Smckusic 	loc = scanc(len, &cgp->cg_free[start], fragtbl, 1 << (allocsiz - 1));
6324651Smckusic 	if (loc == 0) {
6334651Smckusic 		len = start - 1;
6344651Smckusic 		start = (cgdmin(cgp->cg_cgx, fs) -
6354651Smckusic 			 cgbase(cgp->cg_cgx, fs)) / NBBY;
6364651Smckusic 		loc = scanc(len, &cgp->cg_free[start], fragtbl,
6374651Smckusic 			1 << (allocsiz - 1));
6384651Smckusic 		if (loc == 0) {
6394651Smckusic 			panic("alloccg: map corrupted");
6404651Smckusic 			return (0);
6414651Smckusic 		}
6424651Smckusic 	}
6434651Smckusic 	bno = (start + len - loc) * NBBY;
6444651Smckusic 	cgp->cg_frotor = bno;
6454651Smckusic 	/*
6464651Smckusic 	 * found the byte in the map
6474651Smckusic 	 * sift through the bits to find the selected frag
6484651Smckusic 	 */
6494651Smckusic 	for (i = 0; i < NBBY; i += FRAG) {
6504651Smckusic 		blk = (cgp->cg_free[bno / NBBY] >> i) & (0xff >> NBBY - FRAG);
6514651Smckusic 		blk <<= 1;
6524651Smckusic 		field = around[allocsiz];
6534651Smckusic 		subfield = inside[allocsiz];
6544651Smckusic 		for (pos = 0; pos <= FRAG - allocsiz; pos++) {
6554651Smckusic 			if ((blk & field) == subfield) {
6564651Smckusic 				return (bno + i + pos);
6574651Smckusic 			}
6584651Smckusic 			field <<= 1;
6594651Smckusic 			subfield <<= 1;
6604651Smckusic 		}
6614651Smckusic 	}
6624651Smckusic 	panic("alloccg: block not in map");
6634651Smckusic 	return (0);
6644651Smckusic }
6654651Smckusic 
6664651Smckusic /*
6674463Smckusic  * update the frsum fields to reflect addition or deletion
6684463Smckusic  * of some frags
6694463Smckusic  */
6704463Smckusic fragacct(fragmap, fraglist, cnt)
6714472Smckusic 	int fragmap;
6724792Smckusic 	long fraglist[];
6734463Smckusic 	int cnt;
6744463Smckusic {
6754463Smckusic 	int inblk;
6764463Smckusic 	register int field, subfield;
6774463Smckusic 	register int siz, pos;
6784463Smckusic 
6794472Smckusic 	inblk = (int)(fragtbl[fragmap]) << 1;
6804463Smckusic 	fragmap <<= 1;
6814463Smckusic 	for (siz = 1; siz < FRAG; siz++) {
6824463Smckusic 		if (((1 << siz) & inblk) == 0)
6834463Smckusic 			continue;
6844463Smckusic 		field = around[siz];
6854463Smckusic 		subfield = inside[siz];
6864463Smckusic 		for (pos = siz; pos <= FRAG; pos++) {
6874463Smckusic 			if ((fragmap & field) == subfield) {
6884463Smckusic 				fraglist[siz] += cnt;
6894463Smckusic 				pos += siz;
6904463Smckusic 				field <<= siz;
6914463Smckusic 				subfield <<= siz;
6924463Smckusic 			}
6934463Smckusic 			field <<= 1;
6944463Smckusic 			subfield <<= 1;
6954463Smckusic 		}
6964463Smckusic 	}
6974463Smckusic }
6984463Smckusic 
6994359Smckusick badblock(fs, bn)
7004359Smckusick 	register struct fs *fs;
7014359Smckusick 	daddr_t bn;
7024359Smckusick {
7034359Smckusick 
7044359Smckusick 	if ((unsigned)bn >= fs->fs_size || bn < cgdmin(dtog(bn, fs), fs)) {
7054359Smckusick 		fserr(fs, "bad block");
7064359Smckusick 		return (1);
7074359Smckusick 	}
7084359Smckusick 	return (0);
7094359Smckusick }
7104359Smckusick 
7114359Smckusick /*
7124359Smckusick  * getfs maps a device number into
7134359Smckusick  * a pointer to the incore super
7144359Smckusick  * block.  The algorithm is a linear
7154359Smckusick  * search through the mount table.
7164359Smckusick  * A consistency check of the
7174359Smckusick  * in core free-block and i-node
7184359Smckusick  * counts is performed.
7194359Smckusick  *
7204359Smckusick  * panic: no fs -- the device is not mounted.
7214359Smckusick  *	this "cannot happen"
7224359Smckusick  */
7234359Smckusick struct fs *
7244359Smckusick getfs(dev)
7254359Smckusick 	dev_t dev;
7264359Smckusick {
7274359Smckusick 	register struct mount *mp;
7284359Smckusick 	register struct fs *fs;
7294359Smckusick 
7304359Smckusick 	for (mp = &mount[0]; mp < &mount[NMOUNT]; mp++)
7314359Smckusick 		if (mp->m_bufp != NULL && mp->m_dev == dev) {
7324359Smckusick 			fs = mp->m_bufp->b_un.b_fs;
7334359Smckusick 			if (fs->fs_magic != FS_MAGIC)
7344359Smckusick 				panic("getfs: bad magic");
7354359Smckusick 			return (fs);
7364359Smckusick 		}
7374359Smckusick 	panic("getfs: no fs");
7384359Smckusick 	return (NULL);
7394359Smckusick }
7404359Smckusick 
7414359Smckusick /*
7424359Smckusick  * Fserr prints the name of a file system
7434359Smckusick  * with an error diagnostic, in the form
7444359Smckusick  *	fs: error message
7454359Smckusick  */
7464359Smckusick fserr(fs, cp)
7474359Smckusick 	struct fs *fs;
7484359Smckusick 	char *cp;
7494359Smckusick {
7504359Smckusick 
7514359Smckusick 	printf("%s: %s\n", fs->fs_fsmnt, cp);
7524359Smckusick }
7534359Smckusick 
7544359Smckusick /*
7554359Smckusick  * Getfsx returns the index in the file system
7564359Smckusick  * table of the specified device.  The swap device
7574359Smckusick  * is also assigned a pseudo-index.  The index may
7584359Smckusick  * be used as a compressed indication of the location
7594359Smckusick  * of a block, recording
7604359Smckusick  *	<getfsx(dev),blkno>
7614359Smckusick  * rather than
7624359Smckusick  *	<dev, blkno>
7634359Smckusick  * provided the information need remain valid only
7644359Smckusick  * as long as the file system is mounted.
7654359Smckusick  */
7664359Smckusick getfsx(dev)
7674359Smckusick 	dev_t dev;
7684359Smckusick {
7694359Smckusick 	register struct mount *mp;
7704359Smckusick 
7714359Smckusick 	if (dev == swapdev)
7724359Smckusick 		return (MSWAPX);
7734359Smckusick 	for(mp = &mount[0]; mp < &mount[NMOUNT]; mp++)
7744359Smckusick 		if (mp->m_dev == dev)
7754359Smckusick 			return (mp - &mount[0]);
7764359Smckusick 	return (-1);
7774359Smckusick }
7784359Smckusick 
7794359Smckusick /*
7804359Smckusick  * Update is the internal name of 'sync'.  It goes through the disk
7814359Smckusick  * queues to initiate sandbagged IO; goes through the inodes to write
7824359Smckusick  * modified nodes; and it goes through the mount table to initiate modified
7834359Smckusick  * super blocks.
7844359Smckusick  */
7854359Smckusick update()
7864359Smckusick {
7874359Smckusick 	register struct inode *ip;
7884359Smckusick 	register struct mount *mp;
7894359Smckusick 	register struct buf *bp;
7904359Smckusick 	struct fs *fs;
7914359Smckusick 	time_t tim;
7924651Smckusic 	int i, blks;
7934359Smckusick 
7944359Smckusick 	if (updlock)
7954359Smckusick 		return;
7964359Smckusick 	updlock++;
7974359Smckusick 	/*
7984359Smckusick 	 * Write back modified superblocks.
7994359Smckusick 	 * Consistency check that the superblock
8004359Smckusick 	 * of each file system is still in the buffer cache.
8014359Smckusick 	 */
8024359Smckusick 	for (mp = &mount[0]; mp < &mount[NMOUNT]; mp++)
8034359Smckusick 		if (mp->m_bufp != NULL) {
8044359Smckusick 			fs = mp->m_bufp->b_un.b_fs;
8054359Smckusick 			if (fs->fs_fmod == 0)
8064359Smckusick 				continue;
8074359Smckusick 			if (fs->fs_ronly != 0)
8084359Smckusick 				panic("update: rofs mod");
8094426Smckusic 			bp = getblk(mp->m_dev, SBLOCK, BSIZE);
8104359Smckusick 			fs->fs_fmod = 0;
8114359Smckusick 			fs->fs_time = TIME;
8124359Smckusick 			if (bp->b_un.b_fs != fs)
8134359Smckusick 				panic("update: bad b_fs");
8144359Smckusick 			bwrite(bp);
8154651Smckusic 			blks = howmany(cssize(fs), BSIZE);
8164651Smckusic 			for (i = 0; i < blks; i++) {
8174651Smckusic 				bp = getblk(mp->m_dev, csaddr(fs) + (i * FRAG),
8184426Smckusic 					BSIZE);
8194359Smckusick 				bwrite(bp);
8204359Smckusick 			}
8214359Smckusick 		}
8224359Smckusick 	/*
8234359Smckusick 	 * Write back each (modified) inode.
8244359Smckusick 	 */
8254359Smckusick 	for (ip = inode; ip < inodeNINODE; ip++)
8264359Smckusick 		if((ip->i_flag&ILOCK)==0 && ip->i_count) {
8274359Smckusick 			ip->i_flag |= ILOCK;
8284359Smckusick 			ip->i_count++;
8294359Smckusick 			tim = TIME;
8304359Smckusick 			iupdat(ip, &tim, &tim, 0);
8314359Smckusick 			iput(ip);
8324359Smckusick 		}
8334359Smckusick 	updlock = 0;
8344359Smckusick 	/*
8354359Smckusick 	 * Force stale buffer cache information to be flushed,
8364359Smckusick 	 * for all devices.
8374359Smckusick 	 */
8384359Smckusick 	bflush(NODEV);
8394359Smckusick }
840