[linux-2.6-block.git] / fs / ufs / util.c

/*
 *  linux/fs/ufs/util.c
 *
 * Copyright (C) 1998
 * Daniel Pirkl <daniel.pirkl@email.cz>
 * Charles University, Faculty of Mathematics and Physics
 */
 
#include <linux/string.h>
#include <linux/slab.h>
#include <linux/ufs_fs.h>
#include <linux/buffer_head.h>

#include "swab.h"
#include "util.h"

#undef UFS_UTILS_DEBUG

#ifdef UFS_UTILS_DEBUG
#define UFSD(x) printk("(%s, %d), %s: ", __FILE__, __LINE__, __FUNCTION__); printk x;
#else
#define UFSD(x)
#endif


struct ufs_buffer_head * _ubh_bread_ (struct ufs_sb_private_info * uspi,
	struct super_block *sb, u64 fragment, u64 size)
{
	struct ufs_buffer_head * ubh;
	unsigned i, j ;
	u64  count = 0;
	if (size & ~uspi->s_fmask)
		return NULL;
	count = size >> uspi->s_fshift;
	if (count > UFS_MAXFRAG)
		return NULL;
	ubh = (struct ufs_buffer_head *)
		kmalloc (sizeof (struct ufs_buffer_head), GFP_KERNEL);
	if (!ubh)
		return NULL;
	ubh->fragment = fragment;
	ubh->count = count;
	for (i = 0; i < count; i++)
		if (!(ubh->bh[i] = sb_bread(sb, fragment + i)))
			goto failed;
	for (; i < UFS_MAXFRAG; i++)
		ubh->bh[i] = NULL;
	return ubh;
failed:
	for (j = 0; j < i; j++)
		brelse (ubh->bh[j]);
	kfree(ubh);
	return NULL;
}

struct ufs_buffer_head * ubh_bread_uspi (struct ufs_sb_private_info * uspi,
	struct super_block *sb, u64 fragment, u64 size)
{
	unsigned i, j;
	u64 count = 0;
	if (size & ~uspi->s_fmask)
		return NULL;
	count = size >> uspi->s_fshift;
	if (count <= 0 || count > UFS_MAXFRAG)
		return NULL;
	USPI_UBH->fragment = fragment;
	USPI_UBH->count = count;
	for (i = 0; i < count; i++)
		if (!(USPI_UBH->bh[i] = sb_bread(sb, fragment + i)))
			goto failed;
	for (; i < UFS_MAXFRAG; i++)
		USPI_UBH->bh[i] = NULL;
	return USPI_UBH;
failed:
	for (j = 0; j < i; j++)
		brelse (USPI_UBH->bh[j]);
	return NULL;
}

void ubh_brelse (struct ufs_buffer_head * ubh)
{
	unsigned i;
	if (!ubh)
		return;
	for (i = 0; i < ubh->count; i++)
		brelse (ubh->bh[i]);
	kfree (ubh);
}

void ubh_brelse_uspi (struct ufs_sb_private_info * uspi)
{
	unsigned i;
	if (!USPI_UBH)
		return;
	for ( i = 0; i < USPI_UBH->count; i++ ) {
		brelse (USPI_UBH->bh[i]);
		USPI_UBH->bh[i] = NULL;
	}
}

void ubh_mark_buffer_dirty (struct ufs_buffer_head * ubh)
{
	unsigned i;
	if (!ubh)
		return;
	for ( i = 0; i < ubh->count; i++ )
		mark_buffer_dirty (ubh->bh[i]);
}

void ubh_mark_buffer_uptodate (struct ufs_buffer_head * ubh, int flag)
{
	unsigned i;
	if (!ubh)
		return;
	if (flag) {
		for ( i = 0; i < ubh->count; i++ )
			set_buffer_uptodate (ubh->bh[i]);
	} else {
		for ( i = 0; i < ubh->count; i++ )
			clear_buffer_uptodate (ubh->bh[i]);
	}
}

void ubh_ll_rw_block (int rw, unsigned nr, struct ufs_buffer_head * ubh[])
{
	unsigned i;
	if (!ubh)
		return;
	for ( i = 0; i < nr; i++ )
		ll_rw_block (rw, ubh[i]->count, ubh[i]->bh);
}

