162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *  linux/fs/sysv/balloc.c
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci *  minix/bitmap.c
662306a36Sopenharmony_ci *  Copyright (C) 1991, 1992  Linus Torvalds
762306a36Sopenharmony_ci *
862306a36Sopenharmony_ci *  ext/freelists.c
962306a36Sopenharmony_ci *  Copyright (C) 1992  Remy Card (card@masi.ibp.fr)
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci *  xenix/alloc.c
1262306a36Sopenharmony_ci *  Copyright (C) 1992  Doug Evans
1362306a36Sopenharmony_ci *
1462306a36Sopenharmony_ci *  coh/alloc.c
1562306a36Sopenharmony_ci *  Copyright (C) 1993  Pascal Haible, Bruno Haible
1662306a36Sopenharmony_ci *
1762306a36Sopenharmony_ci *  sysv/balloc.c
1862306a36Sopenharmony_ci *  Copyright (C) 1993  Bruno Haible
1962306a36Sopenharmony_ci *
2062306a36Sopenharmony_ci *  This file contains code for allocating/freeing blocks.
2162306a36Sopenharmony_ci */
2262306a36Sopenharmony_ci
2362306a36Sopenharmony_ci#include <linux/buffer_head.h>
2462306a36Sopenharmony_ci#include <linux/string.h>
2562306a36Sopenharmony_ci#include "sysv.h"
2662306a36Sopenharmony_ci
2762306a36Sopenharmony_ci/* We don't trust the value of
2862306a36Sopenharmony_ci   sb->sv_sbd2->s_tfree = *sb->sv_free_blocks
2962306a36Sopenharmony_ci   but we nevertheless keep it up to date. */
3062306a36Sopenharmony_ci
3162306a36Sopenharmony_cistatic inline sysv_zone_t *get_chunk(struct super_block *sb, struct buffer_head *bh)
3262306a36Sopenharmony_ci{
3362306a36Sopenharmony_ci	char *bh_data = bh->b_data;
3462306a36Sopenharmony_ci
3562306a36Sopenharmony_ci	if (SYSV_SB(sb)->s_type == FSTYPE_SYSV4)
3662306a36Sopenharmony_ci		return (sysv_zone_t*)(bh_data+4);
3762306a36Sopenharmony_ci	else
3862306a36Sopenharmony_ci		return (sysv_zone_t*)(bh_data+2);
3962306a36Sopenharmony_ci}
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci/* NOTE NOTE NOTE: nr is a block number _as_ _stored_ _on_ _disk_ */
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_civoid sysv_free_block(struct super_block * sb, sysv_zone_t nr)
4462306a36Sopenharmony_ci{
4562306a36Sopenharmony_ci	struct sysv_sb_info * sbi = SYSV_SB(sb);
4662306a36Sopenharmony_ci	struct buffer_head * bh;
4762306a36Sopenharmony_ci	sysv_zone_t *blocks = sbi->s_bcache;
4862306a36Sopenharmony_ci	unsigned count;
4962306a36Sopenharmony_ci	unsigned block = fs32_to_cpu(sbi, nr);
5062306a36Sopenharmony_ci
5162306a36Sopenharmony_ci	/*
5262306a36Sopenharmony_ci	 * This code does not work at all for AFS (it has a bitmap
5362306a36Sopenharmony_ci	 * free list).  As AFS is supposed to be read-only no one
5462306a36Sopenharmony_ci	 * should call this for an AFS filesystem anyway...
5562306a36Sopenharmony_ci	 */
5662306a36Sopenharmony_ci	if (sbi->s_type == FSTYPE_AFS)
5762306a36Sopenharmony_ci		return;
5862306a36Sopenharmony_ci
5962306a36Sopenharmony_ci	if (block < sbi->s_firstdatazone || block >= sbi->s_nzones) {
6062306a36Sopenharmony_ci		printk("sysv_free_block: trying to free block not in datazone\n");
6162306a36Sopenharmony_ci		return;
6262306a36Sopenharmony_ci	}
6362306a36Sopenharmony_ci
6462306a36Sopenharmony_ci	mutex_lock(&sbi->s_lock);
6562306a36Sopenharmony_ci	count = fs16_to_cpu(sbi, *sbi->s_bcache_count);
6662306a36Sopenharmony_ci
6762306a36Sopenharmony_ci	if (count > sbi->s_flc_size) {
6862306a36Sopenharmony_ci		printk("sysv_free_block: flc_count > flc_size\n");
6962306a36Sopenharmony_ci		mutex_unlock(&sbi->s_lock);
7062306a36Sopenharmony_ci		return;
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci	/* If the free list head in super-block is full, it is copied
7362306a36Sopenharmony_ci	 * into this block being freed, ditto if it's completely empty
7462306a36Sopenharmony_ci	 * (applies only on Coherent).
7562306a36Sopenharmony_ci	 */
7662306a36Sopenharmony_ci	if (count == sbi->s_flc_size || count == 0) {
7762306a36Sopenharmony_ci		block += sbi->s_block_base;
7862306a36Sopenharmony_ci		bh = sb_getblk(sb, block);
7962306a36Sopenharmony_ci		if (!bh) {
8062306a36Sopenharmony_ci			printk("sysv_free_block: getblk() failed\n");
8162306a36Sopenharmony_ci			mutex_unlock(&sbi->s_lock);
8262306a36Sopenharmony_ci			return;
8362306a36Sopenharmony_ci		}
8462306a36Sopenharmony_ci		memset(bh->b_data, 0, sb->s_blocksize);
8562306a36Sopenharmony_ci		*(__fs16*)bh->b_data = cpu_to_fs16(sbi, count);
8662306a36Sopenharmony_ci		memcpy(get_chunk(sb,bh), blocks, count * sizeof(sysv_zone_t));
8762306a36Sopenharmony_ci		mark_buffer_dirty(bh);
8862306a36Sopenharmony_ci		set_buffer_uptodate(bh);
8962306a36Sopenharmony_ci		brelse(bh);
9062306a36Sopenharmony_ci		count = 0;
9162306a36Sopenharmony_ci	}
9262306a36Sopenharmony_ci	sbi->s_bcache[count++] = nr;
9362306a36Sopenharmony_ci
9462306a36Sopenharmony_ci	*sbi->s_bcache_count = cpu_to_fs16(sbi, count);
9562306a36Sopenharmony_ci	fs32_add(sbi, sbi->s_free_blocks, 1);
9662306a36Sopenharmony_ci	dirty_sb(sb);
9762306a36Sopenharmony_ci	mutex_unlock(&sbi->s_lock);
9862306a36Sopenharmony_ci}
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_cisysv_zone_t sysv_new_block(struct super_block * sb)
10162306a36Sopenharmony_ci{
10262306a36Sopenharmony_ci	struct sysv_sb_info *sbi = SYSV_SB(sb);
10362306a36Sopenharmony_ci	unsigned int block;
10462306a36Sopenharmony_ci	sysv_zone_t nr;
10562306a36Sopenharmony_ci	struct buffer_head * bh;
10662306a36Sopenharmony_ci	unsigned count;
10762306a36Sopenharmony_ci
10862306a36Sopenharmony_ci	mutex_lock(&sbi->s_lock);
10962306a36Sopenharmony_ci	count = fs16_to_cpu(sbi, *sbi->s_bcache_count);
11062306a36Sopenharmony_ci
11162306a36Sopenharmony_ci	if (count == 0) /* Applies only to Coherent FS */
11262306a36Sopenharmony_ci		goto Enospc;
11362306a36Sopenharmony_ci	nr = sbi->s_bcache[--count];
11462306a36Sopenharmony_ci	if (nr == 0)  /* Applies only to Xenix FS, SystemV FS */
11562306a36Sopenharmony_ci		goto Enospc;
11662306a36Sopenharmony_ci
11762306a36Sopenharmony_ci	block = fs32_to_cpu(sbi, nr);
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	*sbi->s_bcache_count = cpu_to_fs16(sbi, count);
12062306a36Sopenharmony_ci
12162306a36Sopenharmony_ci	if (block < sbi->s_firstdatazone || block >= sbi->s_nzones) {
12262306a36Sopenharmony_ci		printk("sysv_new_block: new block %d is not in data zone\n",
12362306a36Sopenharmony_ci			block);
12462306a36Sopenharmony_ci		goto Enospc;
12562306a36Sopenharmony_ci	}
12662306a36Sopenharmony_ci
12762306a36Sopenharmony_ci	if (count == 0) { /* the last block continues the free list */
12862306a36Sopenharmony_ci		unsigned count;
12962306a36Sopenharmony_ci
13062306a36Sopenharmony_ci		block += sbi->s_block_base;
13162306a36Sopenharmony_ci		if (!(bh = sb_bread(sb, block))) {
13262306a36Sopenharmony_ci			printk("sysv_new_block: cannot read free-list block\n");
13362306a36Sopenharmony_ci			/* retry this same block next time */
13462306a36Sopenharmony_ci			*sbi->s_bcache_count = cpu_to_fs16(sbi, 1);
13562306a36Sopenharmony_ci			goto Enospc;
13662306a36Sopenharmony_ci		}
13762306a36Sopenharmony_ci		count = fs16_to_cpu(sbi, *(__fs16*)bh->b_data);
13862306a36Sopenharmony_ci		if (count > sbi->s_flc_size) {
13962306a36Sopenharmony_ci			printk("sysv_new_block: free-list block with >flc_size entries\n");
14062306a36Sopenharmony_ci			brelse(bh);
14162306a36Sopenharmony_ci			goto Enospc;
14262306a36Sopenharmony_ci		}
14362306a36Sopenharmony_ci		*sbi->s_bcache_count = cpu_to_fs16(sbi, count);
14462306a36Sopenharmony_ci		memcpy(sbi->s_bcache, get_chunk(sb, bh),
14562306a36Sopenharmony_ci				count * sizeof(sysv_zone_t));
14662306a36Sopenharmony_ci		brelse(bh);
14762306a36Sopenharmony_ci	}
14862306a36Sopenharmony_ci	/* Now the free list head in the superblock is valid again. */
14962306a36Sopenharmony_ci	fs32_add(sbi, sbi->s_free_blocks, -1);
15062306a36Sopenharmony_ci	dirty_sb(sb);
15162306a36Sopenharmony_ci	mutex_unlock(&sbi->s_lock);
15262306a36Sopenharmony_ci	return nr;
15362306a36Sopenharmony_ci
15462306a36Sopenharmony_ciEnospc:
15562306a36Sopenharmony_ci	mutex_unlock(&sbi->s_lock);
15662306a36Sopenharmony_ci	return 0;
15762306a36Sopenharmony_ci}
15862306a36Sopenharmony_ci
15962306a36Sopenharmony_ciunsigned long sysv_count_free_blocks(struct super_block * sb)
16062306a36Sopenharmony_ci{
16162306a36Sopenharmony_ci	struct sysv_sb_info * sbi = SYSV_SB(sb);
16262306a36Sopenharmony_ci	int sb_count;
16362306a36Sopenharmony_ci	int count;
16462306a36Sopenharmony_ci	struct buffer_head * bh = NULL;
16562306a36Sopenharmony_ci	sysv_zone_t *blocks;
16662306a36Sopenharmony_ci	unsigned block;
16762306a36Sopenharmony_ci	int n;
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci	/*
17062306a36Sopenharmony_ci	 * This code does not work at all for AFS (it has a bitmap
17162306a36Sopenharmony_ci	 * free list).  As AFS is supposed to be read-only we just
17262306a36Sopenharmony_ci	 * lie and say it has no free block at all.
17362306a36Sopenharmony_ci	 */
17462306a36Sopenharmony_ci	if (sbi->s_type == FSTYPE_AFS)
17562306a36Sopenharmony_ci		return 0;
17662306a36Sopenharmony_ci
17762306a36Sopenharmony_ci	mutex_lock(&sbi->s_lock);
17862306a36Sopenharmony_ci	sb_count = fs32_to_cpu(sbi, *sbi->s_free_blocks);
17962306a36Sopenharmony_ci
18062306a36Sopenharmony_ci	if (0)
18162306a36Sopenharmony_ci		goto trust_sb;
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	/* this causes a lot of disk traffic ... */
18462306a36Sopenharmony_ci	count = 0;
18562306a36Sopenharmony_ci	n = fs16_to_cpu(sbi, *sbi->s_bcache_count);
18662306a36Sopenharmony_ci	blocks = sbi->s_bcache;
18762306a36Sopenharmony_ci	while (1) {
18862306a36Sopenharmony_ci		sysv_zone_t zone;
18962306a36Sopenharmony_ci		if (n > sbi->s_flc_size)
19062306a36Sopenharmony_ci			goto E2big;
19162306a36Sopenharmony_ci		zone = 0;
19262306a36Sopenharmony_ci		while (n && (zone = blocks[--n]) != 0)
19362306a36Sopenharmony_ci			count++;
19462306a36Sopenharmony_ci		if (zone == 0)
19562306a36Sopenharmony_ci			break;
19662306a36Sopenharmony_ci
19762306a36Sopenharmony_ci		block = fs32_to_cpu(sbi, zone);
19862306a36Sopenharmony_ci		if (bh)
19962306a36Sopenharmony_ci			brelse(bh);
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci		if (block < sbi->s_firstdatazone || block >= sbi->s_nzones)
20262306a36Sopenharmony_ci			goto Einval;
20362306a36Sopenharmony_ci		block += sbi->s_block_base;
20462306a36Sopenharmony_ci		bh = sb_bread(sb, block);
20562306a36Sopenharmony_ci		if (!bh)
20662306a36Sopenharmony_ci			goto Eio;
20762306a36Sopenharmony_ci		n = fs16_to_cpu(sbi, *(__fs16*)bh->b_data);
20862306a36Sopenharmony_ci		blocks = get_chunk(sb, bh);
20962306a36Sopenharmony_ci	}
21062306a36Sopenharmony_ci	if (bh)
21162306a36Sopenharmony_ci		brelse(bh);
21262306a36Sopenharmony_ci	if (count != sb_count)
21362306a36Sopenharmony_ci		goto Ecount;
21462306a36Sopenharmony_cidone:
21562306a36Sopenharmony_ci	mutex_unlock(&sbi->s_lock);
21662306a36Sopenharmony_ci	return count;
21762306a36Sopenharmony_ci
21862306a36Sopenharmony_ciEinval:
21962306a36Sopenharmony_ci	printk("sysv_count_free_blocks: new block %d is not in data zone\n",
22062306a36Sopenharmony_ci		block);
22162306a36Sopenharmony_ci	goto trust_sb;
22262306a36Sopenharmony_ciEio:
22362306a36Sopenharmony_ci	printk("sysv_count_free_blocks: cannot read free-list block\n");
22462306a36Sopenharmony_ci	goto trust_sb;
22562306a36Sopenharmony_ciE2big:
22662306a36Sopenharmony_ci	printk("sysv_count_free_blocks: >flc_size entries in free-list block\n");
22762306a36Sopenharmony_ci	if (bh)
22862306a36Sopenharmony_ci		brelse(bh);
22962306a36Sopenharmony_citrust_sb:
23062306a36Sopenharmony_ci	count = sb_count;
23162306a36Sopenharmony_ci	goto done;
23262306a36Sopenharmony_ciEcount:
23362306a36Sopenharmony_ci	printk("sysv_count_free_blocks: free block count was %d, "
23462306a36Sopenharmony_ci		"correcting to %d\n", sb_count, count);
23562306a36Sopenharmony_ci	if (!sb_rdonly(sb)) {
23662306a36Sopenharmony_ci		*sbi->s_free_blocks = cpu_to_fs32(sbi, count);
23762306a36Sopenharmony_ci		dirty_sb(sb);
23862306a36Sopenharmony_ci	}
23962306a36Sopenharmony_ci	goto done;
24062306a36Sopenharmony_ci}
241