Home | History | Annotate | Line # | Download | only in udf
udf_allocation.c revision 1.32.22.1
      1  1.32.22.1   bouyer /* $NetBSD: udf_allocation.c,v 1.32.22.1 2013/09/07 15:58:31 bouyer 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.32.22.1   bouyer __KERNEL_RCSID(0, "$NetBSD: udf_allocation.c,v 1.32.22.1 2013/09/07 15:58:31 bouyer 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_compat_netbsd.h"
     37        1.1  reinoud #endif
     38        1.1  reinoud 
     39        1.1  reinoud /* TODO strip */
     40        1.1  reinoud #include <sys/param.h>
     41        1.1  reinoud #include <sys/systm.h>
     42        1.1  reinoud #include <sys/sysctl.h>
     43        1.1  reinoud #include <sys/namei.h>
     44        1.1  reinoud #include <sys/proc.h>
     45        1.1  reinoud #include <sys/kernel.h>
     46        1.1  reinoud #include <sys/vnode.h>
     47        1.1  reinoud #include <miscfs/genfs/genfs_node.h>
     48        1.1  reinoud #include <sys/mount.h>
     49        1.1  reinoud #include <sys/buf.h>
     50        1.1  reinoud #include <sys/file.h>
     51        1.1  reinoud #include <sys/device.h>
     52        1.1  reinoud #include <sys/disklabel.h>
     53        1.1  reinoud #include <sys/ioctl.h>
     54        1.1  reinoud #include <sys/malloc.h>
     55        1.1  reinoud #include <sys/dirent.h>
     56        1.1  reinoud #include <sys/stat.h>
     57        1.1  reinoud #include <sys/conf.h>
     58        1.1  reinoud #include <sys/kauth.h>
     59        1.1  reinoud #include <sys/kthread.h>
     60        1.1  reinoud #include <dev/clock_subr.h>
     61        1.1  reinoud 
     62        1.1  reinoud #include <fs/udf/ecma167-udf.h>
     63        1.1  reinoud #include <fs/udf/udf_mount.h>
     64        1.1  reinoud 
     65        1.1  reinoud #include "udf.h"
     66        1.1  reinoud #include "udf_subr.h"
     67        1.1  reinoud #include "udf_bswap.h"
     68        1.1  reinoud 
     69        1.1  reinoud 
     70        1.1  reinoud #define VTOI(vnode) ((struct udf_node *) vnode->v_data)
     71        1.1  reinoud 
     72        1.1  reinoud static void udf_record_allocation_in_node(struct udf_mount *ump,
     73        1.1  reinoud 	struct buf *buf, uint16_t vpart_num, uint64_t *mapping,
     74        1.1  reinoud 	struct long_ad *node_ad_cpy);
     75        1.1  reinoud 
     76       1.28  reinoud static void udf_collect_free_space_for_vpart(struct udf_mount *ump,
     77       1.28  reinoud 	uint16_t vpart_num, uint32_t num_lb);
     78       1.28  reinoud 
     79       1.31  reinoud static int udf_ads_merge(uint32_t max_len, uint32_t lb_size, struct long_ad *a1, struct long_ad *a2);
     80       1.28  reinoud static void udf_wipe_adslots(struct udf_node *udf_node);
     81       1.28  reinoud static void udf_count_alloc_exts(struct udf_node *udf_node);
     82       1.28  reinoud 
     83        1.1  reinoud 
     84        1.1  reinoud /* --------------------------------------------------------------------- */
     85       1.11  reinoud 
     86       1.12  reinoud #if 0
     87        1.1  reinoud #if 1
     88        1.1  reinoud static void
     89        1.1  reinoud udf_node_dump(struct udf_node *udf_node) {
     90        1.1  reinoud 	struct file_entry    *fe;
     91        1.1  reinoud 	struct extfile_entry *efe;
     92        1.1  reinoud 	struct icb_tag *icbtag;
     93       1.11  reinoud 	struct long_ad s_ad;
     94        1.1  reinoud 	uint64_t inflen;
     95       1.11  reinoud 	uint32_t icbflags, addr_type;
     96        1.1  reinoud 	uint32_t len, lb_num;
     97       1.11  reinoud 	uint32_t flags;
     98        1.1  reinoud 	int part_num;
     99       1.11  reinoud 	int lb_size, eof, slot;
    100        1.1  reinoud 
    101       1.10  reinoud 	if ((udf_verbose & UDF_DEBUG_NODEDUMP) == 0)
    102        1.1  reinoud 		return;
    103        1.1  reinoud 
    104        1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    105        1.1  reinoud 
    106        1.1  reinoud 	fe  = udf_node->fe;
    107        1.1  reinoud 	efe = udf_node->efe;
    108        1.1  reinoud 	if (fe) {
    109        1.1  reinoud 		icbtag = &fe->icbtag;
    110        1.1  reinoud 		inflen = udf_rw64(fe->inf_len);
    111        1.1  reinoud 	} else {
    112        1.1  reinoud 		icbtag = &efe->icbtag;
    113        1.1  reinoud 		inflen = udf_rw64(efe->inf_len);
    114        1.1  reinoud 	}
    115        1.1  reinoud 
    116        1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
    117        1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    118        1.1  reinoud 
    119       1.11  reinoud 	printf("udf_node_dump %p :\n", udf_node);
    120        1.1  reinoud 
    121        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    122       1.11  reinoud 		printf("\tIntern alloc, len = %"PRIu64"\n", inflen);
    123        1.1  reinoud 		return;
    124        1.1  reinoud 	}
    125        1.1  reinoud 
    126       1.11  reinoud 	printf("\tInflen  = %"PRIu64"\n", inflen);
    127       1.11  reinoud 	printf("\t\t");
    128        1.1  reinoud 
    129       1.11  reinoud 	slot = 0;
    130       1.11  reinoud 	for (;;) {
    131       1.11  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    132       1.11  reinoud 		if (eof)
    133       1.11  reinoud 			break;
    134       1.11  reinoud 		part_num = udf_rw16(s_ad.loc.part_num);
    135       1.11  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
    136       1.11  reinoud 		len   = udf_rw32(s_ad.len);
    137       1.11  reinoud 		flags = UDF_EXT_FLAGS(len);
    138       1.11  reinoud 		len   = UDF_EXT_LEN(len);
    139        1.1  reinoud 
    140        1.1  reinoud 		printf("[");
    141        1.1  reinoud 		if (part_num >= 0)
    142        1.1  reinoud 			printf("part %d, ", part_num);
    143        1.1  reinoud 		printf("lb_num %d, len %d", lb_num, len);
    144        1.1  reinoud 		if (flags)
    145       1.10  reinoud 			printf(", flags %d", flags>>30);
    146        1.1  reinoud 		printf("] ");
    147       1.11  reinoud 
    148       1.11  reinoud 		if (flags == UDF_EXT_REDIRECT) {
    149       1.11  reinoud 			printf("\n\textent END\n\tallocation extent\n\t\t");
    150       1.11  reinoud 		}
    151       1.11  reinoud 
    152       1.11  reinoud 		slot++;
    153        1.1  reinoud 	}
    154       1.11  reinoud 	printf("\n\tl_ad END\n\n");
    155        1.1  reinoud }
    156        1.1  reinoud #else
    157        1.1  reinoud #define udf_node_dump(a)
    158        1.1  reinoud #endif
    159        1.1  reinoud 
    160        1.9  reinoud 
    161        1.9  reinoud static void
    162        1.9  reinoud udf_assert_allocated(struct udf_mount *ump, uint16_t vpart_num,
    163        1.9  reinoud 	uint32_t lb_num, uint32_t num_lb)
    164        1.9  reinoud {
    165        1.9  reinoud 	struct udf_bitmap *bitmap;
    166        1.9  reinoud 	struct part_desc *pdesc;
    167        1.9  reinoud 	uint32_t ptov;
    168        1.9  reinoud 	uint32_t bitval;
    169        1.9  reinoud 	uint8_t *bpos;
    170        1.9  reinoud 	int bit;
    171        1.9  reinoud 	int phys_part;
    172        1.9  reinoud 	int ok;
    173        1.9  reinoud 
    174       1.10  reinoud 	DPRINTF(PARANOIA, ("udf_assert_allocated: check virt lbnum %d "
    175        1.9  reinoud 			  "part %d + %d sect\n", lb_num, vpart_num, num_lb));
    176        1.9  reinoud 
    177        1.9  reinoud 	/* get partition backing up this vpart_num */
    178        1.9  reinoud 	pdesc = ump->partitions[ump->vtop[vpart_num]];
    179        1.9  reinoud 
    180        1.9  reinoud 	switch (ump->vtop_tp[vpart_num]) {
    181        1.9  reinoud 	case UDF_VTOP_TYPE_PHYS :
    182        1.9  reinoud 	case UDF_VTOP_TYPE_SPARABLE :
    183        1.9  reinoud 		/* free space to freed or unallocated space bitmap */
    184        1.9  reinoud 		ptov      = udf_rw32(pdesc->start_loc);
    185        1.9  reinoud 		phys_part = ump->vtop[vpart_num];
    186        1.9  reinoud 
    187        1.9  reinoud 		/* use unallocated bitmap */
    188        1.9  reinoud 		bitmap = &ump->part_unalloc_bits[phys_part];
    189        1.9  reinoud 
    190        1.9  reinoud 		/* if no bitmaps are defined, bail out */
    191        1.9  reinoud 		if (bitmap->bits == NULL)
    192        1.9  reinoud 			break;
    193        1.9  reinoud 
    194        1.9  reinoud 		/* check bits */
    195        1.9  reinoud 		KASSERT(bitmap->bits);
    196        1.9  reinoud 		ok = 1;
    197        1.9  reinoud 		bpos = bitmap->bits + lb_num/8;
    198        1.9  reinoud 		bit  = lb_num % 8;
    199        1.9  reinoud 		while (num_lb > 0) {
    200        1.9  reinoud 			bitval = (1 << bit);
    201        1.9  reinoud 			DPRINTF(PARANOIA, ("XXX : check %d, %p, bit %d\n",
    202        1.9  reinoud 				lb_num, bpos, bit));
    203        1.9  reinoud 			KASSERT(bitmap->bits + lb_num/8 == bpos);
    204        1.9  reinoud 			if (*bpos & bitval) {
    205        1.9  reinoud 				printf("\tlb_num %d is NOT marked busy\n",
    206        1.9  reinoud 					lb_num);
    207        1.9  reinoud 				ok = 0;
    208        1.9  reinoud 			}
    209        1.9  reinoud 			lb_num++; num_lb--;
    210        1.9  reinoud 			bit = (bit + 1) % 8;
    211        1.9  reinoud 			if (bit == 0)
    212        1.9  reinoud 				bpos++;
    213        1.9  reinoud 		}
    214        1.9  reinoud 		if (!ok) {
    215        1.9  reinoud 			/* KASSERT(0); */
    216        1.9  reinoud 		}
    217        1.9  reinoud 
    218        1.9  reinoud 		break;
    219        1.9  reinoud 	case UDF_VTOP_TYPE_VIRT :
    220        1.9  reinoud 		/* TODO check space */
    221        1.9  reinoud 		KASSERT(num_lb == 1);
    222        1.9  reinoud 		break;
    223        1.9  reinoud 	case UDF_VTOP_TYPE_META :
    224        1.9  reinoud 		/* TODO check space in the metadata bitmap */
    225        1.9  reinoud 	default:
    226        1.9  reinoud 		/* not implemented */
    227        1.9  reinoud 		break;
    228        1.9  reinoud 	}
    229        1.9  reinoud }
    230        1.9  reinoud 
    231        1.9  reinoud 
    232        1.1  reinoud static void
    233        1.1  reinoud udf_node_sanity_check(struct udf_node *udf_node,
    234       1.17  reinoud 		uint64_t *cnt_inflen, uint64_t *cnt_logblksrec)
    235       1.17  reinoud {
    236       1.17  reinoud 	union dscrptr *dscr;
    237        1.1  reinoud 	struct file_entry    *fe;
    238        1.1  reinoud 	struct extfile_entry *efe;
    239        1.1  reinoud 	struct icb_tag *icbtag;
    240       1.11  reinoud 	struct long_ad  s_ad;
    241        1.1  reinoud 	uint64_t inflen, logblksrec;
    242       1.11  reinoud 	uint32_t icbflags, addr_type;
    243       1.11  reinoud 	uint32_t len, lb_num, l_ea, l_ad, max_l_ad;
    244        1.9  reinoud 	uint16_t part_num;
    245       1.17  reinoud 	uint8_t *data_pos;
    246       1.11  reinoud 	int dscr_size, lb_size, flags, whole_lb;
    247       1.17  reinoud 	int i, slot, eof;
    248        1.1  reinoud 
    249        1.9  reinoud //	KASSERT(mutex_owned(&udf_node->ump->allocate_mutex));
    250        1.1  reinoud 
    251       1.10  reinoud 	if (1)
    252       1.10  reinoud 		udf_node_dump(udf_node);
    253       1.10  reinoud 
    254        1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    255        1.1  reinoud 
    256        1.1  reinoud 	fe  = udf_node->fe;
    257        1.1  reinoud 	efe = udf_node->efe;
    258        1.1  reinoud 	if (fe) {
    259       1.17  reinoud 		dscr       = (union dscrptr *) fe;
    260       1.17  reinoud 		icbtag     = &fe->icbtag;
    261       1.17  reinoud 		inflen     = udf_rw64(fe->inf_len);
    262       1.11  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
    263        1.1  reinoud 		logblksrec = udf_rw64(fe->logblks_rec);
    264       1.11  reinoud 		l_ad       = udf_rw32(fe->l_ad);
    265        1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
    266        1.1  reinoud 	} else {
    267       1.17  reinoud 		dscr       = (union dscrptr *) efe;
    268       1.17  reinoud 		icbtag     = &efe->icbtag;
    269       1.17  reinoud 		inflen     = udf_rw64(efe->inf_len);
    270       1.11  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
    271        1.1  reinoud 		logblksrec = udf_rw64(efe->logblks_rec);
    272       1.11  reinoud 		l_ad       = udf_rw32(efe->l_ad);
    273        1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
    274        1.1  reinoud 	}
    275       1.17  reinoud 	data_pos  = (uint8_t *) dscr + dscr_size + l_ea;
    276       1.11  reinoud 	max_l_ad   = lb_size - dscr_size - l_ea;
    277        1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
    278        1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    279        1.1  reinoud 
    280       1.17  reinoud 	/* check if tail is zero */
    281       1.17  reinoud 	DPRINTF(PARANOIA, ("Sanity check blank tail\n"));
    282       1.17  reinoud 	for (i = l_ad; i < max_l_ad; i++) {
    283       1.17  reinoud 		if (data_pos[i] != 0)
    284       1.17  reinoud 			printf( "sanity_check: violation: node byte %d "
    285       1.17  reinoud 				"has value %d\n", i, data_pos[i]);
    286       1.17  reinoud 	}
    287       1.17  reinoud 
    288        1.1  reinoud 	/* reset counters */
    289        1.1  reinoud 	*cnt_inflen     = 0;
    290        1.1  reinoud 	*cnt_logblksrec = 0;
    291        1.1  reinoud 
    292        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    293        1.1  reinoud 		KASSERT(l_ad <= max_l_ad);
    294        1.1  reinoud 		KASSERT(l_ad == inflen);
    295        1.1  reinoud 		*cnt_inflen = inflen;
    296        1.1  reinoud 		return;
    297        1.1  reinoud 	}
    298        1.1  reinoud 
    299        1.1  reinoud 	/* start counting */
    300        1.1  reinoud 	whole_lb = 1;
    301       1.11  reinoud 	slot = 0;
    302       1.11  reinoud 	for (;;) {
    303       1.11  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    304       1.11  reinoud 		if (eof)
    305       1.11  reinoud 			break;
    306        1.1  reinoud 		KASSERT(whole_lb == 1);
    307       1.11  reinoud 
    308       1.11  reinoud 		part_num = udf_rw16(s_ad.loc.part_num);
    309       1.11  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
    310       1.11  reinoud 		len   = udf_rw32(s_ad.len);
    311       1.11  reinoud 		flags = UDF_EXT_FLAGS(len);
    312       1.11  reinoud 		len   = UDF_EXT_LEN(len);
    313       1.11  reinoud 
    314        1.6  reinoud 		if (flags != UDF_EXT_REDIRECT) {
    315        1.6  reinoud 			*cnt_inflen += len;
    316        1.6  reinoud 			if (flags == UDF_EXT_ALLOCATED) {
    317        1.6  reinoud 				*cnt_logblksrec += (len + lb_size -1) / lb_size;
    318        1.6  reinoud 			}
    319        1.6  reinoud 		} else {
    320        1.6  reinoud 			KASSERT(len == lb_size);
    321        1.1  reinoud 		}
    322        1.9  reinoud 		/* check allocation */
    323        1.9  reinoud 		if (flags == UDF_EXT_ALLOCATED)
    324        1.9  reinoud 			udf_assert_allocated(udf_node->ump, part_num, lb_num,
    325        1.9  reinoud 				(len + lb_size - 1) / lb_size);
    326        1.8  reinoud 
    327        1.8  reinoud 		/* check whole lb */
    328        1.1  reinoud 		whole_lb = ((len % lb_size) == 0);
    329       1.11  reinoud 
    330       1.11  reinoud 		slot++;
    331        1.1  reinoud 	}
    332        1.1  reinoud 	/* rest should be zero (ad_off > l_ad < max_l_ad - adlen) */
    333        1.1  reinoud 
    334        1.1  reinoud 	KASSERT(*cnt_inflen == inflen);
    335        1.1  reinoud 	KASSERT(*cnt_logblksrec == logblksrec);
    336        1.1  reinoud 
    337        1.9  reinoud //	KASSERT(mutex_owned(&udf_node->ump->allocate_mutex));
    338        1.1  reinoud }
    339        1.1  reinoud #else
    340       1.12  reinoud static void
    341       1.12  reinoud udf_node_sanity_check(struct udf_node *udf_node,
    342       1.12  reinoud 		uint64_t *cnt_inflen, uint64_t *cnt_logblksrec) {
    343       1.12  reinoud 	struct file_entry    *fe;
    344       1.12  reinoud 	struct extfile_entry *efe;
    345       1.12  reinoud 	struct icb_tag *icbtag;
    346       1.12  reinoud 	uint64_t inflen, logblksrec;
    347       1.12  reinoud 	int dscr_size, lb_size;
    348       1.12  reinoud 
    349       1.12  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
    350       1.12  reinoud 
    351       1.12  reinoud 	fe  = udf_node->fe;
    352       1.12  reinoud 	efe = udf_node->efe;
    353       1.12  reinoud 	if (fe) {
    354       1.12  reinoud 		icbtag = &fe->icbtag;
    355       1.12  reinoud 		inflen = udf_rw64(fe->inf_len);
    356       1.12  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
    357       1.12  reinoud 		logblksrec = udf_rw64(fe->logblks_rec);
    358       1.12  reinoud 	} else {
    359       1.12  reinoud 		icbtag = &efe->icbtag;
    360       1.12  reinoud 		inflen = udf_rw64(efe->inf_len);
    361       1.12  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
    362       1.12  reinoud 		logblksrec = udf_rw64(efe->logblks_rec);
    363       1.12  reinoud 	}
    364       1.12  reinoud 	*cnt_logblksrec = logblksrec;
    365       1.12  reinoud 	*cnt_inflen     = inflen;
    366       1.12  reinoud }
    367        1.1  reinoud #endif
    368        1.1  reinoud 
    369        1.1  reinoud /* --------------------------------------------------------------------- */
    370        1.1  reinoud 
    371       1.26  reinoud void
    372       1.26  reinoud udf_calc_freespace(struct udf_mount *ump, uint64_t *sizeblks, uint64_t *freeblks)
    373       1.26  reinoud {
    374       1.26  reinoud 	struct logvol_int_desc *lvid;
    375       1.26  reinoud 	uint32_t *pos1, *pos2;
    376       1.26  reinoud 	int vpart, num_vpart;
    377       1.26  reinoud 
    378       1.26  reinoud 	lvid = ump->logvol_integrity;
    379       1.26  reinoud 	*freeblks = *sizeblks = 0;
    380       1.26  reinoud 
    381       1.26  reinoud 	/*
    382       1.26  reinoud 	 * Sequentials media report free space directly (CD/DVD/BD-R), for the
    383       1.26  reinoud 	 * other media we need the logical volume integrity.
    384       1.26  reinoud 	 *
    385       1.26  reinoud 	 * We sum all free space up here regardless of type.
    386       1.26  reinoud 	 */
    387       1.26  reinoud 
    388       1.26  reinoud 	KASSERT(lvid);
    389       1.26  reinoud 	num_vpart = udf_rw32(lvid->num_part);
    390       1.26  reinoud 
    391       1.26  reinoud 	if (ump->discinfo.mmc_cur & MMC_CAP_SEQUENTIAL) {
    392       1.26  reinoud 		/* use track info directly summing if there are 2 open */
    393       1.26  reinoud 		/* XXX assumption at most two tracks open */
    394       1.26  reinoud 		*freeblks = ump->data_track.free_blocks;
    395       1.26  reinoud 		if (ump->data_track.tracknr != ump->metadata_track.tracknr)
    396       1.26  reinoud 			*freeblks += ump->metadata_track.free_blocks;
    397       1.26  reinoud 		*sizeblks = ump->discinfo.last_possible_lba;
    398       1.26  reinoud 	} else {
    399       1.26  reinoud 		/* free and used space for mountpoint based on logvol integrity */
    400       1.26  reinoud 		for (vpart = 0; vpart < num_vpart; vpart++) {
    401       1.26  reinoud 			pos1 = &lvid->tables[0] + vpart;
    402       1.26  reinoud 			pos2 = &lvid->tables[0] + num_vpart + vpart;
    403       1.26  reinoud 			if (udf_rw32(*pos1) != (uint32_t) -1) {
    404       1.26  reinoud 				*freeblks += udf_rw32(*pos1);
    405       1.26  reinoud 				*sizeblks += udf_rw32(*pos2);
    406       1.26  reinoud 			}
    407       1.26  reinoud 		}
    408       1.26  reinoud 	}
    409       1.26  reinoud 	/* adjust for accounted uncommitted blocks */
    410       1.26  reinoud 	for (vpart = 0; vpart < num_vpart; vpart++)
    411       1.26  reinoud 		*freeblks -= ump->uncommitted_lbs[vpart];
    412       1.26  reinoud 
    413       1.26  reinoud 	if (*freeblks > UDF_DISC_SLACK) {
    414       1.26  reinoud 		*freeblks -= UDF_DISC_SLACK;
    415       1.26  reinoud 	} else {
    416       1.26  reinoud 		*freeblks = 0;
    417       1.26  reinoud 	}
    418       1.26  reinoud }
    419       1.26  reinoud 
    420       1.26  reinoud 
    421       1.26  reinoud static void
    422       1.26  reinoud udf_calc_vpart_freespace(struct udf_mount *ump, uint16_t vpart_num, uint64_t *freeblks)
    423       1.26  reinoud {
    424       1.26  reinoud 	struct logvol_int_desc *lvid;
    425       1.26  reinoud 	uint32_t *pos1;
    426       1.26  reinoud 
    427       1.26  reinoud 	lvid = ump->logvol_integrity;
    428       1.26  reinoud 	*freeblks = 0;
    429       1.26  reinoud 
    430       1.26  reinoud 	/*
    431       1.26  reinoud 	 * Sequentials media report free space directly (CD/DVD/BD-R), for the
    432       1.26  reinoud 	 * other media we need the logical volume integrity.
    433       1.26  reinoud 	 *
    434       1.26  reinoud 	 * We sum all free space up here regardless of type.
    435       1.26  reinoud 	 */
    436       1.26  reinoud 
    437       1.26  reinoud 	KASSERT(lvid);
    438       1.26  reinoud 	if (ump->discinfo.mmc_cur & MMC_CAP_SEQUENTIAL) {
    439       1.26  reinoud 		/* XXX assumption at most two tracks open */
    440       1.26  reinoud 		if (vpart_num == ump->data_part) {
    441       1.26  reinoud 			*freeblks = ump->data_track.free_blocks;
    442       1.26  reinoud 		} else {
    443       1.26  reinoud 			*freeblks = ump->metadata_track.free_blocks;
    444       1.26  reinoud 		}
    445       1.26  reinoud 	} else {
    446       1.26  reinoud 		/* free and used space for mountpoint based on logvol integrity */
    447       1.26  reinoud 		pos1 = &lvid->tables[0] + vpart_num;
    448       1.26  reinoud 		if (udf_rw32(*pos1) != (uint32_t) -1)
    449       1.26  reinoud 			*freeblks += udf_rw32(*pos1);
    450       1.26  reinoud 	}
    451       1.26  reinoud 
    452       1.26  reinoud 	/* adjust for accounted uncommitted blocks */
    453       1.28  reinoud 	if (*freeblks > ump->uncommitted_lbs[vpart_num]) {
    454       1.28  reinoud 		*freeblks -= ump->uncommitted_lbs[vpart_num];
    455       1.28  reinoud 	} else {
    456       1.28  reinoud 		*freeblks = 0;
    457       1.28  reinoud 	}
    458       1.26  reinoud }
    459       1.26  reinoud 
    460       1.26  reinoud /* --------------------------------------------------------------------- */
    461       1.26  reinoud 
    462        1.1  reinoud int
    463        1.1  reinoud udf_translate_vtop(struct udf_mount *ump, struct long_ad *icb_loc,
    464        1.1  reinoud 		   uint32_t *lb_numres, uint32_t *extres)
    465        1.1  reinoud {
    466        1.1  reinoud 	struct part_desc       *pdesc;
    467        1.1  reinoud 	struct spare_map_entry *sme;
    468        1.1  reinoud 	struct long_ad s_icb_loc;
    469        1.1  reinoud 	uint64_t foffset, end_foffset;
    470        1.1  reinoud 	uint32_t lb_size, len;
    471        1.1  reinoud 	uint32_t lb_num, lb_rel, lb_packet;
    472        1.1  reinoud 	uint32_t udf_rw32_lbmap, ext_offset;
    473        1.1  reinoud 	uint16_t vpart;
    474        1.1  reinoud 	int rel, part, error, eof, slot, flags;
    475        1.1  reinoud 
    476        1.1  reinoud 	assert(ump && icb_loc && lb_numres);
    477        1.1  reinoud 
    478        1.1  reinoud 	vpart  = udf_rw16(icb_loc->loc.part_num);
    479        1.1  reinoud 	lb_num = udf_rw32(icb_loc->loc.lb_num);
    480        1.1  reinoud 	if (vpart > UDF_VTOP_RAWPART)
    481        1.1  reinoud 		return EINVAL;
    482        1.1  reinoud 
    483        1.1  reinoud translate_again:
    484        1.1  reinoud 	part = ump->vtop[vpart];
    485        1.1  reinoud 	pdesc = ump->partitions[part];
    486        1.1  reinoud 
    487        1.1  reinoud 	switch (ump->vtop_tp[vpart]) {
    488        1.1  reinoud 	case UDF_VTOP_TYPE_RAW :
    489        1.1  reinoud 		/* 1:1 to the end of the device */
    490        1.1  reinoud 		*lb_numres = lb_num;
    491        1.1  reinoud 		*extres = INT_MAX;
    492        1.1  reinoud 		return 0;
    493        1.1  reinoud 	case UDF_VTOP_TYPE_PHYS :
    494        1.1  reinoud 		/* transform into its disc logical block */
    495        1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    496        1.1  reinoud 			return EINVAL;
    497        1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    498        1.1  reinoud 
    499        1.1  reinoud 		/* extent from here to the end of the partition */
    500        1.1  reinoud 		*extres = udf_rw32(pdesc->part_len) - lb_num;
    501        1.1  reinoud 		return 0;
    502        1.1  reinoud 	case UDF_VTOP_TYPE_VIRT :
    503        1.1  reinoud 		/* only maps one logical block, lookup in VAT */
    504        1.1  reinoud 		if (lb_num >= ump->vat_entries)		/* XXX > or >= ? */
    505        1.1  reinoud 			return EINVAL;
    506        1.1  reinoud 
    507        1.1  reinoud 		/* lookup in virtual allocation table file */
    508        1.1  reinoud 		mutex_enter(&ump->allocate_mutex);
    509        1.1  reinoud 		error = udf_vat_read(ump->vat_node,
    510        1.1  reinoud 				(uint8_t *) &udf_rw32_lbmap, 4,
    511        1.1  reinoud 				ump->vat_offset + lb_num * 4);
    512        1.1  reinoud 		mutex_exit(&ump->allocate_mutex);
    513        1.1  reinoud 
    514        1.1  reinoud 		if (error)
    515        1.1  reinoud 			return error;
    516        1.1  reinoud 
    517        1.1  reinoud 		lb_num = udf_rw32(udf_rw32_lbmap);
    518        1.1  reinoud 
    519        1.1  reinoud 		/* transform into its disc logical block */
    520        1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    521        1.1  reinoud 			return EINVAL;
    522        1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    523        1.1  reinoud 
    524        1.1  reinoud 		/* just one logical block */
    525        1.1  reinoud 		*extres = 1;
    526        1.1  reinoud 		return 0;
    527        1.1  reinoud 	case UDF_VTOP_TYPE_SPARABLE :
    528        1.1  reinoud 		/* check if the packet containing the lb_num is remapped */
    529        1.1  reinoud 		lb_packet = lb_num / ump->sparable_packet_size;
    530        1.1  reinoud 		lb_rel    = lb_num % ump->sparable_packet_size;
    531        1.1  reinoud 
    532        1.1  reinoud 		for (rel = 0; rel < udf_rw16(ump->sparing_table->rt_l); rel++) {
    533        1.1  reinoud 			sme = &ump->sparing_table->entries[rel];
    534        1.1  reinoud 			if (lb_packet == udf_rw32(sme->org)) {
    535        1.1  reinoud 				/* NOTE maps to absolute disc logical block! */
    536        1.1  reinoud 				*lb_numres = udf_rw32(sme->map) + lb_rel;
    537        1.1  reinoud 				*extres    = ump->sparable_packet_size - lb_rel;
    538        1.1  reinoud 				return 0;
    539        1.1  reinoud 			}
    540        1.1  reinoud 		}
    541        1.1  reinoud 
    542        1.1  reinoud 		/* transform into its disc logical block */
    543        1.1  reinoud 		if (lb_num > udf_rw32(pdesc->part_len))
    544        1.1  reinoud 			return EINVAL;
    545        1.1  reinoud 		*lb_numres = lb_num + udf_rw32(pdesc->start_loc);
    546        1.1  reinoud 
    547        1.1  reinoud 		/* rest of block */
    548        1.1  reinoud 		*extres = ump->sparable_packet_size - lb_rel;
    549        1.1  reinoud 		return 0;
    550        1.1  reinoud 	case UDF_VTOP_TYPE_META :
    551        1.1  reinoud 		/* we have to look into the file's allocation descriptors */
    552        1.1  reinoud 
    553        1.1  reinoud 		/* use metadatafile allocation mutex */
    554        1.1  reinoud 		lb_size = udf_rw32(ump->logical_vol->lb_size);
    555        1.1  reinoud 
    556        1.1  reinoud 		UDF_LOCK_NODE(ump->metadata_node, 0);
    557        1.1  reinoud 
    558        1.1  reinoud 		/* get first overlapping extent */
    559        1.1  reinoud 		foffset = 0;
    560        1.1  reinoud 		slot    = 0;
    561        1.1  reinoud 		for (;;) {
    562        1.1  reinoud 			udf_get_adslot(ump->metadata_node,
    563        1.1  reinoud 				slot, &s_icb_loc, &eof);
    564        1.5  reinoud 			DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, "
    565        1.5  reinoud 				"len = %d, lb_num = %d, part = %d\n",
    566        1.5  reinoud 				slot, eof,
    567        1.5  reinoud 				UDF_EXT_FLAGS(udf_rw32(s_icb_loc.len)),
    568        1.5  reinoud 				UDF_EXT_LEN(udf_rw32(s_icb_loc.len)),
    569        1.5  reinoud 				udf_rw32(s_icb_loc.loc.lb_num),
    570        1.5  reinoud 				udf_rw16(s_icb_loc.loc.part_num)));
    571        1.1  reinoud 			if (eof) {
    572        1.1  reinoud 				DPRINTF(TRANSLATE,
    573        1.1  reinoud 					("Meta partition translation "
    574        1.1  reinoud 					 "failed: can't seek location\n"));
    575        1.1  reinoud 				UDF_UNLOCK_NODE(ump->metadata_node, 0);
    576        1.1  reinoud 				return EINVAL;
    577        1.1  reinoud 			}
    578        1.1  reinoud 			len   = udf_rw32(s_icb_loc.len);
    579        1.1  reinoud 			flags = UDF_EXT_FLAGS(len);
    580        1.1  reinoud 			len   = UDF_EXT_LEN(len);
    581        1.1  reinoud 
    582        1.5  reinoud 			if (flags == UDF_EXT_REDIRECT) {
    583        1.5  reinoud 				slot++;
    584        1.5  reinoud 				continue;
    585        1.5  reinoud 			}
    586        1.5  reinoud 
    587        1.1  reinoud 			end_foffset = foffset + len;
    588        1.1  reinoud 
    589  1.32.22.1   bouyer 			if (end_foffset > (uint64_t) lb_num * lb_size)
    590        1.1  reinoud 				break;	/* found */
    591        1.5  reinoud 			foffset = end_foffset;
    592        1.1  reinoud 			slot++;
    593        1.1  reinoud 		}
    594        1.1  reinoud 		/* found overlapping slot */
    595        1.1  reinoud 		ext_offset = lb_num * lb_size - foffset;
    596        1.1  reinoud 
    597        1.1  reinoud 		/* process extent offset */
    598        1.1  reinoud 		lb_num   = udf_rw32(s_icb_loc.loc.lb_num);
    599        1.1  reinoud 		vpart    = udf_rw16(s_icb_loc.loc.part_num);
    600        1.1  reinoud 		lb_num  += (ext_offset + lb_size -1) / lb_size;
    601        1.1  reinoud 		ext_offset = 0;
    602        1.1  reinoud 
    603        1.1  reinoud 		UDF_UNLOCK_NODE(ump->metadata_node, 0);
    604        1.1  reinoud 		if (flags != UDF_EXT_ALLOCATED) {
    605        1.1  reinoud 			DPRINTF(TRANSLATE, ("Metadata partition translation "
    606        1.1  reinoud 					    "failed: not allocated\n"));
    607        1.1  reinoud 			return EINVAL;
    608        1.1  reinoud 		}
    609        1.1  reinoud 
    610        1.1  reinoud 		/*
    611        1.1  reinoud 		 * vpart and lb_num are updated, translate again since we
    612        1.1  reinoud 		 * might be mapped on sparable media
    613        1.1  reinoud 		 */
    614        1.1  reinoud 		goto translate_again;
    615        1.1  reinoud 	default:
    616        1.1  reinoud 		printf("UDF vtop translation scheme %d unimplemented yet\n",
    617        1.1  reinoud 			ump->vtop_tp[vpart]);
    618        1.1  reinoud 	}
    619        1.1  reinoud 
    620        1.1  reinoud 	return EINVAL;
    621        1.1  reinoud }
    622        1.1  reinoud 
    623       1.16  reinoud 
    624       1.16  reinoud /* XXX  provisional primitive braindead version */
    625       1.16  reinoud /* TODO use ext_res */
    626       1.16  reinoud void
    627       1.16  reinoud udf_translate_vtop_list(struct udf_mount *ump, uint32_t sectors,
    628       1.16  reinoud 	uint16_t vpart_num, uint64_t *lmapping, uint64_t *pmapping)
    629       1.16  reinoud {
    630       1.16  reinoud 	struct long_ad loc;
    631       1.16  reinoud 	uint32_t lb_numres, ext_res;
    632       1.16  reinoud 	int sector;
    633       1.16  reinoud 
    634       1.16  reinoud 	for (sector = 0; sector < sectors; sector++) {
    635       1.16  reinoud 		memset(&loc, 0, sizeof(struct long_ad));
    636       1.16  reinoud 		loc.loc.part_num = udf_rw16(vpart_num);
    637       1.16  reinoud 		loc.loc.lb_num   = udf_rw32(*lmapping);
    638       1.16  reinoud 		udf_translate_vtop(ump, &loc, &lb_numres, &ext_res);
    639       1.16  reinoud 		*pmapping = lb_numres;
    640       1.16  reinoud 		lmapping++; pmapping++;
    641       1.16  reinoud 	}
    642       1.16  reinoud }
    643       1.16  reinoud 
    644       1.16  reinoud 
    645        1.1  reinoud /* --------------------------------------------------------------------- */
    646        1.1  reinoud 
    647        1.1  reinoud /*
    648        1.1  reinoud  * Translate an extent (in logical_blocks) into logical block numbers; used
    649        1.1  reinoud  * for read and write operations. DOESNT't check extents.
    650        1.1  reinoud  */
    651        1.1  reinoud 
    652        1.1  reinoud int
    653        1.1  reinoud udf_translate_file_extent(struct udf_node *udf_node,
    654        1.1  reinoud 		          uint32_t from, uint32_t num_lb,
    655        1.1  reinoud 			  uint64_t *map)
    656        1.1  reinoud {
    657        1.1  reinoud 	struct udf_mount *ump;
    658        1.1  reinoud 	struct icb_tag *icbtag;
    659        1.1  reinoud 	struct long_ad t_ad, s_ad;
    660        1.1  reinoud 	uint64_t transsec;
    661        1.1  reinoud 	uint64_t foffset, end_foffset;
    662        1.1  reinoud 	uint32_t transsec32;
    663        1.1  reinoud 	uint32_t lb_size;
    664        1.1  reinoud 	uint32_t ext_offset;
    665        1.1  reinoud 	uint32_t lb_num, len;
    666        1.1  reinoud 	uint32_t overlap, translen;
    667        1.1  reinoud 	uint16_t vpart_num;
    668        1.1  reinoud 	int eof, error, flags;
    669        1.1  reinoud 	int slot, addr_type, icbflags;
    670        1.1  reinoud 
    671        1.1  reinoud 	if (!udf_node)
    672        1.1  reinoud 		return ENOENT;
    673        1.1  reinoud 
    674        1.1  reinoud 	KASSERT(num_lb > 0);
    675        1.1  reinoud 
    676        1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);
    677        1.1  reinoud 
    678        1.1  reinoud 	/* initialise derivative vars */
    679        1.1  reinoud 	ump = udf_node->ump;
    680        1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
    681        1.1  reinoud 
    682        1.1  reinoud 	if (udf_node->fe) {
    683        1.1  reinoud 		icbtag = &udf_node->fe->icbtag;
    684        1.1  reinoud 	} else {
    685        1.1  reinoud 		icbtag = &udf_node->efe->icbtag;
    686        1.1  reinoud 	}
    687        1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
    688        1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
    689        1.1  reinoud 
    690        1.1  reinoud 	/* do the work */
    691        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
    692        1.1  reinoud 		*map = UDF_TRANS_INTERN;
    693        1.1  reinoud 		UDF_UNLOCK_NODE(udf_node, 0);
    694        1.1  reinoud 		return 0;
    695        1.1  reinoud 	}
    696        1.1  reinoud 
    697        1.1  reinoud 	/* find first overlapping extent */
    698        1.1  reinoud 	foffset = 0;
    699        1.1  reinoud 	slot    = 0;
    700        1.1  reinoud 	for (;;) {
    701        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    702        1.4  reinoud 		DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, len = %d, "
    703        1.4  reinoud 			"lb_num = %d, part = %d\n", slot, eof,
    704        1.4  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)),
    705        1.4  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
    706        1.4  reinoud 			udf_rw32(s_ad.loc.lb_num),
    707        1.4  reinoud 			udf_rw16(s_ad.loc.part_num)));
    708        1.1  reinoud 		if (eof) {
    709        1.1  reinoud 			DPRINTF(TRANSLATE,
    710        1.1  reinoud 				("Translate file extent "
    711        1.1  reinoud 				 "failed: can't seek location\n"));
    712        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
    713        1.1  reinoud 			return EINVAL;
    714        1.1  reinoud 		}
    715        1.1  reinoud 		len    = udf_rw32(s_ad.len);
    716        1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
    717        1.1  reinoud 		len    = UDF_EXT_LEN(len);
    718        1.1  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
    719        1.1  reinoud 
    720        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
    721        1.1  reinoud 			slot++;
    722        1.1  reinoud 			continue;
    723        1.1  reinoud 		}
    724        1.1  reinoud 
    725        1.1  reinoud 		end_foffset = foffset + len;
    726        1.1  reinoud 
    727  1.32.22.1   bouyer 		if (end_foffset > (uint64_t) from * lb_size)
    728        1.1  reinoud 			break;	/* found */
    729        1.1  reinoud 		foffset = end_foffset;
    730        1.1  reinoud 		slot++;
    731        1.1  reinoud 	}
    732        1.1  reinoud 	/* found overlapping slot */
    733  1.32.22.1   bouyer 	ext_offset = (uint64_t) from * lb_size - foffset;
    734        1.1  reinoud 
    735        1.1  reinoud 	for (;;) {
    736        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
    737        1.4  reinoud 		DPRINTF(ADWLK, ("slot %d, eof = %d, flags = %d, len = %d, "
    738        1.4  reinoud 			"lb_num = %d, part = %d\n", slot, eof,
    739        1.4  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)),
    740        1.4  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
    741        1.4  reinoud 			udf_rw32(s_ad.loc.lb_num),
    742        1.4  reinoud 			udf_rw16(s_ad.loc.part_num)));
    743        1.1  reinoud 		if (eof) {
    744        1.1  reinoud 			DPRINTF(TRANSLATE,
    745        1.1  reinoud 				("Translate file extent "
    746        1.1  reinoud 				 "failed: past eof\n"));
    747        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
    748        1.1  reinoud 			return EINVAL;
    749        1.1  reinoud 		}
    750        1.1  reinoud 
    751        1.1  reinoud 		len    = udf_rw32(s_ad.len);
    752        1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
    753        1.1  reinoud 		len    = UDF_EXT_LEN(len);
    754        1.1  reinoud 
    755        1.1  reinoud 		lb_num    = udf_rw32(s_ad.loc.lb_num);
    756        1.1  reinoud 		vpart_num = udf_rw16(s_ad.loc.part_num);
    757        1.1  reinoud 
    758        1.1  reinoud 		end_foffset = foffset + len;
    759        1.1  reinoud 
    760        1.1  reinoud 		/* process extent, don't forget to advance on ext_offset! */
    761        1.1  reinoud 		lb_num  += (ext_offset + lb_size -1) / lb_size;
    762        1.1  reinoud 		overlap  = (len - ext_offset + lb_size -1) / lb_size;
    763        1.1  reinoud 		ext_offset = 0;
    764        1.1  reinoud 
    765        1.1  reinoud 		/*
    766        1.1  reinoud 		 * note that the while(){} is nessisary for the extent that
    767        1.1  reinoud 		 * the udf_translate_vtop() returns doens't have to span the
    768        1.1  reinoud 		 * whole extent.
    769        1.1  reinoud 		 */
    770        1.1  reinoud 
    771        1.1  reinoud 		overlap = MIN(overlap, num_lb);
    772        1.4  reinoud 		while (overlap && (flags != UDF_EXT_REDIRECT)) {
    773        1.1  reinoud 			switch (flags) {
    774        1.1  reinoud 			case UDF_EXT_FREE :
    775        1.1  reinoud 			case UDF_EXT_ALLOCATED_BUT_NOT_USED :
    776        1.1  reinoud 				transsec = UDF_TRANS_ZERO;
    777        1.1  reinoud 				translen = overlap;
    778        1.1  reinoud 				while (overlap && num_lb && translen) {
    779        1.1  reinoud 					*map++ = transsec;
    780        1.1  reinoud 					lb_num++;
    781        1.1  reinoud 					overlap--; num_lb--; translen--;
    782        1.1  reinoud 				}
    783        1.1  reinoud 				break;
    784        1.1  reinoud 			case UDF_EXT_ALLOCATED :
    785        1.1  reinoud 				t_ad.loc.lb_num   = udf_rw32(lb_num);
    786        1.1  reinoud 				t_ad.loc.part_num = udf_rw16(vpart_num);
    787        1.1  reinoud 				error = udf_translate_vtop(ump,
    788        1.1  reinoud 						&t_ad, &transsec32, &translen);
    789        1.1  reinoud 				transsec = transsec32;
    790        1.1  reinoud 				if (error) {
    791        1.1  reinoud 					UDF_UNLOCK_NODE(udf_node, 0);
    792        1.1  reinoud 					return error;
    793        1.1  reinoud 				}
    794        1.1  reinoud 				while (overlap && num_lb && translen) {
    795        1.1  reinoud 					*map++ = transsec;
    796        1.1  reinoud 					lb_num++; transsec++;
    797        1.1  reinoud 					overlap--; num_lb--; translen--;
    798        1.1  reinoud 				}
    799        1.1  reinoud 				break;
    800        1.4  reinoud 			default:
    801        1.4  reinoud 				DPRINTF(TRANSLATE,
    802        1.4  reinoud 					("Translate file extent "
    803        1.4  reinoud 					 "failed: bad flags %x\n", flags));
    804        1.4  reinoud 				UDF_UNLOCK_NODE(udf_node, 0);
    805        1.4  reinoud 				return EINVAL;
    806        1.1  reinoud 			}
    807        1.1  reinoud 		}
    808        1.1  reinoud 		if (num_lb == 0)
    809        1.1  reinoud 			break;
    810        1.1  reinoud 
    811        1.1  reinoud 		if (flags != UDF_EXT_REDIRECT)
    812        1.1  reinoud 			foffset = end_foffset;
    813        1.1  reinoud 		slot++;
    814        1.1  reinoud 	}
    815        1.1  reinoud 	UDF_UNLOCK_NODE(udf_node, 0);
    816        1.1  reinoud 
    817        1.1  reinoud 	return 0;
    818        1.1  reinoud }
    819        1.1  reinoud 
    820        1.1  reinoud /* --------------------------------------------------------------------- */
    821        1.1  reinoud 
    822        1.1  reinoud static int
    823        1.1  reinoud udf_search_free_vatloc(struct udf_mount *ump, uint32_t *lbnumres)
    824        1.1  reinoud {
    825        1.1  reinoud 	uint32_t lb_size, lb_num, lb_map, udf_rw32_lbmap;
    826        1.1  reinoud 	uint8_t *blob;
    827        1.1  reinoud 	int entry, chunk, found, error;
    828        1.1  reinoud 
    829        1.1  reinoud 	KASSERT(ump);
    830        1.1  reinoud 	KASSERT(ump->logical_vol);
    831        1.1  reinoud 
    832        1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
    833        1.1  reinoud 	blob = malloc(lb_size, M_UDFTEMP, M_WAITOK);
    834        1.1  reinoud 
    835        1.1  reinoud 	/* TODO static allocation of search chunk */
    836        1.1  reinoud 
    837        1.1  reinoud 	lb_num = MIN(ump->vat_entries, ump->vat_last_free_lb);
    838        1.1  reinoud 	found  = 0;
    839        1.1  reinoud 	error  = 0;
    840        1.1  reinoud 	entry  = 0;
    841        1.1  reinoud 	do {
    842        1.1  reinoud 		chunk = MIN(lb_size, (ump->vat_entries - lb_num) * 4);
    843        1.1  reinoud 		if (chunk <= 0)
    844        1.1  reinoud 			break;
    845        1.1  reinoud 		/* load in chunk */
    846        1.1  reinoud 		error = udf_vat_read(ump->vat_node, blob, chunk,
    847        1.1  reinoud 				ump->vat_offset + lb_num * 4);
    848        1.1  reinoud 
    849        1.1  reinoud 		if (error)
    850        1.1  reinoud 			break;
    851        1.1  reinoud 
    852        1.1  reinoud 		/* search this chunk */
    853        1.1  reinoud 		for (entry=0; entry < chunk /4; entry++, lb_num++) {
    854        1.1  reinoud 			udf_rw32_lbmap = *((uint32_t *) (blob + entry * 4));
    855        1.1  reinoud 			lb_map = udf_rw32(udf_rw32_lbmap);
    856        1.1  reinoud 			if (lb_map == 0xffffffff) {
    857        1.1  reinoud 				found = 1;
    858        1.1  reinoud 				break;
    859        1.1  reinoud 			}
    860        1.1  reinoud 		}
    861        1.1  reinoud 	} while (!found);
    862        1.1  reinoud 	if (error) {
    863        1.1  reinoud 		printf("udf_search_free_vatloc: error reading in vat chunk "
    864        1.1  reinoud 			"(lb %d, size %d)\n", lb_num, chunk);
    865        1.1  reinoud 	}
    866        1.1  reinoud 
    867        1.1  reinoud 	if (!found) {
    868        1.1  reinoud 		/* extend VAT */
    869        1.1  reinoud 		DPRINTF(WRITE, ("udf_search_free_vatloc: extending\n"));
    870        1.1  reinoud 		lb_num = ump->vat_entries;
    871        1.1  reinoud 		ump->vat_entries++;
    872        1.1  reinoud 	}
    873        1.1  reinoud 
    874        1.1  reinoud 	/* mark entry with initialiser just in case */
    875        1.1  reinoud 	lb_map = udf_rw32(0xfffffffe);
    876        1.1  reinoud 	udf_vat_write(ump->vat_node, (uint8_t *) &lb_map, 4,
    877        1.1  reinoud 		ump->vat_offset + lb_num *4);
    878        1.1  reinoud 	ump->vat_last_free_lb = lb_num;
    879        1.1  reinoud 
    880        1.1  reinoud 	free(blob, M_UDFTEMP);
    881        1.1  reinoud 	*lbnumres = lb_num;
    882        1.1  reinoud 	return 0;
    883        1.1  reinoud }
    884        1.1  reinoud 
    885        1.1  reinoud 
    886        1.1  reinoud static void
    887        1.1  reinoud udf_bitmap_allocate(struct udf_bitmap *bitmap, int ismetadata,
    888       1.16  reinoud 	uint32_t *num_lb, uint64_t *lmappos)
    889        1.1  reinoud {
    890        1.1  reinoud 	uint32_t offset, lb_num, bit;
    891        1.1  reinoud 	int32_t  diff;
    892        1.1  reinoud 	uint8_t *bpos;
    893        1.1  reinoud 	int pass;
    894        1.1  reinoud 
    895        1.1  reinoud 	if (!ismetadata) {
    896        1.1  reinoud 		/* heuristic to keep the two pointers not too close */
    897        1.1  reinoud 		diff = bitmap->data_pos - bitmap->metadata_pos;
    898        1.1  reinoud 		if ((diff >= 0) && (diff < 1024))
    899        1.1  reinoud 			bitmap->data_pos = bitmap->metadata_pos + 1024;
    900        1.1  reinoud 	}
    901        1.1  reinoud 	offset = ismetadata ? bitmap->metadata_pos : bitmap->data_pos;
    902        1.1  reinoud 	offset &= ~7;
    903        1.1  reinoud 	for (pass = 0; pass < 2; pass++) {
    904        1.1  reinoud 		if (offset >= bitmap->max_offset)
    905        1.1  reinoud 			offset = 0;
    906        1.1  reinoud 
    907        1.1  reinoud 		while (offset < bitmap->max_offset) {
    908        1.1  reinoud 			if (*num_lb == 0)
    909        1.1  reinoud 				break;
    910        1.1  reinoud 
    911        1.1  reinoud 			/* use first bit not set */
    912        1.1  reinoud 			bpos  = bitmap->bits + offset/8;
    913        1.9  reinoud 			bit = ffs(*bpos);	/* returns 0 or 1..8 */
    914        1.1  reinoud 			if (bit == 0) {
    915        1.1  reinoud 				offset += 8;
    916        1.1  reinoud 				continue;
    917        1.1  reinoud 			}
    918       1.20  reinoud 
    919       1.20  reinoud 			/* check for ffs overshoot */
    920       1.20  reinoud 			if (offset + bit-1 >= bitmap->max_offset) {
    921       1.20  reinoud 				offset = bitmap->max_offset;
    922       1.20  reinoud 				break;
    923       1.20  reinoud 			}
    924       1.20  reinoud 
    925        1.9  reinoud 			DPRINTF(PARANOIA, ("XXX : allocate %d, %p, bit %d\n",
    926        1.9  reinoud 				offset + bit -1, bpos, bit-1));
    927        1.1  reinoud 			*bpos &= ~(1 << (bit-1));
    928        1.1  reinoud 			lb_num = offset + bit-1;
    929        1.1  reinoud 			*lmappos++ = lb_num;
    930        1.1  reinoud 			*num_lb = *num_lb - 1;
    931        1.1  reinoud 			// offset = (offset & ~7);
    932        1.1  reinoud 		}
    933        1.1  reinoud 	}
    934        1.1  reinoud 
    935        1.1  reinoud 	if (ismetadata) {
    936        1.1  reinoud 		bitmap->metadata_pos = offset;
    937        1.1  reinoud 	} else {
    938        1.1  reinoud 		bitmap->data_pos = offset;
    939        1.1  reinoud 	}
    940        1.1  reinoud }
    941        1.1  reinoud 
    942        1.1  reinoud 
    943        1.1  reinoud static void
    944        1.1  reinoud udf_bitmap_free(struct udf_bitmap *bitmap, uint32_t lb_num, uint32_t num_lb)
    945        1.1  reinoud {
    946        1.1  reinoud 	uint32_t offset;
    947        1.1  reinoud 	uint32_t bit, bitval;
    948        1.1  reinoud 	uint8_t *bpos;
    949        1.1  reinoud 
    950        1.1  reinoud 	offset = lb_num;
    951        1.1  reinoud 
    952        1.1  reinoud 	/* starter bits */
    953        1.1  reinoud 	bpos = bitmap->bits + offset/8;
    954        1.1  reinoud 	bit = offset % 8;
    955        1.1  reinoud 	while ((bit != 0) && (num_lb > 0)) {
    956        1.1  reinoud 		bitval = (1 << bit);
    957        1.1  reinoud 		KASSERT((*bpos & bitval) == 0);
    958        1.9  reinoud 		DPRINTF(PARANOIA, ("XXX : free %d, %p, %d\n",
    959        1.9  reinoud 			offset, bpos, bit));
    960        1.1  reinoud 		*bpos |= bitval;
    961        1.1  reinoud 		offset++; num_lb--;
    962        1.1  reinoud 		bit = (bit + 1) % 8;
    963        1.1  reinoud 	}
    964        1.1  reinoud 	if (num_lb == 0)
    965        1.1  reinoud 		return;
    966        1.1  reinoud 
    967        1.1  reinoud 	/* whole bytes */
    968        1.1  reinoud 	KASSERT(bit == 0);
    969        1.1  reinoud 	bpos = bitmap->bits + offset / 8;
    970        1.1  reinoud 	while (num_lb >= 8) {
    971        1.1  reinoud 		KASSERT((*bpos == 0));
    972        1.9  reinoud 		DPRINTF(PARANOIA, ("XXX : free %d + 8, %p\n", offset, bpos));
    973        1.1  reinoud 		*bpos = 255;
    974        1.1  reinoud 		offset += 8; num_lb -= 8;
    975        1.1  reinoud 		bpos++;
    976        1.1  reinoud 	}
    977        1.1  reinoud 
    978        1.1  reinoud 	/* stop bits */
    979        1.1  reinoud 	KASSERT(num_lb < 8);
    980        1.1  reinoud 	bit = 0;
    981        1.1  reinoud 	while (num_lb > 0) {
    982        1.1  reinoud 		bitval = (1 << bit);
    983        1.1  reinoud 		KASSERT((*bpos & bitval) == 0);
    984        1.9  reinoud 		DPRINTF(PARANOIA, ("XXX : free %d, %p, %d\n",
    985        1.9  reinoud 			offset, bpos, bit));
    986        1.1  reinoud 		*bpos |= bitval;
    987        1.1  reinoud 		offset++; num_lb--;
    988        1.1  reinoud 		bit = (bit + 1) % 8;
    989        1.1  reinoud 	}
    990        1.1  reinoud }
    991        1.1  reinoud 
    992       1.28  reinoud 
    993       1.28  reinoud static uint32_t
    994       1.28  reinoud udf_bitmap_check_trunc_free(struct udf_bitmap *bitmap, uint32_t to_trunc)
    995       1.28  reinoud {
    996       1.28  reinoud 	uint32_t seq_free, offset;
    997       1.28  reinoud 	uint8_t *bpos;
    998       1.28  reinoud 	uint8_t  bit, bitval;
    999       1.28  reinoud 
   1000       1.28  reinoud 	DPRINTF(RESERVE, ("\ttrying to trunc %d bits from bitmap\n", to_trunc));
   1001       1.28  reinoud 	offset = bitmap->max_offset - to_trunc;
   1002       1.28  reinoud 
   1003       1.28  reinoud 	/* starter bits (if any) */
   1004       1.28  reinoud 	bpos = bitmap->bits + offset/8;
   1005       1.28  reinoud 	bit = offset % 8;
   1006       1.28  reinoud 	seq_free = 0;
   1007       1.28  reinoud 	while (to_trunc > 0) {
   1008       1.28  reinoud 		seq_free++;
   1009       1.28  reinoud 		bitval = (1 << bit);
   1010       1.28  reinoud 		if (!(*bpos & bitval))
   1011       1.28  reinoud 			seq_free = 0;
   1012       1.28  reinoud 		offset++; to_trunc--;
   1013       1.28  reinoud 		bit++;
   1014       1.28  reinoud 		if (bit == 8) {
   1015       1.28  reinoud 			bpos++;
   1016       1.28  reinoud 			bit = 0;
   1017       1.28  reinoud 		}
   1018       1.28  reinoud 	}
   1019       1.28  reinoud 
   1020       1.28  reinoud 	DPRINTF(RESERVE, ("\tfound %d sequential free bits in bitmap\n", seq_free));
   1021       1.28  reinoud 	return seq_free;
   1022       1.28  reinoud }
   1023       1.28  reinoud 
   1024       1.26  reinoud /* --------------------------------------------------------------------- */
   1025       1.26  reinoud 
   1026       1.26  reinoud /*
   1027       1.26  reinoud  * We check for overall disc space with a margin to prevent critical
   1028       1.26  reinoud  * conditions.  If disc space is low we try to force a sync() to improve our
   1029       1.26  reinoud  * estimates.  When confronted with meta-data partition size shortage we know
   1030       1.26  reinoud  * we have to check if it can be extended and we need to extend it when
   1031       1.26  reinoud  * needed.
   1032       1.26  reinoud  *
   1033       1.26  reinoud  * A 2nd strategy we could use when disc space is getting low on a disc
   1034       1.26  reinoud  * formatted with a meta-data partition is to see if there are sparse areas in
   1035       1.26  reinoud  * the meta-data partition and free blocks there for extra data.
   1036       1.26  reinoud  */
   1037       1.26  reinoud 
   1038       1.26  reinoud void
   1039       1.26  reinoud udf_do_reserve_space(struct udf_mount *ump, struct udf_node *udf_node,
   1040       1.26  reinoud 	uint16_t vpart_num, uint32_t num_lb)
   1041       1.26  reinoud {
   1042       1.26  reinoud 	ump->uncommitted_lbs[vpart_num] += num_lb;
   1043       1.26  reinoud 	if (udf_node)
   1044       1.26  reinoud 		udf_node->uncommitted_lbs += num_lb;
   1045       1.26  reinoud }
   1046       1.26  reinoud 
   1047       1.26  reinoud 
   1048       1.26  reinoud void
   1049       1.26  reinoud udf_do_unreserve_space(struct udf_mount *ump, struct udf_node *udf_node,
   1050       1.26  reinoud 	uint16_t vpart_num, uint32_t num_lb)
   1051       1.26  reinoud {
   1052       1.26  reinoud 	ump->uncommitted_lbs[vpart_num] -= num_lb;
   1053       1.26  reinoud 	if (ump->uncommitted_lbs[vpart_num] < 0) {
   1054       1.26  reinoud 		DPRINTF(RESERVE, ("UDF: underflow on partition reservation, "
   1055       1.26  reinoud 			"part %d: %d\n", vpart_num,
   1056       1.26  reinoud 			ump->uncommitted_lbs[vpart_num]));
   1057       1.26  reinoud 		ump->uncommitted_lbs[vpart_num] = 0;
   1058       1.26  reinoud 	}
   1059       1.26  reinoud 	if (udf_node) {
   1060       1.26  reinoud 		udf_node->uncommitted_lbs -= num_lb;
   1061       1.26  reinoud 		if (udf_node->uncommitted_lbs < 0) {
   1062       1.26  reinoud 			DPRINTF(RESERVE, ("UDF: underflow of node "
   1063       1.26  reinoud 				"reservation : %d\n",
   1064       1.26  reinoud 				udf_node->uncommitted_lbs));
   1065       1.26  reinoud 			udf_node->uncommitted_lbs = 0;
   1066       1.26  reinoud 		}
   1067       1.26  reinoud 	}
   1068       1.26  reinoud }
   1069       1.26  reinoud 
   1070       1.26  reinoud 
   1071       1.26  reinoud int
   1072       1.26  reinoud udf_reserve_space(struct udf_mount *ump, struct udf_node *udf_node,
   1073       1.26  reinoud 	int udf_c_type, uint16_t vpart_num, uint32_t num_lb, int can_fail)
   1074       1.26  reinoud {
   1075       1.26  reinoud 	uint64_t freeblks;
   1076       1.26  reinoud 	uint64_t slack;
   1077       1.26  reinoud 	int i, error;
   1078       1.26  reinoud 
   1079       1.26  reinoud 	slack = 0;
   1080       1.26  reinoud 	if (can_fail)
   1081       1.26  reinoud 		slack = UDF_DISC_SLACK;
   1082       1.26  reinoud 
   1083       1.26  reinoud 	error = 0;
   1084       1.26  reinoud 	mutex_enter(&ump->allocate_mutex);
   1085       1.26  reinoud 
   1086       1.26  reinoud 	/* check if there is enough space available */
   1087       1.28  reinoud 	for (i = 0; i < 3; i++) {	/* XXX arbitrary number */
   1088       1.26  reinoud 		udf_calc_vpart_freespace(ump, vpart_num, &freeblks);
   1089       1.26  reinoud 		if (num_lb + slack < freeblks)
   1090       1.26  reinoud 			break;
   1091       1.26  reinoud 		/* issue SYNC */
   1092       1.26  reinoud 		DPRINTF(RESERVE, ("udf_reserve_space: issuing sync\n"));
   1093       1.26  reinoud 		mutex_exit(&ump->allocate_mutex);
   1094       1.26  reinoud 		udf_do_sync(ump, FSCRED, 0);
   1095       1.26  reinoud 		mutex_enter(&mntvnode_lock);
   1096       1.28  reinoud 		/* 1/8 second wait */
   1097       1.26  reinoud 		cv_timedwait(&ump->dirtynodes_cv, &mntvnode_lock,
   1098       1.28  reinoud 			hz/8);
   1099       1.26  reinoud 		mutex_exit(&mntvnode_lock);
   1100       1.26  reinoud 		mutex_enter(&ump->allocate_mutex);
   1101       1.26  reinoud 	}
   1102       1.26  reinoud 
   1103       1.26  reinoud 	/* check if there is enough space available now */
   1104       1.26  reinoud 	udf_calc_vpart_freespace(ump, vpart_num, &freeblks);
   1105       1.26  reinoud 	if (num_lb + slack >= freeblks) {
   1106       1.28  reinoud 		DPRINTF(RESERVE, ("udf_reserve_space: try to redistribute "
   1107       1.28  reinoud 				  "partition space\n"));
   1108       1.28  reinoud 		DPRINTF(RESERVE, ("\tvpart %d, type %d is full\n",
   1109       1.28  reinoud 				vpart_num, ump->vtop_alloc[vpart_num]));
   1110       1.28  reinoud 		/* Try to redistribute space if possible */
   1111       1.28  reinoud 		udf_collect_free_space_for_vpart(ump, vpart_num, num_lb + slack);
   1112       1.26  reinoud 	}
   1113       1.26  reinoud 
   1114       1.26  reinoud 	/* check if there is enough space available now */
   1115       1.26  reinoud 	udf_calc_vpart_freespace(ump, vpart_num, &freeblks);
   1116       1.26  reinoud 	if (num_lb + slack <= freeblks) {
   1117       1.26  reinoud 		udf_do_reserve_space(ump, udf_node, vpart_num, num_lb);
   1118       1.26  reinoud 	} else {
   1119       1.26  reinoud 		DPRINTF(RESERVE, ("udf_reserve_space: out of disc space\n"));
   1120       1.26  reinoud 		error = ENOSPC;
   1121       1.26  reinoud 	}
   1122       1.26  reinoud 
   1123       1.26  reinoud 	mutex_exit(&ump->allocate_mutex);
   1124       1.26  reinoud 	return error;
   1125       1.26  reinoud }
   1126       1.26  reinoud 
   1127       1.26  reinoud 
   1128       1.26  reinoud void
   1129       1.26  reinoud udf_cleanup_reservation(struct udf_node *udf_node)
   1130       1.26  reinoud {
   1131       1.26  reinoud 	struct udf_mount *ump = udf_node->ump;
   1132       1.26  reinoud 	int vpart_num;
   1133       1.26  reinoud 
   1134       1.26  reinoud 	mutex_enter(&ump->allocate_mutex);
   1135       1.26  reinoud 
   1136       1.26  reinoud 	/* compensate for overlapping blocks */
   1137       1.26  reinoud 	DPRINTF(RESERVE, ("UDF: overlapped %d blocks in count\n", udf_node->uncommitted_lbs));
   1138       1.26  reinoud 
   1139       1.26  reinoud 	vpart_num = udf_get_record_vpart(ump, udf_get_c_type(udf_node));
   1140       1.26  reinoud 	udf_do_unreserve_space(ump, udf_node, vpart_num, udf_node->uncommitted_lbs);
   1141       1.26  reinoud 
   1142       1.26  reinoud 	DPRINTF(RESERVE, ("\ttotal now %d\n", ump->uncommitted_lbs[vpart_num]));
   1143       1.26  reinoud 
   1144       1.26  reinoud 	/* sanity */
   1145       1.26  reinoud 	if (ump->uncommitted_lbs[vpart_num] < 0)
   1146       1.26  reinoud 		ump->uncommitted_lbs[vpart_num] = 0;
   1147       1.26  reinoud 
   1148       1.26  reinoud 	mutex_exit(&ump->allocate_mutex);
   1149       1.26  reinoud }
   1150       1.26  reinoud 
   1151       1.26  reinoud /* --------------------------------------------------------------------- */
   1152       1.26  reinoud 
   1153       1.26  reinoud /*
   1154       1.26  reinoud  * Allocate an extent of given length on given virt. partition. It doesn't
   1155       1.26  reinoud  * have to be one stretch.
   1156       1.26  reinoud  */
   1157        1.1  reinoud 
   1158       1.26  reinoud int
   1159       1.26  reinoud udf_allocate_space(struct udf_mount *ump, struct udf_node *udf_node,
   1160       1.26  reinoud 	int udf_c_type, uint16_t vpart_num, uint32_t num_lb, uint64_t *lmapping)
   1161        1.1  reinoud {
   1162        1.1  reinoud 	struct mmc_trackinfo *alloc_track, *other_track;
   1163        1.1  reinoud 	struct udf_bitmap *bitmap;
   1164        1.1  reinoud 	struct part_desc *pdesc;
   1165        1.1  reinoud 	struct logvol_int_desc *lvid;
   1166       1.16  reinoud 	uint64_t *lmappos;
   1167        1.1  reinoud 	uint32_t ptov, lb_num, *freepos, free_lbs;
   1168        1.1  reinoud 	int lb_size, alloc_num_lb;
   1169       1.17  reinoud 	int alloc_type, error;
   1170       1.17  reinoud 	int is_node;
   1171        1.1  reinoud 
   1172       1.17  reinoud 	DPRINTF(CALL, ("udf_allocate_space(ctype %d, vpart %d, num_lb %d\n",
   1173       1.17  reinoud 		udf_c_type, vpart_num, num_lb));
   1174        1.1  reinoud 	mutex_enter(&ump->allocate_mutex);
   1175       1.16  reinoud 
   1176        1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1177        1.1  reinoud 	KASSERT(lb_size == ump->discinfo.sector_size);
   1178        1.1  reinoud 
   1179       1.17  reinoud 	alloc_type =  ump->vtop_alloc[vpart_num];
   1180       1.17  reinoud 	is_node    = (udf_c_type == UDF_C_NODE);
   1181        1.1  reinoud 
   1182        1.1  reinoud 	lmappos = lmapping;
   1183       1.16  reinoud 	error = 0;
   1184        1.1  reinoud 	switch (alloc_type) {
   1185        1.1  reinoud 	case UDF_ALLOC_VAT :
   1186        1.1  reinoud 		/* search empty slot in VAT file */
   1187        1.1  reinoud 		KASSERT(num_lb == 1);
   1188        1.1  reinoud 		error = udf_search_free_vatloc(ump, &lb_num);
   1189       1.26  reinoud 		if (!error) {
   1190        1.1  reinoud 			*lmappos = lb_num;
   1191       1.26  reinoud 
   1192       1.26  reinoud 			/* reserve on the backing sequential partition since
   1193       1.26  reinoud 			 * that partition is credited back later */
   1194       1.26  reinoud 			udf_do_reserve_space(ump, udf_node,
   1195       1.26  reinoud 				ump->vtop[vpart_num], num_lb);
   1196       1.26  reinoud 		}
   1197        1.1  reinoud 		break;
   1198        1.1  reinoud 	case UDF_ALLOC_SEQUENTIAL :
   1199        1.1  reinoud 		/* sequential allocation on recordable media */
   1200       1.17  reinoud 		/* get partition backing up this vpart_num_num */
   1201       1.17  reinoud 		pdesc = ump->partitions[ump->vtop[vpart_num]];
   1202       1.16  reinoud 
   1203        1.1  reinoud 		/* calculate offset from physical base partition */
   1204        1.1  reinoud 		ptov  = udf_rw32(pdesc->start_loc);
   1205        1.1  reinoud 
   1206       1.17  reinoud 		/* get our track descriptors */
   1207       1.17  reinoud 		if (vpart_num == ump->node_part) {
   1208       1.17  reinoud 			alloc_track = &ump->metadata_track;
   1209       1.17  reinoud 			other_track = &ump->data_track;
   1210       1.17  reinoud 		} else {
   1211       1.17  reinoud 			alloc_track = &ump->data_track;
   1212       1.17  reinoud 			other_track = &ump->metadata_track;
   1213       1.17  reinoud 		}
   1214       1.17  reinoud 
   1215       1.17  reinoud 		/* allocate */
   1216        1.1  reinoud 		for (lb_num = 0; lb_num < num_lb; lb_num++) {
   1217        1.1  reinoud 			*lmappos++ = alloc_track->next_writable - ptov;
   1218        1.1  reinoud 			alloc_track->next_writable++;
   1219        1.1  reinoud 			alloc_track->free_blocks--;
   1220        1.1  reinoud 		}
   1221       1.17  reinoud 
   1222       1.17  reinoud 		/* keep other track up-to-date */
   1223        1.1  reinoud 		if (alloc_track->tracknr == other_track->tracknr)
   1224        1.1  reinoud 			memcpy(other_track, alloc_track,
   1225        1.1  reinoud 				sizeof(struct mmc_trackinfo));
   1226        1.1  reinoud 		break;
   1227        1.1  reinoud 	case UDF_ALLOC_SPACEMAP :
   1228       1.16  reinoud 		/* try to allocate on unallocated bits */
   1229        1.1  reinoud 		alloc_num_lb = num_lb;
   1230       1.17  reinoud 		bitmap = &ump->part_unalloc_bits[vpart_num];
   1231       1.17  reinoud 		udf_bitmap_allocate(bitmap, is_node, &alloc_num_lb, lmappos);
   1232        1.1  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1233       1.16  reinoud 
   1234       1.16  reinoud 		/* have we allocated all? */
   1235        1.1  reinoud 		if (alloc_num_lb) {
   1236        1.1  reinoud 			/* TODO convert freed to unalloc and try again */
   1237        1.1  reinoud 			/* free allocated piece for now */
   1238        1.1  reinoud 			lmappos = lmapping;
   1239        1.1  reinoud 			for (lb_num=0; lb_num < num_lb-alloc_num_lb; lb_num++) {
   1240        1.1  reinoud 				udf_bitmap_free(bitmap, *lmappos++, 1);
   1241        1.1  reinoud 			}
   1242        1.1  reinoud 			error = ENOSPC;
   1243        1.1  reinoud 		}
   1244        1.1  reinoud 		if (!error) {
   1245        1.1  reinoud 			/* adjust freecount */
   1246        1.1  reinoud 			lvid = ump->logvol_integrity;
   1247       1.17  reinoud 			freepos = &lvid->tables[0] + vpart_num;
   1248        1.1  reinoud 			free_lbs = udf_rw32(*freepos);
   1249        1.1  reinoud 			*freepos = udf_rw32(free_lbs - num_lb);
   1250        1.1  reinoud 		}
   1251        1.1  reinoud 		break;
   1252       1.15  reinoud 	case UDF_ALLOC_METABITMAP :		/* UDF 2.50, 2.60 BluRay-RE */
   1253       1.16  reinoud 		/* allocate on metadata unallocated bits */
   1254       1.16  reinoud 		alloc_num_lb = num_lb;
   1255       1.16  reinoud 		bitmap = &ump->metadata_unalloc_bits;
   1256       1.17  reinoud 		udf_bitmap_allocate(bitmap, is_node, &alloc_num_lb, lmappos);
   1257       1.16  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1258       1.16  reinoud 
   1259       1.16  reinoud 		/* have we allocated all? */
   1260       1.17  reinoud 		if (alloc_num_lb) {
   1261       1.16  reinoud 			/* YIKES! TODO we need to extend the metadata partition */
   1262       1.16  reinoud 			/* free allocated piece for now */
   1263       1.16  reinoud 			lmappos = lmapping;
   1264       1.16  reinoud 			for (lb_num=0; lb_num < num_lb-alloc_num_lb; lb_num++) {
   1265       1.16  reinoud 				udf_bitmap_free(bitmap, *lmappos++, 1);
   1266       1.16  reinoud 			}
   1267       1.16  reinoud 			error = ENOSPC;
   1268       1.16  reinoud 		}
   1269       1.16  reinoud 		if (!error) {
   1270       1.16  reinoud 			/* adjust freecount */
   1271       1.16  reinoud 			lvid = ump->logvol_integrity;
   1272       1.17  reinoud 			freepos = &lvid->tables[0] + vpart_num;
   1273       1.16  reinoud 			free_lbs = udf_rw32(*freepos);
   1274       1.16  reinoud 			*freepos = udf_rw32(free_lbs - num_lb);
   1275       1.16  reinoud 		}
   1276       1.16  reinoud 		break;
   1277       1.15  reinoud 	case UDF_ALLOC_METASEQUENTIAL :		/* UDF 2.60       BluRay-R  */
   1278       1.15  reinoud 	case UDF_ALLOC_RELAXEDSEQUENTIAL :	/* UDF 2.50/~meta BluRay-R  */
   1279        1.1  reinoud 		printf("ALERT: udf_allocate_space : allocation %d "
   1280        1.1  reinoud 				"not implemented yet!\n", alloc_type);
   1281        1.1  reinoud 		/* TODO implement, doesn't have to be contiguous */
   1282        1.1  reinoud 		error = ENOSPC;
   1283        1.1  reinoud 		break;
   1284        1.1  reinoud 	}
   1285        1.1  reinoud 
   1286       1.26  reinoud 	if (!error) {
   1287       1.26  reinoud 		/* credit our partition since we have committed the space */
   1288       1.26  reinoud 		udf_do_unreserve_space(ump, udf_node, vpart_num, num_lb);
   1289       1.26  reinoud 	}
   1290       1.26  reinoud 
   1291        1.1  reinoud #ifdef DEBUG
   1292        1.1  reinoud 	if (udf_verbose & UDF_DEBUG_ALLOC) {
   1293        1.1  reinoud 		lmappos = lmapping;
   1294       1.16  reinoud 		printf("udf_allocate_space, allocated logical lba :\n");
   1295        1.1  reinoud 		for (lb_num = 0; lb_num < num_lb; lb_num++) {
   1296       1.25  reinoud 			printf("%s %"PRIu64, (lb_num > 0)?",":"",
   1297       1.16  reinoud 				*lmappos++);
   1298        1.1  reinoud 		}
   1299       1.16  reinoud 		printf("\n");
   1300        1.1  reinoud 	}
   1301        1.1  reinoud #endif
   1302        1.1  reinoud 	mutex_exit(&ump->allocate_mutex);
   1303        1.1  reinoud 
   1304        1.1  reinoud 	return error;
   1305        1.1  reinoud }
   1306        1.1  reinoud 
   1307        1.1  reinoud /* --------------------------------------------------------------------- */
   1308        1.1  reinoud 
   1309        1.1  reinoud void
   1310        1.1  reinoud udf_free_allocated_space(struct udf_mount *ump, uint32_t lb_num,
   1311        1.1  reinoud 	uint16_t vpart_num, uint32_t num_lb)
   1312        1.1  reinoud {
   1313        1.1  reinoud 	struct udf_bitmap *bitmap;
   1314        1.1  reinoud 	struct part_desc *pdesc;
   1315        1.1  reinoud 	struct logvol_int_desc *lvid;
   1316        1.1  reinoud 	uint32_t ptov, lb_map, udf_rw32_lbmap;
   1317        1.1  reinoud 	uint32_t *freepos, free_lbs;
   1318        1.1  reinoud 	int phys_part;
   1319        1.1  reinoud 	int error;
   1320        1.1  reinoud 
   1321        1.1  reinoud 	DPRINTF(ALLOC, ("udf_free_allocated_space: freeing virt lbnum %d "
   1322        1.1  reinoud 			  "part %d + %d sect\n", lb_num, vpart_num, num_lb));
   1323        1.1  reinoud 
   1324       1.10  reinoud 	/* no use freeing zero length */
   1325       1.10  reinoud 	if (num_lb == 0)
   1326       1.10  reinoud 		return;
   1327       1.10  reinoud 
   1328        1.1  reinoud 	mutex_enter(&ump->allocate_mutex);
   1329        1.1  reinoud 
   1330        1.1  reinoud 	/* get partition backing up this vpart_num */
   1331        1.1  reinoud 	pdesc = ump->partitions[ump->vtop[vpart_num]];
   1332        1.1  reinoud 
   1333        1.1  reinoud 	switch (ump->vtop_tp[vpart_num]) {
   1334        1.1  reinoud 	case UDF_VTOP_TYPE_PHYS :
   1335        1.1  reinoud 	case UDF_VTOP_TYPE_SPARABLE :
   1336        1.1  reinoud 		/* free space to freed or unallocated space bitmap */
   1337        1.1  reinoud 		ptov      = udf_rw32(pdesc->start_loc);
   1338        1.1  reinoud 		phys_part = ump->vtop[vpart_num];
   1339        1.1  reinoud 
   1340        1.1  reinoud 		/* first try freed space bitmap */
   1341        1.1  reinoud 		bitmap    = &ump->part_freed_bits[phys_part];
   1342        1.1  reinoud 
   1343        1.1  reinoud 		/* if not defined, use unallocated bitmap */
   1344        1.1  reinoud 		if (bitmap->bits == NULL)
   1345        1.1  reinoud 			bitmap = &ump->part_unalloc_bits[phys_part];
   1346        1.1  reinoud 
   1347       1.17  reinoud 		/* if no bitmaps are defined, bail out; XXX OK? */
   1348        1.1  reinoud 		if (bitmap->bits == NULL)
   1349        1.1  reinoud 			break;
   1350        1.1  reinoud 
   1351        1.1  reinoud 		/* free bits if its defined */
   1352        1.1  reinoud 		KASSERT(bitmap->bits);
   1353        1.1  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1354        1.1  reinoud 		udf_bitmap_free(bitmap, lb_num, num_lb);
   1355        1.1  reinoud 
   1356        1.1  reinoud 		/* adjust freecount */
   1357        1.1  reinoud 		lvid = ump->logvol_integrity;
   1358        1.1  reinoud 		freepos = &lvid->tables[0] + vpart_num;
   1359        1.1  reinoud 		free_lbs = udf_rw32(*freepos);
   1360        1.1  reinoud 		*freepos = udf_rw32(free_lbs + num_lb);
   1361        1.1  reinoud 		break;
   1362        1.1  reinoud 	case UDF_VTOP_TYPE_VIRT :
   1363        1.1  reinoud 		/* free this VAT entry */
   1364        1.1  reinoud 		KASSERT(num_lb == 1);
   1365        1.1  reinoud 
   1366        1.1  reinoud 		lb_map = 0xffffffff;
   1367        1.1  reinoud 		udf_rw32_lbmap = udf_rw32(lb_map);
   1368        1.1  reinoud 		error = udf_vat_write(ump->vat_node,
   1369        1.1  reinoud 			(uint8_t *) &udf_rw32_lbmap, 4,
   1370        1.1  reinoud 			ump->vat_offset + lb_num * 4);
   1371        1.1  reinoud 		KASSERT(error == 0);
   1372        1.1  reinoud 		ump->vat_last_free_lb = MIN(ump->vat_last_free_lb, lb_num);
   1373        1.1  reinoud 		break;
   1374        1.1  reinoud 	case UDF_VTOP_TYPE_META :
   1375        1.1  reinoud 		/* free space in the metadata bitmap */
   1376       1.17  reinoud 		bitmap = &ump->metadata_unalloc_bits;
   1377       1.17  reinoud 		KASSERT(bitmap->bits);
   1378       1.17  reinoud 
   1379       1.17  reinoud 		ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1380       1.17  reinoud 		udf_bitmap_free(bitmap, lb_num, num_lb);
   1381       1.17  reinoud 
   1382       1.17  reinoud 		/* adjust freecount */
   1383       1.17  reinoud 		lvid = ump->logvol_integrity;
   1384       1.17  reinoud 		freepos = &lvid->tables[0] + vpart_num;
   1385       1.17  reinoud 		free_lbs = udf_rw32(*freepos);
   1386       1.17  reinoud 		*freepos = udf_rw32(free_lbs + num_lb);
   1387       1.17  reinoud 		break;
   1388        1.1  reinoud 	default:
   1389        1.1  reinoud 		printf("ALERT: udf_free_allocated_space : allocation %d "
   1390        1.1  reinoud 			"not implemented yet!\n", ump->vtop_tp[vpart_num]);
   1391        1.1  reinoud 		break;
   1392        1.1  reinoud 	}
   1393        1.1  reinoud 
   1394        1.1  reinoud 	mutex_exit(&ump->allocate_mutex);
   1395        1.1  reinoud }
   1396        1.1  reinoud 
   1397        1.1  reinoud /* --------------------------------------------------------------------- */
   1398        1.1  reinoud 
   1399        1.1  reinoud /*
   1400       1.28  reinoud  * Special function to synchronise the metadatamirror file when they change on
   1401       1.28  reinoud  * resizing. When the metadatafile is actually duplicated, this action is a
   1402       1.28  reinoud  * no-op since they describe different extents on the disc.
   1403       1.28  reinoud  */
   1404       1.28  reinoud 
   1405       1.31  reinoud void
   1406       1.31  reinoud udf_synchronise_metadatamirror_node(struct udf_mount *ump)
   1407       1.28  reinoud {
   1408       1.28  reinoud 	struct udf_node *meta_node, *metamirror_node;
   1409       1.28  reinoud 	struct long_ad s_ad;
   1410       1.31  reinoud 	uint32_t len, flags;
   1411       1.28  reinoud 	int slot, cpy_slot;
   1412       1.28  reinoud 	int error, eof;
   1413       1.28  reinoud 
   1414       1.28  reinoud 	if (ump->metadata_flags & METADATA_DUPLICATED)
   1415       1.28  reinoud 		return;
   1416       1.28  reinoud 
   1417       1.28  reinoud 	meta_node       = ump->metadata_node;
   1418       1.28  reinoud 	metamirror_node = ump->metadatamirror_node;
   1419       1.28  reinoud 
   1420       1.28  reinoud 	/* 1) wipe mirror node */
   1421       1.28  reinoud 	udf_wipe_adslots(metamirror_node);
   1422       1.28  reinoud 
   1423       1.28  reinoud 	/* 2) copy all node descriptors from the meta_node */
   1424       1.28  reinoud 	slot     = 0;
   1425       1.28  reinoud 	cpy_slot = 0;
   1426       1.28  reinoud 	for (;;) {
   1427       1.28  reinoud 		udf_get_adslot(meta_node, slot, &s_ad, &eof);
   1428       1.28  reinoud 		if (eof)
   1429       1.28  reinoud 			break;
   1430       1.31  reinoud 		len   = udf_rw32(s_ad.len);
   1431       1.31  reinoud 		flags = UDF_EXT_FLAGS(len);
   1432       1.31  reinoud 		len   = UDF_EXT_LEN(len);
   1433       1.31  reinoud 
   1434       1.31  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   1435       1.31  reinoud 			slot++;
   1436       1.31  reinoud 			continue;
   1437       1.31  reinoud 		}
   1438       1.31  reinoud 
   1439       1.28  reinoud 		error = udf_append_adslot(metamirror_node, &cpy_slot, &s_ad);
   1440       1.28  reinoud 		if (error) {
   1441       1.28  reinoud 			/* WTF, this shouldn't happen, what to do now? */
   1442       1.28  reinoud 			panic("udf_synchronise_metadatamirror_node failed!");
   1443       1.28  reinoud 		}
   1444       1.31  reinoud 		cpy_slot++;
   1445       1.28  reinoud 		slot++;
   1446       1.28  reinoud 	}
   1447       1.28  reinoud 
   1448       1.28  reinoud 	/* 3) adjust metamirror_node size */
   1449       1.28  reinoud 	if (meta_node->fe) {
   1450       1.28  reinoud 		KASSERT(metamirror_node->fe);
   1451       1.28  reinoud 		metamirror_node->fe->inf_len = meta_node->fe->inf_len;
   1452       1.28  reinoud 	} else {
   1453       1.28  reinoud 		KASSERT(meta_node->efe);
   1454       1.28  reinoud 		KASSERT(metamirror_node->efe);
   1455       1.28  reinoud 		metamirror_node->efe->inf_len  = meta_node->efe->inf_len;
   1456       1.28  reinoud 		metamirror_node->efe->obj_size = meta_node->efe->obj_size;
   1457       1.28  reinoud 	}
   1458       1.28  reinoud 
   1459       1.28  reinoud 	/* for sanity */
   1460       1.28  reinoud 	udf_count_alloc_exts(metamirror_node);
   1461       1.28  reinoud }
   1462       1.28  reinoud 
   1463       1.28  reinoud /* --------------------------------------------------------------------- */
   1464       1.28  reinoud 
   1465       1.28  reinoud /*
   1466       1.28  reinoud  * When faced with an out of space but there is still space available on other
   1467       1.28  reinoud  * partitions, try to redistribute the space. This is only defined for media
   1468       1.28  reinoud  * using Metadata partitions.
   1469       1.28  reinoud  *
   1470       1.28  reinoud  * There are two formats to deal with. Either its a `normal' metadata
   1471       1.28  reinoud  * partition and we can move blocks between a metadata bitmap and its
   1472       1.28  reinoud  * companion data spacemap OR its a UDF 2.60 formatted BluRay-R disc with POW
   1473       1.28  reinoud  * and a metadata partition.
   1474       1.28  reinoud  */
   1475       1.28  reinoud 
   1476       1.31  reinoud /* implementation limit: ump->datapart is the companion partition */
   1477       1.28  reinoud static uint32_t
   1478       1.28  reinoud udf_trunc_metadatapart(struct udf_mount *ump, uint32_t num_lb)
   1479       1.28  reinoud {
   1480       1.28  reinoud 	struct udf_node *bitmap_node;
   1481       1.28  reinoud 	struct udf_bitmap *bitmap;
   1482       1.28  reinoud 	struct space_bitmap_desc *sbd, *new_sbd;
   1483       1.28  reinoud 	struct logvol_int_desc *lvid;
   1484       1.28  reinoud 	uint64_t inf_len;
   1485       1.31  reinoud 	uint64_t meta_free_lbs, data_free_lbs, to_trunc;
   1486       1.28  reinoud 	uint32_t *freepos, *sizepos;
   1487       1.31  reinoud 	uint32_t unit, lb_size;
   1488       1.28  reinoud 	uint16_t meta_vpart_num, data_vpart_num, num_vpart;
   1489       1.28  reinoud 	int err;
   1490       1.28  reinoud 
   1491       1.28  reinoud 	unit = ump->metadata_alloc_unit_size;
   1492       1.28  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1493       1.28  reinoud 	lvid = ump->logvol_integrity;
   1494       1.28  reinoud 
   1495       1.31  reinoud 	/* XXX
   1496       1.31  reinoud 	 *
   1497       1.31  reinoud 	 * the following checks will fail for BD-R UDF 2.60! but they are
   1498       1.31  reinoud 	 * read-only for now anyway! Its even doubtfull if it is to be allowed
   1499       1.31  reinoud 	 * for these discs.
   1500       1.31  reinoud 	 */
   1501       1.31  reinoud 
   1502       1.28  reinoud 	/* lookup vpart for metadata partition */
   1503       1.28  reinoud 	meta_vpart_num = ump->node_part;
   1504       1.28  reinoud 	KASSERT(ump->vtop_alloc[meta_vpart_num] == UDF_ALLOC_METABITMAP);
   1505       1.28  reinoud 
   1506       1.28  reinoud 	/* lookup vpart for data partition */
   1507       1.28  reinoud 	data_vpart_num = ump->data_part;
   1508       1.28  reinoud 	KASSERT(ump->vtop_alloc[data_vpart_num] == UDF_ALLOC_SPACEMAP);
   1509       1.28  reinoud 
   1510       1.28  reinoud 	udf_calc_vpart_freespace(ump, data_vpart_num, &data_free_lbs);
   1511       1.28  reinoud 	udf_calc_vpart_freespace(ump, meta_vpart_num, &meta_free_lbs);
   1512       1.28  reinoud 
   1513       1.28  reinoud 	DPRINTF(RESERVE, ("\tfree space on data partition     %"PRIu64" blks\n", data_free_lbs));
   1514       1.28  reinoud 	DPRINTF(RESERVE, ("\tfree space on metadata partition %"PRIu64" blks\n", meta_free_lbs));
   1515       1.28  reinoud 
   1516       1.28  reinoud 	/* give away some of the free meta space, in unit block sizes */
   1517       1.29  reinoud 	to_trunc = meta_free_lbs/4;			/* give out a quarter */
   1518       1.28  reinoud 	to_trunc = MAX(to_trunc, num_lb);
   1519       1.28  reinoud 	to_trunc = unit * ((to_trunc + unit-1) / unit);	/* round up */
   1520       1.28  reinoud 
   1521       1.28  reinoud 	/* scale down if needed and bail out when out of space */
   1522       1.28  reinoud 	if (to_trunc >= meta_free_lbs)
   1523       1.28  reinoud 		return num_lb;
   1524       1.28  reinoud 
   1525       1.28  reinoud 	/* check extent of bits marked free at the end of the map */
   1526       1.28  reinoud 	bitmap = &ump->metadata_unalloc_bits;
   1527       1.28  reinoud 	to_trunc = udf_bitmap_check_trunc_free(bitmap, to_trunc);
   1528       1.28  reinoud 	to_trunc = unit * (to_trunc / unit);		/* round down again */
   1529       1.28  reinoud 	if (to_trunc == 0)
   1530       1.28  reinoud 		return num_lb;
   1531       1.28  reinoud 
   1532       1.31  reinoud 	DPRINTF(RESERVE, ("\ttruncating %"PRIu64" lbs from the metadata bitmap\n",
   1533       1.28  reinoud 		to_trunc));
   1534       1.28  reinoud 
   1535       1.28  reinoud 	/* get length of the metadata bitmap node file */
   1536       1.28  reinoud 	bitmap_node = ump->metadatabitmap_node;
   1537       1.28  reinoud 	if (bitmap_node->fe) {
   1538       1.28  reinoud 		inf_len = udf_rw64(bitmap_node->fe->inf_len);
   1539       1.28  reinoud 	} else {
   1540       1.28  reinoud 		KASSERT(bitmap_node->efe);
   1541       1.28  reinoud 		inf_len = udf_rw64(bitmap_node->efe->inf_len);
   1542       1.28  reinoud 	}
   1543       1.28  reinoud 	inf_len -= to_trunc/8;
   1544       1.28  reinoud 
   1545       1.28  reinoud 	/* as per [UDF 2.60/2.2.13.6] : */
   1546       1.28  reinoud 	/* 1) update the SBD in the metadata bitmap file */
   1547       1.28  reinoud 	sbd = (struct space_bitmap_desc *) bitmap->blob;
   1548       1.31  reinoud 	sbd->num_bits  = udf_rw32(udf_rw32(sbd->num_bits)  - to_trunc);
   1549       1.31  reinoud 	sbd->num_bytes = udf_rw32(udf_rw32(sbd->num_bytes) - to_trunc/8);
   1550       1.28  reinoud 	bitmap->max_offset = udf_rw32(sbd->num_bits);
   1551       1.28  reinoud 
   1552       1.28  reinoud 	num_vpart = udf_rw32(lvid->num_part);
   1553       1.28  reinoud 	freepos = &lvid->tables[0] + meta_vpart_num;
   1554       1.28  reinoud 	sizepos = &lvid->tables[0] + num_vpart + meta_vpart_num;
   1555       1.28  reinoud 	*freepos = udf_rw32(*freepos) - to_trunc;
   1556       1.28  reinoud 	*sizepos = udf_rw32(*sizepos) - to_trunc;
   1557       1.28  reinoud 
   1558       1.28  reinoud 	/* realloc bitmap for better memory usage */
   1559       1.28  reinoud 	new_sbd = realloc(sbd, inf_len, M_UDFVOLD,
   1560       1.28  reinoud 		M_CANFAIL | M_WAITOK);
   1561       1.28  reinoud 	if (new_sbd) {
   1562       1.28  reinoud 		/* update pointers */
   1563       1.28  reinoud 		ump->metadata_unalloc_dscr = new_sbd;
   1564       1.28  reinoud 		bitmap->blob = (uint8_t *) new_sbd;
   1565       1.28  reinoud 	}
   1566       1.28  reinoud 	ump->lvclose |= UDF_WRITE_PART_BITMAPS;
   1567       1.28  reinoud 
   1568       1.28  reinoud 	/*
   1569       1.31  reinoud 	 * The truncated space is secured now and can't be allocated anymore.
   1570       1.31  reinoud 	 * Release the allocate mutex so we can shrink the nodes the normal
   1571       1.31  reinoud 	 * way.
   1572       1.28  reinoud 	 */
   1573       1.28  reinoud 	mutex_exit(&ump->allocate_mutex);
   1574       1.28  reinoud 
   1575       1.28  reinoud 	/* 2) trunc the metadata bitmap information file, freeing blocks */
   1576       1.28  reinoud 	err = udf_shrink_node(bitmap_node, inf_len);
   1577       1.28  reinoud 	KASSERT(err == 0);
   1578       1.28  reinoud 
   1579       1.28  reinoud 	/* 3) trunc the metadata file and mirror file, freeing blocks */
   1580       1.31  reinoud 	inf_len = (uint64_t) udf_rw32(sbd->num_bits) * lb_size;	/* [4/14.12.4] */
   1581       1.28  reinoud 	err = udf_shrink_node(ump->metadata_node, inf_len);
   1582       1.28  reinoud 	KASSERT(err == 0);
   1583       1.31  reinoud 	if (ump->metadatamirror_node) {
   1584       1.31  reinoud 		if (ump->metadata_flags & METADATA_DUPLICATED) {
   1585       1.31  reinoud 			err = udf_shrink_node(ump->metadatamirror_node, inf_len);
   1586       1.31  reinoud 		} else {
   1587       1.31  reinoud 			/* extents will be copied on writeout */
   1588       1.31  reinoud 		}
   1589       1.28  reinoud 		KASSERT(err == 0);
   1590       1.28  reinoud 	}
   1591       1.28  reinoud 	ump->lvclose |= UDF_WRITE_METAPART_NODES;
   1592       1.28  reinoud 
   1593       1.28  reinoud 	/* relock before exit */
   1594       1.28  reinoud 	mutex_enter(&ump->allocate_mutex);
   1595       1.28  reinoud 
   1596       1.28  reinoud 	if (to_trunc > num_lb)
   1597       1.28  reinoud 		return 0;
   1598       1.28  reinoud 	return num_lb - to_trunc;
   1599       1.28  reinoud }
   1600       1.28  reinoud 
   1601       1.28  reinoud 
   1602       1.28  reinoud static void
   1603       1.28  reinoud udf_sparsify_metadatapart(struct udf_mount *ump, uint32_t num_lb)
   1604       1.28  reinoud {
   1605       1.28  reinoud 	/* NOT IMPLEMENTED, fail */
   1606       1.28  reinoud }
   1607       1.28  reinoud 
   1608       1.28  reinoud 
   1609       1.28  reinoud static void
   1610       1.28  reinoud udf_collect_free_space_for_vpart(struct udf_mount *ump,
   1611       1.28  reinoud 	uint16_t vpart_num, uint32_t num_lb)
   1612       1.28  reinoud {
   1613       1.28  reinoud 	/* allocate mutex is helt */
   1614       1.28  reinoud 
   1615       1.28  reinoud 	/* only defined for metadata partitions */
   1616       1.28  reinoud 	if (ump->vtop_tp[ump->node_part] != UDF_VTOP_TYPE_META) {
   1617       1.28  reinoud 		DPRINTF(RESERVE, ("\tcan't grow/shrink; no metadata partitioning\n"));
   1618       1.28  reinoud 		return;
   1619       1.28  reinoud 	}
   1620       1.28  reinoud 
   1621       1.28  reinoud 	/* UDF 2.60 BD-R+POW? */
   1622       1.28  reinoud 	if (ump->vtop_alloc[ump->node_part] == UDF_ALLOC_METASEQUENTIAL) {
   1623       1.28  reinoud 		DPRINTF(RESERVE, ("\tUDF 2.60 BD-R+POW track grow not implemented yet\n"));
   1624       1.28  reinoud 		return;
   1625       1.28  reinoud 	}
   1626       1.28  reinoud 
   1627       1.28  reinoud 	if (ump->vtop_tp[vpart_num] == UDF_VTOP_TYPE_META) {
   1628       1.28  reinoud 		/* try to grow the meta partition */
   1629       1.28  reinoud 		DPRINTF(RESERVE, ("\ttrying to grow the meta partition\n"));
   1630       1.28  reinoud 		/* as per [UDF 2.60/2.2.13.5] : extend bitmap and metadata file(s) */
   1631       1.30  reinoud 		DPRINTF(NOTIMPL, ("\tgrowing meta partition not implemented yet\n"));
   1632       1.28  reinoud 	} else {
   1633       1.28  reinoud 		/* try to shrink the metadata partition */
   1634       1.28  reinoud 		DPRINTF(RESERVE, ("\ttrying to shrink the meta partition\n"));
   1635       1.28  reinoud 		/* as per [UDF 2.60/2.2.13.6] : either trunc or make sparse */
   1636       1.28  reinoud 		num_lb = udf_trunc_metadatapart(ump, num_lb);
   1637       1.28  reinoud 		if (num_lb)
   1638       1.28  reinoud 			udf_sparsify_metadatapart(ump, num_lb);
   1639       1.28  reinoud 	}
   1640       1.28  reinoud 
   1641       1.28  reinoud 	/* allocate mutex should still be helt */
   1642       1.28  reinoud }
   1643       1.28  reinoud 
   1644       1.28  reinoud /* --------------------------------------------------------------------- */
   1645       1.28  reinoud 
   1646       1.28  reinoud /*
   1647        1.1  reinoud  * Allocate a buf on disc for direct write out. The space doesn't have to be
   1648        1.1  reinoud  * contiguous as the caller takes care of this.
   1649        1.1  reinoud  */
   1650        1.1  reinoud 
   1651        1.1  reinoud void
   1652        1.1  reinoud udf_late_allocate_buf(struct udf_mount *ump, struct buf *buf,
   1653       1.17  reinoud 	uint64_t *lmapping, struct long_ad *node_ad_cpy, uint16_t *vpart_nump)
   1654        1.1  reinoud {
   1655        1.1  reinoud 	struct udf_node  *udf_node = VTOI(buf->b_vp);
   1656        1.1  reinoud 	int lb_size, blks, udf_c_type;
   1657       1.17  reinoud 	int vpart_num, num_lb;
   1658        1.1  reinoud 	int error, s;
   1659        1.1  reinoud 
   1660        1.1  reinoud 	/*
   1661        1.1  reinoud 	 * for each sector in the buf, allocate a sector on disc and record
   1662        1.1  reinoud 	 * its position in the provided mapping array.
   1663        1.1  reinoud 	 *
   1664        1.1  reinoud 	 * If its userdata or FIDs, record its location in its node.
   1665        1.1  reinoud 	 */
   1666        1.1  reinoud 
   1667        1.1  reinoud 	lb_size    = udf_rw32(ump->logical_vol->lb_size);
   1668        1.1  reinoud 	num_lb     = (buf->b_bcount + lb_size -1) / lb_size;
   1669        1.1  reinoud 	blks       = lb_size / DEV_BSIZE;
   1670        1.1  reinoud 	udf_c_type = buf->b_udf_c_type;
   1671        1.1  reinoud 
   1672        1.1  reinoud 	KASSERT(lb_size == ump->discinfo.sector_size);
   1673        1.1  reinoud 
   1674       1.17  reinoud 	/* select partition to record the buffer on */
   1675       1.26  reinoud 	vpart_num = *vpart_nump = udf_get_record_vpart(ump, udf_c_type);
   1676        1.1  reinoud 
   1677        1.1  reinoud 	if (udf_c_type == UDF_C_NODE) {
   1678        1.1  reinoud 		/* if not VAT, its allready allocated */
   1679       1.17  reinoud 		if (ump->vtop_alloc[ump->node_part] != UDF_ALLOC_VAT)
   1680        1.1  reinoud 			return;
   1681        1.1  reinoud 
   1682       1.17  reinoud 		/* allocate on its backing sequential partition */
   1683       1.17  reinoud 		vpart_num = ump->data_part;
   1684        1.1  reinoud 	}
   1685        1.1  reinoud 
   1686       1.26  reinoud 	/* XXX can this still happen? */
   1687       1.17  reinoud 	/* do allocation on the selected partition */
   1688       1.26  reinoud 	error = udf_allocate_space(ump, udf_node, udf_c_type,
   1689       1.17  reinoud 			vpart_num, num_lb, lmapping);
   1690        1.1  reinoud 	if (error) {
   1691       1.26  reinoud 		/*
   1692       1.26  reinoud 		 * ARGH! we haven't done our accounting right! it should
   1693       1.26  reinoud 		 * allways succeed.
   1694       1.26  reinoud 		 */
   1695        1.1  reinoud 		panic("UDF disc allocation accounting gone wrong");
   1696        1.1  reinoud 	}
   1697        1.1  reinoud 
   1698        1.1  reinoud 	/* If its userdata or FIDs, record its allocation in its node. */
   1699       1.16  reinoud 	if ((udf_c_type == UDF_C_USERDATA) ||
   1700       1.16  reinoud 	    (udf_c_type == UDF_C_FIDS) ||
   1701       1.16  reinoud 	    (udf_c_type == UDF_C_METADATA_SBM))
   1702       1.16  reinoud 	{
   1703       1.17  reinoud 		udf_record_allocation_in_node(ump, buf, vpart_num, lmapping,
   1704        1.1  reinoud 			node_ad_cpy);
   1705        1.1  reinoud 		/* decrement our outstanding bufs counter */
   1706        1.1  reinoud 		s = splbio();
   1707        1.1  reinoud 			udf_node->outstanding_bufs--;
   1708        1.1  reinoud 		splx(s);
   1709        1.1  reinoud 	}
   1710        1.1  reinoud }
   1711        1.1  reinoud 
   1712        1.1  reinoud /* --------------------------------------------------------------------- */
   1713        1.1  reinoud 
   1714        1.1  reinoud /*
   1715        1.1  reinoud  * Try to merge a1 with the new piece a2. udf_ads_merge returns error when not
   1716        1.1  reinoud  * possible (anymore); a2 returns the rest piece.
   1717        1.1  reinoud  */
   1718        1.1  reinoud 
   1719        1.1  reinoud static int
   1720       1.31  reinoud udf_ads_merge(uint32_t max_len, uint32_t lb_size, struct long_ad *a1, struct long_ad *a2)
   1721        1.1  reinoud {
   1722       1.31  reinoud 	uint32_t merge_len;
   1723        1.1  reinoud 	uint32_t a1_len, a2_len;
   1724        1.1  reinoud 	uint32_t a1_flags, a2_flags;
   1725        1.1  reinoud 	uint32_t a1_lbnum, a2_lbnum;
   1726        1.1  reinoud 	uint16_t a1_part, a2_part;
   1727        1.1  reinoud 
   1728        1.1  reinoud 	a1_flags = UDF_EXT_FLAGS(udf_rw32(a1->len));
   1729        1.1  reinoud 	a1_len   = UDF_EXT_LEN(udf_rw32(a1->len));
   1730        1.1  reinoud 	a1_lbnum = udf_rw32(a1->loc.lb_num);
   1731        1.1  reinoud 	a1_part  = udf_rw16(a1->loc.part_num);
   1732        1.1  reinoud 
   1733        1.1  reinoud 	a2_flags = UDF_EXT_FLAGS(udf_rw32(a2->len));
   1734        1.1  reinoud 	a2_len   = UDF_EXT_LEN(udf_rw32(a2->len));
   1735        1.1  reinoud 	a2_lbnum = udf_rw32(a2->loc.lb_num);
   1736        1.1  reinoud 	a2_part  = udf_rw16(a2->loc.part_num);
   1737        1.1  reinoud 
   1738        1.1  reinoud 	/* defines same space */
   1739        1.1  reinoud 	if (a1_flags != a2_flags)
   1740        1.1  reinoud 		return 1;
   1741        1.1  reinoud 
   1742        1.1  reinoud 	if (a1_flags != UDF_EXT_FREE) {
   1743        1.1  reinoud 		/* the same partition */
   1744        1.1  reinoud 		if (a1_part != a2_part)
   1745        1.1  reinoud 			return 1;
   1746        1.1  reinoud 
   1747        1.1  reinoud 		/* a2 is successor of a1 */
   1748        1.1  reinoud 		if (a1_lbnum * lb_size + a1_len != a2_lbnum * lb_size)
   1749        1.1  reinoud 			return 1;
   1750        1.1  reinoud 	}
   1751        1.9  reinoud 
   1752        1.1  reinoud 	/* merge as most from a2 if possible */
   1753        1.1  reinoud 	merge_len = MIN(a2_len, max_len - a1_len);
   1754        1.1  reinoud 	a1_len   += merge_len;
   1755        1.1  reinoud 	a2_len   -= merge_len;
   1756        1.1  reinoud 	a2_lbnum += merge_len/lb_size;
   1757        1.1  reinoud 
   1758        1.1  reinoud 	a1->len = udf_rw32(a1_len | a1_flags);
   1759        1.1  reinoud 	a2->len = udf_rw32(a2_len | a2_flags);
   1760        1.1  reinoud 	a2->loc.lb_num = udf_rw32(a2_lbnum);
   1761        1.1  reinoud 
   1762        1.1  reinoud 	if (a2_len > 0)
   1763        1.1  reinoud 		return 1;
   1764        1.1  reinoud 
   1765        1.1  reinoud 	/* there is space over to merge */
   1766        1.1  reinoud 	return 0;
   1767        1.1  reinoud }
   1768        1.1  reinoud 
   1769        1.1  reinoud /* --------------------------------------------------------------------- */
   1770        1.1  reinoud 
   1771        1.1  reinoud static void
   1772        1.1  reinoud udf_wipe_adslots(struct udf_node *udf_node)
   1773        1.1  reinoud {
   1774        1.1  reinoud 	struct file_entry      *fe;
   1775        1.1  reinoud 	struct extfile_entry   *efe;
   1776        1.1  reinoud 	struct alloc_ext_entry *ext;
   1777        1.1  reinoud 	uint64_t inflen, objsize;
   1778        1.1  reinoud 	uint32_t lb_size, dscr_size, l_ea, l_ad, max_l_ad, crclen;
   1779        1.1  reinoud 	uint8_t *data_pos;
   1780        1.1  reinoud 	int extnr;
   1781        1.1  reinoud 
   1782        1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1783        1.1  reinoud 
   1784        1.1  reinoud 	fe  = udf_node->fe;
   1785        1.1  reinoud 	efe = udf_node->efe;
   1786        1.1  reinoud 	if (fe) {
   1787        1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   1788        1.1  reinoud 		objsize = inflen;
   1789        1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   1790        1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   1791        1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   1792        1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   1793        1.1  reinoud 	} else {
   1794        1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   1795        1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   1796        1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   1797        1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   1798        1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   1799        1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   1800        1.1  reinoud 	}
   1801        1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   1802        1.1  reinoud 
   1803        1.1  reinoud 	/* wipe fe/efe */
   1804        1.1  reinoud 	memset(data_pos, 0, max_l_ad);
   1805        1.1  reinoud 	crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea;
   1806        1.1  reinoud 	if (fe) {
   1807        1.1  reinoud 		fe->l_ad         = udf_rw32(0);
   1808        1.1  reinoud 		fe->logblks_rec  = udf_rw64(0);
   1809       1.22  reinoud 		fe->tag.desc_crc_len = udf_rw16(crclen);
   1810        1.1  reinoud 	} else {
   1811        1.1  reinoud 		efe->l_ad        = udf_rw32(0);
   1812        1.1  reinoud 		efe->logblks_rec = udf_rw64(0);
   1813       1.22  reinoud 		efe->tag.desc_crc_len = udf_rw16(crclen);
   1814        1.1  reinoud 	}
   1815        1.1  reinoud 
   1816        1.1  reinoud 	/* wipe all allocation extent entries */
   1817        1.1  reinoud 	for (extnr = 0; extnr < udf_node->num_extensions; extnr++) {
   1818        1.1  reinoud 		ext = udf_node->ext[extnr];
   1819        1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1820       1.11  reinoud 		data_pos = (uint8_t *) ext->data;
   1821        1.1  reinoud 		max_l_ad = lb_size - dscr_size;
   1822        1.1  reinoud 		memset(data_pos, 0, max_l_ad);
   1823        1.1  reinoud 		ext->l_ad = udf_rw32(0);
   1824        1.1  reinoud 
   1825        1.1  reinoud 		crclen = dscr_size - UDF_DESC_TAG_LENGTH;
   1826       1.22  reinoud 		ext->tag.desc_crc_len = udf_rw16(crclen);
   1827        1.1  reinoud 	}
   1828       1.11  reinoud 	udf_node->i_flags |= IN_NODE_REBUILD;
   1829        1.1  reinoud }
   1830        1.1  reinoud 
   1831        1.1  reinoud /* --------------------------------------------------------------------- */
   1832        1.1  reinoud 
   1833        1.1  reinoud void
   1834        1.1  reinoud udf_get_adslot(struct udf_node *udf_node, int slot, struct long_ad *icb,
   1835        1.1  reinoud 	int *eof) {
   1836        1.1  reinoud 	struct file_entry      *fe;
   1837        1.1  reinoud 	struct extfile_entry   *efe;
   1838        1.1  reinoud 	struct alloc_ext_entry *ext;
   1839        1.1  reinoud 	struct icb_tag *icbtag;
   1840        1.1  reinoud 	struct short_ad *short_ad;
   1841       1.11  reinoud 	struct long_ad *long_ad, l_icb;
   1842        1.1  reinoud 	uint32_t offset;
   1843       1.11  reinoud 	uint32_t lb_size, dscr_size, l_ea, l_ad, flags;
   1844        1.1  reinoud 	uint8_t *data_pos;
   1845        1.1  reinoud 	int icbflags, addr_type, adlen, extnr;
   1846        1.1  reinoud 
   1847        1.1  reinoud 	/* determine what descriptor we are in */
   1848        1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   1849        1.1  reinoud 
   1850        1.1  reinoud 	fe  = udf_node->fe;
   1851        1.1  reinoud 	efe = udf_node->efe;
   1852        1.1  reinoud 	if (fe) {
   1853        1.1  reinoud 		icbtag  = &fe->icbtag;
   1854        1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   1855        1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   1856        1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   1857        1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   1858        1.1  reinoud 	} else {
   1859        1.1  reinoud 		icbtag  = &efe->icbtag;
   1860        1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   1861        1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   1862        1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   1863        1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   1864        1.1  reinoud 	}
   1865        1.1  reinoud 
   1866        1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   1867        1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   1868        1.1  reinoud 
   1869        1.1  reinoud 	/* just in case we're called on an intern, its EOF */
   1870        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   1871        1.1  reinoud 		memset(icb, 0, sizeof(struct long_ad));
   1872        1.1  reinoud 		*eof = 1;
   1873        1.1  reinoud 		return;
   1874        1.1  reinoud 	}
   1875        1.1  reinoud 
   1876        1.1  reinoud 	adlen = 0;
   1877        1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1878        1.1  reinoud 		adlen = sizeof(struct short_ad);
   1879        1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1880        1.1  reinoud 		adlen = sizeof(struct long_ad);
   1881        1.1  reinoud 	}
   1882        1.1  reinoud 
   1883        1.1  reinoud 	/* if offset too big, we go to the allocation extensions */
   1884        1.1  reinoud 	offset = slot * adlen;
   1885        1.3  reinoud 	extnr  = -1;
   1886       1.11  reinoud 	while (offset >= l_ad) {
   1887       1.11  reinoud 		/* check if our last entry is a redirect */
   1888       1.11  reinoud 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1889       1.11  reinoud 			short_ad = (struct short_ad *) (data_pos + l_ad-adlen);
   1890       1.11  reinoud 			l_icb.len          = short_ad->len;
   1891       1.11  reinoud 			l_icb.loc.part_num = udf_node->loc.loc.part_num;
   1892       1.11  reinoud 			l_icb.loc.lb_num   = short_ad->lb_num;
   1893       1.11  reinoud 		} else {
   1894       1.11  reinoud 			KASSERT(addr_type == UDF_ICB_LONG_ALLOC);
   1895       1.11  reinoud 			long_ad = (struct long_ad *) (data_pos + l_ad-adlen);
   1896       1.11  reinoud 			l_icb = *long_ad;
   1897       1.11  reinoud 		}
   1898       1.11  reinoud 		flags = UDF_EXT_FLAGS(udf_rw32(l_icb.len));
   1899       1.11  reinoud 		if (flags != UDF_EXT_REDIRECT) {
   1900       1.11  reinoud 			l_ad = 0;	/* force EOF */
   1901       1.11  reinoud 			break;
   1902       1.11  reinoud 		}
   1903       1.11  reinoud 
   1904       1.11  reinoud 		/* advance to next extent */
   1905        1.3  reinoud 		extnr++;
   1906       1.11  reinoud 		if (extnr >= udf_node->num_extensions) {
   1907       1.11  reinoud 			l_ad = 0;	/* force EOF */
   1908       1.11  reinoud 			break;
   1909       1.11  reinoud 		}
   1910       1.11  reinoud 		offset = offset - l_ad;
   1911        1.1  reinoud 		ext  = udf_node->ext[extnr];
   1912        1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   1913        1.1  reinoud 		l_ad = udf_rw32(ext->l_ad);
   1914        1.3  reinoud 		data_pos = (uint8_t *) ext + dscr_size;
   1915        1.1  reinoud 	}
   1916        1.1  reinoud 
   1917       1.11  reinoud 	/* XXX l_ad == 0 should be enough to check */
   1918        1.1  reinoud 	*eof = (offset >= l_ad) || (l_ad == 0);
   1919        1.1  reinoud 	if (*eof) {
   1920       1.11  reinoud 		DPRINTF(PARANOIDADWLK, ("returning EOF, extnr %d, offset %d, "
   1921       1.11  reinoud 			"l_ad %d\n", extnr, offset, l_ad));
   1922        1.1  reinoud 		memset(icb, 0, sizeof(struct long_ad));
   1923        1.1  reinoud 		return;
   1924        1.1  reinoud 	}
   1925        1.1  reinoud 
   1926        1.1  reinoud 	/* get the element */
   1927        1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1928        1.1  reinoud 		short_ad = (struct short_ad *) (data_pos + offset);
   1929        1.1  reinoud 		icb->len          = short_ad->len;
   1930        1.5  reinoud 		icb->loc.part_num = udf_node->loc.loc.part_num;
   1931        1.1  reinoud 		icb->loc.lb_num   = short_ad->lb_num;
   1932        1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   1933        1.1  reinoud 		long_ad = (struct long_ad *) (data_pos + offset);
   1934        1.1  reinoud 		*icb = *long_ad;
   1935        1.1  reinoud 	}
   1936       1.11  reinoud 	DPRINTF(PARANOIDADWLK, ("returning element : v %d, lb %d, len %d, "
   1937       1.11  reinoud 		"flags %d\n", icb->loc.part_num, icb->loc.lb_num,
   1938       1.11  reinoud 		UDF_EXT_LEN(icb->len), UDF_EXT_FLAGS(icb->len)));
   1939        1.1  reinoud }
   1940        1.1  reinoud 
   1941        1.1  reinoud /* --------------------------------------------------------------------- */
   1942        1.1  reinoud 
   1943        1.1  reinoud int
   1944       1.11  reinoud udf_append_adslot(struct udf_node *udf_node, int *slot, struct long_ad *icb) {
   1945       1.11  reinoud 	struct udf_mount *ump = udf_node->ump;
   1946       1.13  reinoud 	union dscrptr          *dscr, *extdscr;
   1947        1.1  reinoud 	struct file_entry      *fe;
   1948        1.1  reinoud 	struct extfile_entry   *efe;
   1949        1.1  reinoud 	struct alloc_ext_entry *ext;
   1950        1.1  reinoud 	struct icb_tag *icbtag;
   1951        1.1  reinoud 	struct short_ad *short_ad;
   1952       1.11  reinoud 	struct long_ad *long_ad, o_icb, l_icb;
   1953        1.1  reinoud 	uint64_t logblks_rec, *logblks_rec_p;
   1954       1.16  reinoud 	uint64_t lmapping;
   1955       1.11  reinoud 	uint32_t offset, rest, len, lb_num;
   1956        1.1  reinoud 	uint32_t lb_size, dscr_size, l_ea, l_ad, *l_ad_p, max_l_ad, crclen;
   1957       1.11  reinoud 	uint32_t flags;
   1958       1.11  reinoud 	uint16_t vpart_num;
   1959        1.1  reinoud 	uint8_t *data_pos;
   1960        1.1  reinoud 	int icbflags, addr_type, adlen, extnr;
   1961       1.11  reinoud 	int error;
   1962        1.1  reinoud 
   1963       1.11  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   1964       1.17  reinoud 	vpart_num = udf_rw16(udf_node->loc.loc.part_num);
   1965        1.1  reinoud 
   1966       1.17  reinoud 	/* determine what descriptor we are in */
   1967        1.1  reinoud 	fe  = udf_node->fe;
   1968        1.1  reinoud 	efe = udf_node->efe;
   1969        1.1  reinoud 	if (fe) {
   1970        1.1  reinoud 		icbtag  = &fe->icbtag;
   1971        1.1  reinoud 		dscr      = (union dscrptr *) fe;
   1972        1.1  reinoud 		dscr_size = sizeof(struct file_entry) -1;
   1973        1.1  reinoud 
   1974        1.1  reinoud 		l_ea      = udf_rw32(fe->l_ea);
   1975        1.1  reinoud 		l_ad_p    = &fe->l_ad;
   1976        1.1  reinoud 		logblks_rec_p = &fe->logblks_rec;
   1977        1.1  reinoud 	} else {
   1978        1.1  reinoud 		icbtag    = &efe->icbtag;
   1979        1.1  reinoud 		dscr      = (union dscrptr *) efe;
   1980        1.1  reinoud 		dscr_size = sizeof(struct extfile_entry) -1;
   1981        1.1  reinoud 
   1982        1.1  reinoud 		l_ea      = udf_rw32(efe->l_ea);
   1983        1.1  reinoud 		l_ad_p    = &efe->l_ad;
   1984        1.1  reinoud 		logblks_rec_p = &efe->logblks_rec;
   1985        1.1  reinoud 	}
   1986        1.1  reinoud 	data_pos  = (uint8_t *) dscr + dscr_size + l_ea;
   1987        1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   1988        1.1  reinoud 
   1989        1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   1990        1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   1991        1.1  reinoud 
   1992        1.1  reinoud 	/* just in case we're called on an intern, its EOF */
   1993        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   1994        1.1  reinoud 		panic("udf_append_adslot on UDF_ICB_INTERN_ALLOC\n");
   1995        1.1  reinoud 	}
   1996        1.1  reinoud 
   1997        1.1  reinoud 	adlen = 0;
   1998        1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   1999        1.1  reinoud 		adlen = sizeof(struct short_ad);
   2000        1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   2001        1.1  reinoud 		adlen = sizeof(struct long_ad);
   2002        1.1  reinoud 	}
   2003        1.1  reinoud 
   2004       1.17  reinoud 	/* clean up given long_ad since it can be a synthesized one */
   2005       1.11  reinoud 	flags = UDF_EXT_FLAGS(udf_rw32(icb->len));
   2006       1.11  reinoud 	if (flags == UDF_EXT_FREE) {
   2007        1.9  reinoud 		icb->loc.part_num = udf_rw16(0);
   2008        1.9  reinoud 		icb->loc.lb_num   = udf_rw32(0);
   2009        1.9  reinoud 	}
   2010        1.9  reinoud 
   2011        1.1  reinoud 	/* if offset too big, we go to the allocation extensions */
   2012       1.11  reinoud 	l_ad   = udf_rw32(*l_ad_p);
   2013       1.11  reinoud 	offset = (*slot) * adlen;
   2014       1.11  reinoud 	extnr  = -1;
   2015       1.11  reinoud 	while (offset >= l_ad) {
   2016       1.11  reinoud 		/* check if our last entry is a redirect */
   2017       1.11  reinoud 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   2018       1.11  reinoud 			short_ad = (struct short_ad *) (data_pos + l_ad-adlen);
   2019       1.11  reinoud 			l_icb.len          = short_ad->len;
   2020       1.11  reinoud 			l_icb.loc.part_num = udf_node->loc.loc.part_num;
   2021       1.11  reinoud 			l_icb.loc.lb_num   = short_ad->lb_num;
   2022       1.11  reinoud 		} else {
   2023       1.11  reinoud 			KASSERT(addr_type == UDF_ICB_LONG_ALLOC);
   2024       1.11  reinoud 			long_ad = (struct long_ad *) (data_pos + l_ad-adlen);
   2025       1.11  reinoud 			l_icb = *long_ad;
   2026       1.11  reinoud 		}
   2027       1.11  reinoud 		flags = UDF_EXT_FLAGS(udf_rw32(l_icb.len));
   2028       1.11  reinoud 		if (flags != UDF_EXT_REDIRECT) {
   2029       1.11  reinoud 			/* only one past the last one is adressable */
   2030       1.11  reinoud 			break;
   2031       1.11  reinoud 		}
   2032       1.11  reinoud 
   2033       1.11  reinoud 		/* advance to next extent */
   2034       1.11  reinoud 		extnr++;
   2035       1.11  reinoud 		KASSERT(extnr < udf_node->num_extensions);
   2036       1.11  reinoud 		offset = offset - l_ad;
   2037       1.11  reinoud 
   2038        1.1  reinoud 		ext  = udf_node->ext[extnr];
   2039        1.1  reinoud 		dscr = (union dscrptr *) ext;
   2040        1.1  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   2041       1.11  reinoud 		max_l_ad = lb_size - dscr_size;
   2042        1.1  reinoud 		l_ad_p = &ext->l_ad;
   2043       1.11  reinoud 		l_ad   = udf_rw32(*l_ad_p);
   2044       1.11  reinoud 		data_pos = (uint8_t *) ext + dscr_size;
   2045       1.11  reinoud 	}
   2046       1.11  reinoud 	DPRINTF(PARANOIDADWLK, ("append, ext %d, offset %d, l_ad %d\n",
   2047       1.11  reinoud 		extnr, offset, udf_rw32(*l_ad_p)));
   2048       1.11  reinoud 	KASSERT(l_ad == udf_rw32(*l_ad_p));
   2049        1.1  reinoud 
   2050        1.1  reinoud 	/* offset is offset within the current (E)FE/AED */
   2051        1.1  reinoud 	l_ad   = udf_rw32(*l_ad_p);
   2052       1.22  reinoud 	crclen = udf_rw16(dscr->tag.desc_crc_len);
   2053        1.1  reinoud 	logblks_rec = udf_rw64(*logblks_rec_p);
   2054        1.1  reinoud 
   2055        1.1  reinoud 	/* overwriting old piece? */
   2056        1.1  reinoud 	if (offset < l_ad) {
   2057        1.1  reinoud 		/* overwrite entry; compensate for the old element */
   2058        1.1  reinoud 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   2059        1.1  reinoud 			short_ad = (struct short_ad *) (data_pos + offset);
   2060        1.1  reinoud 			o_icb.len          = short_ad->len;
   2061        1.1  reinoud 			o_icb.loc.part_num = udf_rw16(0);	/* ignore */
   2062        1.1  reinoud 			o_icb.loc.lb_num   = short_ad->lb_num;
   2063        1.1  reinoud 		} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   2064        1.1  reinoud 			long_ad = (struct long_ad *) (data_pos + offset);
   2065        1.1  reinoud 			o_icb = *long_ad;
   2066        1.1  reinoud 		} else {
   2067        1.1  reinoud 			panic("Invalid address type in udf_append_adslot\n");
   2068        1.1  reinoud 		}
   2069        1.1  reinoud 
   2070        1.1  reinoud 		len = udf_rw32(o_icb.len);
   2071        1.1  reinoud 		if (UDF_EXT_FLAGS(len) == UDF_EXT_ALLOCATED) {
   2072        1.1  reinoud 			/* adjust counts */
   2073        1.1  reinoud 			len = UDF_EXT_LEN(len);
   2074        1.1  reinoud 			logblks_rec -= (len + lb_size -1) / lb_size;
   2075        1.1  reinoud 		}
   2076        1.1  reinoud 	}
   2077        1.1  reinoud 
   2078       1.11  reinoud 	/* check if we're not appending a redirection */
   2079       1.11  reinoud 	flags = UDF_EXT_FLAGS(udf_rw32(icb->len));
   2080       1.11  reinoud 	KASSERT(flags != UDF_EXT_REDIRECT);
   2081       1.11  reinoud 
   2082       1.11  reinoud 	/* round down available space */
   2083       1.11  reinoud 	rest = adlen * ((max_l_ad - offset) / adlen);
   2084        1.1  reinoud 	if (rest <= adlen) {
   2085       1.11  reinoud 		/* have to append aed, see if we already have a spare one */
   2086       1.11  reinoud 		extnr++;
   2087       1.11  reinoud 		ext = udf_node->ext[extnr];
   2088       1.11  reinoud 		l_icb = udf_node->ext_loc[extnr];
   2089       1.11  reinoud 		if (ext == NULL) {
   2090       1.11  reinoud 			DPRINTF(ALLOC,("adding allocation extent %d\n", extnr));
   2091       1.17  reinoud 
   2092       1.26  reinoud 			error = udf_reserve_space(ump, NULL, UDF_C_NODE,
   2093       1.26  reinoud 					vpart_num, 1, /* can fail */ false);
   2094       1.26  reinoud 			if (error) {
   2095       1.26  reinoud 				printf("UDF: couldn't reserve space for AED!\n");
   2096       1.26  reinoud 				return error;
   2097       1.26  reinoud 			}
   2098       1.26  reinoud 			error = udf_allocate_space(ump, NULL, UDF_C_NODE,
   2099       1.26  reinoud 					vpart_num, 1, &lmapping);
   2100       1.11  reinoud 			lb_num = lmapping;
   2101       1.11  reinoud 			if (error)
   2102       1.26  reinoud 				panic("UDF: couldn't allocate AED!\n");
   2103       1.11  reinoud 
   2104       1.11  reinoud 			/* initialise pointer to location */
   2105       1.11  reinoud 			memset(&l_icb, 0, sizeof(struct long_ad));
   2106       1.11  reinoud 			l_icb.len = udf_rw32(lb_size | UDF_EXT_REDIRECT);
   2107       1.11  reinoud 			l_icb.loc.lb_num   = udf_rw32(lb_num);
   2108       1.11  reinoud 			l_icb.loc.part_num = udf_rw16(vpart_num);
   2109       1.11  reinoud 
   2110       1.11  reinoud 			/* create new aed descriptor */
   2111       1.13  reinoud 			udf_create_logvol_dscr(ump, udf_node, &l_icb, &extdscr);
   2112       1.13  reinoud 			ext = &extdscr->aee;
   2113       1.11  reinoud 
   2114       1.11  reinoud 			udf_inittag(ump, &ext->tag, TAGID_ALLOCEXTENT, lb_num);
   2115       1.11  reinoud 			dscr_size  = sizeof(struct alloc_ext_entry) -1;
   2116       1.11  reinoud 			max_l_ad = lb_size - dscr_size;
   2117       1.11  reinoud 			memset(ext->data, 0, max_l_ad);
   2118       1.11  reinoud 			ext->l_ad = udf_rw32(0);
   2119       1.11  reinoud 			ext->tag.desc_crc_len =
   2120       1.22  reinoud 				udf_rw16(dscr_size - UDF_DESC_TAG_LENGTH);
   2121       1.11  reinoud 
   2122       1.11  reinoud 			/* declare aed */
   2123       1.11  reinoud 			udf_node->num_extensions++;
   2124       1.11  reinoud 			udf_node->ext_loc[extnr] = l_icb;
   2125       1.11  reinoud 			udf_node->ext[extnr] = ext;
   2126       1.11  reinoud 		}
   2127       1.11  reinoud 		/* add redirect and adjust l_ad and crclen for old descr */
   2128       1.11  reinoud 		if (addr_type == UDF_ICB_SHORT_ALLOC) {
   2129       1.11  reinoud 			short_ad = (struct short_ad *) (data_pos + offset);
   2130       1.11  reinoud 			short_ad->len    = l_icb.len;
   2131       1.11  reinoud 			short_ad->lb_num = l_icb.loc.lb_num;
   2132       1.11  reinoud 		} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   2133       1.11  reinoud 			long_ad = (struct long_ad *) (data_pos + offset);
   2134       1.11  reinoud 			*long_ad = l_icb;
   2135       1.11  reinoud 		}
   2136       1.11  reinoud 		l_ad   += adlen;
   2137       1.11  reinoud 		crclen += adlen;
   2138       1.22  reinoud 		dscr->tag.desc_crc_len = udf_rw16(crclen);
   2139       1.11  reinoud 		*l_ad_p = udf_rw32(l_ad);
   2140       1.11  reinoud 
   2141       1.11  reinoud 		/* advance to the new extension */
   2142       1.11  reinoud 		KASSERT(ext != NULL);
   2143       1.11  reinoud 		dscr = (union dscrptr *) ext;
   2144       1.11  reinoud 		dscr_size  = sizeof(struct alloc_ext_entry) -1;
   2145       1.11  reinoud 		max_l_ad = lb_size - dscr_size;
   2146       1.11  reinoud 		data_pos = (uint8_t *) dscr + dscr_size;
   2147       1.11  reinoud 
   2148       1.11  reinoud 		l_ad_p = &ext->l_ad;
   2149       1.11  reinoud 		l_ad   = udf_rw32(*l_ad_p);
   2150       1.22  reinoud 		crclen = udf_rw16(dscr->tag.desc_crc_len);
   2151       1.11  reinoud 		offset = 0;
   2152       1.11  reinoud 
   2153       1.11  reinoud 		/* adjust callees slot count for link insert */
   2154       1.11  reinoud 		*slot += 1;
   2155        1.1  reinoud 	}
   2156        1.1  reinoud 
   2157        1.1  reinoud 	/* write out the element */
   2158       1.11  reinoud 	DPRINTF(PARANOIDADWLK, ("adding element : %p : v %d, lb %d, "
   2159       1.11  reinoud 			"len %d, flags %d\n", data_pos + offset,
   2160       1.11  reinoud 			icb->loc.part_num, icb->loc.lb_num,
   2161       1.11  reinoud 			UDF_EXT_LEN(icb->len), UDF_EXT_FLAGS(icb->len)));
   2162        1.1  reinoud 	if (addr_type == UDF_ICB_SHORT_ALLOC) {
   2163        1.1  reinoud 		short_ad = (struct short_ad *) (data_pos + offset);
   2164        1.1  reinoud 		short_ad->len    = icb->len;
   2165        1.1  reinoud 		short_ad->lb_num = icb->loc.lb_num;
   2166        1.1  reinoud 	} else if (addr_type == UDF_ICB_LONG_ALLOC) {
   2167        1.1  reinoud 		long_ad = (struct long_ad *) (data_pos + offset);
   2168        1.1  reinoud 		*long_ad = *icb;
   2169        1.1  reinoud 	}
   2170        1.1  reinoud 
   2171        1.1  reinoud 	/* adjust logblks recorded count */
   2172       1.23  reinoud 	len = udf_rw32(icb->len);
   2173       1.23  reinoud 	flags = UDF_EXT_FLAGS(len);
   2174       1.11  reinoud 	if (flags == UDF_EXT_ALLOCATED)
   2175       1.23  reinoud 		logblks_rec += (UDF_EXT_LEN(len) + lb_size -1) / lb_size;
   2176        1.1  reinoud 	*logblks_rec_p = udf_rw64(logblks_rec);
   2177        1.1  reinoud 
   2178        1.1  reinoud 	/* adjust l_ad and crclen when needed */
   2179        1.1  reinoud 	if (offset >= l_ad) {
   2180        1.1  reinoud 		l_ad   += adlen;
   2181        1.1  reinoud 		crclen += adlen;
   2182       1.22  reinoud 		dscr->tag.desc_crc_len = udf_rw16(crclen);
   2183        1.1  reinoud 		*l_ad_p = udf_rw32(l_ad);
   2184        1.1  reinoud 	}
   2185        1.1  reinoud 
   2186        1.1  reinoud 	return 0;
   2187        1.1  reinoud }
   2188        1.1  reinoud 
   2189        1.1  reinoud /* --------------------------------------------------------------------- */
   2190        1.1  reinoud 
   2191       1.11  reinoud static void
   2192       1.11  reinoud udf_count_alloc_exts(struct udf_node *udf_node)
   2193       1.11  reinoud {
   2194       1.11  reinoud 	struct long_ad s_ad;
   2195       1.11  reinoud 	uint32_t lb_num, len, flags;
   2196       1.11  reinoud 	uint16_t vpart_num;
   2197       1.11  reinoud 	int slot, eof;
   2198       1.11  reinoud 	int num_extents, extnr;
   2199       1.11  reinoud 	int lb_size;
   2200       1.11  reinoud 
   2201       1.11  reinoud 	if (udf_node->num_extensions == 0)
   2202       1.11  reinoud 		return;
   2203       1.11  reinoud 
   2204       1.11  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   2205       1.11  reinoud 	/* count number of allocation extents in use */
   2206       1.11  reinoud 	num_extents = 0;
   2207       1.11  reinoud 	slot = 0;
   2208       1.11  reinoud 	for (;;) {
   2209       1.11  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2210       1.11  reinoud 		if (eof)
   2211       1.11  reinoud 			break;
   2212       1.11  reinoud 		len   = udf_rw32(s_ad.len);
   2213       1.11  reinoud 		flags = UDF_EXT_FLAGS(len);
   2214       1.11  reinoud 
   2215       1.11  reinoud 		if (flags == UDF_EXT_REDIRECT)
   2216       1.11  reinoud 			num_extents++;
   2217       1.11  reinoud 
   2218       1.11  reinoud 		slot++;
   2219       1.11  reinoud 	}
   2220       1.11  reinoud 
   2221       1.11  reinoud 	DPRINTF(ALLOC, ("udf_count_alloc_ext counted %d live extents\n",
   2222       1.11  reinoud 		num_extents));
   2223       1.11  reinoud 
   2224       1.11  reinoud 	/* XXX choice: we could delay freeing them on node writeout */
   2225       1.11  reinoud 	/* free excess entries */
   2226       1.11  reinoud 	extnr = num_extents;
   2227       1.11  reinoud 	for (;extnr < udf_node->num_extensions; extnr++) {
   2228       1.11  reinoud 		DPRINTF(ALLOC, ("freeing alloc ext %d\n", extnr));
   2229       1.11  reinoud 		/* free dscriptor */
   2230       1.11  reinoud 		s_ad = udf_node->ext_loc[extnr];
   2231       1.11  reinoud 		udf_free_logvol_dscr(udf_node->ump, &s_ad,
   2232       1.11  reinoud 			udf_node->ext[extnr]);
   2233       1.11  reinoud 		udf_node->ext[extnr] = NULL;
   2234       1.11  reinoud 
   2235       1.11  reinoud 		/* free disc space */
   2236       1.11  reinoud 		lb_num    = udf_rw32(s_ad.loc.lb_num);
   2237       1.11  reinoud 		vpart_num = udf_rw16(s_ad.loc.part_num);
   2238       1.11  reinoud 		udf_free_allocated_space(udf_node->ump, lb_num, vpart_num, 1);
   2239       1.11  reinoud 
   2240       1.11  reinoud 		memset(&udf_node->ext_loc[extnr], 0, sizeof(struct long_ad));
   2241       1.11  reinoud 	}
   2242       1.11  reinoud 
   2243       1.11  reinoud 	/* set our new number of allocation extents */
   2244       1.11  reinoud 	udf_node->num_extensions = num_extents;
   2245       1.11  reinoud }
   2246       1.11  reinoud 
   2247       1.11  reinoud 
   2248       1.11  reinoud /* --------------------------------------------------------------------- */
   2249       1.11  reinoud 
   2250        1.1  reinoud /*
   2251        1.1  reinoud  * Adjust the node's allocation descriptors to reflect the new mapping; do
   2252        1.1  reinoud  * take note that we might glue to existing allocation descriptors.
   2253        1.1  reinoud  *
   2254        1.1  reinoud  * XXX Note there can only be one allocation being recorded/mount; maybe
   2255        1.1  reinoud  * explicit allocation in shedule thread?
   2256        1.1  reinoud  */
   2257        1.1  reinoud 
   2258        1.1  reinoud static void
   2259        1.1  reinoud udf_record_allocation_in_node(struct udf_mount *ump, struct buf *buf,
   2260        1.1  reinoud 	uint16_t vpart_num, uint64_t *mapping, struct long_ad *node_ad_cpy)
   2261        1.1  reinoud {
   2262        1.1  reinoud 	struct vnode    *vp = buf->b_vp;
   2263        1.1  reinoud 	struct udf_node *udf_node = VTOI(vp);
   2264        1.1  reinoud 	struct file_entry      *fe;
   2265        1.1  reinoud 	struct extfile_entry   *efe;
   2266        1.1  reinoud 	struct icb_tag  *icbtag;
   2267        1.1  reinoud 	struct long_ad   s_ad, c_ad;
   2268        1.1  reinoud 	uint64_t inflen, from, till;
   2269        1.1  reinoud 	uint64_t foffset, end_foffset, restart_foffset;
   2270        1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   2271       1.31  reinoud 	uint32_t max_len;
   2272        1.1  reinoud 	uint32_t num_lb, len, flags, lb_num;
   2273        1.1  reinoud 	uint32_t run_start;
   2274        1.9  reinoud 	uint32_t slot_offset, replace_len, replace;
   2275        1.1  reinoud 	int addr_type, icbflags;
   2276       1.16  reinoud //	int udf_c_type = buf->b_udf_c_type;
   2277        1.1  reinoud 	int lb_size, run_length, eof;
   2278        1.1  reinoud 	int slot, cpy_slot, cpy_slots, restart_slot;
   2279        1.1  reinoud 	int error;
   2280        1.1  reinoud 
   2281        1.1  reinoud 	DPRINTF(ALLOC, ("udf_record_allocation_in_node\n"));
   2282        1.1  reinoud 
   2283       1.16  reinoud #if 0
   2284       1.16  reinoud 	/* XXX disable sanity check for now */
   2285        1.1  reinoud 	/* sanity check ... should be panic ? */
   2286        1.1  reinoud 	if ((udf_c_type != UDF_C_USERDATA) && (udf_c_type != UDF_C_FIDS))
   2287        1.1  reinoud 		return;
   2288       1.16  reinoud #endif
   2289        1.1  reinoud 
   2290        1.1  reinoud 	lb_size = udf_rw32(udf_node->ump->logical_vol->lb_size);
   2291       1.31  reinoud 	max_len = ((UDF_EXT_MAXLEN / lb_size) * lb_size);
   2292        1.1  reinoud 
   2293        1.1  reinoud 	/* do the job */
   2294        1.1  reinoud 	UDF_LOCK_NODE(udf_node, 0);	/* XXX can deadlock ? */
   2295        1.9  reinoud 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   2296        1.1  reinoud 
   2297        1.1  reinoud 	fe  = udf_node->fe;
   2298        1.1  reinoud 	efe = udf_node->efe;
   2299        1.1  reinoud 	if (fe) {
   2300        1.1  reinoud 		icbtag = &fe->icbtag;
   2301        1.1  reinoud 		inflen = udf_rw64(fe->inf_len);
   2302        1.1  reinoud 	} else {
   2303        1.1  reinoud 		icbtag = &efe->icbtag;
   2304        1.1  reinoud 		inflen = udf_rw64(efe->inf_len);
   2305        1.1  reinoud 	}
   2306        1.1  reinoud 
   2307        1.1  reinoud 	/* do check if `till' is not past file information length */
   2308        1.1  reinoud 	from = buf->b_lblkno * lb_size;
   2309        1.1  reinoud 	till = MIN(inflen, from + buf->b_resid);
   2310        1.1  reinoud 
   2311        1.1  reinoud 	num_lb = (till - from + lb_size -1) / lb_size;
   2312        1.1  reinoud 
   2313        1.9  reinoud 	DPRINTF(ALLOC, ("record allocation from %"PRIu64" + %d\n", from, buf->b_bcount));
   2314        1.1  reinoud 
   2315        1.1  reinoud 	icbflags  = udf_rw16(icbtag->flags);
   2316        1.1  reinoud 	addr_type = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2317        1.1  reinoud 
   2318        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   2319        1.1  reinoud 		/* nothing to do */
   2320        1.1  reinoud 		/* XXX clean up rest of node? just in case? */
   2321        1.1  reinoud 		UDF_UNLOCK_NODE(udf_node, 0);
   2322        1.1  reinoud 		return;
   2323        1.1  reinoud 	}
   2324        1.1  reinoud 
   2325        1.1  reinoud 	slot     = 0;
   2326        1.1  reinoud 	cpy_slot = 0;
   2327        1.1  reinoud 	foffset  = 0;
   2328        1.1  reinoud 
   2329        1.1  reinoud 	/* 1) copy till first overlap piece to the rewrite buffer */
   2330        1.1  reinoud 	for (;;) {
   2331        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2332        1.1  reinoud 		if (eof) {
   2333        1.1  reinoud 			DPRINTF(WRITE,
   2334        1.1  reinoud 				("Record allocation in node "
   2335        1.1  reinoud 				 "failed: encountered EOF\n"));
   2336        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2337        1.1  reinoud 			buf->b_error = EINVAL;
   2338        1.1  reinoud 			return;
   2339        1.1  reinoud 		}
   2340        1.1  reinoud 		len   = udf_rw32(s_ad.len);
   2341        1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   2342        1.1  reinoud 		len   = UDF_EXT_LEN(len);
   2343        1.1  reinoud 
   2344        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   2345        1.1  reinoud 			slot++;
   2346        1.1  reinoud 			continue;
   2347        1.1  reinoud 		}
   2348        1.1  reinoud 
   2349        1.1  reinoud 		end_foffset = foffset + len;
   2350        1.1  reinoud 		if (end_foffset > from)
   2351        1.1  reinoud 			break;	/* found */
   2352        1.1  reinoud 
   2353        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2354        1.1  reinoud 
   2355        1.1  reinoud 		DPRINTF(ALLOC, ("\t1: vp %d, lb %d, len %d, flags %d "
   2356        1.1  reinoud 			"-> stack\n",
   2357        1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   2358        1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   2359        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2360        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2361        1.1  reinoud 
   2362        1.1  reinoud 		foffset = end_foffset;
   2363        1.1  reinoud 		slot++;
   2364        1.1  reinoud 	}
   2365        1.1  reinoud 	restart_slot    = slot;
   2366        1.1  reinoud 	restart_foffset = foffset;
   2367        1.1  reinoud 
   2368        1.1  reinoud 	/* 2) trunc overlapping slot at overlap and copy it */
   2369        1.1  reinoud 	slot_offset = from - foffset;
   2370        1.1  reinoud 	if (slot_offset > 0) {
   2371        1.1  reinoud 		DPRINTF(ALLOC, ("\tslot_offset = %d, flags = %d (%d)\n",
   2372        1.1  reinoud 				slot_offset, flags >> 30, flags));
   2373        1.1  reinoud 
   2374        1.1  reinoud 		s_ad.len = udf_rw32(slot_offset | flags);
   2375        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2376        1.1  reinoud 
   2377        1.1  reinoud 		DPRINTF(ALLOC, ("\t2: vp %d, lb %d, len %d, flags %d "
   2378        1.1  reinoud 			"-> stack\n",
   2379        1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   2380        1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   2381        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2382        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2383        1.1  reinoud 	}
   2384        1.1  reinoud 	foffset += slot_offset;
   2385        1.1  reinoud 
   2386        1.1  reinoud 	/* 3) insert new mappings */
   2387        1.1  reinoud 	memset(&s_ad, 0, sizeof(struct long_ad));
   2388        1.1  reinoud 	lb_num = 0;
   2389        1.1  reinoud 	for (lb_num = 0; lb_num < num_lb; lb_num++) {
   2390        1.1  reinoud 		run_start  = mapping[lb_num];
   2391        1.1  reinoud 		run_length = 1;
   2392        1.1  reinoud 		while (lb_num < num_lb-1) {
   2393        1.1  reinoud 			if (mapping[lb_num+1] != mapping[lb_num]+1)
   2394        1.1  reinoud 				if (mapping[lb_num+1] != mapping[lb_num])
   2395        1.1  reinoud 					break;
   2396        1.1  reinoud 			run_length++;
   2397        1.1  reinoud 			lb_num++;
   2398        1.1  reinoud 		}
   2399        1.1  reinoud 		/* insert slot for this mapping */
   2400        1.1  reinoud 		len = run_length * lb_size;
   2401        1.1  reinoud 
   2402        1.1  reinoud 		/* bounds checking */
   2403        1.1  reinoud 		if (foffset + len > till)
   2404        1.1  reinoud 			len = till - foffset;
   2405        1.1  reinoud 		KASSERT(foffset + len <= inflen);
   2406        1.1  reinoud 
   2407        1.1  reinoud 		s_ad.len = udf_rw32(len | UDF_EXT_ALLOCATED);
   2408        1.1  reinoud 		s_ad.loc.part_num = udf_rw16(vpart_num);
   2409        1.1  reinoud 		s_ad.loc.lb_num   = udf_rw32(run_start);
   2410        1.1  reinoud 
   2411        1.1  reinoud 		foffset += len;
   2412        1.1  reinoud 
   2413        1.1  reinoud 		/* paranoia */
   2414        1.1  reinoud 		if (len == 0) {
   2415        1.1  reinoud 			DPRINTF(WRITE,
   2416        1.1  reinoud 				("Record allocation in node "
   2417        1.1  reinoud 				 "failed: insert failed\n"));
   2418        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2419        1.1  reinoud 			buf->b_error = EINVAL;
   2420        1.1  reinoud 			return;
   2421        1.1  reinoud 		}
   2422        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2423        1.1  reinoud 
   2424        1.1  reinoud 		DPRINTF(ALLOC, ("\t3: insert new mapping vp %d lb %d, len %d, "
   2425        1.1  reinoud 				"flags %d -> stack\n",
   2426        1.1  reinoud 			udf_rw16(s_ad.loc.part_num), udf_rw32(s_ad.loc.lb_num),
   2427        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2428        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2429        1.1  reinoud 	}
   2430        1.1  reinoud 
   2431        1.1  reinoud 	/* 4) pop replaced length */
   2432        1.9  reinoud 	slot    = restart_slot;
   2433        1.1  reinoud 	foffset = restart_foffset;
   2434        1.1  reinoud 
   2435        1.9  reinoud 	replace_len = till - foffset;	/* total amount of bytes to pop */
   2436        1.8  reinoud 	slot_offset = from - foffset;	/* offset in first encounted slot */
   2437        1.9  reinoud 	KASSERT((slot_offset % lb_size) == 0);
   2438        1.9  reinoud 
   2439        1.1  reinoud 	for (;;) {
   2440        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2441        1.1  reinoud 		if (eof)
   2442        1.1  reinoud 			break;
   2443        1.1  reinoud 
   2444        1.1  reinoud 		len    = udf_rw32(s_ad.len);
   2445        1.1  reinoud 		flags  = UDF_EXT_FLAGS(len);
   2446        1.1  reinoud 		len    = UDF_EXT_LEN(len);
   2447        1.1  reinoud 		lb_num = udf_rw32(s_ad.loc.lb_num);
   2448        1.1  reinoud 
   2449        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   2450        1.1  reinoud 			slot++;
   2451        1.1  reinoud 			continue;
   2452        1.1  reinoud 		}
   2453        1.1  reinoud 
   2454        1.8  reinoud 		DPRINTF(ALLOC, ("\t4i: got slot %d, slot_offset %d, "
   2455        1.9  reinoud 				"replace_len %d, "
   2456        1.8  reinoud 				"vp %d, lb %d, len %d, flags %d\n",
   2457        1.9  reinoud 			slot, slot_offset, replace_len,
   2458        1.8  reinoud 			udf_rw16(s_ad.loc.part_num),
   2459        1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   2460        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2461        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2462        1.1  reinoud 
   2463        1.9  reinoud 		/* adjust for slot offset */
   2464        1.9  reinoud 		if (slot_offset) {
   2465        1.9  reinoud 			DPRINTF(ALLOC, ("\t4s: skipping %d\n", slot_offset));
   2466        1.9  reinoud 			lb_num += slot_offset / lb_size;
   2467        1.9  reinoud 			len    -= slot_offset;
   2468        1.9  reinoud 			foffset += slot_offset;
   2469        1.9  reinoud 			replace_len -= slot_offset;
   2470        1.9  reinoud 
   2471        1.9  reinoud 			/* mark adjusted */
   2472        1.9  reinoud 			slot_offset = 0;
   2473        1.9  reinoud 		}
   2474        1.9  reinoud 
   2475        1.9  reinoud 		/* advance for (the rest of) this slot */
   2476        1.9  reinoud 		replace = MIN(len, replace_len);
   2477        1.9  reinoud 		DPRINTF(ALLOC, ("\t4d: replacing %d\n", replace));
   2478        1.9  reinoud 
   2479        1.9  reinoud 		/* advance for this slot */
   2480        1.9  reinoud 		if (replace) {
   2481       1.10  reinoud 			/* note: dont round DOWN on num_lb since we then
   2482       1.10  reinoud 			 * forget the last partial one */
   2483        1.9  reinoud 			num_lb = (replace + lb_size - 1) / lb_size;
   2484        1.9  reinoud 			if (flags != UDF_EXT_FREE) {
   2485        1.9  reinoud 				udf_free_allocated_space(ump, lb_num,
   2486        1.9  reinoud 					udf_rw16(s_ad.loc.part_num), num_lb);
   2487        1.9  reinoud 			}
   2488        1.9  reinoud 			lb_num      += num_lb;
   2489        1.9  reinoud 			len         -= replace;
   2490        1.9  reinoud 			foffset     += replace;
   2491        1.9  reinoud 			replace_len -= replace;
   2492        1.9  reinoud 		}
   2493        1.1  reinoud 
   2494        1.9  reinoud 		/* do we have a slot tail ? */
   2495        1.1  reinoud 		if (len) {
   2496        1.9  reinoud 			KASSERT(foffset % lb_size == 0);
   2497        1.1  reinoud 
   2498        1.1  reinoud 			/* we arrived at our point, push remainder */
   2499        1.1  reinoud 			s_ad.len        = udf_rw32(len | flags);
   2500        1.1  reinoud 			s_ad.loc.lb_num = udf_rw32(lb_num);
   2501        1.9  reinoud 			if (flags == UDF_EXT_FREE)
   2502        1.9  reinoud 				s_ad.loc.lb_num = udf_rw32(0);
   2503        1.1  reinoud 			node_ad_cpy[cpy_slot++] = s_ad;
   2504        1.1  reinoud 			foffset += len;
   2505        1.1  reinoud 			slot++;
   2506        1.1  reinoud 
   2507        1.1  reinoud 			DPRINTF(ALLOC, ("\t4: vp %d, lb %d, len %d, flags %d "
   2508        1.1  reinoud 				"-> stack\n",
   2509        1.1  reinoud 				udf_rw16(s_ad.loc.part_num),
   2510        1.1  reinoud 				udf_rw32(s_ad.loc.lb_num),
   2511        1.1  reinoud 				UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2512        1.1  reinoud 				UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2513        1.1  reinoud 			break;
   2514        1.1  reinoud 		}
   2515        1.9  reinoud 
   2516        1.1  reinoud 		slot++;
   2517        1.1  reinoud 	}
   2518        1.1  reinoud 
   2519        1.1  reinoud 	/* 5) copy remainder */
   2520        1.1  reinoud 	for (;;) {
   2521        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   2522        1.1  reinoud 		if (eof)
   2523        1.1  reinoud 			break;
   2524        1.1  reinoud 
   2525        1.1  reinoud 		len   = udf_rw32(s_ad.len);
   2526        1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   2527        1.1  reinoud 		len   = UDF_EXT_LEN(len);
   2528        1.1  reinoud 
   2529        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   2530        1.1  reinoud 			slot++;
   2531        1.1  reinoud 			continue;
   2532        1.1  reinoud 		}
   2533        1.1  reinoud 
   2534        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   2535        1.1  reinoud 
   2536        1.1  reinoud 		DPRINTF(ALLOC, ("\t5: insert new mapping "
   2537        1.1  reinoud 			"vp %d lb %d, len %d, flags %d "
   2538        1.1  reinoud 			"-> stack\n",
   2539        1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   2540        1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   2541        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2542        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2543        1.1  reinoud 
   2544        1.1  reinoud 		slot++;
   2545        1.1  reinoud 	}
   2546        1.1  reinoud 
   2547        1.1  reinoud 	/* 6) reset node descriptors */
   2548        1.1  reinoud 	udf_wipe_adslots(udf_node);
   2549        1.1  reinoud 
   2550        1.1  reinoud 	/* 7) copy back extents; merge when possible. Recounting on the fly */
   2551        1.1  reinoud 	cpy_slots = cpy_slot;
   2552        1.1  reinoud 
   2553        1.1  reinoud 	c_ad = node_ad_cpy[0];
   2554        1.1  reinoud 	slot = 0;
   2555        1.1  reinoud 	DPRINTF(ALLOC, ("\t7s: stack -> got mapping vp %d "
   2556        1.1  reinoud 		"lb %d, len %d, flags %d\n",
   2557        1.1  reinoud 	udf_rw16(c_ad.loc.part_num),
   2558        1.1  reinoud 	udf_rw32(c_ad.loc.lb_num),
   2559        1.1  reinoud 	UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2560        1.1  reinoud 	UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2561        1.1  reinoud 
   2562        1.1  reinoud 	for (cpy_slot = 1; cpy_slot < cpy_slots; cpy_slot++) {
   2563        1.1  reinoud 		s_ad = node_ad_cpy[cpy_slot];
   2564        1.1  reinoud 
   2565        1.1  reinoud 		DPRINTF(ALLOC, ("\t7i: stack -> got mapping vp %d "
   2566        1.1  reinoud 			"lb %d, len %d, flags %d\n",
   2567        1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   2568        1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   2569        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   2570        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   2571        1.1  reinoud 
   2572        1.1  reinoud 		/* see if we can merge */
   2573       1.31  reinoud 		if (udf_ads_merge(max_len, lb_size, &c_ad, &s_ad)) {
   2574        1.1  reinoud 			/* not mergable (anymore) */
   2575        1.1  reinoud 			DPRINTF(ALLOC, ("\t7: appending vp %d lb %d, "
   2576        1.1  reinoud 				"len %d, flags %d\n",
   2577        1.1  reinoud 			udf_rw16(c_ad.loc.part_num),
   2578        1.1  reinoud 			udf_rw32(c_ad.loc.lb_num),
   2579        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2580        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2581        1.1  reinoud 
   2582       1.11  reinoud 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   2583        1.1  reinoud 			if (error) {
   2584        1.1  reinoud 				buf->b_error = error;
   2585        1.1  reinoud 				goto out;
   2586        1.1  reinoud 			}
   2587        1.1  reinoud 			c_ad = s_ad;
   2588        1.1  reinoud 			slot++;
   2589        1.1  reinoud 		}
   2590        1.1  reinoud 	}
   2591        1.1  reinoud 
   2592        1.1  reinoud 	/* 8) push rest slot (if any) */
   2593        1.1  reinoud 	if (UDF_EXT_LEN(c_ad.len) > 0) {
   2594        1.1  reinoud 		DPRINTF(ALLOC, ("\t8: last append vp %d lb %d, "
   2595        1.1  reinoud 				"len %d, flags %d\n",
   2596        1.1  reinoud 		udf_rw16(c_ad.loc.part_num),
   2597        1.1  reinoud 		udf_rw32(c_ad.loc.lb_num),
   2598        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(c_ad.len)),
   2599        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   2600        1.1  reinoud 
   2601       1.11  reinoud 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   2602        1.1  reinoud 		if (error) {
   2603        1.1  reinoud 			buf->b_error = error;
   2604        1.1  reinoud 			goto out;
   2605        1.1  reinoud 		}
   2606        1.1  reinoud 	}
   2607        1.1  reinoud 
   2608        1.1  reinoud out:
   2609       1.11  reinoud 	udf_count_alloc_exts(udf_node);
   2610       1.11  reinoud 
   2611        1.1  reinoud 	/* the node's descriptors should now be sane */
   2612        1.9  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2613        1.1  reinoud 	UDF_UNLOCK_NODE(udf_node, 0);
   2614        1.1  reinoud 
   2615        1.1  reinoud 	KASSERT(orig_inflen == new_inflen);
   2616        1.1  reinoud 	KASSERT(new_lbrec >= orig_lbrec);
   2617        1.1  reinoud 
   2618        1.1  reinoud 	return;
   2619        1.1  reinoud }
   2620        1.1  reinoud 
   2621        1.1  reinoud /* --------------------------------------------------------------------- */
   2622        1.1  reinoud 
   2623        1.1  reinoud int
   2624        1.1  reinoud udf_grow_node(struct udf_node *udf_node, uint64_t new_size)
   2625        1.1  reinoud {
   2626        1.1  reinoud 	union dscrptr *dscr;
   2627        1.1  reinoud 	struct vnode *vp = udf_node->vnode;
   2628        1.1  reinoud 	struct udf_mount *ump = udf_node->ump;
   2629        1.1  reinoud 	struct file_entry    *fe;
   2630        1.1  reinoud 	struct extfile_entry *efe;
   2631        1.1  reinoud 	struct icb_tag  *icbtag;
   2632        1.1  reinoud 	struct long_ad c_ad, s_ad;
   2633        1.1  reinoud 	uint64_t size_diff, old_size, inflen, objsize, chunk, append_len;
   2634        1.1  reinoud 	uint64_t foffset, end_foffset;
   2635        1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   2636       1.31  reinoud 	uint32_t lb_size, unit_size, dscr_size, crclen, lastblock_grow;
   2637       1.17  reinoud 	uint32_t icbflags, len, flags, max_len;
   2638        1.1  reinoud 	uint32_t max_l_ad, l_ad, l_ea;
   2639       1.17  reinoud 	uint16_t my_part, dst_part;
   2640        1.1  reinoud 	uint8_t *data_pos, *evacuated_data;
   2641       1.17  reinoud 	int addr_type;
   2642        1.1  reinoud 	int slot, cpy_slot;
   2643       1.26  reinoud 	int eof, error;
   2644        1.1  reinoud 
   2645        1.1  reinoud 	DPRINTF(ALLOC, ("udf_grow_node\n"));
   2646        1.9  reinoud 
   2647        1.9  reinoud 	UDF_LOCK_NODE(udf_node, 0);
   2648        1.1  reinoud 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   2649        1.1  reinoud 
   2650        1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   2651       1.31  reinoud 
   2652       1.31  reinoud 	/* max_len in unit's IFF its a metadata node or metadata mirror node */
   2653       1.31  reinoud 	unit_size = lb_size;
   2654       1.31  reinoud 	if ((udf_node == ump->metadata_node) || (udf_node == ump->metadatamirror_node))
   2655       1.31  reinoud 		unit_size = ump->metadata_alloc_unit_size * lb_size;
   2656       1.31  reinoud 	max_len = ((UDF_EXT_MAXLEN / unit_size) * unit_size);
   2657        1.1  reinoud 
   2658        1.1  reinoud 	fe  = udf_node->fe;
   2659        1.1  reinoud 	efe = udf_node->efe;
   2660        1.1  reinoud 	if (fe) {
   2661        1.1  reinoud 		dscr       = (union dscrptr *) fe;
   2662        1.1  reinoud 		icbtag  = &fe->icbtag;
   2663        1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   2664        1.1  reinoud 		objsize = inflen;
   2665        1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   2666        1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   2667        1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   2668        1.1  reinoud 	} else {
   2669        1.1  reinoud 		dscr       = (union dscrptr *) efe;
   2670        1.1  reinoud 		icbtag  = &efe->icbtag;
   2671        1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   2672        1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   2673        1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   2674        1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   2675        1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   2676        1.1  reinoud 	}
   2677        1.1  reinoud 	data_pos  = (uint8_t *) dscr + dscr_size + l_ea;
   2678        1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   2679        1.1  reinoud 
   2680        1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
   2681        1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2682        1.1  reinoud 
   2683        1.1  reinoud 	old_size  = inflen;
   2684        1.1  reinoud 	size_diff = new_size - old_size;
   2685        1.1  reinoud 
   2686        1.1  reinoud 	DPRINTF(ALLOC, ("\tfrom %"PRIu64" to %"PRIu64"\n", old_size, new_size));
   2687        1.1  reinoud 
   2688        1.1  reinoud 	evacuated_data = NULL;
   2689        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   2690        1.1  reinoud 		if (l_ad + size_diff <= max_l_ad) {
   2691        1.1  reinoud 			/* only reflect size change directly in the node */
   2692        1.1  reinoud 			inflen  += size_diff;
   2693        1.1  reinoud 			objsize += size_diff;
   2694        1.1  reinoud 			l_ad    += size_diff;
   2695        1.1  reinoud 			crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   2696        1.1  reinoud 			if (fe) {
   2697        1.1  reinoud 				fe->inf_len   = udf_rw64(inflen);
   2698        1.1  reinoud 				fe->l_ad      = udf_rw32(l_ad);
   2699       1.22  reinoud 				fe->tag.desc_crc_len = udf_rw16(crclen);
   2700        1.1  reinoud 			} else {
   2701        1.1  reinoud 				efe->inf_len  = udf_rw64(inflen);
   2702        1.1  reinoud 				efe->obj_size = udf_rw64(objsize);
   2703        1.1  reinoud 				efe->l_ad     = udf_rw32(l_ad);
   2704       1.22  reinoud 				efe->tag.desc_crc_len = udf_rw16(crclen);
   2705        1.1  reinoud 			}
   2706        1.1  reinoud 			error = 0;
   2707        1.1  reinoud 
   2708        1.1  reinoud 			/* set new size for uvm */
   2709        1.1  reinoud 			uvm_vnp_setsize(vp, old_size);
   2710        1.1  reinoud 			uvm_vnp_setwritesize(vp, new_size);
   2711        1.1  reinoud 
   2712        1.1  reinoud #if 0
   2713        1.1  reinoud 			/* zero append space in buffer */
   2714       1.32  hannken 			ubc_zerorange(&vp->v_uobj, old_size,
   2715       1.32  hannken 			    new_size - old_size, UBC_UNMAP_FLAG(vp));
   2716        1.1  reinoud #endif
   2717        1.1  reinoud 
   2718        1.9  reinoud 			udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2719        1.9  reinoud 
   2720        1.1  reinoud 			/* unlock */
   2721        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2722        1.1  reinoud 
   2723        1.1  reinoud 			KASSERT(new_inflen == orig_inflen + size_diff);
   2724        1.1  reinoud 			KASSERT(new_lbrec == orig_lbrec);
   2725        1.1  reinoud 			KASSERT(new_lbrec == 0);
   2726        1.1  reinoud 			return 0;
   2727        1.1  reinoud 		}
   2728        1.1  reinoud 
   2729        1.1  reinoud 		DPRINTF(ALLOC, ("\tCONVERT from internal\n"));
   2730        1.1  reinoud 
   2731        1.1  reinoud 		if (old_size > 0) {
   2732        1.1  reinoud 			/* allocate some space and copy in the stuff to keep */
   2733        1.1  reinoud 			evacuated_data = malloc(lb_size, M_UDFTEMP, M_WAITOK);
   2734        1.1  reinoud 			memset(evacuated_data, 0, lb_size);
   2735        1.1  reinoud 
   2736        1.1  reinoud 			/* node is locked, so safe to exit mutex */
   2737        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   2738        1.1  reinoud 
   2739        1.1  reinoud 			/* read in using the `normal' vn_rdwr() */
   2740        1.1  reinoud 			error = vn_rdwr(UIO_READ, udf_node->vnode,
   2741        1.1  reinoud 					evacuated_data, old_size, 0,
   2742        1.1  reinoud 					UIO_SYSSPACE, IO_ALTSEMANTICS | IO_NODELOCKED,
   2743        1.1  reinoud 					FSCRED, NULL, NULL);
   2744        1.1  reinoud 
   2745        1.1  reinoud 			/* enter again */
   2746        1.1  reinoud 			UDF_LOCK_NODE(udf_node, 0);
   2747        1.1  reinoud 		}
   2748        1.1  reinoud 
   2749       1.14  reinoud 		/* convert to a normal alloc and select type */
   2750       1.17  reinoud 		my_part  = udf_rw16(udf_node->loc.loc.part_num);
   2751       1.26  reinoud 		dst_part = udf_get_record_vpart(ump, udf_get_c_type(udf_node));
   2752       1.17  reinoud 		addr_type = UDF_ICB_SHORT_ALLOC;
   2753       1.17  reinoud 		if (dst_part != my_part)
   2754       1.17  reinoud 			addr_type = UDF_ICB_LONG_ALLOC;
   2755       1.14  reinoud 
   2756        1.1  reinoud 		icbflags &= ~UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2757       1.17  reinoud 		icbflags |= addr_type;
   2758        1.1  reinoud 		icbtag->flags = udf_rw16(icbflags);
   2759        1.1  reinoud 
   2760        1.1  reinoud 		/* wipe old descriptor space */
   2761        1.1  reinoud 		udf_wipe_adslots(udf_node);
   2762        1.1  reinoud 
   2763        1.1  reinoud 		memset(&c_ad, 0, sizeof(struct long_ad));
   2764        1.1  reinoud 		c_ad.len          = udf_rw32(old_size | UDF_EXT_FREE);
   2765        1.1  reinoud 		c_ad.loc.part_num = udf_rw16(0); /* not relevant */
   2766        1.1  reinoud 		c_ad.loc.lb_num   = udf_rw32(0); /* not relevant */
   2767        1.1  reinoud 
   2768        1.1  reinoud 		slot = 0;
   2769        1.1  reinoud 	} else {
   2770        1.1  reinoud 		/* goto the last entry (if any) */
   2771        1.1  reinoud 		slot     = 0;
   2772        1.1  reinoud 		cpy_slot = 0;
   2773        1.1  reinoud 		foffset  = 0;
   2774        1.1  reinoud 		memset(&c_ad, 0, sizeof(struct long_ad));
   2775        1.1  reinoud 		for (;;) {
   2776        1.1  reinoud 			udf_get_adslot(udf_node, slot, &c_ad, &eof);
   2777        1.1  reinoud 			if (eof)
   2778        1.1  reinoud 				break;
   2779        1.1  reinoud 
   2780        1.1  reinoud 			len   = udf_rw32(c_ad.len);
   2781        1.1  reinoud 			flags = UDF_EXT_FLAGS(len);
   2782        1.1  reinoud 			len   = UDF_EXT_LEN(len);
   2783        1.1  reinoud 
   2784        1.1  reinoud 			end_foffset = foffset + len;
   2785        1.1  reinoud 			if (flags != UDF_EXT_REDIRECT)
   2786        1.1  reinoud 				foffset = end_foffset;
   2787        1.1  reinoud 
   2788        1.1  reinoud 			slot++;
   2789        1.1  reinoud 		}
   2790        1.1  reinoud 		/* at end of adslots */
   2791        1.1  reinoud 
   2792        1.1  reinoud 		/* special case if the old size was zero, then there is no last slot */
   2793        1.1  reinoud 		if (old_size == 0) {
   2794        1.1  reinoud 			c_ad.len          = udf_rw32(0 | UDF_EXT_FREE);
   2795        1.1  reinoud 			c_ad.loc.part_num = udf_rw16(0); /* not relevant */
   2796        1.1  reinoud 			c_ad.loc.lb_num   = udf_rw32(0); /* not relevant */
   2797        1.1  reinoud 		} else {
   2798        1.1  reinoud 			/* refetch last slot */
   2799        1.1  reinoud 			slot--;
   2800        1.1  reinoud 			udf_get_adslot(udf_node, slot, &c_ad, &eof);
   2801        1.1  reinoud 		}
   2802        1.1  reinoud 	}
   2803        1.1  reinoud 
   2804        1.1  reinoud 	/*
   2805        1.1  reinoud 	 * If the length of the last slot is not a multiple of lb_size, adjust
   2806        1.1  reinoud 	 * length so that it is; don't forget to adjust `append_len'! relevant for
   2807        1.1  reinoud 	 * extending existing files
   2808        1.1  reinoud 	 */
   2809        1.1  reinoud 	len   = udf_rw32(c_ad.len);
   2810        1.1  reinoud 	flags = UDF_EXT_FLAGS(len);
   2811        1.1  reinoud 	len   = UDF_EXT_LEN(len);
   2812        1.1  reinoud 
   2813        1.1  reinoud 	lastblock_grow = 0;
   2814        1.1  reinoud 	if (len % lb_size > 0) {
   2815        1.1  reinoud 		lastblock_grow = lb_size - (len % lb_size);
   2816        1.1  reinoud 		lastblock_grow = MIN(size_diff, lastblock_grow);
   2817        1.1  reinoud 		len += lastblock_grow;
   2818        1.1  reinoud 		c_ad.len = udf_rw32(len | flags);
   2819        1.1  reinoud 
   2820        1.1  reinoud 		/* TODO zero appened space in buffer! */
   2821       1.32  hannken 		/* using ubc_zerorange(&vp->v_uobj, old_size, */
   2822       1.32  hannken 		/*    new_size - old_size, UBC_UNMAP_FLAG(vp)); ? */
   2823        1.1  reinoud 	}
   2824        1.1  reinoud 	memset(&s_ad, 0, sizeof(struct long_ad));
   2825        1.1  reinoud 
   2826        1.1  reinoud 	/* size_diff can be bigger than allowed, so grow in chunks */
   2827        1.1  reinoud 	append_len = size_diff - lastblock_grow;
   2828        1.1  reinoud 	while (append_len > 0) {
   2829        1.1  reinoud 		chunk = MIN(append_len, max_len);
   2830        1.1  reinoud 		s_ad.len = udf_rw32(chunk | UDF_EXT_FREE);
   2831        1.1  reinoud 		s_ad.loc.part_num = udf_rw16(0);
   2832        1.1  reinoud 		s_ad.loc.lb_num   = udf_rw32(0);
   2833        1.1  reinoud 
   2834       1.31  reinoud 		if (udf_ads_merge(max_len, lb_size, &c_ad, &s_ad)) {
   2835        1.1  reinoud 			/* not mergable (anymore) */
   2836       1.11  reinoud 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   2837        1.1  reinoud 			if (error)
   2838        1.1  reinoud 				goto errorout;
   2839        1.1  reinoud 			slot++;
   2840        1.1  reinoud 			c_ad = s_ad;
   2841        1.1  reinoud 			memset(&s_ad, 0, sizeof(struct long_ad));
   2842        1.1  reinoud 		}
   2843        1.1  reinoud 		append_len -= chunk;
   2844        1.1  reinoud 	}
   2845        1.1  reinoud 
   2846        1.1  reinoud 	/* if there is a rest piece in the accumulator, append it */
   2847        1.8  reinoud 	if (UDF_EXT_LEN(udf_rw32(c_ad.len)) > 0) {
   2848       1.11  reinoud 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   2849        1.1  reinoud 		if (error)
   2850        1.1  reinoud 			goto errorout;
   2851        1.1  reinoud 		slot++;
   2852        1.1  reinoud 	}
   2853        1.1  reinoud 
   2854        1.1  reinoud 	/* if there is a rest piece that didn't fit, append it */
   2855        1.8  reinoud 	if (UDF_EXT_LEN(udf_rw32(s_ad.len)) > 0) {
   2856       1.11  reinoud 		error = udf_append_adslot(udf_node, &slot, &s_ad);
   2857        1.1  reinoud 		if (error)
   2858        1.1  reinoud 			goto errorout;
   2859        1.1  reinoud 		slot++;
   2860        1.1  reinoud 	}
   2861        1.1  reinoud 
   2862        1.1  reinoud 	inflen  += size_diff;
   2863        1.1  reinoud 	objsize += size_diff;
   2864        1.1  reinoud 	if (fe) {
   2865        1.1  reinoud 		fe->inf_len   = udf_rw64(inflen);
   2866        1.1  reinoud 	} else {
   2867        1.1  reinoud 		efe->inf_len  = udf_rw64(inflen);
   2868        1.1  reinoud 		efe->obj_size = udf_rw64(objsize);
   2869        1.1  reinoud 	}
   2870        1.1  reinoud 	error = 0;
   2871        1.1  reinoud 
   2872        1.1  reinoud 	if (evacuated_data) {
   2873        1.1  reinoud 		/* set new write size for uvm */
   2874        1.1  reinoud 		uvm_vnp_setwritesize(vp, old_size);
   2875        1.1  reinoud 
   2876        1.1  reinoud 		/* write out evacuated data */
   2877        1.1  reinoud 		error = vn_rdwr(UIO_WRITE, udf_node->vnode,
   2878        1.1  reinoud 				evacuated_data, old_size, 0,
   2879        1.1  reinoud 				UIO_SYSSPACE, IO_ALTSEMANTICS | IO_NODELOCKED,
   2880        1.1  reinoud 				FSCRED, NULL, NULL);
   2881        1.1  reinoud 		uvm_vnp_setsize(vp, old_size);
   2882        1.1  reinoud 	}
   2883        1.1  reinoud 
   2884        1.1  reinoud errorout:
   2885        1.1  reinoud 	if (evacuated_data)
   2886        1.1  reinoud 		free(evacuated_data, M_UDFTEMP);
   2887        1.9  reinoud 
   2888       1.11  reinoud 	udf_count_alloc_exts(udf_node);
   2889       1.11  reinoud 
   2890        1.9  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2891        1.1  reinoud 	UDF_UNLOCK_NODE(udf_node, 0);
   2892        1.1  reinoud 
   2893        1.1  reinoud 	KASSERT(new_inflen == orig_inflen + size_diff);
   2894        1.1  reinoud 	KASSERT(new_lbrec == orig_lbrec);
   2895        1.1  reinoud 
   2896        1.1  reinoud 	return error;
   2897        1.1  reinoud }
   2898        1.1  reinoud 
   2899        1.1  reinoud /* --------------------------------------------------------------------- */
   2900        1.1  reinoud 
   2901        1.1  reinoud int
   2902        1.1  reinoud udf_shrink_node(struct udf_node *udf_node, uint64_t new_size)
   2903        1.1  reinoud {
   2904        1.1  reinoud 	struct vnode *vp = udf_node->vnode;
   2905        1.1  reinoud 	struct udf_mount *ump = udf_node->ump;
   2906        1.1  reinoud 	struct file_entry    *fe;
   2907        1.1  reinoud 	struct extfile_entry *efe;
   2908        1.1  reinoud 	struct icb_tag  *icbtag;
   2909        1.1  reinoud 	struct long_ad c_ad, s_ad, *node_ad_cpy;
   2910        1.1  reinoud 	uint64_t size_diff, old_size, inflen, objsize;
   2911        1.1  reinoud 	uint64_t foffset, end_foffset;
   2912        1.1  reinoud 	uint64_t orig_inflen, orig_lbrec, new_inflen, new_lbrec;
   2913       1.31  reinoud 	uint32_t lb_size, unit_size, dscr_size, crclen;
   2914       1.27  reinoud 	uint32_t slot_offset, slot_offset_lb;
   2915        1.1  reinoud 	uint32_t len, flags, max_len;
   2916        1.1  reinoud 	uint32_t num_lb, lb_num;
   2917        1.1  reinoud 	uint32_t max_l_ad, l_ad, l_ea;
   2918        1.1  reinoud 	uint16_t vpart_num;
   2919        1.1  reinoud 	uint8_t *data_pos;
   2920        1.1  reinoud 	int icbflags, addr_type;
   2921        1.1  reinoud 	int slot, cpy_slot, cpy_slots;
   2922        1.1  reinoud 	int eof, error;
   2923        1.1  reinoud 
   2924        1.1  reinoud 	DPRINTF(ALLOC, ("udf_shrink_node\n"));
   2925        1.9  reinoud 
   2926        1.9  reinoud 	UDF_LOCK_NODE(udf_node, 0);
   2927        1.1  reinoud 	udf_node_sanity_check(udf_node, &orig_inflen, &orig_lbrec);
   2928        1.1  reinoud 
   2929        1.1  reinoud 	lb_size = udf_rw32(ump->logical_vol->lb_size);
   2930       1.31  reinoud 
   2931       1.31  reinoud 	/* max_len in unit's IFF its a metadata node or metadata mirror node */
   2932       1.31  reinoud 	unit_size = lb_size;
   2933       1.31  reinoud 	if ((udf_node == ump->metadata_node) || (udf_node == ump->metadatamirror_node))
   2934       1.31  reinoud 		unit_size = ump->metadata_alloc_unit_size * lb_size;
   2935       1.31  reinoud 	max_len = ((UDF_EXT_MAXLEN / unit_size) * unit_size);
   2936        1.1  reinoud 
   2937        1.1  reinoud 	/* do the work */
   2938        1.1  reinoud 	fe  = udf_node->fe;
   2939        1.1  reinoud 	efe = udf_node->efe;
   2940        1.1  reinoud 	if (fe) {
   2941        1.1  reinoud 		icbtag  = &fe->icbtag;
   2942        1.1  reinoud 		inflen  = udf_rw64(fe->inf_len);
   2943        1.1  reinoud 		objsize = inflen;
   2944        1.1  reinoud 		dscr_size  = sizeof(struct file_entry) -1;
   2945        1.1  reinoud 		l_ea       = udf_rw32(fe->l_ea);
   2946        1.1  reinoud 		l_ad       = udf_rw32(fe->l_ad);
   2947        1.1  reinoud 		data_pos = (uint8_t *) fe + dscr_size + l_ea;
   2948        1.1  reinoud 	} else {
   2949        1.1  reinoud 		icbtag  = &efe->icbtag;
   2950        1.1  reinoud 		inflen  = udf_rw64(efe->inf_len);
   2951        1.1  reinoud 		objsize = udf_rw64(efe->obj_size);
   2952        1.1  reinoud 		dscr_size  = sizeof(struct extfile_entry) -1;
   2953        1.1  reinoud 		l_ea       = udf_rw32(efe->l_ea);
   2954        1.1  reinoud 		l_ad       = udf_rw32(efe->l_ad);
   2955        1.1  reinoud 		data_pos = (uint8_t *) efe + dscr_size + l_ea;
   2956        1.1  reinoud 	}
   2957        1.1  reinoud 	max_l_ad = lb_size - dscr_size - l_ea;
   2958        1.1  reinoud 
   2959        1.1  reinoud 	icbflags   = udf_rw16(icbtag->flags);
   2960        1.1  reinoud 	addr_type  = icbflags & UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   2961        1.1  reinoud 
   2962        1.1  reinoud 	old_size  = inflen;
   2963        1.1  reinoud 	size_diff = old_size - new_size;
   2964        1.1  reinoud 
   2965        1.1  reinoud 	DPRINTF(ALLOC, ("\tfrom %"PRIu64" to %"PRIu64"\n", old_size, new_size));
   2966        1.1  reinoud 
   2967        1.1  reinoud 	/* shrink the node to its new size */
   2968        1.1  reinoud 	if (addr_type == UDF_ICB_INTERN_ALLOC) {
   2969        1.1  reinoud 		/* only reflect size change directly in the node */
   2970        1.1  reinoud 		KASSERT(new_size <= max_l_ad);
   2971        1.1  reinoud 		inflen  -= size_diff;
   2972        1.1  reinoud 		objsize -= size_diff;
   2973        1.1  reinoud 		l_ad    -= size_diff;
   2974        1.1  reinoud 		crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   2975        1.1  reinoud 		if (fe) {
   2976        1.1  reinoud 			fe->inf_len   = udf_rw64(inflen);
   2977        1.1  reinoud 			fe->l_ad      = udf_rw32(l_ad);
   2978       1.22  reinoud 			fe->tag.desc_crc_len = udf_rw16(crclen);
   2979        1.1  reinoud 		} else {
   2980        1.1  reinoud 			efe->inf_len  = udf_rw64(inflen);
   2981        1.1  reinoud 			efe->obj_size = udf_rw64(objsize);
   2982        1.1  reinoud 			efe->l_ad     = udf_rw32(l_ad);
   2983       1.22  reinoud 			efe->tag.desc_crc_len = udf_rw16(crclen);
   2984        1.1  reinoud 		}
   2985        1.1  reinoud 		error = 0;
   2986        1.7  reinoud 
   2987        1.7  reinoud 		/* clear the space in the descriptor */
   2988        1.7  reinoud 		KASSERT(old_size > new_size);
   2989        1.7  reinoud 		memset(data_pos + new_size, 0, old_size - new_size);
   2990        1.7  reinoud 
   2991        1.1  reinoud 		/* TODO zero appened space in buffer! */
   2992       1.32  hannken 		/* using ubc_zerorange(&vp->v_uobj, old_size, */
   2993       1.32  hannken 		/*    old_size - new_size, UBC_UNMAP_FLAG(vp)); ? */
   2994        1.1  reinoud 
   2995        1.1  reinoud 		/* set new size for uvm */
   2996        1.1  reinoud 		uvm_vnp_setsize(vp, new_size);
   2997        1.9  reinoud 
   2998        1.9  reinoud 		udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   2999        1.1  reinoud 		UDF_UNLOCK_NODE(udf_node, 0);
   3000        1.1  reinoud 
   3001        1.1  reinoud 		KASSERT(new_inflen == orig_inflen - size_diff);
   3002        1.1  reinoud 		KASSERT(new_lbrec == orig_lbrec);
   3003        1.1  reinoud 		KASSERT(new_lbrec == 0);
   3004        1.1  reinoud 
   3005        1.1  reinoud 		return 0;
   3006        1.1  reinoud 	}
   3007        1.1  reinoud 
   3008        1.1  reinoud 	/* setup node cleanup extents copy space */
   3009        1.1  reinoud 	node_ad_cpy = malloc(lb_size * UDF_MAX_ALLOC_EXTENTS,
   3010        1.1  reinoud 		M_UDFMNT, M_WAITOK);
   3011        1.1  reinoud 	memset(node_ad_cpy, 0, lb_size * UDF_MAX_ALLOC_EXTENTS);
   3012        1.1  reinoud 
   3013        1.1  reinoud 	/*
   3014        1.1  reinoud 	 * Shrink the node by releasing the allocations and truncate the last
   3015        1.1  reinoud 	 * allocation to the new size. If the new size fits into the
   3016        1.1  reinoud 	 * allocation descriptor itself, transform it into an
   3017        1.1  reinoud 	 * UDF_ICB_INTERN_ALLOC.
   3018        1.1  reinoud 	 */
   3019        1.1  reinoud 	slot     = 0;
   3020        1.1  reinoud 	cpy_slot = 0;
   3021        1.1  reinoud 	foffset  = 0;
   3022        1.1  reinoud 
   3023        1.1  reinoud 	/* 1) copy till first overlap piece to the rewrite buffer */
   3024        1.1  reinoud 	for (;;) {
   3025        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   3026        1.1  reinoud 		if (eof) {
   3027        1.1  reinoud 			DPRINTF(WRITE,
   3028        1.1  reinoud 				("Shrink node failed: "
   3029        1.1  reinoud 				 "encountered EOF\n"));
   3030        1.1  reinoud 			error = EINVAL;
   3031        1.1  reinoud 			goto errorout; /* panic? */
   3032        1.1  reinoud 		}
   3033        1.1  reinoud 		len   = udf_rw32(s_ad.len);
   3034        1.1  reinoud 		flags = UDF_EXT_FLAGS(len);
   3035        1.1  reinoud 		len   = UDF_EXT_LEN(len);
   3036        1.1  reinoud 
   3037        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   3038        1.1  reinoud 			slot++;
   3039        1.1  reinoud 			continue;
   3040        1.1  reinoud 		}
   3041        1.1  reinoud 
   3042        1.1  reinoud 		end_foffset = foffset + len;
   3043        1.1  reinoud 		if (end_foffset > new_size)
   3044        1.1  reinoud 			break;	/* found */
   3045        1.1  reinoud 
   3046        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   3047        1.1  reinoud 
   3048        1.1  reinoud 		DPRINTF(ALLOC, ("\t1: vp %d, lb %d, len %d, flags %d "
   3049        1.1  reinoud 			"-> stack\n",
   3050        1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   3051        1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   3052        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   3053        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   3054        1.1  reinoud 
   3055        1.1  reinoud 		foffset = end_foffset;
   3056        1.1  reinoud 		slot++;
   3057        1.1  reinoud 	}
   3058        1.1  reinoud 	slot_offset = new_size - foffset;
   3059        1.1  reinoud 
   3060        1.1  reinoud 	/* 2) trunc overlapping slot at overlap and copy it */
   3061        1.1  reinoud 	if (slot_offset > 0) {
   3062        1.1  reinoud 		lb_num    = udf_rw32(s_ad.loc.lb_num);
   3063        1.1  reinoud 		vpart_num = udf_rw16(s_ad.loc.part_num);
   3064        1.1  reinoud 
   3065        1.1  reinoud 		if (flags == UDF_EXT_ALLOCATED) {
   3066       1.27  reinoud 			/* calculate extent in lb, and offset in lb */
   3067       1.27  reinoud 			num_lb = (len + lb_size -1) / lb_size;
   3068       1.27  reinoud 			slot_offset_lb = (slot_offset + lb_size -1) / lb_size;
   3069       1.27  reinoud 
   3070       1.27  reinoud 			/* adjust our slot */
   3071       1.27  reinoud 			lb_num += slot_offset_lb;
   3072       1.27  reinoud 			num_lb -= slot_offset_lb;
   3073        1.1  reinoud 
   3074        1.1  reinoud 			udf_free_allocated_space(ump, lb_num, vpart_num, num_lb);
   3075        1.1  reinoud 		}
   3076        1.1  reinoud 
   3077        1.1  reinoud 		s_ad.len = udf_rw32(slot_offset | flags);
   3078        1.1  reinoud 		node_ad_cpy[cpy_slot++] = s_ad;
   3079        1.1  reinoud 		slot++;
   3080        1.1  reinoud 
   3081        1.1  reinoud 		DPRINTF(ALLOC, ("\t2: vp %d, lb %d, len %d, flags %d "
   3082        1.1  reinoud 			"-> stack\n",
   3083        1.1  reinoud 			udf_rw16(s_ad.loc.part_num),
   3084        1.1  reinoud 			udf_rw32(s_ad.loc.lb_num),
   3085        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(s_ad.len)),
   3086        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   3087        1.1  reinoud 	}
   3088        1.1  reinoud 
   3089        1.1  reinoud 	/* 3) delete remainder */
   3090        1.1  reinoud 	for (;;) {
   3091        1.1  reinoud 		udf_get_adslot(udf_node, slot, &s_ad, &eof);
   3092        1.1  reinoud 		if (eof)
   3093        1.1  reinoud 			break;
   3094        1.1  reinoud 
   3095        1.1  reinoud 		len       = udf_rw32(s_ad.len);
   3096        1.1  reinoud 		flags     = UDF_EXT_FLAGS(len);
   3097        1.1  reinoud 		len       = UDF_EXT_LEN(len);
   3098        1.1  reinoud 
   3099        1.1  reinoud 		if (flags == UDF_EXT_REDIRECT) {
   3100        1.1  reinoud 			slot++;
   3101        1.1  reinoud 			continue;
   3102        1.1  reinoud 		}
   3103        1.1  reinoud 
   3104        1.1  reinoud 		DPRINTF(ALLOC, ("\t3: delete remainder "
   3105        1.1  reinoud 			"vp %d lb %d, len %d, flags %d\n",
   3106        1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   3107        1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   3108        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   3109        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   3110        1.1  reinoud 
   3111        1.1  reinoud 		if (flags == UDF_EXT_ALLOCATED) {
   3112        1.1  reinoud 			lb_num    = udf_rw32(s_ad.loc.lb_num);
   3113        1.1  reinoud 			vpart_num = udf_rw16(s_ad.loc.part_num);
   3114        1.1  reinoud 			num_lb    = (len + lb_size - 1) / lb_size;
   3115        1.1  reinoud 
   3116        1.1  reinoud 			udf_free_allocated_space(ump, lb_num, vpart_num,
   3117        1.1  reinoud 				num_lb);
   3118        1.1  reinoud 		}
   3119        1.1  reinoud 
   3120        1.1  reinoud 		slot++;
   3121        1.1  reinoud 	}
   3122        1.1  reinoud 
   3123        1.1  reinoud 	/* 4) if it will fit into the descriptor then convert */
   3124        1.1  reinoud 	if (new_size < max_l_ad) {
   3125        1.1  reinoud 		/*
   3126        1.1  reinoud 		 * resque/evacuate old piece by reading it in, and convert it
   3127        1.1  reinoud 		 * to internal alloc.
   3128        1.1  reinoud 		 */
   3129        1.1  reinoud 		if (new_size == 0) {
   3130        1.1  reinoud 			/* XXX/TODO only for zero sizing now */
   3131        1.1  reinoud 			udf_wipe_adslots(udf_node);
   3132        1.1  reinoud 
   3133        1.1  reinoud 			icbflags &= ~UDF_ICB_TAG_FLAGS_ALLOC_MASK;
   3134        1.1  reinoud 			icbflags |=  UDF_ICB_INTERN_ALLOC;
   3135        1.1  reinoud 			icbtag->flags = udf_rw16(icbflags);
   3136        1.1  reinoud 
   3137        1.1  reinoud 			inflen  -= size_diff;	KASSERT(inflen == 0);
   3138        1.1  reinoud 			objsize -= size_diff;
   3139        1.1  reinoud 			l_ad     = new_size;
   3140        1.1  reinoud 			crclen = dscr_size - UDF_DESC_TAG_LENGTH + l_ea + l_ad;
   3141        1.1  reinoud 			if (fe) {
   3142        1.1  reinoud 				fe->inf_len   = udf_rw64(inflen);
   3143        1.1  reinoud 				fe->l_ad      = udf_rw32(l_ad);
   3144       1.22  reinoud 				fe->tag.desc_crc_len = udf_rw16(crclen);
   3145        1.1  reinoud 			} else {
   3146        1.1  reinoud 				efe->inf_len  = udf_rw64(inflen);
   3147        1.1  reinoud 				efe->obj_size = udf_rw64(objsize);
   3148        1.1  reinoud 				efe->l_ad     = udf_rw32(l_ad);
   3149       1.22  reinoud 				efe->tag.desc_crc_len = udf_rw16(crclen);
   3150        1.1  reinoud 			}
   3151        1.1  reinoud 			/* eventually copy in evacuated piece */
   3152        1.1  reinoud 			/* set new size for uvm */
   3153        1.1  reinoud 			uvm_vnp_setsize(vp, new_size);
   3154        1.1  reinoud 
   3155        1.1  reinoud 			free(node_ad_cpy, M_UDFMNT);
   3156        1.9  reinoud 			udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   3157        1.9  reinoud 
   3158        1.1  reinoud 			UDF_UNLOCK_NODE(udf_node, 0);
   3159        1.1  reinoud 
   3160        1.1  reinoud 			KASSERT(new_inflen == orig_inflen - size_diff);
   3161        1.1  reinoud 			KASSERT(new_inflen == 0);
   3162        1.1  reinoud 			KASSERT(new_lbrec == 0);
   3163        1.1  reinoud 
   3164        1.1  reinoud 			return 0;
   3165        1.1  reinoud 		}
   3166        1.1  reinoud 
   3167        1.1  reinoud 		printf("UDF_SHRINK_NODE: could convert to internal alloc!\n");
   3168        1.1  reinoud 	}
   3169        1.1  reinoud 
   3170        1.1  reinoud 	/* 5) reset node descriptors */
   3171        1.1  reinoud 	udf_wipe_adslots(udf_node);
   3172        1.1  reinoud 
   3173        1.1  reinoud 	/* 6) copy back extents; merge when possible. Recounting on the fly */
   3174        1.1  reinoud 	cpy_slots = cpy_slot;
   3175        1.1  reinoud 
   3176        1.1  reinoud 	c_ad = node_ad_cpy[0];
   3177        1.1  reinoud 	slot = 0;
   3178        1.1  reinoud 	for (cpy_slot = 1; cpy_slot < cpy_slots; cpy_slot++) {
   3179        1.1  reinoud 		s_ad = node_ad_cpy[cpy_slot];
   3180        1.1  reinoud 
   3181        1.1  reinoud 		DPRINTF(ALLOC, ("\t6: stack -> got mapping vp %d "
   3182        1.1  reinoud 			"lb %d, len %d, flags %d\n",
   3183        1.1  reinoud 		udf_rw16(s_ad.loc.part_num),
   3184        1.1  reinoud 		udf_rw32(s_ad.loc.lb_num),
   3185        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(s_ad.len)),
   3186        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(s_ad.len)) >> 30));
   3187        1.1  reinoud 
   3188        1.1  reinoud 		/* see if we can merge */
   3189       1.31  reinoud 		if (udf_ads_merge(max_len, lb_size, &c_ad, &s_ad)) {
   3190        1.1  reinoud 			/* not mergable (anymore) */
   3191        1.1  reinoud 			DPRINTF(ALLOC, ("\t6: appending vp %d lb %d, "
   3192        1.1  reinoud 				"len %d, flags %d\n",
   3193        1.1  reinoud 			udf_rw16(c_ad.loc.part_num),
   3194        1.1  reinoud 			udf_rw32(c_ad.loc.lb_num),
   3195        1.1  reinoud 			UDF_EXT_LEN(udf_rw32(c_ad.len)),
   3196        1.1  reinoud 			UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   3197        1.1  reinoud 
   3198       1.11  reinoud 			error = udf_append_adslot(udf_node, &slot, &c_ad);
   3199        1.1  reinoud 			if (error)
   3200        1.1  reinoud 				goto errorout; /* panic? */
   3201        1.1  reinoud 			c_ad = s_ad;
   3202        1.1  reinoud 			slot++;
   3203        1.1  reinoud 		}
   3204        1.1  reinoud 	}
   3205        1.1  reinoud 
   3206        1.1  reinoud 	/* 7) push rest slot (if any) */
   3207        1.1  reinoud 	if (UDF_EXT_LEN(c_ad.len) > 0) {
   3208        1.1  reinoud 		DPRINTF(ALLOC, ("\t7: last append vp %d lb %d, "
   3209        1.1  reinoud 				"len %d, flags %d\n",
   3210        1.1  reinoud 		udf_rw16(c_ad.loc.part_num),
   3211        1.1  reinoud 		udf_rw32(c_ad.loc.lb_num),
   3212        1.1  reinoud 		UDF_EXT_LEN(udf_rw32(c_ad.len)),
   3213        1.1  reinoud 		UDF_EXT_FLAGS(udf_rw32(c_ad.len)) >> 30));
   3214        1.1  reinoud 
   3215       1.11  reinoud 		error = udf_append_adslot(udf_node, &slot, &c_ad);
   3216        1.1  reinoud 		if (error)
   3217        1.1  reinoud 			goto errorout; /* panic? */
   3218        1.1  reinoud 		;
   3219        1.1  reinoud 	}
   3220        1.1  reinoud 
   3221        1.1  reinoud 	inflen  -= size_diff;
   3222        1.1  reinoud 	objsize -= size_diff;
   3223        1.1  reinoud 	if (fe) {
   3224        1.1  reinoud 		fe->inf_len   = udf_rw64(inflen);
   3225        1.1  reinoud 	} else {
   3226        1.1  reinoud 		efe->inf_len  = udf_rw64(inflen);
   3227        1.1  reinoud 		efe->obj_size = udf_rw64(objsize);
   3228        1.1  reinoud 	}
   3229        1.1  reinoud 	error = 0;
   3230        1.1  reinoud 
   3231        1.1  reinoud 	/* set new size for uvm */
   3232        1.1  reinoud 	uvm_vnp_setsize(vp, new_size);
   3233        1.1  reinoud 
   3234        1.1  reinoud errorout:
   3235        1.1  reinoud 	free(node_ad_cpy, M_UDFMNT);
   3236        1.9  reinoud 
   3237       1.11  reinoud 	udf_count_alloc_exts(udf_node);
   3238       1.11  reinoud 
   3239        1.9  reinoud 	udf_node_sanity_check(udf_node, &new_inflen, &new_lbrec);
   3240        1.1  reinoud 	UDF_UNLOCK_NODE(udf_node, 0);
   3241        1.1  reinoud 
   3242        1.1  reinoud 	KASSERT(new_inflen == orig_inflen - size_diff);
   3243        1.1  reinoud 
   3244        1.1  reinoud 	return error;
   3245        1.1  reinoud }
   3246        1.1  reinoud 
   3247