void ubh_wait_on_buffer (struct ufs_buffer_head * ubh)
{
	unsigned i;
	if (!ubh)
		return;
	for ( i = 0; i < ubh->count; i++ )
		wait_on_buffer (ubh->bh[i]);
}

unsigned ubh_max_bcount (struct ufs_buffer_head * ubh)
{
	unsigned i;
	unsigned max = 0;
	if (!ubh)
		return 0;
	for ( i = 0; i < ubh->count; i++ ) 
		if ( atomic_read(&ubh->bh[i]->b_count) > max )
			max = atomic_read(&ubh->bh[i]->b_count);
	return max;
}

void ubh_bforget (struct ufs_buffer_head * ubh)
{
	unsigned i;
	if (!ubh) 
		return;
	for ( i = 0; i < ubh->count; i++ ) if ( ubh->bh[i] ) 
		bforget (ubh->bh[i]);
}
 
int ubh_buffer_dirty (struct ufs_buffer_head * ubh)
{
	unsigned i;
	unsigned result = 0;
	if (!ubh)
		return 0;
	for ( i = 0; i < ubh->count; i++ )
		result |= buffer_dirty(ubh->bh[i]);
	return result;
}

void _ubh_ubhcpymem_(struct ufs_sb_private_info * uspi, 
	unsigned char * mem, struct ufs_buffer_head * ubh, unsigned size)
{
	unsigned len, bhno;
	if (size > (ubh->count << uspi->s_fshift))
		size = ubh->count << uspi->s_fshift;
	bhno = 0;
	while (size) {
		len = min_t(unsigned int, size, uspi->s_fsize);
		memcpy (mem, ubh->bh[bhno]->b_data, len);
		mem += uspi->s_fsize;
		size -= len;
		bhno++;
	}
}

void _ubh_memcpyubh_(struct ufs_sb_private_info * uspi, 
	struct ufs_buffer_head * ubh, unsigned char * mem, unsigned size)
{
	unsigned len, bhno;
	if (size > (ubh->count << uspi->s_fshift))
		size = ubh->count << uspi->s_fshift;
	bhno = 0;
	while (size) {
		len = min_t(unsigned int, size, uspi->s_fsize);
		memcpy (ubh->bh[bhno]->b_data, mem, len);
		mem += uspi->s_fsize;
		size -= len;
		bhno++;
	}
}

dev_t
ufs_get_inode_dev(struct super_block *sb, struct ufs_inode_info *ufsi)
{
	__fs32 fs32;
	dev_t dev;

	if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
		fs32 = ufsi->i_u1.i_data[1];
	else
		fs32 = ufsi->i_u1.i_data[0];
	fs32 = fs32_to_cpu(sb, fs32);
	switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
	case UFS_ST_SUNx86:
	case UFS_ST_SUN:
		if ((fs32 & 0xffff0000) == 0 ||
		    (fs32 & 0xffff0000) == 0xffff0000)
			dev = old_decode_dev(fs32 & 0x7fff);
		else
			dev = MKDEV(sysv_major(fs32), sysv_minor(fs32));
		break;

	default:
		dev = old_decode_dev(fs32);
		break;
	}
	return dev;
}

