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