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