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