Home | History | Annotate | Line # | Download | only in udf
udf_allocation.c revision 1.32.8.1
      1  1.32.8.1   bouyer /* $NetBSD: udf_allocation.c,v 1.32.8.1 2013/09/07 15:57:35 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.8.1   bouyer __KERNEL_RCSID(0, "$NetBSD: udf_allocation.c,v 1.32.8.1 2013/09/07 15:57:35 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.8.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.8.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.8.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