void
ufs_set_inode_dev(struct super_block *sb, struct ufs_inode_info *ufsi, dev_t dev)
{
	__fs32 fs32;

	switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
	case UFS_ST_SUNx86:
	case UFS_ST_SUN:
		fs32 = sysv_encode_dev(dev);
		if ((fs32 & 0xffff8000) == 0) {
			fs32 = old_encode_dev(dev);
		}
		break;

	default:
		fs32 = old_encode_dev(dev);
		break;
	}
	fs32 = cpu_to_fs32(sb, fs32);
	if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
		ufsi->i_u1.i_data[1] = fs32;
	else
		ufsi->i_u1.i_data[0] = fs32;
}
Commit	Line	Data
1da177e4 LT	1	/*
	2	* linux/fs/ufs/util.c
	3	*
	4	* Copyright (C) 1998
	5	* Daniel Pirkl <daniel.pirkl@email.cz>
	6	* Charles University, Faculty of Mathematics and Physics
	7	*/
	8
	9	#include <linux/string.h>
	10	#include <linux/slab.h>
	11	#include <linux/ufs_fs.h>
	12	#include <linux/buffer_head.h>
	13
	14	#include "swab.h"
	15	#include "util.h"
	16
	17	#undef UFS_UTILS_DEBUG
	18
	19	#ifdef UFS_UTILS_DEBUG
	20	#define UFSD(x) printk("(%s, %d), %s: ", __FILE__, __LINE__, __FUNCTION__); printk x;
	21	#else
	22	#define UFSD(x)
	23	#endif
	24
	25
	26	struct ufs_buffer_head * _ubh_bread_ (struct ufs_sb_private_info * uspi,
	27	struct super_block *sb, u64 fragment, u64 size)
	28	{
	29	struct ufs_buffer_head * ubh;
	30	unsigned i, j ;
	31	u64 count = 0;
	32	if (size & ~uspi->s_fmask)
	33	return NULL;
	34	count = size >> uspi->s_fshift;
	35	if (count > UFS_MAXFRAG)
	36	return NULL;
	37	ubh = (struct ufs_buffer_head *)
	38	kmalloc (sizeof (struct ufs_buffer_head), GFP_KERNEL);
	39	if (!ubh)
	40	return NULL;
	41	ubh->fragment = fragment;
	42	ubh->count = count;
	43	for (i = 0; i < count; i++)
	44	if (!(ubh->bh[i] = sb_bread(sb, fragment + i)))
	45	goto failed;
	46	for (; i < UFS_MAXFRAG; i++)
	47	ubh->bh[i] = NULL;
	48	return ubh;
	49	failed:
	50	for (j = 0; j < i; j++)
	51	brelse (ubh->bh[j]);
	52	kfree(ubh);
	53	return NULL;
	54	}
	55
	56	struct ufs_buffer_head * ubh_bread_uspi (struct ufs_sb_private_info * uspi,
	57	struct super_block *sb, u64 fragment, u64 size)
	58	{
	59	unsigned i, j;
	60	u64 count = 0;
	61	if (size & ~uspi->s_fmask)
	62	return NULL;
	63	count = size >> uspi->s_fshift;
	64	if (count <= 0 \|\| count > UFS_MAXFRAG)
65	return NULL;
66	USPI_UBH->fragment = fragment;
67	USPI_UBH->count = count;
68	for (i = 0; i < count; i++)
69	if (!(USPI_UBH->bh[i] = sb_bread(sb, fragment + i)))
70	goto failed;
71	for (; i < UFS_MAXFRAG; i++)
72	USPI_UBH->bh[i] = NULL;
73	return USPI_UBH;
74	failed:
75	for (j = 0; j < i; j++)
76	brelse (USPI_UBH->bh[j]);
77	return NULL;
78	}
79
80	void ubh_brelse (struct ufs_buffer_head * ubh)
81	{
82	unsigned i;
83	if (!ubh)
84	return;
85	for (i = 0; i < ubh->count; i++)
86	brelse (ubh->bh[i]);
87	kfree (ubh);
88	}
89
90	void ubh_brelse_uspi (struct ufs_sb_private_info * uspi)
91	{
92	unsigned i;
93	if (!USPI_UBH)
94	return;
95	for ( i = 0; i < USPI_UBH->count; i++ ) {
96	brelse (USPI_UBH->bh[i]);
97	USPI_UBH->bh[i] = NULL;
98	}
99	}
100
101	void ubh_mark_buffer_dirty (struct ufs_buffer_head * ubh)
102	{
103	unsigned i;
104	if (!ubh)
105	return;
106	for ( i = 0; i < ubh->count; i++ )
107	mark_buffer_dirty (ubh->bh[i]);
108	}
109
110	void ubh_mark_buffer_uptodate (struct ufs_buffer_head * ubh, int flag)
111	{
112	unsigned i;
113	if (!ubh)
114	return;
115	if (flag) {
116	for ( i = 0; i < ubh->count; i++ )
117	set_buffer_uptodate (ubh->bh[i]);
118	} else {
119	for ( i = 0; i < ubh->count; i++ )
120	clear_buffer_uptodate (ubh->bh[i]);
121	}
122	}
123
124	void ubh_ll_rw_block (int rw, unsigned nr, struct ufs_buffer_head * ubh[])
125	{
126	unsigned i;
127	if (!ubh)
128	return;
129	for ( i = 0; i < nr; i++ )
130	ll_rw_block (rw, ubh[i]->count, ubh[i]->bh);
131	}
132
133	void ubh_wait_on_buffer (struct ufs_buffer_head * ubh)
134	{
135	unsigned i;
136	if (!ubh)
137	return;
138	for ( i = 0; i < ubh->count; i++ )
139	wait_on_buffer (ubh->bh[i]);
140	}
141
142	unsigned ubh_max_bcount (struct ufs_buffer_head * ubh)
143	{
144	unsigned i;
145	unsigned max = 0;
146	if (!ubh)
147	return 0;
148	for ( i = 0; i < ubh->count; i++ )
149	if ( atomic_read(&ubh->bh[i]->b_count) > max )
150	max = atomic_read(&ubh->bh[i]->b_count);
151	return max;
152	}
153
154	void ubh_bforget (struct ufs_buffer_head * ubh)
155	{
156	unsigned i;
157	if (!ubh)
158	return;
159	for ( i = 0; i < ubh->count; i++ ) if ( ubh->bh[i] )
160	bforget (ubh->bh[i]);
161	}
162
163	int ubh_buffer_dirty (struct ufs_buffer_head * ubh)
164	{
165	unsigned i;
166	unsigned result = 0;
167	if (!ubh)
168	return 0;
169	for ( i = 0; i < ubh->count; i++ )
170	result \|= buffer_dirty(ubh->bh[i]);
171	return result;
172	}
173
174	void _ubh_ubhcpymem_(struct ufs_sb_private_info * uspi,
175	unsigned char * mem, struct ufs_buffer_head * ubh, unsigned size)
176	{
177	unsigned len, bhno;
178	if (size > (ubh->count << uspi->s_fshift))
179	size = ubh->count << uspi->s_fshift;
180	bhno = 0;
181	while (size) {
182	len = min_t(unsigned int, size, uspi->s_fsize);
183	memcpy (mem, ubh->bh[bhno]->b_data, len);
184	mem += uspi->s_fsize;
185	size -= len;
186	bhno++;
187	}
188	}
189
190	void _ubh_memcpyubh_(struct ufs_sb_private_info * uspi,
191	struct ufs_buffer_head * ubh, unsigned char * mem, unsigned size)
192	{
193	unsigned len, bhno;
194	if (size > (ubh->count << uspi->s_fshift))
195	size = ubh->count << uspi->s_fshift;
196	bhno = 0;
197	while (size) {
198	len = min_t(unsigned int, size, uspi->s_fsize);
199	memcpy (ubh->bh[bhno]->b_data, mem, len);
200	mem += uspi->s_fsize;
201	size -= len;
202	bhno++;
203	}
204	}
205
206	dev_t
207	ufs_get_inode_dev(struct super_block sb, struct ufs_inode_info ufsi)
208	{
209	__fs32 fs32;
210	dev_t dev;
211
212	if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
213	fs32 = ufsi->i_u1.i_data[1];
214	else
215	fs32 = ufsi->i_u1.i_data[0];
216	fs32 = fs32_to_cpu(sb, fs32);
217	switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
218	case UFS_ST_SUNx86:
219	case UFS_ST_SUN:
220	if ((fs32 & 0xffff0000) == 0 \|\|
221	(fs32 & 0xffff0000) == 0xffff0000)
222	dev = old_decode_dev(fs32 & 0x7fff);
223	else
224	dev = MKDEV(sysv_major(fs32), sysv_minor(fs32));
225	break;
226
227	default:
228	dev = old_decode_dev(fs32);
229	break;
230	}
231	return dev;
232	}
233
234	void
235	ufs_set_inode_dev(struct super_block sb, struct ufs_inode_info ufsi, dev_t dev)
236	{
237	__fs32 fs32;
238
239	switch (UFS_SB(sb)->s_flags & UFS_ST_MASK) {
240	case UFS_ST_SUNx86:
241	case UFS_ST_SUN:
242	fs32 = sysv_encode_dev(dev);
243	if ((fs32 & 0xffff8000) == 0) {
244	fs32 = old_encode_dev(dev);
245	}
246	break;
247
248	default:
249	fs32 = old_encode_dev(dev);
250	break;
251	}
252	fs32 = cpu_to_fs32(sb, fs32);
253	if ((UFS_SB(sb)->s_flags & UFS_ST_MASK) == UFS_ST_SUNx86)
254	ufsi->i_u1.i_data[1] = fs32;
255	else
256	ufsi->i_u1.i_data[0] = fs32;
257	}