Home | History | Annotate | Line # | Download | only in udf
udf_allocation.c revision 1.2.4.4
      1  1.2.4.4   simonb /* $NetBSD: udf_allocation.c,v 1.2.4.4 2008/07/22 05:44:02 simonb Exp $ */
      2      1.1  reinoud 
      3      1.1  reinoud /*
      4      1.1  reinoud  * Copyright (c) 2006, 2008 Reinoud Zandijk
      5      1.1  reinoud  * All rights reserved.
      6      1.1  reinoud  *
      7      1.1  reinoud  * Redistribution and use in source and binary forms, with or without
      8      1.1  reinoud  * modification, are permitted provided that the following conditions
      9      1.1  reinoud  * are met:
     10      1.1  reinoud  * 1. Redistributions of source code must retain the above copyright
     11      1.1  reinoud  *    notice, this list of conditions and the following disclaimer.
     12      1.1  reinoud  * 2. Redistributions in binary form must reproduce the above copyright
     13      1.1  reinoud  *    notice, this list of conditions and the following disclaimer in the
     14      1.1  reinoud  *    documentation and/or other materials provided with the distribution.
     15      1.1  reinoud  *
     16      1.1  reinoud  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     17      1.1  reinoud  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
     18      1.1  reinoud  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
     19      1.1  reinoud  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
     20      1.1  reinoud  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
     21      1.1  reinoud  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
     22      1.1  reinoud  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
     23      1.1  reinoud  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
     24      1.1  reinoud  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
     25      1.1  reinoud  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
     26      1.1  reinoud  *
     27      1.1  reinoud  */
     28      1.1  reinoud 
     29      1.1  reinoud #include <sys/cdefs.h>
     30      1.1  reinoud #ifndef lint
     31  1.2.4.4   simonb __KERNEL_RCSID(0, "$NetBSD: udf_allocation.c,v 1.2.4.4 2008/07/22 05:44:02 simonb Exp $");
     32      1.1  reinoud #endif /* not lint */
     33      1.1  reinoud 
     34      1.1  reinoud 
     35      1.1  reinoud #if defined(_KERNEL_OPT)
     36      1.1  reinoud #include "opt_quota.h"
     37      1.1  reinoud #include "opt_compat_netbsd.h"
     38      1.1  reinoud #endif
     39      1.1  reinoud 
     40      1.1  reinoud /* TODO strip */
     41      1.1  reinoud #include <sys/param.h>
     42      1.1  reinoud #include <sys/systm.h>
     43      1.1  reinoud #include <sys/sysctl.h>
     44      1.1  reinoud #include <sys/namei.h>
     45      1.1  reinoud #include <sys/proc.h>
     46      1.1  reinoud #include <sys/kernel.h>
     47      1.1  reinoud #include <sys/vnode.h>
     48      1.1  reinoud #include <miscfs/genfs/genfs_node.h>
     49      1.1  reinoud #include <sys/mount.h>
     50      1.1  reinoud #include <sys/buf.h>
     51      1.1  reinoud #include <sys/file.h>
     52      1.1  reinoud #include <sys/device.h>
     53      1.1  reinoud #include <sys/disklabel.h>
     54      1.1  reinoud #include <sys/ioctl.h>
     55      1.1  reinoud #include <sys/malloc.h>
     56      1.1  reinoud #include <sys/dirent.h>
     57      1.1  reinoud #include <sys/stat.h>
     58      1.1  reinoud #include <sys/conf.h>
     59      1.1  reinoud #include <sys/kauth.h>
     60      1.1  reinoud #include <sys/kthread.h>
     61      1.1  reinoud #include <dev/clock_subr.h>
     62      1.1  reinoud 
     63      1.1  reinoud #include <fs/udf/ecma167-udf.h>
     64      1.1  reinoud #include <fs/udf/udf_mount.h>
     65      1.1  reinoud 
     66      1.1  reinoud #if defined(_KERNEL_OPT)
     67      1.1  reinoud #include "opt_udf.h"
     68      1.1  reinoud #endif
     69      1.1  reinoud 
     70      1.1  reinoud #include "udf.h"
     71      1.1  reinoud #include "udf_subr.h"
     72      1.1  reinoud #include "udf_bswap.h"
     73      1.1  reinoud 
     74      1.1  reinoud 
     75      1.1  reinoud #define VTOI(vnode) ((struct udf_node *) vnode->v_data)
     76      1.1  reinoud 
     77      1.1  reinoud static void udf_record_allocation_in_node(struct udf_mount *ump,
     78      1.1  reinoud 	struct buf *buf, uint16_t vpart_num, uint64_t *mapping,
     79      1.1  reinoud 	struct long_ad *node_ad_cpy);
     80      1.1  reinoud 
     81      1.1  reinoud /*
     82      1.1  reinoud  * IDEA/BUSY: Each udf_node gets its own extentwalker state for all operations;
     83      1.1  reinoud  * this will hopefully/likely reduce O(nlog(n)) to O(1) for most functionality
     84      1.1  reinoud  * since actions are most likely sequencial and thus seeking doesn't need
     85      1.1  reinoud  * searching for the same or adjacent position again.
     86      1.1  reinoud  */
     87      1.1  reinoud 
     88      1.1  reinoud /* --------------------------------------------------------------------- */
     89  1.2.4.3   simonb 
     90  1.2.4.3   simonb #if 0
     91      1.1  reinoud #if 1
     92      1.1  reinoud static void
     93      1.1  reinoud udf_node_dump(struct udf_node *udf_node) {
     94      1.1  reinoud 	struct file_entry    *fe;
     95      1.1  reinoud 	struct extfile_entry *efe;
     96      1.1  reinoud 	struct icb_tag *icbtag;
     97  1.2.4.3   simonb 	struct long_ad s_ad;
     98      1.1  reinoud 	uint64_t inflen;
     99  1.2.4.3   simonb 	uint32_t icbflags, addr_type;
    100      1.1  reinoud 	uint32_t len, lb_num;
    101  1.2.4.3   simonb 	uint32_t flags;
    102      1.1  reinoud 	int part_num;
    103  1.2.4.3   simonb 	int lb_size, eof, slot;
    104      1.1  reinoud 
    105  1.2.4.3   simonb 	if ((udf_verbose & UDF_DEBUG_NODEDUMP) == 0)
    106      1.1  reinoud 		return;
    107      1.1  reinoud 
    108      1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    109      1.1  reinoud 
    110      1.1  reinoud 	fe  = udf_node->fe;
    111      1.1  reinoud 	efe = udf_node->efe;
    112      1.1  reinoud 	if (fe) {
    113      1.1  reinoud 		icbtag = &fe->icbtag;
    114      1.1  reinoud 		inflen = udf_rw64(fe->inf_len);
    115      1.1  reinoud 	} else {
    116      1.1  reinoud 		icbtag = &efe->icbtag;
    117      1.1  reinoud 		inflen = udf_rw64(efe->inf_len);
    118      1.1  reinoud 	}
    119      1.1  reinoud 
    120      1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
    121      1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    122      1.1  reinoud 
    123  1.2.4.3   simonb 	printf("udf_node_dump %p :\n", udf_node);
    124      1.1  reinoud 
    125      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    126  1.2.4.3   simonb 		printf("\tIntern alloc, len = %"PRIu64"\n", inflen);
    127      1.1  reinoud 		return;
    128      1.1  reinoud 	}
    129      1.1  reinoud 
    130  1.2.4.3   simonb 	printf("\tInflen  = %"PRIu64"\n", inflen);
    131  1.2.4.3   simonb 	printf("\t\t");
    132      1.1  reinoud 
    133  1.2.4.3   simonb 	slot = 0;
    134  1.2.4.3   simonb 	for (;;) {
    135  1.2.4.3   simonb 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    136  1.2.4.3   simonb 		if (eof)
    137  1.2.4.3   simonb 			break;
    138  1.2.4.3   simonb 		part_num = udf_rw16(s_ad.loc.part_num);
    139  1.2.4.3   simonb 		lb_num = udf_rw32(s_ad.loc.lb_num);
    140  1.2.4.3   simonb 		len   = udf_rw32(s_ad.len);
    141  1.2.4.3   simonb 		flags = UDF_EXT_FLAGS(len);
    142  1.2.4.3   simonb 		len   = UDF_EXT_LEN(len);
    143      1.1  reinoud 
    144      1.1  reinoud 		printf("[");
    145      1.1  reinoud 		if (part_num >= 0)
    146      1.1  reinoud 			printf("part %d, ", part_num);
    147      1.1  reinoud 		printf("lb_num %d, len %d", lb_num, len);
    148      1.1  reinoud 		if (flags)
    149  1.2.4.3   simonb 			printf(", flags %d", flags>>30);
    150      1.1  reinoud 		printf("] ");
    151  1.2.4.3   simonb 
    152  1.2.4.3   simonb 		if (flags == UDF_EXT_REDIRECT) {
    153  1.2.4.3   simonb 			printf("\n\textent END\n\tallocation extent\n\t\t");
    154  1.2.4.3   simonb 		}
    155  1.2.4.3   simonb 
    156  1.2.4.3   simonb 		slot++;
    157      1.1  reinoud 	}
    158  1.2.4.3   simonb 	printf("\n\tl_ad END\n\n");
    159      1.1  reinoud }
    160      1.1  reinoud #else
    161      1.1  reinoud #define udf_node_dump(a)
    162      1.1  reinoud #endif
    163      1.1  reinoud 
    164  1.2.4.2   simonb 
    165  1.2.4.2   simonb static void
    166  1.2.4.2   simonb udf_assert_allocated(struct udf_mount *ump, uint16_t vpart_num,
    167  1.2.4.2   simonb 	uint32_t lb_num, uint32_t num_lb)
    168  1.2.4.2   simonb {
    169  1.2.4.2   simonb 	struct udf_bitmap *bitmap;
    170  1.2.4.2   simonb 	struct part_desc *pdesc;
    171  1.2.4.2   simonb 	uint32_t ptov;
    172  1.2.4.2   simonb 	uint32_t bitval;
    173  1.2.4.2   simonb 	uint8_t *bpos;
    174  1.2.4.2   simonb 	int bit;
    175  1.2.4.2   simonb 	int phys_part;
    176  1.2.4.2   simonb 	int ok;
    177  1.2.4.2   simonb 
    178  1.2.4.3   simonb 	DPRINTF(PARANOIA, ("udf_assert_allocated: check virt lbnum %d "
    179  1.2.4.2   simonb 			  "part %d + %d sect\n", lb_num, vpart_num, num_lb));
    180  1.2.4.2   simonb 
    181  1.2.4.2   simonb 	/* get partition backing up this vpart_num */
    182  1.2.4.2   simonb 	pdesc = ump->partitions[ump->vtop[vpart_num]];
    183  1.2.4.2   simonb 
    184  1.2.4.2   simonb 	switch (ump->vtop_tp[vpart_num]) {
    185  1.2.4.2   simonb 	case UDF_VTOP_TYPE_PHYS :
    186  1.2.4.2   simonb 	case UDF_VTOP_TYPE_SPARABLE :
    187  1.2.4.2   simonb 		/* free space to freed or unallocated space bitmap */
    188  1.2.4.2   simonb 		ptov      = udf_rw32(pdesc->start_loc);
    189  1.2.4.2   simonb 		phys_part = ump->vtop[vpart_num];
    190  1.2.4.2   simonb 
    191  1.2.4.2   simonb 		/* use unallocated bitmap */
    192  1.2.4.2   simonb 		bitmap = &ump->part_unalloc_bits[phys_part];
    193  1.2.4.2   simonb 
    194  1.2.4.2   simonb 		/* if no bitmaps are defined, bail out */
    195  1.2.4.2   simonb 		if (bitmap->bits == NULL)
    196  1.2.4.2   simonb 			break;
    197  1.2.4.2   simonb 
    198  1.2.4.2   simonb 		/* check bits */
    199  1.2.4.2   simonb 		KASSERT(bitmap->bits);
    200  1.2.4.2   simonb 		ok = 1;
    201  1.2.4.2   simonb 		bpos = bitmap->bits + lb_num/8;
    202  1.2.4.2   simonb 		bit  = lb_num % 8;
    203  1.2.4.2   simonb 		while (num_lb > 0) {
    204  1.2.4.2   simonb 			bitval = (1 << bit);
    205  1.2.4.2   simonb 			DPRINTF(PARANOIA, ("XXX : check %d, %p, bit %d\n",
    206  1.2.4.2   simonb 				lb_num, bpos, bit));
    207  1.2.4.2   simonb 			KASSERT(bitmap->bits + lb_num/8 == bpos);
    208  1.2.4.2   simonb 			if (*bpos & bitval) {
    209  1.2.4.2   simonb 				printf("\tlb_num %d is NOT marked busy\n",
    210  1.2.4.2   simonb 					lb_num);
    211  1.2.4.2   simonb 				ok = 0;
    212  1.2.4.2   simonb 			}
    213  1.2.4.2   simonb 			lb_num++; num_lb--;
    214  1.2.4.2   simonb 			bit = (bit + 1) % 8;
    215  1.2.4.2   simonb 			if (bit == 0)
    216  1.2.4.2   simonb 				bpos++;
    217  1.2.4.2   simonb 		}
    218  1.2.4.2   simonb 		if (!ok) {
    219  1.2.4.2   simonb 			/* KASSERT(0); */
    220  1.2.4.2   simonb 		}
    221  1.2.4.2   simonb 
    222  1.2.4.2   simonb 		break;
    223  1.2.4.2   simonb 	case UDF_VTOP_TYPE_VIRT :
    224  1.2.4.2   simonb 		/* TODO check space */
    225  1.2.4.2   simonb 		KASSERT(num_lb == 1);
    226  1.2.4.2   simonb 		break;
    227  1.2.4.2   simonb 	case UDF_VTOP_TYPE_META :
    228  1.2.4.2   simonb 		/* TODO check space in the metadata bitmap */
    229  1.2.4.2   simonb 	default:
    230  1.2.4.2   simonb 		/* not implemented */
    231  1.2.4.2   simonb 		break;
    232  1.2.4.2   simonb 	}
    233  1.2.4.2   simonb }
    234  1.2.4.2   simonb 
    235  1.2.4.2   simonb 
    236      1.1  reinoud static void
    237      1.1  reinoud udf_node_sanity_check(struct udf_node *udf_node,
    238      1.1  reinoud 		uint64_t *cnt_inflen, uint64_t *cnt_logblksrec) {
    239      1.1  reinoud 	struct file_entry    *fe;
    240      1.1  reinoud 	struct extfile_entry *efe;
    241      1.1  reinoud 	struct icb_tag *icbtag;
    242  1.2.4.3   simonb 	struct long_ad  s_ad;
    243      1.1  reinoud 	uint64_t inflen, logblksrec;
    244  1.2.4.3   simonb 	uint32_t icbflags, addr_type;
    245  1.2.4.3   simonb 	uint32_t len, lb_num, l_ea, l_ad, max_l_ad;
    246  1.2.4.2   simonb 	uint16_t part_num;
    247  1.2.4.3   simonb 	int dscr_size, lb_size, flags, whole_lb;
    248  1.2.4.3   simonb 	int slot, eof;
    249      1.1  reinoud 
    250  1.2.4.2   simonb //	KASSERT(mutex_owned(&udf_node->ump->allocate_mutex));
    251      1.1  reinoud 
    252  1.2.4.3   simonb 	if (1)
    253  1.2.4.3   simonb 		udf_node_dump(udf_node);
    254  1.2.4.3   simonb 
    255      1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    256      1.1  reinoud 
    257      1.1  reinoud 	fe  = udf_node->fe;
    258      1.1  reinoud 	efe = udf_node->efe;
    259      1.1  reinoud 	if (fe) {
    260      1.1  reinoud 		icbtag = &fe->icbtag;
    261      1.1  reinoud 		inflen = udf_rw64(fe->inf_len);
    262      1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
    263  1.2.4.3   simonb 		logblksrec = udf_rw64(fe->logblks_rec);
    264      1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
    265  1.2.4.3   simonb 		l_ea       = udf_rw32(fe->l_ea);
    266      1.1  reinoud 	} else {
    267      1.1  reinoud 		icbtag = &efe->icbtag;
    268      1.1  reinoud 		inflen = udf_rw64(efe->inf_len);
    269      1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
    270  1.2.4.3   simonb 		logblksrec = udf_rw64(efe->logblks_rec);
    271      1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
    272  1.2.4.3   simonb 		l_ea       = udf_rw32(efe->l_ea);
    273      1.1  reinoud 	}
    274  1.2.4.3   simonb 	max_l_ad   = lb_size - dscr_size - l_ea;
    275      1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
    276      1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    277      1.1  reinoud 
    278      1.1  reinoud 	/* reset counters */
    279      1.1  reinoud 	*cnt_inflen     = 0;
    280      1.1  reinoud 	*cnt_logblksrec = 0;
    281      1.1  reinoud 
    282      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    283      1.1  reinoud 		KASSERT(l_ad <= max_l_ad);
    284      1.1  reinoud 		KASSERT(l_ad == inflen);
    285      1.1  reinoud 		*cnt_inflen = inflen;
    286      1.1  reinoud 		return;
    287      1.1  reinoud 	}
    288      1.1  reinoud 
    289      1.1  reinoud 	/* start counting */
    290      1.1  reinoud 	whole_lb = 1;
    291  1.2.4.3   simonb 	slot = 0;
    292  1.2.4.3   simonb 	for (;;) {
    293  1.2.4.3   simonb 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    294  1.2.4.3   simonb 		if (eof)
    295  1.2.4.3   simonb 			break;
    296      1.1  reinoud 		KASSERT(whole_lb == 1);
    297  1.2.4.3   simonb 
    298  1.2.4.3   simonb 		part_num = udf_rw16(s_ad.loc.part_num);
    299  1.2.4.3   simonb 		lb_num = udf_rw32(s_ad.loc.lb_num);
    300  1.2.4.3   simonb 		len   = udf_rw32(s_ad.len);
    301  1.2.4.3   simonb 		flags = UDF_EXT_FLAGS(len);
    302  1.2.4.3   simonb 		len   = UDF_EXT_LEN(len);
    303  1.2.4.3   simonb 
    304  1.2.4.1   simonb 		if (flags != UDF_EXT_REDIRECT) {
    305  1.2.4.1   simonb 			*cnt_inflen += len;
    306  1.2.4.1   simonb 			if (flags == UDF_EXT_ALLOCATED) {
    307  1.2.4.1   simonb 				*cnt_logblksrec += (len + lb_size -1) / lb_size;
    308  1.2.4.1   simonb 			}
    309  1.2.4.1   simonb 		} else {
    310  1.2.4.1   simonb 			KASSERT(len == lb_size);
    311      1.1  reinoud 		}
    312  1.2.4.2   simonb 		/* check allocation */
    313  1.2.4.2   simonb 		if (flags == UDF_EXT_ALLOCATED)
    314  1.2.4.2   simonb 			udf_assert_allocated(udf_node->ump, part_num, lb_num,
    315  1.2.4.2   simonb 				(len + lb_size - 1) / lb_size);
    316  1.2.4.2   simonb 
    317  1.2.4.2   simonb 		/* check whole lb */
    318      1.1  reinoud 		whole_lb = ((len % lb_size) == 0);
    319  1.2.4.3   simonb 
    320  1.2.4.3   simonb 		slot++;
    321      1.1  reinoud 	}
    322      1.1  reinoud 	/* rest should be zero (ad_off > l_ad < max_l_ad - adlen) */
    323      1.1  reinoud 
    324      1.1  reinoud 	KASSERT(*cnt_inflen == inflen);
    325      1.1  reinoud 	KASSERT(*cnt_logblksrec == logblksrec);
    326      1.1  reinoud 
    327  1.2.4.2   simonb //	KASSERT(mutex_owned(&udf_node->ump->allocate_mutex));
    328      1.1  reinoud }
    329      1.1  reinoud #else
    330  1.2.4.3   simonb static void
    331  1.2.4.3   simonb udf_node_sanity_check(struct udf_node *udf_node,
    332  1.2.4.3   simonb 		uint64_t *cnt_inflen, uint64_t *cnt_logblksrec) {
    333  1.2.4.3   simonb 	struct file_entry    *fe;
    334  1.2.4.3   simonb 	struct extfile_entry *efe;
    335  1.2.4.3   simonb 	struct icb_tag *icbtag;
    336  1.2.4.3   simonb 	uint64_t inflen, logblksrec;
    337  1.2.4.3   simonb 	int dscr_size, lb_size;
    338  1.2.4.3   simonb 
    339  1.2.4.3   simonb 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    340  1.2.4.3   simonb 
    341  1.2.4.3   simonb 	fe  = udf_node->fe;
    342  1.2.4.3   simonb 	efe = udf_node->efe;
    343  1.2.4.3   simonb 	if (fe) {
    344  1.2.4.3   simonb 		icbtag = &fe->icbtag;
    345  1.2.4.3   simonb 		inflen = udf_rw64(fe->inf_len);
    346  1.2.4.3   simonb 		dscr_size  = sizeof(struct file_entry) -1;
    347  1.2.4.3   simonb 		logblksrec = udf_rw64(fe->logblks_rec);
    348  1.2.4.3   simonb 	} else {
    349  1.2.4.3   simonb 		icbtag = &efe->icbtag;
    350  1.2.4.3   simonb 		inflen = udf_rw64(efe->inf_len);
    351  1.2.4.3   simonb 		dscr_size  = sizeof(struct extfile_entry) -1;
    352  1.2.4.3   simonb 		logblksrec = udf_rw64(efe->logblks_rec);
    353  1.2.4.3   simonb 	}
    354  1.2.4.3   simonb 	*cnt_logblksrec = logblksrec;
    355  1.2.4.3   simonb 	*cnt_inflen     = inflen;
    356  1.2.4.3   simonb }
    357      1.1  reinoud #endif
    358      1.1  reinoud 
    359      1.1  reinoud /* --------------------------------------------------------------------- */
    360      1.1  reinoud 
    361      1.1  reinoud int
    362      1.1  reinoud udf_translate_vtop(struct udf_mount *ump, struct long_ad *icb_loc,
    363      1.1  reinoud 		   uint32_t *lb_numres, uint32_t *extres)
    364      1.1  reinoud {
    365      1.1  reinoud 	struct part_desc       *pdesc;
    366      1.1  reinoud 	struct spare_map_entry *sme;
    367      1.1  reinoud 	struct long_ad s_icb_loc;
    368      1.1  reinoud 	uint64_t foffset, end_foffset;
    369      1.1  reinoud 	uint32_t lb_size, len;
    370      1.1  reinoud 	uint32_t lb_num, lb_rel, lb_packet;
    371      1.1  reinoud 	uint32_t udf_rw32_lbmap, ext_offset;
    372      1.1  reinoud 	uint16_t vpart;
    373      1.1  reinoud 	int rel, part, error, eof, slot, flags;
    374      1.1  reinoud 
    375      1.1  reinoud 	assert(ump && icb_loc && lb_numres);
    376      1.1  reinoud 
    377      1.1  reinoud 	vpart  = udf_rw16(icb_loc->loc.part_num);
    378      1.1  reinoud 	lb_num = udf_rw32(icb_loc->loc.lb_num);
    379      1.1  reinoud 	if (vpart > UDF_VTOP_RAWPART)
    380      1.1  reinoud 		return EINVAL;
    381      1.1  reinoud 
    382      1.1  reinoud translate_again:
    383      1.1  reinoud 	part = ump->vtop[vpart];
    384      1.1  reinoud 	pdesc = ump->partitions[part];
    385      1.1  reinoud 
    386      1.1  reinoud 	switch (ump->vtop_tp[vpart]) {
    387      1.1  reinoud 	case UDF_VTOP_TYPE_RAW :
    388      1.1  reinoud 		/* 1:1 to the end of the device */
    389      1.1  reinoud 		*lb_numres = lb_num;
    390      1.1  reinoud 		*extres = INT_MAX;
    391      1.1  reinoud 		return 0;
    392      1.1  reinoud 	case UDF_VTOP_TYPE_PHYS :
    393      1.1  reinoud 		/* transform into its disc logical block */
    394      1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    395      1.1  reinoud 			return EINVAL;
    396      1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    397      1.1  reinoud 
    398      1.1  reinoud 		/* extent from here to the end of the partition */
    399      1.1  reinoud 		*extres = udf_rw32(pdesc->part_len) - lb_num;
    400      1.1  reinoud 		return 0;
    401      1.1  reinoud 	case UDF_VTOP_TYPE_VIRT :
    402      1.1  reinoud 		/* only maps one logical block, lookup in VAT */
    403      1.1  reinoud 		if (lb_num >= ump->vat_entries)		/* XXX > or >= ? */
    404      1.1  reinoud 			return EINVAL;
    405      1.1  reinoud 
    406      1.1  reinoud 		/* lookup in virtual allocation table file */
    407      1.1  reinoud 		mutex_enter(&ump->allocate_mutex);
    408      1.1  reinoud 		error = udf_vat_read(ump->vat_node,
    409      1.1  reinoud 				(uint8_t *) &udf_rw32_lbmap, 4,
    410      1.1  reinoud 				ump->vat_offset + lb_num * 4);
    411      1.1  reinoud 		mutex_exit(&ump->allocate_mutex);
    412      1.1  reinoud 
    413      1.1  reinoud 		if (error)
    414      1.1  reinoud 			return error;
    415      1.1  reinoud 
    416      1.1  reinoud 		lb_num = udf_rw32(udf_rw32_lbmap);
    417      1.1  reinoud 
    418      1.1  reinoud 		/* transform into its disc logical block */
    419      1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    420      1.1  reinoud 			return EINVAL;
    421      1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    422      1.1  reinoud 
    423      1.1  reinoud 		/* just one logical block */
    424      1.1  reinoud 		*extres = 1;
    425      1.1  reinoud 		return 0;
    426      1.1  reinoud 	case UDF_VTOP_TYPE_SPARABLE :
    427      1.1  reinoud 		/* check if the packet containing the lb_num is remapped */
    428      1.1  reinoud 		lb_packet = lb_num / ump->sparable_packet_size;
    429      1.1  reinoud 		lb_rel    = lb_num % ump->sparable_packet_size;
    430      1.1  reinoud 
    431      1.1  reinoud 		for (rel = 0; rel < udf_rw16(ump->sparing_table->rt_l); rel++) {
    432      1.1  reinoud 			sme = &ump->sparing_table->entries[rel];
    433      1.1  reinoud 			if (lb_packet == udf_rw32(sme->org)) {
    434      1.1  reinoud 				/* NOTE maps to absolute disc logical block! */
    435      1.1  reinoud 				*lb_numres = udf_rw32(sme->map) + lb_rel;
    436      1.1  reinoud 				*extres    = ump->sparable_packet_size - lb_rel;
    437      1.1  reinoud 				return 0;
    438      1.1  reinoud 			}
    439      1.1  reinoud 		}
    440      1.1  reinoud 
    441      1.1  reinoud 		/* transform into its disc logical block */
    442      1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    443      1.1  reinoud 			return EINVAL;
    444      1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    445      1.1  reinoud 
    446      1.1  reinoud 		/* rest of block */
    447      1.1  reinoud 		*extres = ump->sparable_packet_size - lb_rel;
    448      1.1  reinoud 		return 0;
    449      1.1  reinoud 	case UDF_VTOP_TYPE_META :
    450      1.1  reinoud 		/* we have to look into the file's allocation descriptors */
    451      1.1  reinoud 
    452      1.1  reinoud 		/* use metadatafile allocation mutex */
    453      1.1  reinoud 		lb_size = udf_rw32(ump->logical_vol->lb_size);
    454      1.1  reinoud 
    455      1.1  reinoud 		UDF_LOCK_NODE(ump->metadata_node, 0);
    456      1.1  reinoud 
    457      1.1  reinoud 		/* get first overlapping extent */
    458      1.1  reinoud 		foffset = 0;
    459      1.1  reinoud 		slot    = 0;
    460      1.1  reinoud 		for (;;) {
    461      1.1  reinoud 			udf_get_adslot(ump->metadata_node,
    462      1.1  reinoud 				slot, &s_icb_loc, &eof);
    463  1.2.4.1   simonb 			DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, "
    464  1.2.4.1   simonb 				"len = %d, lb_num = %d, part = %d\n",
    465  1.2.4.1   simonb 				slot, eof,
    466  1.2.4.1   simonb 				UDF_EXT_FLAGS(udf_rw32(s_icb_loc.len)),
    467  1.2.4.1   simonb 				UDF_EXT_LEN(udf_rw32(s_icb_loc.len)),
    468  1.2.4.1   simonb 				udf_rw32(s_icb_loc.loc.lb_num),
    469  1.2.4.1   simonb 				udf_rw16(s_icb_loc.loc.part_num)));
    470      1.1  reinoud 			if (eof) {
    471      1.1  reinoud 				DPRINTF(TRANSLATE,
    472      1.1  reinoud 					("Meta partition translation "
    473      1.1  reinoud 					 "failed: can't seek location\n"));
    474      1.1  reinoud 				UDF_UNLOCK_NODE(ump->metadata_node, 0);
    475      1.1  reinoud 				return EINVAL;
    476      1.1  reinoud 			}
    477      1.1  reinoud 			len   = udf_rw32(s_icb_loc.len);
    478      1.1  reinoud 			flags = UDF_EXT_FLAGS(len);
    479      1.1  reinoud 			len   = UDF_EXT_LEN(len);
    480      1.1  reinoud 
    481  1.2.4.1   simonb 			if (flags == UDF_EXT_REDIRECT) {
    482  1.2.4.1   simonb 				slot++;
    483  1.2.4.1   simonb 				continue;
    484  1.2.4.1   simonb 			}
    485  1.2.4.1   simonb 
    486      1.1  reinoud 			end_foffset = foffset + len;
    487      1.1  reinoud 
    488      1.1  reinoud 			if (end_foffset > lb_num * lb_size)
    489      1.1  reinoud 				break;	/* found */
    490  1.2.4.1   simonb 			foffset = end_foffset;
    491      1.1  reinoud 			slot++;
    492      1.1  reinoud 		}
    493      1.1  reinoud 		/* found overlapping slot */
    494      1.1  reinoud 		ext_offset = lb_num * lb_size - foffset;
    495      1.1  reinoud 
    496      1.1  reinoud 		/* process extent offset */
    497      1.1  reinoud 		lb_num   = udf_rw32(s_icb_loc.loc.lb_num);
    498      1.1  reinoud 		vpart    = udf_rw16(s_icb_loc.loc.part_num);
    499      1.1  reinoud 		lb_num  += (ext_offset + lb_size -1) / lb_size;
    500      1.1  reinoud 		len     -= ext_offset;
    501      1.1  reinoud 		ext_offset = 0;
    502      1.1  reinoud 
    503      1.1  reinoud 		flags = UDF_EXT_FLAGS(s_icb_loc.len);
    504      1.1  reinoud 
    505      1.1  reinoud 		UDF_UNLOCK_NODE(ump->metadata_node, 0);
    506      1.1  reinoud 		if (flags != UDF_EXT_ALLOCATED) {
    507      1.1  reinoud 			DPRINTF(TRANSLATE, ("Metadata partition translation "
    508      1.1  reinoud 					    "failed: not allocated\n"));
    509      1.1  reinoud 			return EINVAL;
    510      1.1  reinoud 		}
    511      1.1  reinoud 
    512      1.1  reinoud 		/*
    513      1.1  reinoud 		 * vpart and lb_num are updated, translate again since we
    514      1.1  reinoud 		 * might be mapped on sparable media
    515      1.1  reinoud 		 */
    516      1.1  reinoud 		goto translate_again;
    517      1.1  reinoud 	default:
    518      1.1  reinoud 		printf("UDF vtop translation scheme %d unimplemented yet\n",
    519      1.1  reinoud 			ump->vtop_tp[vpart]);
    520      1.1  reinoud 	}
    521      1.1  reinoud 
    522      1.1  reinoud 	return EINVAL;
    523      1.1  reinoud }
    524      1.1  reinoud 
    525      1.1  reinoud /* --------------------------------------------------------------------- */
    526      1.1  reinoud 
    527      1.1  reinoud /*
    528      1.1  reinoud  * Translate an extent (in logical_blocks) into logical block numbers; used
    529      1.1  reinoud  * for read and write operations. DOESNT't check extents.
    530      1.1  reinoud  */
    531      1.1  reinoud 
    532      1.1  reinoud int
    533      1.1  reinoud udf_translate_file_extent(struct udf_node *udf_node,
    534      1.1  reinoud 		          uint32_t from, uint32_t num_lb,
    535      1.1  reinoud 			  uint64_t *map)
    536      1.1  reinoud {
    537      1.1  reinoud 	struct udf_mount *ump;
    538      1.1  reinoud 	struct icb_tag *icbtag;
    539      1.1  reinoud 	struct long_ad t_ad, s_ad;
    540      1.1  reinoud 	uint64_t transsec;
    541      1.1  reinoud 	uint64_t foffset, end_foffset;
    542      1.1  reinoud 	uint32_t transsec32;
    543      1.1  reinoud 	uint32_t lb_size;
    544      1.1  reinoud 	uint32_t ext_offset;
    545      1.1  reinoud 	uint32_t lb_num, len;
    546      1.1  reinoud 	uint32_t overlap, translen;
    547      1.1  reinoud 	uint16_t vpart_num;
    548      1.1  reinoud 	int eof, error, flags;
    549      1.1  reinoud 	int slot, addr_type, icbflags;
    550      1.1  reinoud 
    551      1.1  reinoud 	if (!udf_node)
    552      1.1  reinoud 		return ENOENT;
    553      1.1  reinoud 
    554      1.1  reinoud 	KASSERT(num_lb > 0);
    555      1.1  reinoud 
    556      1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);
    557      1.1  reinoud 
    558      1.1  reinoud 	/* initialise derivative vars */
    559      1.1  reinoud 	ump = udf_node->ump;
    560      1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
    561      1.1  reinoud 
    562      1.1  reinoud 	if (udf_node->fe) {
    563      1.1  reinoud 		icbtag = &udf_node->fe->icbtag;
    564      1.1  reinoud 	} else {
    565      1.1  reinoud 		icbtag = &udf_node->efe->icbtag;
    566      1.1  reinoud 	}
    567      1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
    568      1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    569      1.1  reinoud 
    570      1.1  reinoud 	/* do the work */
    571      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    572      1.1  reinoud 		*map = UDF_TRANS_INTERN;
    573      1.1  reinoud 		UDF_UNLOCK_NODE(udf_node, 0);
    574      1.1  reinoud 		return 0;
    575      1.1  reinoud 	}
    576      1.1  reinoud 
    577      1.1  reinoud 	/* find first overlapping extent */
    578      1.1  reinoud 	foffset = 0;
    579      1.1  reinoud 	slot    = 0;
    580      1.1  reinoud 	for (;;) {
    581      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    582  1.2.4.1   simonb 		DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, len = %d, "
    583  1.2.4.1   simonb 			"lb_num = %d, part = %d\n", slot, eof,
    584  1.2.4.1   simonb 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)),
    585  1.2.4.1   simonb 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
    586  1.2.4.1   simonb 			udf_rw32(s_ad.loc.lb_num),
    587  1.2.4.1   simonb 			udf_rw16(s_ad.loc.part_num)));
    588      1.1  reinoud 		if (eof) {
    589      1.1  reinoud 			DPRINTF(TRANSLATE,
    590      1.1  reinoud 				("Translate file extent "
    591      1.1  reinoud 				 "failed: can't seek location\n"));
    592      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
    593      1.1  reinoud 			return EINVAL;
    594      1.1  reinoud 		}
    595      1.1  reinoud 		len    = udf_rw32(s_ad.len);
    596      1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
    597      1.1  reinoud 		len    = UDF_EXT_LEN(len);
    598      1.1  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
    599      1.1  reinoud 
    600      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
    601      1.1  reinoud 			slot++;
    602      1.1  reinoud 			continue;
    603      1.1  reinoud 		}
    604      1.1  reinoud 
    605      1.1  reinoud 		end_foffset = foffset + len;
    606      1.1  reinoud 
    607      1.1  reinoud 		if (end_foffset > from * lb_size)
    608      1.1  reinoud 			break;	/* found */
    609      1.1  reinoud 		foffset = end_foffset;
    610      1.1  reinoud 		slot++;
    611      1.1  reinoud 	}
    612      1.1  reinoud 	/* found overlapping slot */
    613      1.1  reinoud 	ext_offset = from * lb_size - foffset;
    614      1.1  reinoud 
    615      1.1  reinoud 	for (;;) {
    616      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    617  1.2.4.1   simonb 		DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, len = %d, "
    618  1.2.4.1   simonb 			"lb_num = %d, part = %d\n", slot, eof,
    619  1.2.4.1   simonb 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)),
    620  1.2.4.1   simonb 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
    621  1.2.4.1   simonb 			udf_rw32(s_ad.loc.lb_num),
    622  1.2.4.1   simonb 			udf_rw16(s_ad.loc.part_num)));
    623      1.1  reinoud 		if (eof) {
    624      1.1  reinoud 			DPRINTF(TRANSLATE,
    625      1.1  reinoud 				("Translate file extent "
    626      1.1  reinoud 				 "failed: past eof\n"));
    627      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
    628      1.1  reinoud 			return EINVAL;
    629      1.1  reinoud 		}
    630      1.1  reinoud 
    631      1.1  reinoud 		len    = udf_rw32(s_ad.len);
    632      1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
    633      1.1  reinoud 		len    = UDF_EXT_LEN(len);
    634      1.1  reinoud 
    635      1.1  reinoud 		lb_num    = udf_rw32(s_ad.loc.lb_num);
    636      1.1  reinoud 		vpart_num = udf_rw16(s_ad.loc.part_num);
    637      1.1  reinoud 
    638      1.1  reinoud 		end_foffset = foffset + len;
    639      1.1  reinoud 
    640      1.1  reinoud 		/* process extent, don't forget to advance on ext_offset! */
    641      1.1  reinoud 		lb_num  += (ext_offset + lb_size -1) / lb_size;
    642      1.1  reinoud 		overlap  = (len - ext_offset + lb_size -1) / lb_size;
    643      1.1  reinoud 		ext_offset = 0;
    644      1.1  reinoud 
    645      1.1  reinoud 		/*
    646      1.1  reinoud 		 * note that the while(){} is nessisary for the extent that
    647      1.1  reinoud 		 * the udf_translate_vtop() returns doens't have to span the
    648      1.1  reinoud 		 * whole extent.
    649      1.1  reinoud 		 */
    650      1.1  reinoud 
    651      1.1  reinoud 		overlap = MIN(overlap, num_lb);
    652  1.2.4.1   simonb 		while (overlap && (flags != UDF_EXT_REDIRECT)) {
    653      1.1  reinoud 			switch (flags) {
    654      1.1  reinoud 			case UDF_EXT_FREE :
    655      1.1  reinoud 			case UDF_EXT_ALLOCATED_BUT_NOT_USED :
    656      1.1  reinoud 				transsec = UDF_TRANS_ZERO;
    657      1.1  reinoud 				translen = overlap;
    658      1.1  reinoud 				while (overlap && num_lb && translen) {
    659      1.1  reinoud 					*map++ = transsec;
    660      1.1  reinoud 					lb_num++;
    661      1.1  reinoud 					overlap--; num_lb--; translen--;
    662      1.1  reinoud 				}
    663      1.1  reinoud 				break;
    664      1.1  reinoud 			case UDF_EXT_ALLOCATED :
    665      1.1  reinoud 				t_ad.loc.lb_num   = udf_rw32(lb_num);
    666      1.1  reinoud 				t_ad.loc.part_num = udf_rw16(vpart_num);
    667      1.1  reinoud 				error = udf_translate_vtop(ump,
    668      1.1  reinoud 						&t_ad, &transsec32, &translen);
    669      1.1  reinoud 				transsec = transsec32;
    670      1.1  reinoud 				if (error) {
    671      1.1  reinoud 					UDF_UNLOCK_NODE(udf_node, 0);
    672      1.1  reinoud 					return error;
    673      1.1  reinoud 				}
    674      1.1  reinoud 				while (overlap && num_lb && translen) {
    675      1.1  reinoud 					*map++ = transsec;
    676      1.1  reinoud 					lb_num++; transsec++;
    677      1.1  reinoud 					overlap--; num_lb--; translen--;
    678      1.1  reinoud 				}
    679      1.1  reinoud 				break;
    680  1.2.4.1   simonb 			default:
    681  1.2.4.1   simonb 				DPRINTF(TRANSLATE,
    682  1.2.4.1   simonb 					("Translate file extent "
    683  1.2.4.1   simonb 					 "failed: bad flags %x\n", flags));
    684  1.2.4.1   simonb 				UDF_UNLOCK_NODE(udf_node, 0);
    685  1.2.4.1   simonb 				return EINVAL;
    686      1.1  reinoud 			}
    687      1.1  reinoud 		}
    688      1.1  reinoud 		if (num_lb == 0)
    689      1.1  reinoud 			break;
    690      1.1  reinoud 
    691      1.1  reinoud 		if (flags != UDF_EXT_REDIRECT)
    692      1.1  reinoud 			foffset = end_foffset;
    693      1.1  reinoud 		slot++;
    694      1.1  reinoud 	}
    695      1.1  reinoud 	UDF_UNLOCK_NODE(udf_node, 0);
    696      1.1  reinoud 
    697      1.1  reinoud 	return 0;
    698      1.1  reinoud }
    699      1.1  reinoud 
    700      1.1  reinoud /* --------------------------------------------------------------------- */
    701      1.1  reinoud 
    702      1.1  reinoud static int
    703      1.1  reinoud udf_search_free_vatloc(struct udf_mount *ump, uint32_t *lbnumres)
    704      1.1  reinoud {
    705      1.1  reinoud 	uint32_t lb_size, lb_num, lb_map, udf_rw32_lbmap;
    706      1.1  reinoud 	uint8_t *blob;
    707      1.1  reinoud 	int entry, chunk, found, error;
    708      1.1  reinoud 
    709      1.1  reinoud 	KASSERT(ump);
    710      1.1  reinoud 	KASSERT(ump->logical_vol);
    711      1.1  reinoud 
    712      1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
    713      1.1  reinoud 	blob = malloc(lb_size, M_UDFTEMP, M_WAITOK);
    714      1.1  reinoud 
    715      1.1  reinoud 	/* TODO static allocation of search chunk */
    716      1.1  reinoud 
    717      1.1  reinoud 	lb_num = MIN(ump->vat_entries, ump->vat_last_free_lb);
    718      1.1  reinoud 	found  = 0;
    719      1.1  reinoud 	error  = 0;
    720      1.1  reinoud 	entry  = 0;
    721      1.1  reinoud 	do {
    722      1.1  reinoud 		chunk = MIN(lb_size, (ump->vat_entries - lb_num) * 4);
    723      1.1  reinoud 		if (chunk <= 0)
    724      1.1  reinoud 			break;
    725      1.1  reinoud 		/* load in chunk */
    726      1.1  reinoud 		error = udf_vat_read(ump->vat_node, blob, chunk,
    727      1.1  reinoud 				ump->vat_offset + lb_num * 4);
    728      1.1  reinoud 
    729      1.1  reinoud 		if (error)
    730      1.1  reinoud 			break;
    731      1.1  reinoud 
    732      1.1  reinoud 		/* search this chunk */
    733      1.1  reinoud 		for (entry=0; entry < chunk /4; entry++, lb_num++) {
    734      1.1  reinoud 			udf_rw32_lbmap = *((uint32_t *) (blob + entry * 4));
    735      1.1  reinoud 			lb_map = udf_rw32(udf_rw32_lbmap);
    736      1.1  reinoud 			if (lb_map == 0xffffffff) {
    737      1.1  reinoud 				found = 1;
    738      1.1  reinoud 				break;
    739      1.1  reinoud 			}
    740      1.1  reinoud 		}
    741      1.1  reinoud 	} while (!found);
    742      1.1  reinoud 	if (error) {
    743      1.1  reinoud 		printf("udf_search_free_vatloc: error reading in vat chunk "
    744      1.1  reinoud 			"(lb %d, size %d)\n", lb_num, chunk);
    745      1.1  reinoud 	}
    746      1.1  reinoud 
    747      1.1  reinoud 	if (!found) {
    748      1.1  reinoud 		/* extend VAT */
    749      1.1  reinoud 		DPRINTF(WRITE, ("udf_search_free_vatloc: extending\n"));
    750      1.1  reinoud 		lb_num = ump->vat_entries;
    751      1.1  reinoud 		ump->vat_entries++;
    752      1.1  reinoud 	}
    753      1.1  reinoud 
    754      1.1  reinoud 	/* mark entry with initialiser just in case */
    755      1.1  reinoud 	lb_map = udf_rw32(0xfffffffe);
    756      1.1  reinoud 	udf_vat_write(ump->vat_node, (uint8_t *) &lb_map, 4,
    757      1.1  reinoud 		ump->vat_offset + lb_num *4);
    758      1.1  reinoud 	ump->vat_last_free_lb = lb_num;
    759      1.1  reinoud 
    760      1.1  reinoud 	free(blob, M_UDFTEMP);
    761      1.1  reinoud 	*lbnumres = lb_num;
    762      1.1  reinoud 	return 0;
    763      1.1  reinoud }
    764      1.1  reinoud 
    765      1.1  reinoud 
    766      1.1  reinoud static void
    767      1.1  reinoud udf_bitmap_allocate(struct udf_bitmap *bitmap, int ismetadata,
    768      1.1  reinoud 	uint32_t ptov, uint32_t *num_lb, uint64_t *pmappos, uint64_t *lmappos)
    769      1.1  reinoud {
    770      1.1  reinoud 	uint32_t offset, lb_num, bit;
    771      1.1  reinoud 	int32_t  diff;
    772      1.1  reinoud 	uint8_t *bpos;
    773      1.1  reinoud 	int pass;
    774      1.1  reinoud 
    775      1.1  reinoud 	if (!ismetadata) {
    776      1.1  reinoud 		/* heuristic to keep the two pointers not too close */
    777      1.1  reinoud 		diff = bitmap->data_pos - bitmap->metadata_pos;
    778      1.1  reinoud 		if ((diff >= 0) && (diff < 1024))
    779      1.1  reinoud 			bitmap->data_pos = bitmap->metadata_pos + 1024;
    780      1.1  reinoud 	}
    781      1.1  reinoud 	offset = ismetadata ? bitmap->metadata_pos : bitmap->data_pos;
    782      1.1  reinoud 	offset &= ~7;
    783      1.1  reinoud 	for (pass = 0; pass < 2; pass++) {
    784      1.1  reinoud 		if (offset >= bitmap->max_offset)
    785      1.1  reinoud 			offset = 0;
    786      1.1  reinoud 
    787      1.1  reinoud 		while (offset < bitmap->max_offset) {
    788      1.1  reinoud 			if (*num_lb == 0)
    789      1.1  reinoud 				break;
    790      1.1  reinoud 
    791      1.1  reinoud 			/* use first bit not set */
    792      1.1  reinoud 			bpos  = bitmap->bits + offset/8;
    793  1.2.4.2   simonb 			bit = ffs(*bpos);	/* returns 0 or 1..8 */
    794      1.1  reinoud 			if (bit == 0) {
    795      1.1  reinoud 				offset += 8;
    796      1.1  reinoud 				continue;
    797      1.1  reinoud 			}
    798  1.2.4.2   simonb 			DPRINTF(PARANOIA, ("XXX : allocate %d, %p, bit %d\n",
    799  1.2.4.2   simonb 				offset + bit -1, bpos, bit-1));
    800      1.1  reinoud 			*bpos &= ~(1 << (bit-1));
    801      1.1  reinoud 			lb_num = offset + bit-1;
    802      1.1  reinoud 			*lmappos++ = lb_num;
    803      1.1  reinoud 			*pmappos++ = lb_num + ptov;
    804      1.1  reinoud 			*num_lb = *num_lb - 1;
    805      1.1  reinoud 			// offset = (offset & ~7);
    806      1.1  reinoud 		}
    807      1.1  reinoud 	}
    808      1.1  reinoud 
    809      1.1  reinoud 	if (ismetadata) {
    810      1.1  reinoud 		bitmap->metadata_pos = offset;
    811      1.1  reinoud 	} else {
    812      1.1  reinoud 		bitmap->data_pos = offset;
    813      1.1  reinoud 	}
    814      1.1  reinoud }
    815      1.1  reinoud 
    816      1.1  reinoud 
    817      1.1  reinoud static void
    818      1.1  reinoud udf_bitmap_free(struct udf_bitmap *bitmap, uint32_t lb_num, uint32_t num_lb)
    819      1.1  reinoud {
    820      1.1  reinoud 	uint32_t offset;
    821      1.1  reinoud 	uint32_t bit, bitval;
    822      1.1  reinoud 	uint8_t *bpos;
    823      1.1  reinoud 
    824      1.1  reinoud 	offset = lb_num;
    825      1.1  reinoud 
    826      1.1  reinoud 	/* starter bits */
    827      1.1  reinoud 	bpos = bitmap->bits + offset/8;
    828      1.1  reinoud 	bit = offset % 8;
    829      1.1  reinoud 	while ((bit != 0) && (num_lb > 0)) {
    830      1.1  reinoud 		bitval = (1 << bit);
    831      1.1  reinoud 		KASSERT((*bpos & bitval) == 0);
    832  1.2.4.2   simonb 		DPRINTF(PARANOIA, ("XXX : free %d, %p, %d\n",
    833  1.2.4.2   simonb 			offset, bpos, bit));
    834      1.1  reinoud 		*bpos |= bitval;
    835      1.1  reinoud 		offset++; num_lb--;
    836      1.1  reinoud 		bit = (bit + 1) % 8;
    837      1.1  reinoud 	}
    838      1.1  reinoud 	if (num_lb == 0)
    839      1.1  reinoud 		return;
    840      1.1  reinoud 
    841      1.1  reinoud 	/* whole bytes */
    842      1.1  reinoud 	KASSERT(bit == 0);
    843      1.1  reinoud 	bpos = bitmap->bits + offset / 8;
    844      1.1  reinoud 	while (num_lb >= 8) {
    845      1.1  reinoud 		KASSERT((*bpos == 0));
    846  1.2.4.2   simonb 		DPRINTF(PARANOIA, ("XXX : free %d + 8, %p\n", offset, bpos));
    847      1.1  reinoud 		*bpos = 255;
    848      1.1  reinoud 		offset += 8; num_lb -= 8;
    849      1.1  reinoud 		bpos++;
    850      1.1  reinoud 	}
    851      1.1  reinoud 
    852      1.1  reinoud 	/* stop bits */
    853      1.1  reinoud 	KASSERT(num_lb < 8);
    854      1.1  reinoud 	bit = 0;
    855      1.1  reinoud 	while (num_lb > 0) {
    856      1.1  reinoud 		bitval = (1 << bit);
    857      1.1  reinoud 		KASSERT((*bpos & bitval) == 0);
    858  1.2.4.2   simonb 		DPRINTF(PARANOIA, ("XXX : free %d, %p, %d\n",
    859  1.2.4.2   simonb 			offset, bpos, bit));
    860      1.1  reinoud 		*bpos |= bitval;
    861      1.1  reinoud 		offset++; num_lb--;
    862      1.1  reinoud 		bit = (bit + 1) % 8;
    863      1.1  reinoud 	}
    864      1.1  reinoud }
    865      1.1  reinoud 
    866      1.1  reinoud 
    867      1.1  reinoud /* allocate a contiguous sequence of sectornumbers */
    868      1.1  reinoud static int
    869      1.1  reinoud udf_allocate_space(struct udf_mount *ump, int ismetadata, int alloc_type,
    870      1.1  reinoud 	int num_lb, uint16_t *alloc_partp,
    871      1.1  reinoud 	uint64_t *lmapping, uint64_t *pmapping)
    872      1.1  reinoud {
    873      1.1  reinoud 	struct mmc_trackinfo *alloc_track, *other_track;
    874      1.1  reinoud 	struct udf_bitmap *bitmap;
    875      1.1  reinoud 	struct part_desc *pdesc;
    876      1.1  reinoud 	struct logvol_int_desc *lvid;
    877      1.1  reinoud 	uint64_t *lmappos, *pmappos;
    878      1.1  reinoud 	uint32_t ptov, lb_num, *freepos, free_lbs;
    879      1.1  reinoud 	int lb_size, alloc_num_lb;
    880      1.1  reinoud 	int alloc_part;
    881      1.1  reinoud 	int error;
    882      1.1  reinoud 
    883      1.1  reinoud 	mutex_enter(&ump->allocate_mutex);
    884      1.1  reinoud 
    885      1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
    886      1.1  reinoud 	KASSERT(lb_size == ump->discinfo.sector_size);
    887      1.1  reinoud 
    888      1.1  reinoud 	if (ismetadata) {
    889      1.1  reinoud 		alloc_part  = ump->metadata_part;
    890      1.1  reinoud 		alloc_track = &ump->metadata_track;
    891      1.1  reinoud 		other_track = &ump->data_track;
    892      1.1  reinoud 	} else {
    893      1.1  reinoud 		alloc_part  = ump->data_part;
    894      1.1  reinoud 		alloc_track = &ump->data_track;
    895      1.1  reinoud 		other_track = &ump->metadata_track;
    896      1.1  reinoud 	}
    897      1.1  reinoud 
    898      1.1  reinoud 	*alloc_partp = alloc_part;
    899      1.1  reinoud 
    900      1.1  reinoud 	error = 0;
    901      1.1  reinoud 	/* XXX check disc space */
    902      1.1  reinoud 
    903      1.1  reinoud 	pdesc = ump->partitions[ump->vtop[alloc_part]];
    904      1.1  reinoud 	lmappos = lmapping;
    905      1.1  reinoud 	pmappos = pmapping;
    906      1.1  reinoud 
    907      1.1  reinoud 	switch (alloc_type) {
    908      1.1  reinoud 	case UDF_ALLOC_VAT :
    909      1.1  reinoud 		/* search empty slot in VAT file */
    910      1.1  reinoud 		KASSERT(num_lb == 1);
    911      1.1  reinoud 		error = udf_search_free_vatloc(ump, &lb_num);
    912      1.1  reinoud 		if (!error) {
    913      1.1  reinoud 			*lmappos = lb_num;
    914      1.1  reinoud 			*pmappos = 0;		/* will get late-allocated */
    915      1.1  reinoud 		}
    916      1.1  reinoud 		break;
    917      1.1  reinoud 	case UDF_ALLOC_SEQUENTIAL :
    918      1.1  reinoud 		/* sequential allocation on recordable media */
    919      1.1  reinoud 		/* calculate offset from physical base partition */
    920      1.1  reinoud 		ptov  = udf_rw32(pdesc->start_loc);
    921      1.1  reinoud 
    922      1.1  reinoud 		for (lb_num = 0; lb_num < num_lb; lb_num++) {
    923      1.1  reinoud 			*pmappos++ = alloc_track->next_writable;
    924      1.1  reinoud 			*lmappos++ = alloc_track->next_writable - ptov;
    925      1.1  reinoud 			alloc_track->next_writable++;
    926      1.1  reinoud 			alloc_track->free_blocks--;
    927      1.1  reinoud 		}
    928      1.1  reinoud 		if (alloc_track->tracknr == other_track->tracknr)
    929      1.1  reinoud 			memcpy(other_track, alloc_track,
    930      1.1  reinoud 				sizeof(struct mmc_trackinfo));
    931      1.1  reinoud 		break;
    932      1.1  reinoud 	case UDF_ALLOC_SPACEMAP :
    933      1.1  reinoud 		ptov  = udf_rw32(pdesc->start_loc);
    934      1.1  reinoud 
    935      1.1  reinoud 		/* allocate on unallocated bits page */
    936      1.1  reinoud 		alloc_num_lb = num_lb;
    937      1.1  reinoud 		bitmap = &ump->part_unalloc_bits[alloc_part];
    938      1.1  reinoud 		udf_bitmap_allocate(bitmap, ismetadata, ptov, &alloc_num_lb,
    939      1.1  reinoud 			pmappos, lmappos);
    940      1.1  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
    941      1.1  reinoud 		if (alloc_num_lb) {
    942      1.1  reinoud 			/* TODO convert freed to unalloc and try again */
    943      1.1  reinoud 			/* free allocated piece for now */
    944      1.1  reinoud 			lmappos = lmapping;
    945      1.1  reinoud 			for (lb_num=0; lb_num < num_lb-alloc_num_lb; lb_num++) {
    946      1.1  reinoud 				udf_bitmap_free(bitmap, *lmappos++, 1);
    947      1.1  reinoud 			}
    948      1.1  reinoud 			error = ENOSPC;
    949      1.1  reinoud 		}
    950      1.1  reinoud 		if (!error) {
    951      1.1  reinoud 			/* adjust freecount */
    952      1.1  reinoud 			lvid = ump->logvol_integrity;
    953      1.1  reinoud 			freepos = &lvid->tables[0] + alloc_part;
    954      1.1  reinoud 			free_lbs = udf_rw32(*freepos);
    955      1.1  reinoud 			*freepos = udf_rw32(free_lbs - num_lb);
    956      1.1  reinoud 		}
    957      1.1  reinoud 		break;
    958      1.1  reinoud 	case UDF_ALLOC_METABITMAP :
    959      1.1  reinoud 	case UDF_ALLOC_METASEQUENTIAL :
    960      1.1  reinoud 	case UDF_ALLOC_RELAXEDSEQUENTIAL :
    961      1.1  reinoud 		printf("ALERT: udf_allocate_space : allocation %d "
    962      1.1  reinoud 				"not implemented yet!\n", alloc_type);
    963      1.1  reinoud 		/* TODO implement, doesn't have to be contiguous */
    964      1.1  reinoud 		error = ENOSPC;
    965      1.1  reinoud 		break;
    966      1.1  reinoud 	}
    967      1.1  reinoud 
    968      1.1  reinoud #ifdef DEBUG
    969      1.1  reinoud 	if (udf_verbose & UDF_DEBUG_ALLOC) {
    970      1.1  reinoud 		lmappos = lmapping;
    971      1.1  reinoud 		pmappos = pmapping;
    972      1.1  reinoud 		printf("udf_allocate_space, mapping l->p:\n");
    973      1.1  reinoud 		for (lb_num = 0; lb_num < num_lb; lb_num++) {
    974      1.1  reinoud 			printf("\t%"PRIu64" -> %"PRIu64"\n",
    975      1.1  reinoud 				*lmappos++, *pmappos++);
    976      1.1  reinoud 		}
    977      1.1  reinoud 	}
    978      1.1  reinoud #endif
    979      1.1  reinoud 	mutex_exit(&ump->allocate_mutex);
    980      1.1  reinoud 
    981      1.1  reinoud 	return error;
    982      1.1  reinoud }
    983      1.1  reinoud 
    984      1.1  reinoud /* --------------------------------------------------------------------- */
    985      1.1  reinoud 
    986      1.1  reinoud void
    987      1.1  reinoud udf_free_allocated_space(struct udf_mount *ump, uint32_t lb_num,
    988      1.1  reinoud 	uint16_t vpart_num, uint32_t num_lb)
    989      1.1  reinoud {
    990      1.1  reinoud 	struct udf_bitmap *bitmap;
    991      1.1  reinoud 	struct part_desc *pdesc;
    992      1.1  reinoud 	struct logvol_int_desc *lvid;
    993      1.1  reinoud 	uint32_t ptov, lb_map, udf_rw32_lbmap;
    994      1.1  reinoud 	uint32_t *freepos, free_lbs;
    995      1.1  reinoud 	int phys_part;
    996      1.1  reinoud 	int error;
    997      1.1  reinoud 
    998      1.1  reinoud 	DPRINTF(ALLOC, ("udf_free_allocated_space: freeing virt lbnum %d "
    999      1.1  reinoud 			  "part %d + %d sect\n", lb_num, vpart_num, num_lb));
   1000      1.1  reinoud 
   1001  1.2.4.3   simonb 	/* no use freeing zero length */
   1002  1.2.4.3   simonb 	if (num_lb == 0)
   1003  1.2.4.3   simonb 		return;
   1004  1.2.4.3   simonb 
   1005      1.1  reinoud 	mutex_enter(&ump->allocate_mutex);
   1006      1.1  reinoud 
   1007      1.1  reinoud 	/* get partition backing up this vpart_num */
   1008      1.1  reinoud 	pdesc = ump->partitions[ump->vtop[vpart_num]];
   1009      1.1  reinoud 
   1010      1.1  reinoud 	switch (ump->vtop_tp[vpart_num]) {
   1011      1.1  reinoud 	case UDF_VTOP_TYPE_PHYS :
   1012      1.1  reinoud 	case UDF_VTOP_TYPE_SPARABLE :
   1013      1.1  reinoud 		/* free space to freed or unallocated space bitmap */
   1014      1.1  reinoud 		ptov      = udf_rw32(pdesc->start_loc);
   1015      1.1  reinoud 		phys_part = ump->vtop[vpart_num];
   1016      1.1  reinoud 
   1017      1.1  reinoud 		/* first try freed space bitmap */
   1018      1.1  reinoud 		bitmap    = &ump->part_freed_bits[phys_part];
   1019      1.1  reinoud 
   1020      1.1  reinoud 		/* if not defined, use unallocated bitmap */
   1021      1.1  reinoud 		if (bitmap->bits == NULL)
   1022      1.1  reinoud 			bitmap = &ump->part_unalloc_bits[phys_part];
   1023      1.1  reinoud 
   1024      1.1  reinoud 		/* if no bitmaps are defined, bail out */
   1025      1.1  reinoud 		if (bitmap->bits == NULL)
   1026      1.1  reinoud 			break;
   1027      1.1  reinoud 
   1028      1.1  reinoud 		/* free bits if its defined */
   1029      1.1  reinoud 		KASSERT(bitmap->bits);
   1030      1.1  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1031      1.1  reinoud 		udf_bitmap_free(bitmap, lb_num, num_lb);
   1032      1.1  reinoud 
   1033      1.1  reinoud 		/* adjust freecount */
   1034      1.1  reinoud 		lvid = ump->logvol_integrity;
   1035      1.1  reinoud 		freepos = &lvid->tables[0] + vpart_num;
   1036      1.1  reinoud 		free_lbs = udf_rw32(*freepos);
   1037      1.1  reinoud 		*freepos = udf_rw32(free_lbs + num_lb);
   1038      1.1  reinoud 		break;
   1039      1.1  reinoud 	case UDF_VTOP_TYPE_VIRT :
   1040      1.1  reinoud 		/* free this VAT entry */
   1041      1.1  reinoud 		KASSERT(num_lb == 1);
   1042      1.1  reinoud 
   1043      1.1  reinoud 		lb_map = 0xffffffff;
   1044      1.1  reinoud 		udf_rw32_lbmap = udf_rw32(lb_map);
   1045      1.1  reinoud 		error = udf_vat_write(ump->vat_node,
   1046      1.1  reinoud 			(uint8_t *) &udf_rw32_lbmap, 4,
   1047      1.1  reinoud 			ump->vat_offset + lb_num * 4);
   1048      1.1  reinoud 		KASSERT(error == 0);
   1049      1.1  reinoud 		ump->vat_last_free_lb = MIN(ump->vat_last_free_lb, lb_num);
   1050      1.1  reinoud 		break;
   1051      1.1  reinoud 	case UDF_VTOP_TYPE_META :
   1052      1.1  reinoud 		/* free space in the metadata bitmap */
   1053      1.1  reinoud 	default:
   1054      1.1  reinoud 		printf("ALERT: udf_free_allocated_space : allocation %d "
   1055      1.1  reinoud 			"not implemented yet!\n", ump->vtop_tp[vpart_num]);
   1056      1.1  reinoud 		break;
   1057      1.1  reinoud 	}
   1058      1.1  reinoud 
   1059      1.1  reinoud 	mutex_exit(&ump->allocate_mutex);
   1060      1.1  reinoud }
   1061      1.1  reinoud 
   1062      1.1  reinoud /* --------------------------------------------------------------------- */
   1063      1.1  reinoud 
   1064      1.1  reinoud int
   1065      1.1  reinoud udf_pre_allocate_space(struct udf_mount *ump, int udf_c_type, int num_lb,
   1066      1.1  reinoud 	uint16_t *alloc_partp, uint64_t *lmapping, uint64_t *pmapping)
   1067      1.1  reinoud {
   1068      1.1  reinoud 	int ismetadata, alloc_type;
   1069      1.1  reinoud 
   1070      1.1  reinoud 	ismetadata = (udf_c_type == UDF_C_NODE);
   1071      1.1  reinoud 	alloc_type = ismetadata? ump->meta_alloc : ump->data_alloc;
   1072      1.1  reinoud 
   1073      1.1  reinoud #ifdef DIAGNOSTIC
   1074      1.1  reinoud 	if ((alloc_type == UDF_ALLOC_VAT) && (udf_c_type != UDF_C_NODE)) {
   1075      1.1  reinoud 		panic("udf_pre_allocate_space: bad c_type on VAT!\n");
   1076      1.1  reinoud 	}
   1077      1.1  reinoud #endif
   1078      1.1  reinoud 
   1079      1.1  reinoud 	/* reserve size for VAT allocated data */
   1080      1.1  reinoud 	if (alloc_type == UDF_ALLOC_VAT) {
   1081      1.1  reinoud 		mutex_enter(&ump->allocate_mutex);
   1082      1.1  reinoud 			ump->uncomitted_lb += num_lb;
   1083      1.1  reinoud 		mutex_exit(&ump->allocate_mutex);
   1084      1.1  reinoud 	}
   1085      1.1  reinoud 
   1086      1.1  reinoud 	return udf_allocate_space(ump, ismetadata, alloc_type,
   1087      1.1  reinoud 		num_lb, alloc_partp, lmapping, pmapping);
   1088      1.1  reinoud }
   1089      1.1  reinoud 
   1090      1.1  reinoud /* --------------------------------------------------------------------- */
   1091      1.1  reinoud 
   1092      1.1  reinoud /*
   1093      1.1  reinoud  * Allocate a buf on disc for direct write out. The space doesn't have to be
   1094      1.1  reinoud  * contiguous as the caller takes care of this.
   1095      1.1  reinoud  */
   1096      1.1  reinoud 
   1097      1.1  reinoud void
   1098      1.1  reinoud udf_late_allocate_buf(struct udf_mount *ump, struct buf *buf,
   1099      1.1  reinoud 	uint64_t *lmapping, uint64_t *pmapping, struct long_ad *node_ad_cpy)
   1100      1.1  reinoud {
   1101      1.1  reinoud 	struct udf_node  *udf_node = VTOI(buf->b_vp);
   1102      1.1  reinoud 	uint16_t vpart_num;
   1103      1.1  reinoud 	int lb_size, blks, udf_c_type;
   1104      1.1  reinoud 	int ismetadata, alloc_type;
   1105      1.1  reinoud 	int num_lb;
   1106      1.1  reinoud 	int error, s;
   1107      1.1  reinoud 
   1108      1.1  reinoud 	/*
   1109      1.1  reinoud 	 * for each sector in the buf, allocate a sector on disc and record
   1110      1.1  reinoud 	 * its position in the provided mapping array.
   1111      1.1  reinoud 	 *
   1112      1.1  reinoud 	 * If its userdata or FIDs, record its location in its node.
   1113      1.1  reinoud 	 */
   1114      1.1  reinoud 
   1115      1.1  reinoud 	lb_size    = udf_rw32(ump->logical_vol->lb_size);
   1116      1.1  reinoud 	num_lb     = (buf->b_bcount + lb_size -1) / lb_size;
   1117      1.1  reinoud 	blks       = lb_size / DEV_BSIZE;
   1118      1.1  reinoud 	udf_c_type = buf->b_udf_c_type;
   1119      1.1  reinoud 
   1120      1.1  reinoud 	KASSERT(lb_size == ump->discinfo.sector_size);
   1121      1.1  reinoud 
   1122      1.1  reinoud 	ismetadata = (udf_c_type == UDF_C_NODE);
   1123      1.1  reinoud 	alloc_type = ismetadata? ump->meta_alloc : ump->data_alloc;
   1124      1.1  reinoud 
   1125      1.1  reinoud #ifdef DIAGNOSTIC
   1126      1.1  reinoud 	if ((alloc_type == UDF_ALLOC_VAT) && (udf_c_type != UDF_C_NODE)) {
   1127      1.1  reinoud 		panic("udf_late_allocate_buf: bad c_type on VAT!\n");
   1128      1.1  reinoud 	}
   1129      1.1  reinoud #endif
   1130      1.1  reinoud 
   1131      1.1  reinoud 	if (udf_c_type == UDF_C_NODE) {
   1132      1.1  reinoud 		/* if not VAT, its allready allocated */
   1133      1.1  reinoud 		if (alloc_type != UDF_ALLOC_VAT)
   1134      1.1  reinoud 			return;
   1135      1.1  reinoud 
   1136      1.1  reinoud 		/* allocate sequential */
   1137      1.1  reinoud 		alloc_type = UDF_ALLOC_SEQUENTIAL;
   1138      1.1  reinoud 	}
   1139      1.1  reinoud 
   1140      1.1  reinoud 	error = udf_allocate_space(ump, ismetadata, alloc_type,
   1141      1.1  reinoud 			num_lb, &vpart_num, lmapping, pmapping);
   1142      1.1  reinoud 	if (error) {
   1143      1.1  reinoud 		/* ARGH! we've not done our accounting right! */
   1144      1.1  reinoud 		panic("UDF disc allocation accounting gone wrong");
   1145      1.1  reinoud 	}
   1146      1.1  reinoud 
   1147      1.1  reinoud 	/* commit our sector count */
   1148      1.1  reinoud 	mutex_enter(&ump->allocate_mutex);
   1149      1.1  reinoud 		if (num_lb > ump->uncomitted_lb) {
   1150      1.1  reinoud 			ump->uncomitted_lb = 0;
   1151      1.1  reinoud 		} else {
   1152      1.1  reinoud 			ump->uncomitted_lb -= num_lb;
   1153      1.1  reinoud 		}
   1154      1.1  reinoud 	mutex_exit(&ump->allocate_mutex);
   1155      1.1  reinoud 
   1156      1.1  reinoud 	buf->b_blkno = (*pmapping) * blks;
   1157      1.1  reinoud 
   1158      1.1  reinoud 	/* If its userdata or FIDs, record its allocation in its node. */
   1159      1.1  reinoud 	if ((udf_c_type == UDF_C_USERDATA) || (udf_c_type == UDF_C_FIDS)) {
   1160      1.1  reinoud 		udf_record_allocation_in_node(ump, buf, vpart_num, lmapping,
   1161      1.1  reinoud 			node_ad_cpy);
   1162      1.1  reinoud 		/* decrement our outstanding bufs counter */
   1163      1.1  reinoud 		s = splbio();
   1164      1.1  reinoud 			udf_node->outstanding_bufs--;
   1165      1.1  reinoud 		splx(s);
   1166      1.1  reinoud 	}
   1167      1.1  reinoud }
   1168      1.1  reinoud 
   1169      1.1  reinoud /* --------------------------------------------------------------------- */
   1170      1.1  reinoud 
   1171      1.1  reinoud /*
   1172      1.1  reinoud  * Try to merge a1 with the new piece a2. udf_ads_merge returns error when not
   1173      1.1  reinoud  * possible (anymore); a2 returns the rest piece.
   1174      1.1  reinoud  */
   1175      1.1  reinoud 
   1176      1.1  reinoud static int
   1177      1.1  reinoud udf_ads_merge(uint32_t lb_size, struct long_ad *a1, struct long_ad *a2)
   1178      1.1  reinoud {
   1179      1.1  reinoud 	uint32_t max_len, merge_len;
   1180      1.1  reinoud 	uint32_t a1_len, a2_len;
   1181      1.1  reinoud 	uint32_t a1_flags, a2_flags;
   1182      1.1  reinoud 	uint32_t a1_lbnum, a2_lbnum;
   1183      1.1  reinoud 	uint16_t a1_part, a2_part;
   1184      1.1  reinoud 
   1185      1.1  reinoud 	max_len = ((UDF_EXT_MAXLEN / lb_size) * lb_size);
   1186      1.1  reinoud 
   1187      1.1  reinoud 	a1_flags = UDF_EXT_FLAGS(udf_rw32(a1->len));
   1188      1.1  reinoud 	a1_len   = UDF_EXT_LEN(udf_rw32(a1->len));
   1189      1.1  reinoud 	a1_lbnum = udf_rw32(a1->loc.lb_num);
   1190      1.1  reinoud 	a1_part  = udf_rw16(a1->loc.part_num);
   1191      1.1  reinoud 
   1192      1.1  reinoud 	a2_flags = UDF_EXT_FLAGS(udf_rw32(a2->len));
   1193      1.1  reinoud 	a2_len   = UDF_EXT_LEN(udf_rw32(a2->len));
   1194      1.1  reinoud 	a2_lbnum = udf_rw32(a2->loc.lb_num);
   1195      1.1  reinoud 	a2_part  = udf_rw16(a2->loc.part_num);
   1196      1.1  reinoud 
   1197      1.1  reinoud 	/* defines same space */
   1198      1.1  reinoud 	if (a1_flags != a2_flags)
   1199      1.1  reinoud 		return 1;
   1200      1.1  reinoud 
   1201      1.1  reinoud 	if (a1_flags != UDF_EXT_FREE) {
   1202      1.1  reinoud 		/* the same partition */
   1203      1.1  reinoud 		if (a1_part != a2_part)
   1204      1.1  reinoud 			return 1;
   1205      1.1  reinoud 
   1206      1.1  reinoud 		/* a2 is successor of a1 */
   1207      1.1  reinoud 		if (a1_lbnum * lb_size + a1_len != a2_lbnum * lb_size)
   1208      1.1  reinoud 			return 1;
   1209      1.1  reinoud 	}
   1210  1.2.4.2   simonb 
   1211      1.1  reinoud 	/* merge as most from a2 if possible */
   1212      1.1  reinoud 	merge_len = MIN(a2_len, max_len - a1_len);
   1213      1.1  reinoud 	a1_len   += merge_len;
   1214      1.1  reinoud 	a2_len   -= merge_len;
   1215      1.1  reinoud 	a2_lbnum += merge_len/lb_size;
   1216      1.1  reinoud 
   1217      1.1  reinoud 	a1->len = udf_rw32(a1_len | a1_flags);
   1218      1.1  reinoud 	a2->len = udf_rw32(a2_len | a2_flags);
   1219      1.1  reinoud 	a2->loc.lb_num = udf_rw32(a2_lbnum);
   1220      1.1  reinoud 
   1221      1.1  reinoud 	if (a2_len > 0)
   1222      1.1  reinoud 		return 1;
   1223      1.1  reinoud 
   1224      1.1  reinoud 	/* there is space over to merge */
   1225      1.1  reinoud 	return 0;
   1226      1.1  reinoud }
   1227      1.1  reinoud 
   1228      1.1  reinoud /* --------------------------------------------------------------------- */
   1229      1.1  reinoud 
   1230      1.1  reinoud static void
   1231      1.1  reinoud udf_wipe_adslots(struct udf_node *udf_node)
   1232      1.1  reinoud {
   1233      1.1  reinoud 	struct file_entry      *fe;
   1234      1.1  reinoud 	struct extfile_entry   *efe;
   1235      1.1  reinoud 	struct alloc_ext_entry *ext;
   1236      1.1  reinoud 	uint64_t inflen, objsize;
   1237      1.1  reinoud 	uint32_t lb_size, dscr_size, l_ea, l_ad, max_l_ad, crclen;
   1238      1.1  reinoud 	uint8_t *data_pos;
   1239      1.1  reinoud 	int extnr;
   1240      1.1  reinoud 
   1241      1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1242      1.1  reinoud 
   1243      1.1  reinoud 	fe  = udf_node->fe;
   1244      1.1  reinoud 	efe = udf_node->efe;
   1245      1.1  reinoud 	if (fe) {
   1246      1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   1247      1.1  reinoud 		objsize = inflen;
   1248      1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   1249      1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   1250      1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   1251      1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   1252      1.1  reinoud 	} else {
   1253      1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   1254      1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   1255      1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   1256      1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   1257      1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   1258      1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   1259      1.1  reinoud 	}
   1260      1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   1261      1.1  reinoud 
   1262      1.1  reinoud 	/* wipe fe/efe */
   1263      1.1  reinoud 	memset(data_pos, 0, max_l_ad);
   1264      1.1  reinoud 	crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea;
   1265      1.1  reinoud 	if (fe) {
   1266      1.1  reinoud 		fe->l_ad         = udf_rw32(0);
   1267      1.1  reinoud 		fe->logblks_rec  = udf_rw64(0);
   1268      1.1  reinoud 		fe->tag.desc_crc_len = udf_rw32(crclen);
   1269      1.1  reinoud 	} else {
   1270      1.1  reinoud 		efe->l_ad        = udf_rw32(0);
   1271      1.1  reinoud 		efe->logblks_rec = udf_rw64(0);
   1272      1.1  reinoud 		efe->tag.desc_crc_len = udf_rw32(crclen);
   1273      1.1  reinoud 	}
   1274      1.1  reinoud 
   1275      1.1  reinoud 	/* wipe all allocation extent entries */
   1276      1.1  reinoud 	for (extnr = 0; extnr < udf_node->num_extensions; extnr++) {
   1277      1.1  reinoud 		ext = udf_node->ext[extnr];
   1278      1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1279  1.2.4.3   simonb 		data_pos = (uint8_t *) ext->data;
   1280      1.1  reinoud 		max_l_ad = lb_size - dscr_size;
   1281      1.1  reinoud 		memset(data_pos, 0, max_l_ad);
   1282      1.1  reinoud 		ext->l_ad = udf_rw32(0);
   1283      1.1  reinoud 
   1284      1.1  reinoud 		crclen = dscr_size - UDF_DESC_TAG_LENGTH;
   1285      1.1  reinoud 		ext->tag.desc_crc_len = udf_rw32(crclen);
   1286      1.1  reinoud 	}
   1287  1.2.4.3   simonb 	udf_node->i_flags |= IN_NODE_REBUILD;
   1288      1.1  reinoud }
   1289      1.1  reinoud 
   1290      1.1  reinoud /* --------------------------------------------------------------------- */
   1291      1.1  reinoud 
   1292      1.1  reinoud void
   1293      1.1  reinoud udf_get_adslot(struct udf_node *udf_node, int slot, struct long_ad *icb,
   1294      1.1  reinoud 	int *eof) {
   1295      1.1  reinoud 	struct file_entry      *fe;
   1296      1.1  reinoud 	struct extfile_entry   *efe;
   1297      1.1  reinoud 	struct alloc_ext_entry *ext;
   1298      1.1  reinoud 	struct icb_tag *icbtag;
   1299      1.1  reinoud 	struct short_ad *short_ad;
   1300  1.2.4.3   simonb 	struct long_ad *long_ad, l_icb;
   1301      1.1  reinoud 	uint32_t offset;
   1302  1.2.4.3   simonb 	uint32_t lb_size, dscr_size, l_ea, l_ad, flags;
   1303      1.1  reinoud 	uint8_t *data_pos;
   1304      1.1  reinoud 	int icbflags, addr_type, adlen, extnr;
   1305      1.1  reinoud 
   1306      1.1  reinoud 	/* determine what descriptor we are in */
   1307      1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1308      1.1  reinoud 
   1309      1.1  reinoud 	fe  = udf_node->fe;
   1310      1.1  reinoud 	efe = udf_node->efe;
   1311      1.1  reinoud 	if (fe) {
   1312      1.1  reinoud 		icbtag  = &fe->icbtag;
   1313      1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   1314      1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   1315      1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   1316      1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   1317      1.1  reinoud 	} else {
   1318      1.1  reinoud 		icbtag  = &efe->icbtag;
   1319      1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   1320      1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   1321      1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   1322      1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   1323      1.1  reinoud 	}
   1324      1.1  reinoud 
   1325      1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   1326      1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   1327      1.1  reinoud 
   1328      1.1  reinoud 	/* just in case we're called on an intern, its EOF */
   1329      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   1330      1.1  reinoud 		memset(icb, 0, sizeof(struct long_ad));
   1331      1.1  reinoud 		*eof = 1;
   1332      1.1  reinoud 		return;
   1333      1.1  reinoud 	}
   1334      1.1  reinoud 
   1335      1.1  reinoud 	adlen = 0;
   1336      1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1337      1.1  reinoud 		adlen = sizeof(struct short_ad);
   1338      1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1339      1.1  reinoud 		adlen = sizeof(struct long_ad);
   1340      1.1  reinoud 	}
   1341      1.1  reinoud 
   1342      1.1  reinoud 	/* if offset too big, we go to the allocation extensions */
   1343      1.1  reinoud 	offset = slot * adlen;
   1344  1.2.4.1   simonb 	extnr  = -1;
   1345  1.2.4.3   simonb 	while (offset >= l_ad) {
   1346  1.2.4.3   simonb 		/* check if our last entry is a redirect */
   1347  1.2.4.3   simonb 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1348  1.2.4.3   simonb 			short_ad = (struct short_ad *) (data_pos + l_ad-adlen);
   1349  1.2.4.3   simonb 			l_icb.len          = short_ad->len;
   1350  1.2.4.3   simonb 			l_icb.loc.part_num = udf_node->loc.loc.part_num;
   1351  1.2.4.3   simonb 			l_icb.loc.lb_num   = short_ad->lb_num;
   1352  1.2.4.3   simonb 		} else {
   1353  1.2.4.3   simonb 			KASSERT(addr_type == UDF_ICB_LONG_ALLOC);
   1354  1.2.4.3   simonb 			long_ad = (struct long_ad *) (data_pos + l_ad-adlen);
   1355  1.2.4.3   simonb 			l_icb = *long_ad;
   1356  1.2.4.3   simonb 		}
   1357  1.2.4.3   simonb 		flags = UDF_EXT_FLAGS(udf_rw32(l_icb.len));
   1358  1.2.4.3   simonb 		if (flags != UDF_EXT_REDIRECT) {
   1359  1.2.4.3   simonb 			l_ad = 0;	/* force EOF */
   1360  1.2.4.3   simonb 			break;
   1361  1.2.4.3   simonb 		}
   1362  1.2.4.3   simonb 
   1363  1.2.4.3   simonb 		/* advance to next extent */
   1364  1.2.4.1   simonb 		extnr++;
   1365  1.2.4.3   simonb 		if (extnr >= udf_node->num_extensions) {
   1366  1.2.4.3   simonb 			l_ad = 0;	/* force EOF */
   1367  1.2.4.3   simonb 			break;
   1368  1.2.4.3   simonb 		}
   1369  1.2.4.3   simonb 		offset = offset - l_ad;
   1370      1.1  reinoud 		ext  = udf_node->ext[extnr];
   1371      1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1372      1.1  reinoud 		l_ad = udf_rw32(ext->l_ad);
   1373  1.2.4.1   simonb 		data_pos = (uint8_t *) ext + dscr_size;
   1374      1.1  reinoud 	}
   1375      1.1  reinoud 
   1376  1.2.4.3   simonb 	/* XXX l_ad == 0 should be enough to check */
   1377      1.1  reinoud 	*eof = (offset >= l_ad) || (l_ad == 0);
   1378      1.1  reinoud 	if (*eof) {
   1379  1.2.4.3   simonb 		DPRINTF(PARANOIDADWLK, ("returning EOF, extnr %d, offset %d, "
   1380  1.2.4.3   simonb 			"l_ad %d\n", extnr, offset, l_ad));
   1381      1.1  reinoud 		memset(icb, 0, sizeof(struct long_ad));
   1382      1.1  reinoud 		return;
   1383      1.1  reinoud 	}
   1384      1.1  reinoud 
   1385      1.1  reinoud 	/* get the element */
   1386      1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1387      1.1  reinoud 		short_ad = (struct short_ad *) (data_pos + offset);
   1388      1.1  reinoud 		icb->len          = short_ad->len;
   1389  1.2.4.1   simonb 		icb->loc.part_num = udf_node->loc.loc.part_num;
   1390      1.1  reinoud 		icb->loc.lb_num   = short_ad->lb_num;
   1391      1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1392      1.1  reinoud 		long_ad = (struct long_ad *) (data_pos + offset);
   1393      1.1  reinoud 		*icb = *long_ad;
   1394      1.1  reinoud 	}
   1395  1.2.4.3   simonb 	DPRINTF(PARANOIDADWLK, ("returning element : v %d, lb %d, len %d, "
   1396  1.2.4.3   simonb 		"flags %d\n", icb->loc.part_num, icb->loc.lb_num,
   1397  1.2.4.3   simonb 		UDF_EXT_LEN(icb->len), UDF_EXT_FLAGS(icb->len)));
   1398      1.1  reinoud }
   1399      1.1  reinoud 
   1400      1.1  reinoud /* --------------------------------------------------------------------- */
   1401      1.1  reinoud 
   1402      1.1  reinoud int
   1403  1.2.4.3   simonb udf_append_adslot(struct udf_node *udf_node, int *slot, struct long_ad *icb) {
   1404  1.2.4.3   simonb 	struct udf_mount *ump = udf_node->ump;
   1405  1.2.4.4   simonb 	union dscrptr          *dscr, *extdscr;
   1406      1.1  reinoud 	struct file_entry      *fe;
   1407      1.1  reinoud 	struct extfile_entry   *efe;
   1408      1.1  reinoud 	struct alloc_ext_entry *ext;
   1409      1.1  reinoud 	struct icb_tag *icbtag;
   1410      1.1  reinoud 	struct short_ad *short_ad;
   1411  1.2.4.3   simonb 	struct long_ad *long_ad, o_icb, l_icb;
   1412      1.1  reinoud 	uint64_t logblks_rec, *logblks_rec_p;
   1413  1.2.4.3   simonb 	uint64_t lmapping, pmapping;
   1414  1.2.4.3   simonb 	uint32_t offset, rest, len, lb_num;
   1415      1.1  reinoud 	uint32_t lb_size, dscr_size, l_ea, l_ad, *l_ad_p, max_l_ad, crclen;
   1416  1.2.4.3   simonb 	uint32_t flags;
   1417  1.2.4.3   simonb 	uint16_t vpart_num;
   1418      1.1  reinoud 	uint8_t *data_pos;
   1419      1.1  reinoud 	int icbflags, addr_type, adlen, extnr;
   1420  1.2.4.3   simonb 	int error;
   1421      1.1  reinoud 
   1422      1.1  reinoud 	/* determine what descriptor we are in */
   1423  1.2.4.3   simonb 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1424      1.1  reinoud 
   1425      1.1  reinoud 	fe  = udf_node->fe;
   1426      1.1  reinoud 	efe = udf_node->efe;
   1427      1.1  reinoud 	if (fe) {
   1428      1.1  reinoud 		icbtag  = &fe->icbtag;
   1429      1.1  reinoud 		dscr      = (union dscrptr *) fe;
   1430      1.1  reinoud 		dscr_size = sizeof(struct file_entry) -1;
   1431      1.1  reinoud 
   1432      1.1  reinoud 		l_ea      = udf_rw32(fe->l_ea);
   1433      1.1  reinoud 		l_ad_p    = &fe->l_ad;
   1434      1.1  reinoud 		logblks_rec_p = &fe->logblks_rec;
   1435      1.1  reinoud 	} else {
   1436      1.1  reinoud 		icbtag    = &efe->icbtag;
   1437      1.1  reinoud 		dscr      = (union dscrptr *) efe;
   1438      1.1  reinoud 		dscr_size = sizeof(struct extfile_entry) -1;
   1439      1.1  reinoud 
   1440      1.1  reinoud 		l_ea      = udf_rw32(efe->l_ea);
   1441      1.1  reinoud 		l_ad_p    = &efe->l_ad;
   1442      1.1  reinoud 		logblks_rec_p = &efe->logblks_rec;
   1443      1.1  reinoud 	}
   1444      1.1  reinoud 	data_pos  = (uint8_t *) dscr + dscr_size + l_ea;
   1445      1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   1446      1.1  reinoud 
   1447      1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   1448      1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   1449      1.1  reinoud 
   1450      1.1  reinoud 	/* just in case we're called on an intern, its EOF */
   1451      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   1452      1.1  reinoud 		panic("udf_append_adslot on UDF_ICB_INTERN_ALLOC\n");
   1453      1.1  reinoud 	}
   1454      1.1  reinoud 
   1455      1.1  reinoud 	adlen = 0;
   1456      1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1457      1.1  reinoud 		adlen = sizeof(struct short_ad);
   1458      1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1459      1.1  reinoud 		adlen = sizeof(struct long_ad);
   1460      1.1  reinoud 	}
   1461      1.1  reinoud 
   1462  1.2.4.2   simonb 	/* clean up given long_ad */
   1463  1.2.4.2   simonb #ifdef DIAGNOSTIC
   1464  1.2.4.3   simonb 	flags = UDF_EXT_FLAGS(udf_rw32(icb->len));
   1465  1.2.4.3   simonb 	if (flags == UDF_EXT_FREE) {
   1466  1.2.4.2   simonb 		if ((udf_rw16(icb->loc.part_num) != 0) ||
   1467  1.2.4.2   simonb 		    (udf_rw32(icb->loc.lb_num) != 0))
   1468  1.2.4.2   simonb 			printf("UDF: warning, cleaning long_ad marked free\n");
   1469  1.2.4.2   simonb 		icb->loc.part_num = udf_rw16(0);
   1470  1.2.4.2   simonb 		icb->loc.lb_num   = udf_rw32(0);
   1471  1.2.4.2   simonb 	}
   1472  1.2.4.2   simonb #endif
   1473  1.2.4.2   simonb 
   1474      1.1  reinoud 	/* if offset too big, we go to the allocation extensions */
   1475  1.2.4.3   simonb 	l_ad   = udf_rw32(*l_ad_p);
   1476  1.2.4.3   simonb 	offset = (*slot) * adlen;
   1477  1.2.4.3   simonb 	extnr  = -1;
   1478  1.2.4.3   simonb 	while (offset >= l_ad) {
   1479  1.2.4.3   simonb 		/* check if our last entry is a redirect */
   1480  1.2.4.3   simonb 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1481  1.2.4.3   simonb 			short_ad = (struct short_ad *) (data_pos + l_ad-adlen);
   1482  1.2.4.3   simonb 			l_icb.len          = short_ad->len;
   1483  1.2.4.3   simonb 			l_icb.loc.part_num = udf_node->loc.loc.part_num;
   1484  1.2.4.3   simonb 			l_icb.loc.lb_num   = short_ad->lb_num;
   1485  1.2.4.3   simonb 		} else {
   1486  1.2.4.3   simonb 			KASSERT(addr_type == UDF_ICB_LONG_ALLOC);
   1487  1.2.4.3   simonb 			long_ad = (struct long_ad *) (data_pos + l_ad-adlen);
   1488  1.2.4.3   simonb 			l_icb = *long_ad;
   1489  1.2.4.3   simonb 		}
   1490  1.2.4.3   simonb 		flags = UDF_EXT_FLAGS(udf_rw32(l_icb.len));
   1491  1.2.4.3   simonb 		if (flags != UDF_EXT_REDIRECT) {
   1492  1.2.4.3   simonb 			/* only one past the last one is adressable */
   1493  1.2.4.3   simonb 			break;
   1494  1.2.4.3   simonb 		}
   1495  1.2.4.3   simonb 
   1496  1.2.4.3   simonb 		/* advance to next extent */
   1497  1.2.4.3   simonb 		extnr++;
   1498  1.2.4.3   simonb 		KASSERT(extnr < udf_node->num_extensions);
   1499  1.2.4.3   simonb 		offset = offset - l_ad;
   1500  1.2.4.3   simonb 
   1501      1.1  reinoud 		ext  = udf_node->ext[extnr];
   1502      1.1  reinoud 		dscr = (union dscrptr *) ext;
   1503      1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1504      1.1  reinoud 		max_l_ad = lb_size - dscr_size;
   1505  1.2.4.3   simonb 		l_ad_p = &ext->l_ad;
   1506  1.2.4.3   simonb 		l_ad   = udf_rw32(*l_ad_p);
   1507  1.2.4.3   simonb 		data_pos = (uint8_t *) ext + dscr_size;
   1508      1.1  reinoud 	}
   1509  1.2.4.3   simonb 	DPRINTF(PARANOIDADWLK, ("append, ext %d, offset %d, l_ad %d\n",
   1510  1.2.4.3   simonb 		extnr, offset, udf_rw32(*l_ad_p)));
   1511  1.2.4.3   simonb 	KASSERT(l_ad == udf_rw32(*l_ad_p));
   1512  1.2.4.3   simonb 
   1513      1.1  reinoud 	/* offset is offset within the current (E)FE/AED */
   1514      1.1  reinoud 	l_ad   = udf_rw32(*l_ad_p);
   1515      1.1  reinoud 	crclen = udf_rw32(dscr->tag.desc_crc_len);
   1516      1.1  reinoud 	logblks_rec = udf_rw64(*logblks_rec_p);
   1517      1.1  reinoud 
   1518      1.1  reinoud 	/* overwriting old piece? */
   1519      1.1  reinoud 	if (offset < l_ad) {
   1520      1.1  reinoud 		/* overwrite entry; compensate for the old element */
   1521      1.1  reinoud 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1522      1.1  reinoud 			short_ad = (struct short_ad *) (data_pos + offset);
   1523      1.1  reinoud 			o_icb.len          = short_ad->len;
   1524      1.1  reinoud 			o_icb.loc.part_num = udf_rw16(0);	/* ignore */
   1525      1.1  reinoud 			o_icb.loc.lb_num   = short_ad->lb_num;
   1526      1.1  reinoud 		} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1527      1.1  reinoud 			long_ad = (struct long_ad *) (data_pos + offset);
   1528      1.1  reinoud 			o_icb = *long_ad;
   1529      1.1  reinoud 		} else {
   1530      1.1  reinoud 			panic("Invalid address type in udf_append_adslot\n");
   1531      1.1  reinoud 		}
   1532      1.1  reinoud 
   1533      1.1  reinoud 		len = udf_rw32(o_icb.len);
   1534      1.1  reinoud 		if (UDF_EXT_FLAGS(len) == UDF_EXT_ALLOCATED) {
   1535      1.1  reinoud 			/* adjust counts */
   1536      1.1  reinoud 			len = UDF_EXT_LEN(len);
   1537      1.1  reinoud 			logblks_rec -= (len + lb_size -1) / lb_size;
   1538      1.1  reinoud 		}
   1539      1.1  reinoud 	}
   1540      1.1  reinoud 
   1541  1.2.4.3   simonb 	/* check if we're not appending a redirection */
   1542  1.2.4.3   simonb 	flags = UDF_EXT_FLAGS(udf_rw32(icb->len));
   1543  1.2.4.3   simonb 	KASSERT(flags != UDF_EXT_REDIRECT);
   1544  1.2.4.3   simonb 
   1545  1.2.4.3   simonb 	/* round down available space */
   1546  1.2.4.3   simonb 	rest = adlen * ((max_l_ad - offset) / adlen);
   1547      1.1  reinoud 	if (rest <= adlen) {
   1548  1.2.4.3   simonb 		/* have to append aed, see if we already have a spare one */
   1549  1.2.4.3   simonb 		extnr++;
   1550  1.2.4.3   simonb 		ext = udf_node->ext[extnr];
   1551  1.2.4.3   simonb 		l_icb = udf_node->ext_loc[extnr];
   1552  1.2.4.3   simonb 		if (ext == NULL) {
   1553  1.2.4.3   simonb 			DPRINTF(ALLOC,("adding allocation extent %d\n", extnr));
   1554  1.2.4.3   simonb 			error = udf_pre_allocate_space(ump, UDF_C_NODE, 1,
   1555  1.2.4.3   simonb 					&vpart_num, &lmapping, &pmapping);
   1556  1.2.4.3   simonb 			lb_num = lmapping;
   1557  1.2.4.3   simonb 			if (error)
   1558  1.2.4.3   simonb 				return error;
   1559  1.2.4.3   simonb 
   1560  1.2.4.3   simonb 			/* initialise pointer to location */
   1561  1.2.4.3   simonb 			memset(&l_icb, 0, sizeof(struct long_ad));
   1562  1.2.4.3   simonb 			l_icb.len = udf_rw32(lb_size | UDF_EXT_REDIRECT);
   1563  1.2.4.3   simonb 			l_icb.loc.lb_num   = udf_rw32(lb_num);
   1564  1.2.4.3   simonb 			l_icb.loc.part_num = udf_rw16(vpart_num);
   1565  1.2.4.3   simonb 
   1566  1.2.4.3   simonb 			/* create new aed descriptor */
   1567  1.2.4.4   simonb 			udf_create_logvol_dscr(ump, udf_node, &l_icb, &extdscr);
   1568  1.2.4.4   simonb 			ext = &extdscr->aee;
   1569  1.2.4.3   simonb 
   1570  1.2.4.3   simonb 			udf_inittag(ump, &ext->tag, TAGID_ALLOCEXTENT, lb_num);
   1571  1.2.4.3   simonb 			dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1572  1.2.4.3   simonb 			max_l_ad = lb_size - dscr_size;
   1573  1.2.4.3   simonb 			memset(ext->data, 0, max_l_ad);
   1574  1.2.4.3   simonb 			ext->l_ad = udf_rw32(0);
   1575  1.2.4.3   simonb 			ext->tag.desc_crc_len =
   1576  1.2.4.3   simonb 				udf_rw32(dscr_size - UDF_DESC_TAG_LENGTH);
   1577  1.2.4.3   simonb 
   1578  1.2.4.3   simonb 			/* declare aed */
   1579  1.2.4.3   simonb 			udf_node->num_extensions++;
   1580  1.2.4.3   simonb 			udf_node->ext_loc[extnr] = l_icb;
   1581  1.2.4.3   simonb 			udf_node->ext[extnr] = ext;
   1582  1.2.4.3   simonb 		}
   1583  1.2.4.3   simonb 		/* add redirect and adjust l_ad and crclen for old descr */
   1584  1.2.4.3   simonb 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1585  1.2.4.3   simonb 			short_ad = (struct short_ad *) (data_pos + offset);
   1586  1.2.4.3   simonb 			short_ad->len    = l_icb.len;
   1587  1.2.4.3   simonb 			short_ad->lb_num = l_icb.loc.lb_num;
   1588  1.2.4.3   simonb 		} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1589  1.2.4.3   simonb 			long_ad = (struct long_ad *) (data_pos + offset);
   1590  1.2.4.3   simonb 			*long_ad = l_icb;
   1591  1.2.4.3   simonb 		}
   1592  1.2.4.3   simonb 		l_ad   += adlen;
   1593  1.2.4.3   simonb 		crclen += adlen;
   1594  1.2.4.3   simonb 		dscr->tag.desc_crc_len = udf_rw32(crclen);
   1595  1.2.4.3   simonb 		*l_ad_p = udf_rw32(l_ad);
   1596  1.2.4.3   simonb 
   1597  1.2.4.3   simonb 		/* advance to the new extension */
   1598  1.2.4.3   simonb 		KASSERT(ext != NULL);
   1599  1.2.4.3   simonb 		dscr = (union dscrptr *) ext;
   1600  1.2.4.3   simonb 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1601  1.2.4.3   simonb 		max_l_ad = lb_size - dscr_size;
   1602  1.2.4.3   simonb 		data_pos = (uint8_t *) dscr + dscr_size;
   1603  1.2.4.3   simonb 
   1604  1.2.4.3   simonb 		l_ad_p = &ext->l_ad;
   1605  1.2.4.3   simonb 		l_ad   = udf_rw32(*l_ad_p);
   1606  1.2.4.3   simonb 		crclen = udf_rw32(dscr->tag.desc_crc_len);
   1607  1.2.4.3   simonb 		offset = 0;
   1608  1.2.4.3   simonb 
   1609  1.2.4.3   simonb 		/* adjust callees slot count for link insert */
   1610  1.2.4.3   simonb 		*slot += 1;
   1611      1.1  reinoud 	}
   1612      1.1  reinoud 
   1613      1.1  reinoud 	/* write out the element */
   1614  1.2.4.3   simonb 	DPRINTF(PARANOIDADWLK, ("adding element : %p : v %d, lb %d, "
   1615  1.2.4.3   simonb 			"len %d, flags %d\n", data_pos + offset,
   1616  1.2.4.3   simonb 			icb->loc.part_num, icb->loc.lb_num,
   1617  1.2.4.3   simonb 			UDF_EXT_LEN(icb->len), UDF_EXT_FLAGS(icb->len)));
   1618      1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1619      1.1  reinoud 		short_ad = (struct short_ad *) (data_pos + offset);
   1620      1.1  reinoud 		short_ad->len    = icb->len;
   1621      1.1  reinoud 		short_ad->lb_num = icb->loc.lb_num;
   1622      1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1623      1.1  reinoud 		long_ad = (struct long_ad *) (data_pos + offset);
   1624      1.1  reinoud 		*long_ad = *icb;
   1625      1.1  reinoud 	}
   1626      1.1  reinoud 
   1627      1.1  reinoud 	/* adjust logblks recorded count */
   1628  1.2.4.3   simonb 	flags = UDF_EXT_FLAGS(udf_rw32(icb->len));
   1629  1.2.4.3   simonb 	if (flags == UDF_EXT_ALLOCATED)
   1630      1.1  reinoud 		logblks_rec += (UDF_EXT_LEN(icb->len) + lb_size -1) / lb_size;
   1631      1.1  reinoud 	*logblks_rec_p = udf_rw64(logblks_rec);
   1632      1.1  reinoud 
   1633      1.1  reinoud 	/* adjust l_ad and crclen when needed */
   1634      1.1  reinoud 	if (offset >= l_ad) {
   1635      1.1  reinoud 		l_ad   += adlen;
   1636      1.1  reinoud 		crclen += adlen;
   1637      1.1  reinoud 		dscr->tag.desc_crc_len = udf_rw32(crclen);
   1638      1.1  reinoud 		*l_ad_p = udf_rw32(l_ad);
   1639      1.1  reinoud 	}
   1640      1.1  reinoud 
   1641      1.1  reinoud 	return 0;
   1642      1.1  reinoud }
   1643      1.1  reinoud 
   1644      1.1  reinoud /* --------------------------------------------------------------------- */
   1645      1.1  reinoud 
   1646  1.2.4.3   simonb static void
   1647  1.2.4.3   simonb udf_count_alloc_exts(struct udf_node *udf_node)
   1648  1.2.4.3   simonb {
   1649  1.2.4.3   simonb 	struct long_ad s_ad;
   1650  1.2.4.3   simonb 	uint32_t lb_num, len, flags;
   1651  1.2.4.3   simonb 	uint16_t vpart_num;
   1652  1.2.4.3   simonb 	int slot, eof;
   1653  1.2.4.3   simonb 	int num_extents, extnr;
   1654  1.2.4.3   simonb 	int lb_size;
   1655  1.2.4.3   simonb 
   1656  1.2.4.3   simonb 	if (udf_node->num_extensions == 0)
   1657  1.2.4.3   simonb 		return;
   1658  1.2.4.3   simonb 
   1659  1.2.4.3   simonb 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1660  1.2.4.3   simonb 	/* count number of allocation extents in use */
   1661  1.2.4.3   simonb 	num_extents = 0;
   1662  1.2.4.3   simonb 	slot = 0;
   1663  1.2.4.3   simonb 	for (;;) {
   1664  1.2.4.3   simonb 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   1665  1.2.4.3   simonb 		if (eof)
   1666  1.2.4.3   simonb 			break;
   1667  1.2.4.3   simonb 		len   = udf_rw32(s_ad.len);
   1668  1.2.4.3   simonb 		flags = UDF_EXT_FLAGS(len);
   1669  1.2.4.3   simonb 
   1670  1.2.4.3   simonb 		if (flags == UDF_EXT_REDIRECT)
   1671  1.2.4.3   simonb 			num_extents++;
   1672  1.2.4.3   simonb 
   1673  1.2.4.3   simonb 		slot++;
   1674  1.2.4.3   simonb 	}
   1675  1.2.4.3   simonb 
   1676  1.2.4.3   simonb 	DPRINTF(ALLOC, ("udf_count_alloc_ext counted %d live extents\n",
   1677  1.2.4.3   simonb 		num_extents));
   1678  1.2.4.3   simonb 
   1679  1.2.4.3   simonb 	/* XXX choice: we could delay freeing them on node writeout */
   1680  1.2.4.3   simonb 	/* free excess entries */
   1681  1.2.4.3   simonb 	extnr = num_extents;
   1682  1.2.4.3   simonb 	for (;extnr < udf_node->num_extensions; extnr++) {
   1683  1.2.4.3   simonb 		DPRINTF(ALLOC, ("freeing alloc ext %d\n", extnr));
   1684  1.2.4.3   simonb 		/* free dscriptor */
   1685  1.2.4.3   simonb 		s_ad = udf_node->ext_loc[extnr];
   1686  1.2.4.3   simonb 		udf_free_logvol_dscr(udf_node->ump, &s_ad,
   1687  1.2.4.3   simonb 			udf_node->ext[extnr]);
   1688  1.2.4.3   simonb 		udf_node->ext[extnr] = NULL;
   1689  1.2.4.3   simonb 
   1690  1.2.4.3   simonb 		/* free disc space */
   1691  1.2.4.3   simonb 		lb_num    = udf_rw32(s_ad.loc.lb_num);
   1692  1.2.4.3   simonb 		vpart_num = udf_rw16(s_ad.loc.part_num);
   1693  1.2.4.3   simonb 		udf_free_allocated_space(udf_node->ump, lb_num, vpart_num, 1);
   1694  1.2.4.3   simonb 
   1695  1.2.4.3   simonb 		memset(&udf_node->ext_loc[extnr], 0, sizeof(struct long_ad));
   1696  1.2.4.3   simonb 	}
   1697  1.2.4.3   simonb 
   1698  1.2.4.3   simonb 	/* set our new number of allocation extents */
   1699  1.2.4.3   simonb 	udf_node->num_extensions = num_extents;
   1700  1.2.4.3   simonb }
   1701  1.2.4.3   simonb 
   1702  1.2.4.3   simonb 
   1703  1.2.4.3   simonb /* --------------------------------------------------------------------- */
   1704  1.2.4.3   simonb 
   1705      1.1  reinoud /*
   1706      1.1  reinoud  * Adjust the node's allocation descriptors to reflect the new mapping; do
   1707      1.1  reinoud  * take note that we might glue to existing allocation descriptors.
   1708      1.1  reinoud  *
   1709      1.1  reinoud  * XXX Note there can only be one allocation being recorded/mount; maybe
   1710      1.1  reinoud  * explicit allocation in shedule thread?
   1711      1.1  reinoud  */
   1712      1.1  reinoud 
   1713      1.1  reinoud static void
   1714      1.1  reinoud udf_record_allocation_in_node(struct udf_mount *ump, struct buf *buf,
   1715      1.1  reinoud 	uint16_t vpart_num, uint64_t *mapping, struct long_ad *node_ad_cpy)
   1716      1.1  reinoud {
   1717      1.1  reinoud 	struct vnode    *vp = buf->b_vp;
   1718      1.1  reinoud 	struct udf_node *udf_node = VTOI(vp);
   1719      1.1  reinoud 	struct file_entry      *fe;
   1720      1.1  reinoud 	struct extfile_entry   *efe;
   1721      1.1  reinoud 	struct icb_tag  *icbtag;
   1722      1.1  reinoud 	struct long_ad   s_ad, c_ad;
   1723      1.1  reinoud 	uint64_t inflen, from, till;
   1724      1.1  reinoud 	uint64_t foffset, end_foffset, restart_foffset;
   1725      1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   1726      1.1  reinoud 	uint32_t num_lb, len, flags, lb_num;
   1727      1.1  reinoud 	uint32_t run_start;
   1728  1.2.4.2   simonb 	uint32_t slot_offset, replace_len, replace;
   1729      1.1  reinoud 	int addr_type, icbflags;
   1730      1.1  reinoud 	int udf_c_type = buf->b_udf_c_type;
   1731      1.1  reinoud 	int lb_size, run_length, eof;
   1732      1.1  reinoud 	int slot, cpy_slot, cpy_slots, restart_slot;
   1733      1.1  reinoud 	int error;
   1734      1.1  reinoud 
   1735      1.1  reinoud 	DPRINTF(ALLOC, ("udf_record_allocation_in_node\n"));
   1736      1.1  reinoud 
   1737      1.1  reinoud 	/* sanity check ... should be panic ? */
   1738      1.1  reinoud 	if ((udf_c_type != UDF_C_USERDATA) && (udf_c_type != UDF_C_FIDS))
   1739      1.1  reinoud 		return;
   1740      1.1  reinoud 
   1741      1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1742      1.1  reinoud 
   1743      1.1  reinoud 	/* do the job */
   1744      1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);	/* XXX can deadlock ? */
   1745  1.2.4.2   simonb 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   1746      1.1  reinoud 
   1747      1.1  reinoud 	fe  = udf_node->fe;
   1748      1.1  reinoud 	efe = udf_node->efe;
   1749      1.1  reinoud 	if (fe) {
   1750      1.1  reinoud 		icbtag = &fe->icbtag;
   1751      1.1  reinoud 		inflen = udf_rw64(fe->inf_len);
   1752      1.1  reinoud 	} else {
   1753      1.1  reinoud 		icbtag = &efe->icbtag;
   1754      1.1  reinoud 		inflen = udf_rw64(efe->inf_len);
   1755      1.1  reinoud 	}
   1756      1.1  reinoud 
   1757      1.1  reinoud 	/* do check if `till' is not past file information length */
   1758      1.1  reinoud 	from = buf->b_lblkno * lb_size;
   1759      1.1  reinoud 	till = MIN(inflen, from + buf->b_resid);
   1760      1.1  reinoud 
   1761      1.1  reinoud 	num_lb = (till - from + lb_size -1) / lb_size;
   1762      1.1  reinoud 
   1763  1.2.4.2   simonb 	DPRINTF(ALLOC, ("record allocation from %"PRIu64" + %d\n", from, buf->b_bcount));
   1764      1.1  reinoud 
   1765      1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   1766      1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   1767      1.1  reinoud 
   1768      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   1769      1.1  reinoud 		/* nothing to do */
   1770      1.1  reinoud 		/* XXX clean up rest of node? just in case? */
   1771      1.1  reinoud 		UDF_UNLOCK_NODE(udf_node, 0);
   1772      1.1  reinoud 		return;
   1773      1.1  reinoud 	}
   1774      1.1  reinoud 
   1775      1.1  reinoud 	slot     = 0;
   1776      1.1  reinoud 	cpy_slot = 0;
   1777      1.1  reinoud 	foffset  = 0;
   1778      1.1  reinoud 
   1779      1.1  reinoud 	/* 1) copy till first overlap piece to the rewrite buffer */
   1780      1.1  reinoud 	for (;;) {
   1781      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   1782      1.1  reinoud 		if (eof) {
   1783      1.1  reinoud 			DPRINTF(WRITE,
   1784      1.1  reinoud 				("Record allocation in node "
   1785      1.1  reinoud 				 "failed: encountered EOF\n"));
   1786      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   1787      1.1  reinoud 			buf->b_error = EINVAL;
   1788      1.1  reinoud 			return;
   1789      1.1  reinoud 		}
   1790      1.1  reinoud 		len   = udf_rw32(s_ad.len);
   1791      1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   1792      1.1  reinoud 		len   = UDF_EXT_LEN(len);
   1793      1.1  reinoud 
   1794      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   1795      1.1  reinoud 			slot++;
   1796      1.1  reinoud 			continue;
   1797      1.1  reinoud 		}
   1798      1.1  reinoud 
   1799      1.1  reinoud 		end_foffset = foffset + len;
   1800      1.1  reinoud 		if (end_foffset > from)
   1801      1.1  reinoud 			break;	/* found */
   1802      1.1  reinoud 
   1803      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   1804      1.1  reinoud 
   1805      1.1  reinoud 		DPRINTF(ALLOC, ("\t1: vp %d, lb %d, len %d, flags %d "
   1806      1.1  reinoud 			"-> stack\n",
   1807      1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   1808      1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   1809      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1810      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1811      1.1  reinoud 
   1812      1.1  reinoud 		foffset = end_foffset;
   1813      1.1  reinoud 		slot++;
   1814      1.1  reinoud 	}
   1815      1.1  reinoud 	restart_slot    = slot;
   1816      1.1  reinoud 	restart_foffset = foffset;
   1817      1.1  reinoud 
   1818      1.1  reinoud 	/* 2) trunc overlapping slot at overlap and copy it */
   1819      1.1  reinoud 	slot_offset = from - foffset;
   1820      1.1  reinoud 	if (slot_offset > 0) {
   1821      1.1  reinoud 		DPRINTF(ALLOC, ("\tslot_offset = %d, flags = %d (%d)\n",
   1822      1.1  reinoud 				slot_offset, flags >> 30, flags));
   1823      1.1  reinoud 
   1824      1.1  reinoud 		s_ad.len = udf_rw32(slot_offset | flags);
   1825      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   1826      1.1  reinoud 
   1827      1.1  reinoud 		DPRINTF(ALLOC, ("\t2: vp %d, lb %d, len %d, flags %d "
   1828      1.1  reinoud 			"-> stack\n",
   1829      1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   1830      1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   1831      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1832      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1833      1.1  reinoud 	}
   1834      1.1  reinoud 	foffset += slot_offset;
   1835      1.1  reinoud 
   1836      1.1  reinoud 	/* 3) insert new mappings */
   1837      1.1  reinoud 	memset(&s_ad, 0, sizeof(struct long_ad));
   1838      1.1  reinoud 	lb_num = 0;
   1839      1.1  reinoud 	for (lb_num = 0; lb_num < num_lb; lb_num++) {
   1840      1.1  reinoud 		run_start  = mapping[lb_num];
   1841      1.1  reinoud 		run_length = 1;
   1842      1.1  reinoud 		while (lb_num < num_lb-1) {
   1843      1.1  reinoud 			if (mapping[lb_num+1] != mapping[lb_num]+1)
   1844      1.1  reinoud 				if (mapping[lb_num+1] != mapping[lb_num])
   1845      1.1  reinoud 					break;
   1846      1.1  reinoud 			run_length++;
   1847      1.1  reinoud 			lb_num++;
   1848      1.1  reinoud 		}
   1849      1.1  reinoud 		/* insert slot for this mapping */
   1850      1.1  reinoud 		len = run_length * lb_size;
   1851      1.1  reinoud 
   1852      1.1  reinoud 		/* bounds checking */
   1853      1.1  reinoud 		if (foffset + len > till)
   1854      1.1  reinoud 			len = till - foffset;
   1855      1.1  reinoud 		KASSERT(foffset + len <= inflen);
   1856      1.1  reinoud 
   1857      1.1  reinoud 		s_ad.len = udf_rw32(len | UDF_EXT_ALLOCATED);
   1858      1.1  reinoud 		s_ad.loc.part_num = udf_rw16(vpart_num);
   1859      1.1  reinoud 		s_ad.loc.lb_num   = udf_rw32(run_start);
   1860      1.1  reinoud 
   1861      1.1  reinoud 		foffset += len;
   1862      1.1  reinoud 
   1863      1.1  reinoud 		/* paranoia */
   1864      1.1  reinoud 		if (len == 0) {
   1865      1.1  reinoud 			DPRINTF(WRITE,
   1866      1.1  reinoud 				("Record allocation in node "
   1867      1.1  reinoud 				 "failed: insert failed\n"));
   1868      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   1869      1.1  reinoud 			buf->b_error = EINVAL;
   1870      1.1  reinoud 			return;
   1871      1.1  reinoud 		}
   1872      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   1873      1.1  reinoud 
   1874      1.1  reinoud 		DPRINTF(ALLOC, ("\t3: insert new mapping vp %d lb %d, len %d, "
   1875      1.1  reinoud 				"flags %d -> stack\n",
   1876      1.1  reinoud 			udf_rw16(s_ad.loc.part_num), udf_rw32(s_ad.loc.lb_num),
   1877      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1878      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1879      1.1  reinoud 	}
   1880      1.1  reinoud 
   1881      1.1  reinoud 	/* 4) pop replaced length */
   1882  1.2.4.2   simonb 	slot    = restart_slot;
   1883      1.1  reinoud 	foffset = restart_foffset;
   1884      1.1  reinoud 
   1885  1.2.4.2   simonb 	replace_len = till - foffset;	/* total amount of bytes to pop */
   1886  1.2.4.2   simonb 	slot_offset = from - foffset;	/* offset in first encounted slot */
   1887  1.2.4.2   simonb 	KASSERT((slot_offset % lb_size) == 0);
   1888  1.2.4.2   simonb 
   1889      1.1  reinoud 	for (;;) {
   1890      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   1891      1.1  reinoud 		if (eof)
   1892      1.1  reinoud 			break;
   1893      1.1  reinoud 
   1894      1.1  reinoud 		len    = udf_rw32(s_ad.len);
   1895      1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
   1896      1.1  reinoud 		len    = UDF_EXT_LEN(len);
   1897      1.1  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
   1898      1.1  reinoud 
   1899      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   1900      1.1  reinoud 			slot++;
   1901      1.1  reinoud 			continue;
   1902      1.1  reinoud 		}
   1903      1.1  reinoud 
   1904  1.2.4.2   simonb 		DPRINTF(ALLOC, ("\t4i: got slot %d, slot_offset %d, "
   1905  1.2.4.2   simonb 				"replace_len %d, "
   1906  1.2.4.2   simonb 				"vp %d, lb %d, len %d, flags %d\n",
   1907  1.2.4.2   simonb 			slot, slot_offset, replace_len,
   1908  1.2.4.2   simonb 			udf_rw16(s_ad.loc.part_num),
   1909      1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   1910      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1911      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1912      1.1  reinoud 
   1913  1.2.4.2   simonb 		/* adjust for slot offset */
   1914  1.2.4.2   simonb 		if (slot_offset) {
   1915  1.2.4.2   simonb 			DPRINTF(ALLOC, ("\t4s: skipping %d\n", slot_offset));
   1916  1.2.4.2   simonb 			lb_num += slot_offset / lb_size;
   1917  1.2.4.2   simonb 			len    -= slot_offset;
   1918  1.2.4.2   simonb 			foffset += slot_offset;
   1919  1.2.4.2   simonb 			replace_len -= slot_offset;
   1920  1.2.4.2   simonb 
   1921  1.2.4.2   simonb 			/* mark adjusted */
   1922  1.2.4.2   simonb 			slot_offset = 0;
   1923  1.2.4.2   simonb 		}
   1924  1.2.4.2   simonb 
   1925  1.2.4.2   simonb 		/* advance for (the rest of) this slot */
   1926  1.2.4.2   simonb 		replace = MIN(len, replace_len);
   1927  1.2.4.2   simonb 		DPRINTF(ALLOC, ("\t4d: replacing %d\n", replace));
   1928  1.2.4.2   simonb 
   1929  1.2.4.2   simonb 		/* advance for this slot */
   1930  1.2.4.2   simonb 		if (replace) {
   1931  1.2.4.3   simonb 			/* note: dont round DOWN on num_lb since we then
   1932  1.2.4.3   simonb 			 * forget the last partial one */
   1933  1.2.4.2   simonb 			num_lb = (replace + lb_size - 1) / lb_size;
   1934  1.2.4.2   simonb 			if (flags != UDF_EXT_FREE) {
   1935  1.2.4.2   simonb 				udf_free_allocated_space(ump, lb_num,
   1936  1.2.4.2   simonb 					udf_rw16(s_ad.loc.part_num), num_lb);
   1937      1.1  reinoud 			}
   1938  1.2.4.2   simonb 			lb_num      += num_lb;
   1939  1.2.4.2   simonb 			len         -= replace;
   1940  1.2.4.2   simonb 			foffset     += replace;
   1941  1.2.4.2   simonb 			replace_len -= replace;
   1942  1.2.4.2   simonb 		}
   1943      1.1  reinoud 
   1944  1.2.4.2   simonb 		/* do we have a slot tail ? */
   1945      1.1  reinoud 		if (len) {
   1946  1.2.4.2   simonb 			KASSERT(foffset % lb_size == 0);
   1947      1.1  reinoud 
   1948      1.1  reinoud 			/* we arrived at our point, push remainder */
   1949      1.1  reinoud 			s_ad.len        = udf_rw32(len | flags);
   1950      1.1  reinoud 			s_ad.loc.lb_num = udf_rw32(lb_num);
   1951  1.2.4.2   simonb 			if (flags == UDF_EXT_FREE)
   1952  1.2.4.2   simonb 				s_ad.loc.lb_num = udf_rw32(0);
   1953      1.1  reinoud 			node_ad_cpy[cpy_slot++] = s_ad;
   1954      1.1  reinoud 			foffset += len;
   1955      1.1  reinoud 			slot++;
   1956      1.1  reinoud 
   1957      1.1  reinoud 			DPRINTF(ALLOC, ("\t4: vp %d, lb %d, len %d, flags %d "
   1958      1.1  reinoud 				"-> stack\n",
   1959      1.1  reinoud 				udf_rw16(s_ad.loc.part_num),
   1960      1.1  reinoud 				udf_rw32(s_ad.loc.lb_num),
   1961      1.1  reinoud 				UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1962      1.1  reinoud 				UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1963      1.1  reinoud 			break;
   1964      1.1  reinoud 		}
   1965  1.2.4.2   simonb 
   1966      1.1  reinoud 		slot++;
   1967      1.1  reinoud 	}
   1968      1.1  reinoud 
   1969      1.1  reinoud 	/* 5) copy remainder */
   1970      1.1  reinoud 	for (;;) {
   1971      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   1972      1.1  reinoud 		if (eof)
   1973      1.1  reinoud 			break;
   1974      1.1  reinoud 
   1975      1.1  reinoud 		len   = udf_rw32(s_ad.len);
   1976      1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   1977      1.1  reinoud 		len   = UDF_EXT_LEN(len);
   1978      1.1  reinoud 
   1979      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   1980      1.1  reinoud 			slot++;
   1981      1.1  reinoud 			continue;
   1982      1.1  reinoud 		}
   1983      1.1  reinoud 
   1984      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   1985      1.1  reinoud 
   1986      1.1  reinoud 		DPRINTF(ALLOC, ("\t5: insert new mapping "
   1987      1.1  reinoud 			"vp %d lb %d, len %d, flags %d "
   1988      1.1  reinoud 			"-> stack\n",
   1989      1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   1990      1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   1991      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   1992      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   1993      1.1  reinoud 
   1994      1.1  reinoud 		slot++;
   1995      1.1  reinoud 	}
   1996      1.1  reinoud 
   1997      1.1  reinoud 	/* 6) reset node descriptors */
   1998      1.1  reinoud 	udf_wipe_adslots(udf_node);
   1999      1.1  reinoud 
   2000      1.1  reinoud 	/* 7) copy back extents; merge when possible. Recounting on the fly */
   2001      1.1  reinoud 	cpy_slots = cpy_slot;
   2002      1.1  reinoud 
   2003      1.1  reinoud 	c_ad = node_ad_cpy[0];
   2004      1.1  reinoud 	slot = 0;
   2005      1.1  reinoud 	DPRINTF(ALLOC, ("\t7s: stack -> got mapping vp %d "
   2006      1.1  reinoud 		"lb %d, len %d, flags %d\n",
   2007      1.1  reinoud 	udf_rw16(c_ad.loc.part_num),
   2008      1.1  reinoud 	udf_rw32(c_ad.loc.lb_num),
   2009      1.1  reinoud 	UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2010      1.1  reinoud 	UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2011      1.1  reinoud 
   2012      1.1  reinoud 	for (cpy_slot = 1; cpy_slot < cpy_slots; cpy_slot++) {
   2013      1.1  reinoud 		s_ad = node_ad_cpy[cpy_slot];
   2014      1.1  reinoud 
   2015      1.1  reinoud 		DPRINTF(ALLOC, ("\t7i: stack -> got mapping vp %d "
   2016      1.1  reinoud 			"lb %d, len %d, flags %d\n",
   2017      1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   2018      1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   2019      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2020      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2021      1.1  reinoud 
   2022      1.1  reinoud 		/* see if we can merge */
   2023      1.1  reinoud 		if (udf_ads_merge(lb_size, &c_ad, &s_ad)) {
   2024      1.1  reinoud 			/* not mergable (anymore) */
   2025      1.1  reinoud 			DPRINTF(ALLOC, ("\t7: appending vp %d lb %d, "
   2026      1.1  reinoud 				"len %d, flags %d\n",
   2027      1.1  reinoud 			udf_rw16(c_ad.loc.part_num),
   2028      1.1  reinoud 			udf_rw32(c_ad.loc.lb_num),
   2029      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2030      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2031      1.1  reinoud 
   2032  1.2.4.3   simonb 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   2033      1.1  reinoud 			if (error) {
   2034      1.1  reinoud 				buf->b_error = error;
   2035      1.1  reinoud 				goto out;
   2036      1.1  reinoud 			}
   2037      1.1  reinoud 			c_ad = s_ad;
   2038      1.1  reinoud 			slot++;
   2039      1.1  reinoud 		}
   2040      1.1  reinoud 	}
   2041      1.1  reinoud 
   2042      1.1  reinoud 	/* 8) push rest slot (if any) */
   2043      1.1  reinoud 	if (UDF_EXT_LEN(c_ad.len) > 0) {
   2044      1.1  reinoud 		DPRINTF(ALLOC, ("\t8: last append vp %d lb %d, "
   2045      1.1  reinoud 				"len %d, flags %d\n",
   2046      1.1  reinoud 		udf_rw16(c_ad.loc.part_num),
   2047      1.1  reinoud 		udf_rw32(c_ad.loc.lb_num),
   2048      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2049      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2050      1.1  reinoud 
   2051  1.2.4.3   simonb 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   2052      1.1  reinoud 		if (error) {
   2053      1.1  reinoud 			buf->b_error = error;
   2054      1.1  reinoud 			goto out;
   2055      1.1  reinoud 		}
   2056      1.1  reinoud 	}
   2057      1.1  reinoud 
   2058      1.1  reinoud out:
   2059  1.2.4.3   simonb 	udf_count_alloc_exts(udf_node);
   2060  1.2.4.3   simonb 
   2061      1.1  reinoud 	/* the node's descriptors should now be sane */
   2062      1.1  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2063  1.2.4.2   simonb 	UDF_UNLOCK_NODE(udf_node, 0);
   2064      1.1  reinoud 
   2065      1.1  reinoud 	KASSERT(orig_inflen == new_inflen);
   2066      1.1  reinoud 	KASSERT(new_lbrec >= orig_lbrec);
   2067      1.1  reinoud 
   2068      1.1  reinoud 	return;
   2069      1.1  reinoud }
   2070      1.1  reinoud 
   2071      1.1  reinoud /* --------------------------------------------------------------------- */
   2072      1.1  reinoud 
   2073      1.1  reinoud int
   2074      1.1  reinoud udf_grow_node(struct udf_node *udf_node, uint64_t new_size)
   2075      1.1  reinoud {
   2076      1.1  reinoud 	union dscrptr *dscr;
   2077      1.1  reinoud 	struct vnode *vp = udf_node->vnode;
   2078      1.1  reinoud 	struct udf_mount *ump = udf_node->ump;
   2079      1.1  reinoud 	struct file_entry    *fe;
   2080      1.1  reinoud 	struct extfile_entry *efe;
   2081      1.1  reinoud 	struct icb_tag  *icbtag;
   2082      1.1  reinoud 	struct long_ad c_ad, s_ad;
   2083      1.1  reinoud 	uint64_t size_diff, old_size, inflen, objsize, chunk, append_len;
   2084      1.1  reinoud 	uint64_t foffset, end_foffset;
   2085      1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   2086      1.1  reinoud 	uint32_t lb_size, dscr_size, crclen, lastblock_grow;
   2087      1.1  reinoud 	uint32_t len, flags, max_len;
   2088      1.1  reinoud 	uint32_t max_l_ad, l_ad, l_ea;
   2089      1.1  reinoud 	uint8_t *data_pos, *evacuated_data;
   2090      1.1  reinoud 	int icbflags, addr_type;
   2091      1.1  reinoud 	int slot, cpy_slot;
   2092  1.2.4.4   simonb 	int isdir, eof, error;
   2093      1.1  reinoud 
   2094      1.1  reinoud 	DPRINTF(ALLOC, ("udf_grow_node\n"));
   2095      1.1  reinoud 
   2096      1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);
   2097  1.2.4.2   simonb 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   2098  1.2.4.2   simonb 
   2099      1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   2100      1.1  reinoud 	max_len = ((UDF_EXT_MAXLEN / lb_size) * lb_size);
   2101      1.1  reinoud 
   2102      1.1  reinoud 	fe  = udf_node->fe;
   2103      1.1  reinoud 	efe = udf_node->efe;
   2104      1.1  reinoud 	if (fe) {
   2105      1.1  reinoud 		dscr       = (union dscrptr *) fe;
   2106      1.1  reinoud 		icbtag  = &fe->icbtag;
   2107      1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   2108      1.1  reinoud 		objsize = inflen;
   2109      1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   2110      1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   2111      1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   2112      1.1  reinoud 	} else {
   2113      1.1  reinoud 		dscr       = (union dscrptr *) efe;
   2114      1.1  reinoud 		icbtag  = &efe->icbtag;
   2115      1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   2116      1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   2117      1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   2118      1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   2119      1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   2120      1.1  reinoud 	}
   2121      1.1  reinoud 	data_pos  = (uint8_t *) dscr + dscr_size + l_ea;
   2122      1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   2123      1.1  reinoud 
   2124      1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
   2125      1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2126      1.1  reinoud 
   2127      1.1  reinoud 	old_size  = inflen;
   2128      1.1  reinoud 	size_diff = new_size - old_size;
   2129      1.1  reinoud 
   2130      1.1  reinoud 	DPRINTF(ALLOC, ("\tfrom %"PRIu64" to %"PRIu64"\n", old_size, new_size));
   2131      1.1  reinoud 
   2132      1.1  reinoud 	evacuated_data = NULL;
   2133      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   2134      1.1  reinoud 		if (l_ad + size_diff <= max_l_ad) {
   2135      1.1  reinoud 			/* only reflect size change directly in the node */
   2136      1.1  reinoud 			inflen  += size_diff;
   2137      1.1  reinoud 			objsize += size_diff;
   2138      1.1  reinoud 			l_ad    += size_diff;
   2139      1.1  reinoud 			crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   2140      1.1  reinoud 			if (fe) {
   2141      1.1  reinoud 				fe->inf_len   = udf_rw64(inflen);
   2142      1.1  reinoud 				fe->l_ad      = udf_rw32(l_ad);
   2143      1.1  reinoud 				fe->tag.desc_crc_len = udf_rw32(crclen);
   2144      1.1  reinoud 			} else {
   2145      1.1  reinoud 				efe->inf_len  = udf_rw64(inflen);
   2146      1.1  reinoud 				efe->obj_size = udf_rw64(objsize);
   2147      1.1  reinoud 				efe->l_ad     = udf_rw32(l_ad);
   2148      1.1  reinoud 				efe->tag.desc_crc_len = udf_rw32(crclen);
   2149      1.1  reinoud 			}
   2150      1.1  reinoud 			error = 0;
   2151      1.1  reinoud 
   2152      1.1  reinoud 			/* set new size for uvm */
   2153      1.1  reinoud 			uvm_vnp_setsize(vp, old_size);
   2154      1.1  reinoud 			uvm_vnp_setwritesize(vp, new_size);
   2155      1.1  reinoud 
   2156      1.1  reinoud #if 0
   2157      1.1  reinoud 			/* zero append space in buffer */
   2158      1.1  reinoud 			uvm_vnp_zerorange(vp, old_size, new_size - old_size);
   2159      1.1  reinoud #endif
   2160      1.1  reinoud 
   2161  1.2.4.2   simonb 			udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2162  1.2.4.2   simonb 
   2163      1.1  reinoud 			/* unlock */
   2164      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2165      1.1  reinoud 
   2166      1.1  reinoud 			KASSERT(new_inflen == orig_inflen + size_diff);
   2167      1.1  reinoud 			KASSERT(new_lbrec == orig_lbrec);
   2168      1.1  reinoud 			KASSERT(new_lbrec == 0);
   2169      1.1  reinoud 			return 0;
   2170      1.1  reinoud 		}
   2171      1.1  reinoud 
   2172      1.1  reinoud 		DPRINTF(ALLOC, ("\tCONVERT from internal\n"));
   2173      1.1  reinoud 
   2174      1.1  reinoud 		if (old_size > 0) {
   2175      1.1  reinoud 			/* allocate some space and copy in the stuff to keep */
   2176      1.1  reinoud 			evacuated_data = malloc(lb_size, M_UDFTEMP, M_WAITOK);
   2177      1.1  reinoud 			memset(evacuated_data, 0, lb_size);
   2178      1.1  reinoud 
   2179      1.1  reinoud 			/* node is locked, so safe to exit mutex */
   2180      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2181      1.1  reinoud 
   2182      1.1  reinoud 			/* read in using the `normal' vn_rdwr() */
   2183      1.1  reinoud 			error = vn_rdwr(UIO_READ, udf_node->vnode,
   2184      1.1  reinoud 					evacuated_data, old_size, 0,
   2185      1.1  reinoud 					UIO_SYSSPACE, IO_ALTSEMANTICS | IO_NODELOCKED,
   2186      1.1  reinoud 					FSCRED, NULL, NULL);
   2187      1.1  reinoud 
   2188      1.1  reinoud 			/* enter again */
   2189      1.1  reinoud 			UDF_LOCK_NODE(udf_node, 0);
   2190      1.1  reinoud 		}
   2191      1.1  reinoud 
   2192  1.2.4.4   simonb 		/* convert to a normal alloc and select type */
   2193  1.2.4.4   simonb 		isdir = (vp->v_type == VDIR);
   2194  1.2.4.4   simonb 
   2195      1.1  reinoud 		icbflags &= ~UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2196  1.2.4.4   simonb 		icbflags |=  isdir ? ump->meta_allocdscr : ump->data_allocdscr;
   2197      1.1  reinoud 		icbtag->flags = udf_rw16(icbflags);
   2198      1.1  reinoud 
   2199      1.1  reinoud 		/* wipe old descriptor space */
   2200      1.1  reinoud 		udf_wipe_adslots(udf_node);
   2201      1.1  reinoud 
   2202      1.1  reinoud 		memset(&c_ad, 0, sizeof(struct long_ad));
   2203      1.1  reinoud 		c_ad.len          = udf_rw32(old_size | UDF_EXT_FREE);
   2204      1.1  reinoud 		c_ad.loc.part_num = udf_rw16(0); /* not relevant */
   2205      1.1  reinoud 		c_ad.loc.lb_num   = udf_rw32(0); /* not relevant */
   2206      1.1  reinoud 
   2207      1.1  reinoud 		slot = 0;
   2208      1.1  reinoud 	} else {
   2209      1.1  reinoud 		/* goto the last entry (if any) */
   2210      1.1  reinoud 		slot     = 0;
   2211      1.1  reinoud 		cpy_slot = 0;
   2212      1.1  reinoud 		foffset  = 0;
   2213      1.1  reinoud 		memset(&c_ad, 0, sizeof(struct long_ad));
   2214      1.1  reinoud 		for (;;) {
   2215      1.1  reinoud 			udf_get_adslot(udf_node, slot, &c_ad, &eof);
   2216      1.1  reinoud 			if (eof)
   2217      1.1  reinoud 				break;
   2218      1.1  reinoud 
   2219      1.1  reinoud 			len   = udf_rw32(c_ad.len);
   2220      1.1  reinoud 			flags = UDF_EXT_FLAGS(len);
   2221      1.1  reinoud 			len   = UDF_EXT_LEN(len);
   2222      1.1  reinoud 
   2223      1.1  reinoud 			end_foffset = foffset + len;
   2224      1.1  reinoud 			if (flags != UDF_EXT_REDIRECT)
   2225      1.1  reinoud 				foffset = end_foffset;
   2226      1.1  reinoud 
   2227      1.1  reinoud 			slot++;
   2228      1.1  reinoud 		}
   2229      1.1  reinoud 		/* at end of adslots */
   2230      1.1  reinoud 
   2231      1.1  reinoud 		/* special case if the old size was zero, then there is no last slot */
   2232      1.1  reinoud 		if (old_size == 0) {
   2233      1.1  reinoud 			c_ad.len          = udf_rw32(0 | UDF_EXT_FREE);
   2234      1.1  reinoud 			c_ad.loc.part_num = udf_rw16(0); /* not relevant */
   2235      1.1  reinoud 			c_ad.loc.lb_num   = udf_rw32(0); /* not relevant */
   2236      1.1  reinoud 		} else {
   2237      1.1  reinoud 			/* refetch last slot */
   2238      1.1  reinoud 			slot--;
   2239      1.1  reinoud 			udf_get_adslot(udf_node, slot, &c_ad, &eof);
   2240      1.1  reinoud 		}
   2241      1.1  reinoud 	}
   2242      1.1  reinoud 
   2243      1.1  reinoud 	/*
   2244      1.1  reinoud 	 * If the length of the last slot is not a multiple of lb_size, adjust
   2245      1.1  reinoud 	 * length so that it is; don't forget to adjust `append_len'! relevant for
   2246      1.1  reinoud 	 * extending existing files
   2247      1.1  reinoud 	 */
   2248      1.1  reinoud 	len   = udf_rw32(c_ad.len);
   2249      1.1  reinoud 	flags = UDF_EXT_FLAGS(len);
   2250      1.1  reinoud 	len   = UDF_EXT_LEN(len);
   2251      1.1  reinoud 
   2252      1.1  reinoud 	lastblock_grow = 0;
   2253      1.1  reinoud 	if (len % lb_size > 0) {
   2254      1.1  reinoud 		lastblock_grow = lb_size - (len % lb_size);
   2255      1.1  reinoud 		lastblock_grow = MIN(size_diff, lastblock_grow);
   2256      1.1  reinoud 		len += lastblock_grow;
   2257      1.1  reinoud 		c_ad.len = udf_rw32(len | flags);
   2258      1.1  reinoud 
   2259      1.1  reinoud 		/* TODO zero appened space in buffer! */
   2260      1.1  reinoud 		/* using uvm_vnp_zerorange(vp, old_size, new_size - old_size); ? */
   2261      1.1  reinoud 	}
   2262      1.1  reinoud 	memset(&s_ad, 0, sizeof(struct long_ad));
   2263      1.1  reinoud 
   2264      1.1  reinoud 	/* size_diff can be bigger than allowed, so grow in chunks */
   2265      1.1  reinoud 	append_len = size_diff - lastblock_grow;
   2266      1.1  reinoud 	while (append_len > 0) {
   2267      1.1  reinoud 		chunk = MIN(append_len, max_len);
   2268      1.1  reinoud 		s_ad.len = udf_rw32(chunk | UDF_EXT_FREE);
   2269      1.1  reinoud 		s_ad.loc.part_num = udf_rw16(0);
   2270      1.1  reinoud 		s_ad.loc.lb_num   = udf_rw32(0);
   2271      1.1  reinoud 
   2272      1.1  reinoud 		if (udf_ads_merge(lb_size, &c_ad, &s_ad)) {
   2273      1.1  reinoud 			/* not mergable (anymore) */
   2274  1.2.4.3   simonb 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   2275      1.1  reinoud 			if (error)
   2276      1.1  reinoud 				goto errorout;
   2277      1.1  reinoud 			slot++;
   2278      1.1  reinoud 			c_ad = s_ad;
   2279      1.1  reinoud 			memset(&s_ad, 0, sizeof(struct long_ad));
   2280      1.1  reinoud 		}
   2281      1.1  reinoud 		append_len -= chunk;
   2282      1.1  reinoud 	}
   2283      1.1  reinoud 
   2284      1.1  reinoud 	/* if there is a rest piece in the accumulator, append it */
   2285  1.2.4.2   simonb 	if (UDF_EXT_LEN(udf_rw32(c_ad.len)) > 0) {
   2286  1.2.4.3   simonb 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   2287      1.1  reinoud 		if (error)
   2288      1.1  reinoud 			goto errorout;
   2289      1.1  reinoud 		slot++;
   2290      1.1  reinoud 	}
   2291      1.1  reinoud 
   2292      1.1  reinoud 	/* if there is a rest piece that didn't fit, append it */
   2293  1.2.4.2   simonb 	if (UDF_EXT_LEN(udf_rw32(s_ad.len)) > 0) {
   2294  1.2.4.3   simonb 		error = udf_append_adslot(udf_node, &slot, &s_ad);
   2295      1.1  reinoud 		if (error)
   2296      1.1  reinoud 			goto errorout;
   2297      1.1  reinoud 		slot++;
   2298      1.1  reinoud 	}
   2299      1.1  reinoud 
   2300      1.1  reinoud 	inflen  += size_diff;
   2301      1.1  reinoud 	objsize += size_diff;
   2302      1.1  reinoud 	if (fe) {
   2303      1.1  reinoud 		fe->inf_len   = udf_rw64(inflen);
   2304      1.1  reinoud 	} else {
   2305      1.1  reinoud 		efe->inf_len  = udf_rw64(inflen);
   2306      1.1  reinoud 		efe->obj_size = udf_rw64(objsize);
   2307      1.1  reinoud 	}
   2308      1.1  reinoud 	error = 0;
   2309      1.1  reinoud 
   2310      1.1  reinoud 	if (evacuated_data) {
   2311      1.1  reinoud 		/* set new write size for uvm */
   2312      1.1  reinoud 		uvm_vnp_setwritesize(vp, old_size);
   2313      1.1  reinoud 
   2314      1.1  reinoud 		/* write out evacuated data */
   2315      1.1  reinoud 		error = vn_rdwr(UIO_WRITE, udf_node->vnode,
   2316      1.1  reinoud 				evacuated_data, old_size, 0,
   2317      1.1  reinoud 				UIO_SYSSPACE, IO_ALTSEMANTICS | IO_NODELOCKED,
   2318      1.1  reinoud 				FSCRED, NULL, NULL);
   2319      1.1  reinoud 		uvm_vnp_setsize(vp, old_size);
   2320      1.1  reinoud 	}
   2321      1.1  reinoud 
   2322      1.1  reinoud errorout:
   2323      1.1  reinoud 	if (evacuated_data)
   2324      1.1  reinoud 		free(evacuated_data, M_UDFTEMP);
   2325      1.1  reinoud 
   2326  1.2.4.3   simonb 	udf_count_alloc_exts(udf_node);
   2327  1.2.4.3   simonb 
   2328      1.1  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2329  1.2.4.2   simonb 	UDF_UNLOCK_NODE(udf_node, 0);
   2330  1.2.4.2   simonb 
   2331      1.1  reinoud 	KASSERT(new_inflen == orig_inflen + size_diff);
   2332      1.1  reinoud 	KASSERT(new_lbrec == orig_lbrec);
   2333      1.1  reinoud 
   2334      1.1  reinoud 	return error;
   2335      1.1  reinoud }
   2336      1.1  reinoud 
   2337      1.1  reinoud /* --------------------------------------------------------------------- */
   2338      1.1  reinoud 
   2339      1.1  reinoud int
   2340      1.1  reinoud udf_shrink_node(struct udf_node *udf_node, uint64_t new_size)
   2341      1.1  reinoud {
   2342      1.1  reinoud 	struct vnode *vp = udf_node->vnode;
   2343      1.1  reinoud 	struct udf_mount *ump = udf_node->ump;
   2344      1.1  reinoud 	struct file_entry    *fe;
   2345      1.1  reinoud 	struct extfile_entry *efe;
   2346      1.1  reinoud 	struct icb_tag  *icbtag;
   2347      1.1  reinoud 	struct long_ad c_ad, s_ad, *node_ad_cpy;
   2348      1.1  reinoud 	uint64_t size_diff, old_size, inflen, objsize;
   2349      1.1  reinoud 	uint64_t foffset, end_foffset;
   2350      1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   2351      1.1  reinoud 	uint32_t lb_size, dscr_size, crclen;
   2352      1.1  reinoud 	uint32_t slot_offset;
   2353      1.1  reinoud 	uint32_t len, flags, max_len;
   2354      1.1  reinoud 	uint32_t num_lb, lb_num;
   2355      1.1  reinoud 	uint32_t max_l_ad, l_ad, l_ea;
   2356      1.1  reinoud 	uint16_t vpart_num;
   2357      1.1  reinoud 	uint8_t *data_pos;
   2358      1.1  reinoud 	int icbflags, addr_type;
   2359      1.1  reinoud 	int slot, cpy_slot, cpy_slots;
   2360      1.1  reinoud 	int eof, error;
   2361      1.1  reinoud 
   2362      1.1  reinoud 	DPRINTF(ALLOC, ("udf_shrink_node\n"));
   2363      1.1  reinoud 
   2364      1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);
   2365  1.2.4.2   simonb 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   2366  1.2.4.2   simonb 
   2367      1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   2368      1.1  reinoud 	max_len = ((UDF_EXT_MAXLEN / lb_size) * lb_size);
   2369      1.1  reinoud 
   2370      1.1  reinoud 	/* do the work */
   2371      1.1  reinoud 	fe  = udf_node->fe;
   2372      1.1  reinoud 	efe = udf_node->efe;
   2373      1.1  reinoud 	if (fe) {
   2374      1.1  reinoud 		icbtag  = &fe->icbtag;
   2375      1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   2376      1.1  reinoud 		objsize = inflen;
   2377      1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   2378      1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   2379      1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   2380      1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   2381      1.1  reinoud 	} else {
   2382      1.1  reinoud 		icbtag  = &efe->icbtag;
   2383      1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   2384      1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   2385      1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   2386      1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   2387      1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   2388      1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   2389      1.1  reinoud 	}
   2390      1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   2391      1.1  reinoud 
   2392      1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
   2393      1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2394      1.1  reinoud 
   2395      1.1  reinoud 	old_size  = inflen;
   2396      1.1  reinoud 	size_diff = old_size - new_size;
   2397      1.1  reinoud 
   2398      1.1  reinoud 	DPRINTF(ALLOC, ("\tfrom %"PRIu64" to %"PRIu64"\n", old_size, new_size));
   2399      1.1  reinoud 
   2400      1.1  reinoud 	/* shrink the node to its new size */
   2401      1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   2402      1.1  reinoud 		/* only reflect size change directly in the node */
   2403      1.1  reinoud 		KASSERT(new_size <= max_l_ad);
   2404      1.1  reinoud 		inflen  -= size_diff;
   2405      1.1  reinoud 		objsize -= size_diff;
   2406      1.1  reinoud 		l_ad    -= size_diff;
   2407      1.1  reinoud 		crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   2408      1.1  reinoud 		if (fe) {
   2409      1.1  reinoud 			fe->inf_len   = udf_rw64(inflen);
   2410      1.1  reinoud 			fe->l_ad      = udf_rw32(l_ad);
   2411      1.1  reinoud 			fe->tag.desc_crc_len = udf_rw32(crclen);
   2412      1.1  reinoud 		} else {
   2413      1.1  reinoud 			efe->inf_len  = udf_rw64(inflen);
   2414      1.1  reinoud 			efe->obj_size = udf_rw64(objsize);
   2415      1.1  reinoud 			efe->l_ad     = udf_rw32(l_ad);
   2416      1.1  reinoud 			efe->tag.desc_crc_len = udf_rw32(crclen);
   2417      1.1  reinoud 		}
   2418      1.1  reinoud 		error = 0;
   2419  1.2.4.2   simonb 
   2420  1.2.4.2   simonb 		/* clear the space in the descriptor */
   2421  1.2.4.2   simonb 		KASSERT(old_size > new_size);
   2422  1.2.4.2   simonb 		memset(data_pos + new_size, 0, old_size - new_size);
   2423  1.2.4.2   simonb 
   2424      1.1  reinoud 		/* TODO zero appened space in buffer! */
   2425      1.1  reinoud 		/* using uvm_vnp_zerorange(vp, old_size, old_size - new_size); ? */
   2426      1.1  reinoud 
   2427      1.1  reinoud 		/* set new size for uvm */
   2428      1.1  reinoud 		uvm_vnp_setsize(vp, new_size);
   2429      1.1  reinoud 
   2430      1.1  reinoud 		udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2431  1.2.4.2   simonb 		UDF_UNLOCK_NODE(udf_node, 0);
   2432  1.2.4.2   simonb 
   2433      1.1  reinoud 		KASSERT(new_inflen == orig_inflen - size_diff);
   2434      1.1  reinoud 		KASSERT(new_lbrec == orig_lbrec);
   2435      1.1  reinoud 		KASSERT(new_lbrec == 0);
   2436      1.1  reinoud 
   2437      1.1  reinoud 		return 0;
   2438      1.1  reinoud 	}
   2439      1.1  reinoud 
   2440      1.1  reinoud 	/* setup node cleanup extents copy space */
   2441      1.1  reinoud 	node_ad_cpy = malloc(lb_size * UDF_MAX_ALLOC_EXTENTS,
   2442      1.1  reinoud 		M_UDFMNT, M_WAITOK);
   2443      1.1  reinoud 	memset(node_ad_cpy, 0, lb_size * UDF_MAX_ALLOC_EXTENTS);
   2444      1.1  reinoud 
   2445      1.1  reinoud 	/*
   2446      1.1  reinoud 	 * Shrink the node by releasing the allocations and truncate the last
   2447      1.1  reinoud 	 * allocation to the new size. If the new size fits into the
   2448      1.1  reinoud 	 * allocation descriptor itself, transform it into an
   2449      1.1  reinoud 	 * UDF_ICB_INTERN_ALLOC.
   2450      1.1  reinoud 	 */
   2451      1.1  reinoud 	slot     = 0;
   2452      1.1  reinoud 	cpy_slot = 0;
   2453      1.1  reinoud 	foffset  = 0;
   2454      1.1  reinoud 
   2455      1.1  reinoud 	/* 1) copy till first overlap piece to the rewrite buffer */
   2456      1.1  reinoud 	for (;;) {
   2457      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2458      1.1  reinoud 		if (eof) {
   2459      1.1  reinoud 			DPRINTF(WRITE,
   2460      1.1  reinoud 				("Shrink node failed: "
   2461      1.1  reinoud 				 "encountered EOF\n"));
   2462      1.1  reinoud 			error = EINVAL;
   2463      1.1  reinoud 			goto errorout; /* panic? */
   2464      1.1  reinoud 		}
   2465      1.1  reinoud 		len   = udf_rw32(s_ad.len);
   2466      1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   2467      1.1  reinoud 		len   = UDF_EXT_LEN(len);
   2468      1.1  reinoud 
   2469      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   2470      1.1  reinoud 			slot++;
   2471      1.1  reinoud 			continue;
   2472      1.1  reinoud 		}
   2473      1.1  reinoud 
   2474      1.1  reinoud 		end_foffset = foffset + len;
   2475      1.1  reinoud 		if (end_foffset > new_size)
   2476      1.1  reinoud 			break;	/* found */
   2477      1.1  reinoud 
   2478      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2479      1.1  reinoud 
   2480      1.1  reinoud 		DPRINTF(ALLOC, ("\t1: vp %d, lb %d, len %d, flags %d "
   2481      1.1  reinoud 			"-> stack\n",
   2482      1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   2483      1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   2484      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2485      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2486      1.1  reinoud 
   2487      1.1  reinoud 		foffset = end_foffset;
   2488      1.1  reinoud 		slot++;
   2489      1.1  reinoud 	}
   2490      1.1  reinoud 	slot_offset = new_size - foffset;
   2491      1.1  reinoud 
   2492      1.1  reinoud 	/* 2) trunc overlapping slot at overlap and copy it */
   2493      1.1  reinoud 	if (slot_offset > 0) {
   2494      1.1  reinoud 		lb_num    = udf_rw32(s_ad.loc.lb_num);
   2495      1.1  reinoud 		vpart_num = udf_rw16(s_ad.loc.part_num);
   2496      1.1  reinoud 
   2497      1.1  reinoud 		if (flags == UDF_EXT_ALLOCATED) {
   2498  1.2.4.3   simonb 			/* note: round DOWN on num_lb */
   2499      1.1  reinoud 			lb_num += (slot_offset + lb_size -1) / lb_size;
   2500  1.2.4.3   simonb 			num_lb  = (len - slot_offset) / lb_size;
   2501      1.1  reinoud 
   2502      1.1  reinoud 			udf_free_allocated_space(ump, lb_num, vpart_num, num_lb);
   2503      1.1  reinoud 		}
   2504      1.1  reinoud 
   2505      1.1  reinoud 		s_ad.len = udf_rw32(slot_offset | flags);
   2506      1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2507      1.1  reinoud 		slot++;
   2508      1.1  reinoud 
   2509      1.1  reinoud 		DPRINTF(ALLOC, ("\t2: vp %d, lb %d, len %d, flags %d "
   2510      1.1  reinoud 			"-> stack\n",
   2511      1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   2512      1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   2513      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2514      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2515      1.1  reinoud 	}
   2516      1.1  reinoud 
   2517      1.1  reinoud 	/* 3) delete remainder */
   2518      1.1  reinoud 	for (;;) {
   2519      1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2520      1.1  reinoud 		if (eof)
   2521      1.1  reinoud 			break;
   2522      1.1  reinoud 
   2523      1.1  reinoud 		len       = udf_rw32(s_ad.len);
   2524      1.1  reinoud 		flags     = UDF_EXT_FLAGS(len);
   2525      1.1  reinoud 		len       = UDF_EXT_LEN(len);
   2526      1.1  reinoud 
   2527      1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   2528      1.1  reinoud 			slot++;
   2529      1.1  reinoud 			continue;
   2530      1.1  reinoud 		}
   2531      1.1  reinoud 
   2532      1.1  reinoud 		DPRINTF(ALLOC, ("\t3: delete remainder "
   2533      1.1  reinoud 			"vp %d lb %d, len %d, flags %d\n",
   2534      1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   2535      1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   2536      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2537      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2538      1.1  reinoud 
   2539      1.1  reinoud 		if (flags == UDF_EXT_ALLOCATED) {
   2540      1.1  reinoud 			lb_num    = udf_rw32(s_ad.loc.lb_num);
   2541      1.1  reinoud 			vpart_num = udf_rw16(s_ad.loc.part_num);
   2542      1.1  reinoud 			num_lb    = (len + lb_size - 1) / lb_size;
   2543      1.1  reinoud 
   2544      1.1  reinoud 			udf_free_allocated_space(ump, lb_num, vpart_num,
   2545      1.1  reinoud 				num_lb);
   2546      1.1  reinoud 		}
   2547      1.1  reinoud 
   2548      1.1  reinoud 		slot++;
   2549      1.1  reinoud 	}
   2550      1.1  reinoud 
   2551      1.1  reinoud 	/* 4) if it will fit into the descriptor then convert */
   2552      1.1  reinoud 	if (new_size < max_l_ad) {
   2553      1.1  reinoud 		/*
   2554      1.1  reinoud 		 * resque/evacuate old piece by reading it in, and convert it
   2555      1.1  reinoud 		 * to internal alloc.
   2556      1.1  reinoud 		 */
   2557      1.1  reinoud 		if (new_size == 0) {
   2558      1.1  reinoud 			/* XXX/TODO only for zero sizing now */
   2559      1.1  reinoud 			udf_wipe_adslots(udf_node);
   2560      1.1  reinoud 
   2561      1.1  reinoud 			icbflags &= ~UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2562      1.1  reinoud 			icbflags |=  UDF_ICB_INTERN_ALLOC;
   2563      1.1  reinoud 			icbtag->flags = udf_rw16(icbflags);
   2564      1.1  reinoud 
   2565      1.1  reinoud 			inflen  -= size_diff;	KASSERT(inflen == 0);
   2566      1.1  reinoud 			objsize -= size_diff;
   2567      1.1  reinoud 			l_ad     = new_size;
   2568      1.1  reinoud 			crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   2569      1.1  reinoud 			if (fe) {
   2570      1.1  reinoud 				fe->inf_len   = udf_rw64(inflen);
   2571      1.1  reinoud 				fe->l_ad      = udf_rw32(l_ad);
   2572      1.1  reinoud 				fe->tag.desc_crc_len = udf_rw32(crclen);
   2573      1.1  reinoud 			} else {
   2574      1.1  reinoud 				efe->inf_len  = udf_rw64(inflen);
   2575      1.1  reinoud 				efe->obj_size = udf_rw64(objsize);
   2576      1.1  reinoud 				efe->l_ad     = udf_rw32(l_ad);
   2577      1.1  reinoud 				efe->tag.desc_crc_len = udf_rw32(crclen);
   2578      1.1  reinoud 			}
   2579      1.1  reinoud 			/* eventually copy in evacuated piece */
   2580      1.1  reinoud 			/* set new size for uvm */
   2581      1.1  reinoud 			uvm_vnp_setsize(vp, new_size);
   2582      1.1  reinoud 
   2583      1.1  reinoud 			free(node_ad_cpy, M_UDFMNT);
   2584  1.2.4.2   simonb 			udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2585  1.2.4.2   simonb 
   2586      1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2587      1.1  reinoud 
   2588      1.1  reinoud 			KASSERT(new_inflen == orig_inflen - size_diff);
   2589      1.1  reinoud 			KASSERT(new_inflen == 0);
   2590      1.1  reinoud 			KASSERT(new_lbrec == 0);
   2591      1.1  reinoud 
   2592      1.1  reinoud 			return 0;
   2593      1.1  reinoud 		}
   2594      1.1  reinoud 
   2595      1.1  reinoud 		printf("UDF_SHRINK_NODE: could convert to internal alloc!\n");
   2596      1.1  reinoud 	}
   2597      1.1  reinoud 
   2598      1.1  reinoud 	/* 5) reset node descriptors */
   2599      1.1  reinoud 	udf_wipe_adslots(udf_node);
   2600      1.1  reinoud 
   2601      1.1  reinoud 	/* 6) copy back extents; merge when possible. Recounting on the fly */
   2602      1.1  reinoud 	cpy_slots = cpy_slot;
   2603      1.1  reinoud 
   2604      1.1  reinoud 	c_ad = node_ad_cpy[0];
   2605      1.1  reinoud 	slot = 0;
   2606      1.1  reinoud 	for (cpy_slot = 1; cpy_slot < cpy_slots; cpy_slot++) {
   2607      1.1  reinoud 		s_ad = node_ad_cpy[cpy_slot];
   2608      1.1  reinoud 
   2609      1.1  reinoud 		DPRINTF(ALLOC, ("\t6: stack -> got mapping vp %d "
   2610      1.1  reinoud 			"lb %d, len %d, flags %d\n",
   2611      1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   2612      1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   2613      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2614      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2615      1.1  reinoud 
   2616      1.1  reinoud 		/* see if we can merge */
   2617      1.1  reinoud 		if (udf_ads_merge(lb_size, &c_ad, &s_ad)) {
   2618      1.1  reinoud 			/* not mergable (anymore) */
   2619      1.1  reinoud 			DPRINTF(ALLOC, ("\t6: appending vp %d lb %d, "
   2620      1.1  reinoud 				"len %d, flags %d\n",
   2621      1.1  reinoud 			udf_rw16(c_ad.loc.part_num),
   2622      1.1  reinoud 			udf_rw32(c_ad.loc.lb_num),
   2623      1.1  reinoud 			UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2624      1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2625      1.1  reinoud 
   2626  1.2.4.3   simonb 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   2627      1.1  reinoud 			if (error)
   2628      1.1  reinoud 				goto errorout; /* panic? */
   2629      1.1  reinoud 			c_ad = s_ad;
   2630      1.1  reinoud 			slot++;
   2631      1.1  reinoud 		}
   2632      1.1  reinoud 	}
   2633      1.1  reinoud 
   2634      1.1  reinoud 	/* 7) push rest slot (if any) */
   2635      1.1  reinoud 	if (UDF_EXT_LEN(c_ad.len) > 0) {
   2636      1.1  reinoud 		DPRINTF(ALLOC, ("\t7: last append vp %d lb %d, "
   2637      1.1  reinoud 				"len %d, flags %d\n",
   2638      1.1  reinoud 		udf_rw16(c_ad.loc.part_num),
   2639      1.1  reinoud 		udf_rw32(c_ad.loc.lb_num),
   2640      1.1  reinoud 		UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2641      1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2642      1.1  reinoud 
   2643  1.2.4.3   simonb 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   2644      1.1  reinoud 		if (error)
   2645      1.1  reinoud 			goto errorout; /* panic? */
   2646      1.1  reinoud 		;
   2647      1.1  reinoud 	}
   2648      1.1  reinoud 
   2649      1.1  reinoud 	inflen  -= size_diff;
   2650      1.1  reinoud 	objsize -= size_diff;
   2651      1.1  reinoud 	if (fe) {
   2652      1.1  reinoud 		fe->inf_len   = udf_rw64(inflen);
   2653      1.1  reinoud 	} else {
   2654      1.1  reinoud 		efe->inf_len  = udf_rw64(inflen);
   2655      1.1  reinoud 		efe->obj_size = udf_rw64(objsize);
   2656      1.1  reinoud 	}
   2657      1.1  reinoud 	error = 0;
   2658      1.1  reinoud 
   2659      1.1  reinoud 	/* set new size for uvm */
   2660      1.1  reinoud 	uvm_vnp_setsize(vp, new_size);
   2661      1.1  reinoud 
   2662      1.1  reinoud errorout:
   2663      1.1  reinoud 	free(node_ad_cpy, M_UDFMNT);
   2664      1.1  reinoud 
   2665  1.2.4.3   simonb 	udf_count_alloc_exts(udf_node);
   2666  1.2.4.3   simonb 
   2667      1.1  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2668  1.2.4.2   simonb 	UDF_UNLOCK_NODE(udf_node, 0);
   2669  1.2.4.2   simonb 
   2670      1.1  reinoud 	KASSERT(new_inflen == orig_inflen - size_diff);
   2671      1.1  reinoud 
   2672      1.1  reinoud 	return error;
   2673      1.1  reinoud }
   2674      1.1  reinoud 
   2675