udf.c revision 1.1 1 /* $NetBSD: udf.c,v 1.1 2013/08/05 14:41:57 reinoud Exp $ */
2
3 /*
4 * Copyright (c) 2006, 2008, 2013 Reinoud Zandijk
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 *
27 */
28
29 #include <sys/cdefs.h>
30 #ifndef lint
31 __RCSID("$NetBSD: udf.c,v 1.1 2013/08/05 14:41:57 reinoud Exp $");
32 #endif /* not lint */
33
34 #define _EXPOSE_MMC
35
36 #include <stdio.h>
37 #include <stdlib.h>
38 #include <string.h>
39 #include <errno.h>
40 #include <time.h>
41 #include <assert.h>
42 #include <err.h>
43 #include <unistd.h>
44 #include <fcntl.h>
45 #include <sys/types.h>
46 #include <sys/param.h>
47 #include <sys/cdio.h>
48 #include <sys/stat.h>
49 #include <util.h>
50
51 #include "makefs.h"
52 #include "udf_create.h"
53 #include "udf_write.h"
54 #include "newfs_udf.h"
55
56
57 /*
58 * Note: due to the setup of the newfs code, the current state of the program
59 * and its options are helt in a few global variables. The FS specific parts
60 * are in a global `context' structure.
61 */
62
63 /* global variables describing disc and format requests */
64 int fd; /* device: file descriptor */
65 char *dev; /* device: name */
66 struct mmc_discinfo mmc_discinfo; /* device: disc info */
67
68 char *format_str; /* format: string representation */
69 int format_flags; /* format: attribute flags */
70 int media_accesstype; /* derived from current mmc cap */
71 int check_surface; /* for rewritables */
72 int imagefile_secsize; /* for files */
73
74 int display_progressbar;
75
76 int wrtrack_skew;
77 float meta_fract = (float) UDF_META_PERC / 100.0;
78
79 int mmc_profile; /* emulated profile */
80 int req_enable, req_disable;
81
82
83 /* --------------------------------------------------------------------- */
84
85 int
86 udf_write_sector(void *sector, uint32_t location)
87 {
88 uint64_t wpos;
89 ssize_t ret;
90
91 wpos = (uint64_t) location * context.sector_size;
92 ret = pwrite(fd, sector, context.sector_size, wpos);
93 if (ret == -1)
94 return errno;
95 if (ret < context.sector_size)
96 return EIO;
97 return 0;
98 }
99
100
101 /* not implemented for files */
102 int
103 udf_surface_check(void)
104 {
105 return 0;
106 }
107
108
109 /*
110 * mmc_discinfo and mmc_trackinfo readers modified from origional in udf main
111 * code in sys/fs/udf/
112 */
113
114 #ifdef DEBUG
115 static void
116 udf_dump_discinfo(struct mmc_discinfo *di)
117 {
118 char bits[128];
119
120 printf("Device/media info :\n");
121 printf("\tMMC profile 0x%02x\n", di->mmc_profile);
122 printf("\tderived class %d\n", di->mmc_class);
123 printf("\tsector size %d\n", di->sector_size);
124 printf("\tdisc state %d\n", di->disc_state);
125 printf("\tlast ses state %d\n", di->last_session_state);
126 printf("\tbg format state %d\n", di->bg_format_state);
127 printf("\tfrst track %d\n", di->first_track);
128 printf("\tfst on last ses %d\n", di->first_track_last_session);
129 printf("\tlst on last ses %d\n", di->last_track_last_session);
130 printf("\tlink block penalty %d\n", di->link_block_penalty);
131 snprintb(bits, sizeof(bits), MMC_DFLAGS_FLAGBITS, (uint64_t) di->disc_flags);
132 printf("\tdisc flags %s\n", bits);
133 printf("\tdisc id %x\n", di->disc_id);
134 printf("\tdisc barcode %"PRIx64"\n", di->disc_barcode);
135
136 printf("\tnum sessions %d\n", di->num_sessions);
137 printf("\tnum tracks %d\n", di->num_tracks);
138
139 snprintb(bits, sizeof(bits), MMC_CAP_FLAGBITS, di->mmc_cur);
140 printf("\tcapabilities cur %s\n", bits);
141 snprintb(bits, sizeof(bits), MMC_CAP_FLAGBITS, di->mmc_cap);
142 printf("\tcapabilities cap %s\n", bits);
143 printf("\n");
144 printf("\tlast_possible_lba %d\n", di->last_possible_lba);
145 printf("\n");
146 }
147 #else
148 #define udf_dump_discinfo(a);
149 #endif
150
151 /* --------------------------------------------------------------------- */
152
153 static int
154 udf_emulate_discinfo(fsinfo_t *fsopts, struct mmc_discinfo *di,
155 int mmc_emuprofile)
156 {
157 off_t sectors;
158
159 memset(di, 0, sizeof(struct mmc_discinfo));
160
161 /* file support */
162 if ((mmc_emuprofile != 0x01) && (fsopts->sectorsize != 2048))
163 warnx("cd/dvd/bd sectorsize is not set to default 2048");
164
165 sectors = fsopts->size / fsopts->sectorsize;
166
167 /* commons */
168 di->mmc_profile = mmc_emuprofile;
169 di->disc_state = MMC_STATE_CLOSED;
170 di->last_session_state = MMC_STATE_CLOSED;
171 di->bg_format_state = MMC_BGFSTATE_COMPLETED;
172 di->link_block_penalty = 0;
173
174 di->disc_flags = MMC_DFLAGS_UNRESTRICTED;
175
176 di->last_possible_lba = sectors - 1;
177 di->sector_size = fsopts->sectorsize;
178
179 di->num_sessions = 1;
180 di->num_tracks = 1;
181
182 di->first_track = 1;
183 di->first_track_last_session = di->last_track_last_session = 1;
184
185 di->mmc_cur = MMC_CAP_RECORDABLE | MMC_CAP_ZEROLINKBLK;
186 switch (mmc_emuprofile) {
187 case 0x00: /* unknown, treat as CDROM */
188 case 0x08: /* CDROM */
189 case 0x10: /* DVD-ROM */
190 req_enable |= FORMAT_READONLY;
191 /* FALLTROUGH */
192 case 0x01: /* disc */
193 /* set up a disc info profile for partitions/files */
194 di->mmc_class = MMC_CLASS_DISC;
195 di->mmc_cur |= MMC_CAP_REWRITABLE | MMC_CAP_HW_DEFECTFREE;
196 break;
197 case 0x09: /* CD-R */
198 di->mmc_class = MMC_CLASS_CD;
199 di->mmc_cur |= MMC_CAP_SEQUENTIAL;
200 di->disc_state = MMC_STATE_EMPTY;
201 break;
202 case 0x0a: /* CD-RW + CD-MRW (regretably) */
203 di->mmc_class = MMC_CLASS_CD;
204 di->mmc_cur |= MMC_CAP_REWRITABLE;
205 break;
206 case 0x13: /* DVD-RW */
207 di->mmc_class = MMC_CLASS_DVD;
208 di->mmc_cur |= MMC_CAP_REWRITABLE;
209 break;
210 case 0x11: /* DVD-R */
211 case 0x14: /* DVD-RW sequential */
212 case 0x1b: /* DVD+R */
213 case 0x2b: /* DVD+R DL */
214 case 0x51: /* HD DVD-R */
215 di->mmc_class = MMC_CLASS_DVD;
216 di->mmc_cur |= MMC_CAP_SEQUENTIAL;
217 di->disc_state = MMC_STATE_EMPTY;
218 break;
219 case 0x41: /* BD-R */
220 di->mmc_class = MMC_CLASS_BD;
221 di->mmc_cur |= MMC_CAP_SEQUENTIAL | MMC_CAP_HW_DEFECTFREE;
222 di->disc_state = MMC_STATE_EMPTY;
223 break;
224 case 0x43: /* BD-RE */
225 di->mmc_class = MMC_CLASS_BD;
226 di->mmc_cur |= MMC_CAP_REWRITABLE | MMC_CAP_HW_DEFECTFREE;
227 break;
228 default:
229 err(EINVAL, "makefs_udf: unknown or unimplemented device type");
230 return EINVAL;
231 }
232 di->mmc_cap = di->mmc_cur;
233
234 udf_dump_discinfo(di);
235 return 0;
236 }
237
238
239 int
240 udf_update_trackinfo(struct mmc_discinfo *di, struct mmc_trackinfo *ti)
241 {
242 /* discs partition support */
243 if (ti->tracknr != 1)
244 return EIO;
245
246 /* create fake ti */
247 ti->sessionnr = 1;
248
249 ti->track_mode = 0; /* XXX */
250 ti->data_mode = 0; /* XXX */
251 ti->flags = MMC_TRACKINFO_LRA_VALID | MMC_TRACKINFO_NWA_VALID;
252
253 ti->track_start = 0;
254 ti->packet_size = 32; /* take sensible default */
255
256 ti->track_size = di->last_possible_lba;
257 ti->next_writable = di->last_possible_lba;
258 ti->last_recorded = ti->next_writable;
259 ti->free_blocks = 0;
260
261 return 0;
262 }
263
264
265 #define OPT_STR(letter, name, desc) \
266 { letter, name, NULL, OPT_STRBUF, 0, 0, desc }
267
268 #define OPT_NUM(letter, name, field, min, max, desc) \
269 { letter, name, &diskStructure->field, \
270 sizeof(diskStructure->field) == 8 ? OPT_INT64 : \
271 (sizeof(diskStructure->field) == 4 ? OPT_INT32 : \
272 (sizeof(diskStructure->field) == 2 ? OPT_INT16 : OPT_INT8)), \
273 min, max, desc }
274
275 #define OPT_BOOL(letter, name, field, desc) \
276 OPT_NUM(letter, name, field, 0, 1, desc)
277
278 void
279 udf_prep_opts(fsinfo_t *fsopts)
280 {
281 struct tm *tm;
282 time_t now;
283
284 const option_t udf_options[] = {
285 OPT_STR('T', "disctype", "disc type (cdrom,dvdrom,dvdram,bdre,disk,cdr,dvdr,cdrw,dvdrw)"),
286 // { 'P', "progress", &display_progressbar, OPT_INT32, false, true,
287 // "display progress bar" },
288 { .name = NULL }
289 };
290
291 /* initialise */
292 format_str = strdup("");
293 req_enable = req_disable = 0;
294 format_flags = FORMAT_INVALID;
295 fsopts->sectorsize = 512; /* minimum allowed sector size */
296
297 srandom((unsigned long) time(NULL));
298
299 mmc_profile = 0x01; /* 'disc'/file */
300
301 udf_init_create_context();
302 context.app_name = APP_NAME;
303 context.impl_name = IMPL_NAME;
304 context.app_version_main = APP_VERSION_MAIN;
305 context.app_version_sub = APP_VERSION_SUB;
306
307 /* minimum and maximum UDF versions we advise */
308 context.min_udf = 0x102;
309 context.max_udf = 0x201;
310
311 /* use user's time zone as default */
312 (void)time(&now);
313 tm = localtime(&now);
314 context.gmtoff = tm->tm_gmtoff;
315
316 /* return info */
317 fsopts->fs_specific = NULL;
318 fsopts->fs_options = copy_opts(udf_options);
319 }
320
321
322 void
323 udf_cleanup_opts(fsinfo_t *fsopts)
324 {
325 free(fsopts->fs_options);
326 }
327
328
329 int
330 udf_parse_opts(const char *option, fsinfo_t *fsopts)
331 {
332 option_t *udf_options = fsopts->fs_options;
333 const char *name, *desc;
334 char buf[1024];
335 int i;
336
337 assert(option != NULL);
338
339 if (debug & DEBUG_FS_PARSE_OPTS)
340 printf("udf_parse_opts: got `%s'\n", option);
341
342 i = set_option(udf_options, option, buf, sizeof(buf));
343 if (i == -1)
344 return 0;
345
346 if (udf_options[i].name == NULL)
347 abort();
348
349 name = udf_options[i].name;
350 desc = udf_options[i].desc;
351 switch (udf_options[i].letter) {
352 case 'T':
353 if (strcmp(buf, "cdrom") == 0) {
354 mmc_profile = 0x00;
355 } else if (strcmp(buf, "dvdrom") == 0) {
356 mmc_profile = 0x10;
357 } else if (strcmp(buf, "dvdram") == 0) {
358 mmc_profile = 0x12;
359 } else if (strcmp(buf, "bdre") == 0) {
360 mmc_profile = 0x43;
361 } else if (strcmp(buf, "disk") == 0) {
362 mmc_profile = 0x01;
363 } else if (strcmp(buf, "cdr") == 0) {
364 mmc_profile = 0x09;
365 } else if (strcmp(buf, "dvdr") == 0) {
366 mmc_profile = 0x1b;
367 } else if (strcmp(buf, "cdrw") == 0) {
368 mmc_profile = 0x0a;
369 } else if (strcmp(buf, "dvdrw") == 0) {
370 mmc_profile = 0x13;
371 } else {
372 errx(EINVAL, "Unknown or unimplemented disc format");
373 return 0;
374 }
375 }
376 return 1;
377 }
378
379 /* --------------------------------------------------------------------- */
380
381 struct udf_stats {
382 uint32_t nfiles;
383 uint32_t ndirs;
384 uint32_t ndescr;
385 uint32_t nmetadatablocks;
386 uint32_t ndatablocks;
387 };
388
389
390 /* node reference administration */
391 static void
392 udf_inc_link(union dscrptr *dscr)
393 {
394 struct file_entry *fe;
395 struct extfile_entry *efe;
396
397 if (udf_rw16(dscr->tag.id) == TAGID_FENTRY) {
398 fe = &dscr->fe;
399 fe->link_cnt = udf_rw16(udf_rw16(fe->link_cnt) + 1);
400 } else if (udf_rw16(dscr->tag.id) == TAGID_EXTFENTRY) {
401 efe = &dscr->efe;
402 efe->link_cnt = udf_rw16(udf_rw16(efe->link_cnt) + 1);
403 } else {
404 errx(1, "Bad tag passed to udf_inc_link");
405 }
406 }
407
408
409 static void
410 udf_set_link_cnt(union dscrptr *dscr, int num)
411 {
412 struct file_entry *fe;
413 struct extfile_entry *efe;
414
415 if (udf_rw16(dscr->tag.id) == TAGID_FENTRY) {
416 fe = &dscr->fe;
417 fe->link_cnt = udf_rw16(num);
418 } else if (udf_rw16(dscr->tag.id) == TAGID_EXTFENTRY) {
419 efe = &dscr->efe;
420 efe->link_cnt = udf_rw16(num);
421 } else {
422 errx(1, "Bad tag passed to udf_set_link_cnt");
423 }
424 }
425
426
427 static uint32_t
428 udf_datablocks(off_t sz)
429 {
430 /* predictor if it can be written inside the node */
431 if (sz < context.sector_size - UDF_EXTFENTRY_SIZE - 16)
432 return 0;
433
434 return UDF_ROUNDUP(sz, context.sector_size) / context.sector_size;
435 }
436
437
438 static void
439 udf_prepare_fids(struct long_ad *dir_icb, struct long_ad *dirdata_icb,
440 uint8_t *dirdata, uint32_t dirdata_size)
441 {
442 struct fileid_desc *fid;
443 struct long_ad *icb;
444 uint32_t fidsize, offset;
445 uint32_t location;
446
447 if (udf_datablocks(dirdata_size) == 0) {
448 /* going internal */
449 icb = dir_icb;
450 } else {
451 /* external blocks to write to */
452 icb = dirdata_icb;
453 }
454
455 for (offset = 0; offset < dirdata_size; offset += fidsize) {
456 /* for each FID: */
457 fid = (struct fileid_desc *) (dirdata + offset);
458 assert(udf_rw16(fid->tag.id) == TAGID_FID);
459
460 location = udf_rw32(icb->loc.lb_num);
461 location += offset / context.sector_size;
462
463 fid->tag.tag_loc = udf_rw32(location);
464 udf_validate_tag_and_crc_sums((union dscrptr *) fid);
465
466 fidsize = udf_fidsize(fid);
467 }
468 }
469
470 static int
471 udf_file_inject_blob(union dscrptr *dscr, uint8_t *blob, size_t size)
472 {
473 struct icb_tag *icb;
474 struct file_entry *fe;
475 struct extfile_entry *efe;
476 uint64_t inf_len, obj_size;
477 uint32_t l_ea, l_ad;
478 uint32_t free_space, desc_size;
479 uint16_t crclen;
480 uint8_t *data, *pos;
481
482 fe = NULL;
483 efe = NULL;
484 if (udf_rw16(dscr->tag.id) == TAGID_FENTRY) {
485 fe = &dscr->fe;
486 data = fe->data;
487 l_ea = udf_rw32(fe->l_ea);
488 l_ad = udf_rw32(fe->l_ad);
489 icb = &fe->icbtag;
490 inf_len = udf_rw64(fe->inf_len);
491 obj_size = 0;
492 desc_size = sizeof(struct file_entry);
493 } else if (udf_rw16(dscr->tag.id) == TAGID_EXTFENTRY) {
494 efe = &dscr->efe;
495 data = efe->data;
496 l_ea = udf_rw32(efe->l_ea);
497 l_ad = udf_rw32(efe->l_ad);
498 icb = &efe->icbtag;
499 inf_len = udf_rw64(efe->inf_len);
500 obj_size = udf_rw64(efe->obj_size);
501 desc_size = sizeof(struct extfile_entry);
502 } else {
503 errx(1, "Bad tag passed to udf_file_inject_blob");
504 }
505 crclen = udf_rw16(dscr->tag.desc_crc_len);
506
507 /* calculate free space */
508 free_space = context.sector_size - (l_ea + l_ad) - desc_size;
509 if (udf_datablocks(size)) {
510 assert(free_space < size);
511 return 1;
512 }
513
514 /* going internal */
515 assert(l_ad == 0);
516 assert(udf_rw16(icb->flags) == UDF_ICB_INTERN_ALLOC);
517
518 // assert(free_space >= size);
519 pos = data + l_ea + l_ad;
520 memcpy(pos, blob, size);
521 l_ad += size;
522 crclen += size;
523
524 inf_len += size;
525 obj_size += size;
526
527 if (fe) {
528 fe->l_ad = udf_rw32(l_ad);
529 fe->inf_len = udf_rw64(inf_len);
530 } else if (efe) {
531 efe->l_ad = udf_rw32(l_ad);
532 efe->inf_len = udf_rw64(inf_len);
533 efe->obj_size = udf_rw64(inf_len);
534 }
535
536 /* make sure the header sums stays correct */
537 dscr->tag.desc_crc_len = udf_rw16(crclen);
538 udf_validate_tag_and_crc_sums(dscr);
539
540 return 0;
541 }
542
543
544 /* XXX no sparse file support */
545 static void
546 udf_append_file_mapping(union dscrptr *dscr, struct long_ad *piece)
547 {
548 struct icb_tag *icb;
549 struct file_entry *fe;
550 struct extfile_entry *efe;
551 struct long_ad *last_long, last_piece;
552 struct short_ad *last_short, new_short;
553 uint64_t inf_len, obj_size, logblks_rec;
554 uint32_t l_ea, l_ad, size;
555 uint32_t last_lb_num, piece_lb_num;
556 uint32_t last_len, piece_len, last_flags;
557 uint32_t rest_len, merge_len, last_end;
558 uint16_t last_part_num, piece_part_num;
559 uint16_t crclen, cur_alloc;
560 uint8_t *data, *pos;
561 const int short_len = sizeof(struct short_ad);
562 const int long_len = sizeof(struct long_ad);
563 const int sector_size = context.sector_size;
564 const int use_shorts = (context.data_part == context.metadata_part);
565 uint64_t max_len = UDF_ROUNDDOWN(UDF_EXT_MAXLEN, sector_size);
566
567 if (udf_rw16(dscr->tag.id) == TAGID_FENTRY) {
568 fe = &dscr->fe;
569 data = fe->data;
570 l_ea = fe->l_ea;
571 l_ad = udf_rw32(fe->l_ad);
572 icb = &fe->icbtag;
573 inf_len = udf_rw64(fe->inf_len);
574 logblks_rec = udf_rw64(fe->logblks_rec);
575 obj_size = 0;
576 } else if (udf_rw16(dscr->tag.id) == TAGID_EXTFENTRY) {
577 efe = &dscr->efe;
578 data = efe->data;
579 l_ea = efe->l_ea;
580 l_ad = udf_rw32(efe->l_ad);
581 icb = &efe->icbtag;
582 inf_len = udf_rw64(efe->inf_len);
583 obj_size = udf_rw64(efe->obj_size);
584 logblks_rec = udf_rw64(efe->logblks_rec);
585 } else {
586 errx(1, "Bad tag passed to udf_file_append_blob");
587 }
588 crclen = udf_rw16(dscr->tag.desc_crc_len);
589
590 pos = data + l_ea;
591 cur_alloc = udf_rw16(icb->flags);
592 size = UDF_EXT_LEN(udf_rw32(piece->len));
593
594 /* extract last entry as a long_ad */
595 memset(&last_piece, 0, sizeof(struct long_ad));
596 if (l_ad != 0) {
597 if (use_shorts) {
598 assert(cur_alloc == UDF_ICB_SHORT_ALLOC);
599 pos += l_ad - short_len;
600 last_short = (struct short_ad *) pos;
601 last_lb_num = udf_rw32(last_short->lb_num);
602 last_part_num = udf_rw16(piece->loc.part_num);
603 last_len = UDF_EXT_LEN(udf_rw32(last_short->len));
604 last_flags = UDF_EXT_FLAGS(udf_rw32(last_short->len));
605 } else {
606 assert(cur_alloc == UDF_ICB_LONG_ALLOC);
607 pos += l_ad - long_len;
608 last_long = (struct long_ad *) pos;
609 last_lb_num = udf_rw32(last_long->loc.lb_num);
610 last_part_num = udf_rw16(last_long->loc.part_num);
611 last_len = UDF_EXT_LEN(udf_rw32(last_long->len));
612 last_flags = UDF_EXT_FLAGS(udf_rw32(last_long->len));
613 }
614 }
615
616 piece_len = UDF_EXT_LEN(udf_rw32(piece->len));
617 piece_lb_num = udf_rw32(piece->loc.lb_num);
618 piece_part_num = udf_rw16(piece->loc.part_num);
619
620 /* try merging */
621 rest_len = max_len - last_len;
622
623 merge_len = MIN(udf_rw32(piece->len), rest_len);
624 last_end = last_lb_num + (last_len / sector_size);
625
626 if ((piece_lb_num == last_end) && (last_part_num == piece_part_num)) {
627 /* we can merge */
628 last_len += merge_len;
629 piece_len -= merge_len;
630
631 /* write back merge result */
632 if (use_shorts) {
633 last_short->len = udf_rw32(last_len | last_flags);
634 } else {
635 last_long->len = udf_rw32(last_len | last_flags);
636 }
637 piece_lb_num += merge_len / sector_size;
638 }
639
640 if (piece_len) {
641 /* append new entry */
642 pos = data + l_ea + l_ad;
643 if (use_shorts) {
644 icb->flags = udf_rw16(UDF_ICB_SHORT_ALLOC);
645 memset(&new_short, 0, short_len);
646 new_short.len = udf_rw32(piece_len);
647 new_short.lb_num = udf_rw32(piece_lb_num);
648 memcpy(pos, &new_short, short_len);
649 l_ad += short_len;
650 crclen += short_len;
651 } else {
652 icb->flags = udf_rw16(UDF_ICB_LONG_ALLOC);
653 piece->len = udf_rw32(piece_len);
654 piece->loc.lb_num = udf_rw32(piece_lb_num);
655 memcpy(pos, piece, long_len);
656 l_ad += long_len;
657 crclen += long_len;
658 }
659 }
660 piece->len = udf_rw32(0);
661
662 inf_len += size;
663 obj_size += size;
664 logblks_rec += UDF_ROUNDUP(size, sector_size) / sector_size;
665
666 dscr->tag.desc_crc_len = udf_rw16(crclen);
667 if (udf_rw16(dscr->tag.id) == TAGID_FENTRY) {
668 fe->l_ad = udf_rw32(l_ad);
669 fe->inf_len = udf_rw64(inf_len);
670 fe->logblks_rec = udf_rw64(logblks_rec);
671 } else if (udf_rw16(dscr->tag.id) == TAGID_EXTFENTRY) {
672 efe->l_ad = udf_rw32(l_ad);
673 efe->inf_len = udf_rw64(inf_len);
674 efe->obj_size = udf_rw64(inf_len);
675 efe->logblks_rec = udf_rw64(logblks_rec);
676 }
677 }
678
679
680 static int
681 udf_append_file_contents(union dscrptr *dscr, struct long_ad *data_icb,
682 uint8_t *fdata, size_t flen)
683 {
684 struct long_ad icb;
685 uint32_t location;
686 uint32_t phys;
687 uint16_t vpart;
688 uint8_t *bpos;
689 int cnt, sects;
690 int error;
691
692 if (udf_file_inject_blob(dscr, fdata, flen) == 0)
693 return 0;
694
695 /* has to be appended in mappings */
696 icb = *data_icb;
697 icb.len = udf_rw32(flen);
698 while (udf_rw32(icb.len) > 0)
699 udf_append_file_mapping(dscr, &icb);
700 udf_validate_tag_and_crc_sums(dscr);
701
702 /* write out data piece */
703 vpart = udf_rw16(data_icb->loc.part_num);
704 location = udf_rw32(data_icb->loc.lb_num);
705 sects = udf_datablocks(flen);
706 for (cnt = 0; cnt < sects; cnt++) {
707 bpos = fdata + cnt*context.sector_size;
708 phys = context.vtop_offset[vpart] + location + cnt;
709 error = udf_write_sector(bpos, phys);
710 if (error)
711 return error;
712 }
713 return 0;
714 }
715
716
717 static int
718 udf_create_new_file(struct stat *st, union dscrptr **dscr,
719 int filetype, struct long_ad *icb)
720 {
721 struct file_entry *fe;
722 struct extfile_entry *efe;
723 int error;
724
725 fe = NULL;
726 efe = NULL;
727 if (context.dscrver == 2) {
728 error = udf_create_new_fe(&fe, filetype, st);
729 if (error)
730 errx(error, "can't create fe");
731 *dscr = (union dscrptr *) fe;
732 icb->longad_uniqueid = fe->unique_id;
733 } else {
734 error = udf_create_new_efe(&efe, filetype, st);
735 if (error)
736 errx(error, "can't create fe");
737 *dscr = (union dscrptr *) efe;
738 icb->longad_uniqueid = efe->unique_id;
739 }
740
741 return 0;
742 }
743
744
745 static void
746 udf_estimate_walk(fsinfo_t *fsopts,
747 fsnode *root, char *dir, struct udf_stats *stats)
748 {
749 struct fileid_desc *fid;
750 struct long_ad dummy_ref;
751 fsnode *cur;
752 fsinode *fnode;
753 size_t pathlen = strlen(dir);
754 char *mydir = dir + pathlen;
755 off_t sz;
756 uint32_t nblk, ddoff;
757 uint32_t softlink_len;
758 uint8_t *softlink_buf;
759 int nentries;
760 int error;
761
762 stats->ndirs++;
763
764 /*
765 * Count number of directory entries and count directory size; needed
766 * for the reservation of enough space for the directory. Pity we
767 * don't keep the FIDs we created. If it turns out to be a issue we
768 * can cache it later.
769 */
770 fid = (struct fileid_desc *) malloc(context.sector_size);
771 assert(fid);
772
773 ddoff = 40; /* '..' entry */
774 for (cur = root, nentries = 0; cur != NULL; cur = cur->next) {
775 switch (cur->type & S_IFMT) {
776 default:
777 /* what kind of nodes? */
778 break;
779 case S_IFCHR:
780 case S_IFBLK:
781 /* not supported yet */
782 continue;
783 case S_IFDIR:
784 if (strcmp(cur->name, ".") == 0)
785 continue;
786 case S_IFLNK:
787 case S_IFREG:
788 /* create dummy FID to see how long name will become */
789 udf_create_fid(ddoff, fid, cur->name, 0, &dummy_ref);
790
791 nentries++;
792 ddoff += udf_fidsize(fid);
793 }
794 }
795 sz = ddoff;
796
797 root->inode->st.st_size = sz; /* max now */
798 root->inode->flags |= FI_SIZED;
799
800 nblk = udf_datablocks(sz);
801 stats->nmetadatablocks += nblk;
802
803 /* for each entry in the directory, there needs to be a (E)FE */
804 stats->nmetadatablocks += nentries + 1;
805
806 /* recurse */
807 for (cur = root; cur != NULL; cur = cur->next) {
808 switch (cur->type & S_IFMT) {
809 default:
810 /* what kind of nodes? */
811 break;
812 case S_IFCHR:
813 case S_IFBLK:
814 /* not supported yet */
815 // stats->nfiles++;
816 break;
817 case S_IFDIR:
818 if (strcmp(cur->name, ".") == 0)
819 continue;
820 /* empty dir? */
821 if (!cur->child)
822 break;
823 mydir[0] = '/';
824 strncpy(&mydir[1], cur->name, MAXPATHLEN - pathlen);
825 udf_estimate_walk(fsopts, cur->child, dir, stats);
826 mydir[0] = '\0';
827 break;
828 case S_IFREG:
829 fnode = cur->inode;
830 /* don't double-count hard-links */
831 if (!(fnode->flags & FI_SIZED)) {
832 sz = fnode->st.st_size;
833 nblk = udf_datablocks(sz);
834 stats->ndatablocks += nblk;
835 /* ... */
836 fnode->flags |= FI_SIZED;
837 }
838 stats->nfiles++;
839 break;
840 case S_IFLNK:
841 /* softlink */
842 fnode = cur->inode;
843 /* don't double-count hard-links */
844 if (!(fnode->flags & FI_SIZED)) {
845 error = udf_encode_symlink(&softlink_buf,
846 &softlink_len, cur->symlink);
847 if (error) {
848 printf("SOFTLINK error %d\n", error);
849 break;
850 }
851 nblk = udf_datablocks(softlink_len);
852 stats->ndatablocks += nblk;
853 fnode->flags |= FI_SIZED;
854
855 free(softlink_buf);
856 }
857 stats->nfiles++;
858 break;
859 }
860 }
861 }
862
863
864 #define UDF_MAX_CHUNK_SIZE (4*1024*1024)
865 static int
866 udf_copy_file(struct stat *st, char *path, fsnode *cur, struct fileid_desc *fid,
867 struct long_ad *icb)
868 {
869 union dscrptr *dscr;
870 struct long_ad data_icb;
871 fsinode *fnode;
872 size_t sz, chunk, rd;
873 uint8_t *data;
874 int nblk;
875 int i, f;
876
877 fnode = cur->inode;
878
879 f = open(path, O_RDONLY, 0, 0);
880 if (f < 0) {
881 warn("Can't open file %s for reading", cur->name);
882 return errno;
883 }
884
885 /* claim disc space for the (e)fe descriptor for this file */
886 udf_metadata_alloc(1, icb);
887 udf_create_new_file(st, &dscr, UDF_ICB_FILETYPE_RANDOMACCESS, icb);
888
889 sz = fnode->st.st_size;
890
891 chunk = MIN(sz, UDF_MAX_CHUNK_SIZE);
892 data = malloc(MAX(chunk, context.sector_size));
893 assert(data);
894
895 printf(" ");
896 i = 0;
897 while (chunk) {
898 rd = read(f, data, chunk);
899 if (rd != chunk) {
900 warn("Short read of file %s\n", cur->name);
901 close(f);
902 free(data);
903 return errno;
904 }
905 printf("\b%c", "\\|/-"[i++ % 4]); fflush(stdout);fflush(stderr);
906
907 nblk = udf_datablocks(chunk);
908 if (nblk > 0)
909 udf_data_alloc(nblk, &data_icb);
910 udf_append_file_contents(dscr, &data_icb, data, chunk);
911
912 sz -= chunk;
913 chunk = MIN(sz, UDF_MAX_CHUNK_SIZE);
914 }
915 printf("\b \n");
916 close(f);
917 free(data);
918
919 /* write out dscr (e)fe */
920 udf_set_link_cnt(dscr, fnode->nlink);
921 udf_write_dscr_virt(dscr, udf_rw32(icb->loc.lb_num),
922 udf_rw16(icb->loc.part_num), 1);
923
924 /* remember our location for hardlinks */
925 cur->inode->fsuse = malloc(sizeof(struct long_ad));
926 memcpy(cur->inode->fsuse, icb, sizeof(struct long_ad));
927
928 return 0;
929 }
930
931
932 static int
933 udf_populate_walk(fsinfo_t *fsopts, fsnode *root, char *dir,
934 struct long_ad *parent_icb, struct long_ad *dir_icb)
935 {
936 union dscrptr *dir_dscr, *dscr;
937 struct fileid_desc *fid;
938 struct long_ad icb, data_icb, dirdata_icb;
939 fsnode *cur;
940 fsinode *fnode;
941 size_t pathlen = strlen(dir);
942 size_t dirlen;
943 char *mydir = dir + pathlen;
944 uint32_t nblk, ddoff;
945 uint32_t softlink_len;
946 uint8_t *softlink_buf;
947 uint8_t *dirdata;
948 int error, ret, retval;
949
950 /* claim disc space for the (e)fe descriptor for this dir */
951 udf_metadata_alloc(1, dir_icb);
952
953 /* create new e(fe) */
954 udf_create_new_file(&root->inode->st, &dir_dscr,
955 UDF_ICB_FILETYPE_DIRECTORY, dir_icb);
956
957 /* claim space for the directory contents */
958 dirlen = root->inode->st.st_size;
959 nblk = udf_datablocks(dirlen);
960 if (nblk > 0) {
961 /* claim disc space for the dir contents */
962 udf_data_alloc(nblk, &dirdata_icb);
963 }
964
965 /* allocate memory for the directory contents */
966 nblk++;
967 dirdata = malloc(nblk * context.sector_size);
968 assert(dirdata);
969 memset(dirdata, 0, nblk * context.sector_size);
970
971 /* create and append '..' */
972 fid = (struct fileid_desc *) dirdata;
973 ddoff = udf_create_parentfid(fid, parent_icb);
974
975 /* for '..' */
976 udf_inc_link(dir_dscr);
977
978 /* recurse */
979 retval = 0;
980 for (cur = root; cur != NULL; cur = cur->next) {
981 mydir[0] = '/';
982 strncpy(&mydir[1], cur->name, MAXPATHLEN - pathlen);
983
984 fid = (struct fileid_desc *) (dirdata + ddoff);
985 switch (cur->type & S_IFMT) {
986 default:
987 /* what kind of nodes? */
988 retval = 2;
989 break;
990 case S_IFCHR:
991 case S_IFBLK:
992 /* not supported */
993 retval = 2;
994 warnx("device node %s not supported", dir);
995 break;
996 case S_IFDIR:
997 /* not an empty dir? */
998 if (strcmp(cur->name, ".") == 0)
999 break;
1000 assert(cur->child);
1001 if (cur->child) {
1002 ret = udf_populate_walk(fsopts, cur->child,
1003 dir, dir_icb, &icb);
1004 if (ret)
1005 retval = 2;
1006 }
1007 udf_create_fid(ddoff, fid, cur->name,
1008 UDF_FILE_CHAR_DIR, &icb);
1009 udf_inc_link(dir_dscr);
1010 ddoff += udf_fidsize(fid);
1011 break;
1012 case S_IFREG:
1013 fnode = cur->inode;
1014 /* don't re-copy hard-links */
1015 if (!(fnode->flags & FI_WRITTEN)) {
1016 printf("%s", dir);
1017 error = udf_copy_file(&fnode->st, dir, cur,
1018 fid, &icb);
1019 if (!error) {
1020 fnode->flags |= FI_WRITTEN;
1021 udf_create_fid(ddoff, fid, cur->name,
1022 0, &icb);
1023 ddoff += udf_fidsize(fid);
1024 } else {
1025 retval = 2;
1026 }
1027 } else {
1028 /* hardlink! */
1029 printf("%s (hardlink)\n", dir);
1030 udf_create_fid(ddoff, fid, cur->name,
1031 0, (struct long_ad *) (fnode->fsuse));
1032 ddoff += udf_fidsize(fid);
1033 }
1034 fnode->nlink--;
1035 if (fnode->nlink == 0)
1036 free(fnode->fsuse);
1037 break;
1038 case S_IFLNK:
1039 /* softlink */
1040 fnode = cur->inode;
1041 printf("%s -> %s\n", dir, cur->symlink);
1042 error = udf_encode_symlink(&softlink_buf,
1043 &softlink_len, cur->symlink);
1044 if (error) {
1045 printf("SOFTLINK error %d\n", error);
1046 retval = 2;
1047 break;
1048 }
1049
1050 udf_metadata_alloc(1, &icb);
1051 udf_create_new_file(&fnode->st, &dscr,
1052 UDF_ICB_FILETYPE_SYMLINK, &icb);
1053
1054 nblk = udf_datablocks(softlink_len);
1055 if (nblk > 0)
1056 udf_data_alloc(nblk, &data_icb);
1057 udf_append_file_contents(dscr, &data_icb,
1058 softlink_buf, softlink_len);
1059
1060 /* write out dscr (e)fe */
1061 udf_inc_link(dscr);
1062 udf_write_dscr_virt(dscr, udf_rw32(icb.loc.lb_num),
1063 udf_rw16(icb.loc.part_num), 1);
1064
1065 free(softlink_buf);
1066
1067 udf_create_fid(ddoff, fid, cur->name, 0, &icb);
1068 ddoff += udf_fidsize(fid);
1069 break;
1070 }
1071 mydir[0] = '\0';
1072 }
1073
1074 /* writeout directory contents */
1075 dirlen = ddoff; /* XXX might bite back */
1076
1077 udf_prepare_fids(dir_icb, &dirdata_icb, dirdata, dirlen);
1078 udf_append_file_contents(dir_dscr, &dirdata_icb, dirdata, dirlen);
1079
1080 /* write out dir_dscr (e)fe */
1081 udf_write_dscr_virt(dir_dscr, udf_rw32(dir_icb->loc.lb_num),
1082 udf_rw16(dir_icb->loc.part_num), 1);
1083
1084 return retval;
1085 }
1086
1087
1088 static int
1089 udf_populate(const char *dir, fsnode *root, fsinfo_t *fsopts,
1090 struct udf_stats *stats)
1091 {
1092 struct long_ad rooticb;
1093 static char path[MAXPATHLEN+1];
1094 int error;
1095
1096 /* make sure the root gets the rootdir entry */
1097 context.metadata_alloc_pos = layout.rootdir;
1098 context.data_alloc_pos = layout.rootdir;
1099
1100 strncpy(path, dir, sizeof(path));
1101 error = udf_populate_walk(fsopts, root, path, &rooticb, &rooticb);
1102
1103 return error;
1104 }
1105
1106
1107 static void
1108 udf_enumerate_and_estimate(const char *dir, fsnode *root, fsinfo_t *fsopts,
1109 struct udf_stats *stats)
1110 {
1111 char path[MAXPATHLEN + 1];
1112 uint32_t n, nblk;
1113
1114 strncpy(path, dir, sizeof(path));
1115
1116 /* calculate strict minimal size */
1117 udf_estimate_walk(fsopts, root, path, stats);
1118 printf("ndirs\t\t%d\n", stats->ndirs);
1119 printf("nfiles\t\t%d\n", stats->nfiles);
1120 printf("ndata_blocks\t%d\n", stats->ndatablocks);
1121 printf("nmetadata_blocks\t%d\n", stats->nmetadatablocks);
1122
1123 /* adjust for options : free file nodes */
1124 if (fsopts->freefiles) {
1125 /* be mercifull and reserve more for the FID */
1126 stats->nmetadatablocks += fsopts->freefiles * 1.5;
1127 } else if ((n = fsopts->freefilepc)) {
1128 stats->nmetadatablocks += (stats->nmetadatablocks*n) / (100-n);
1129 }
1130
1131 /* adjust for options : free data blocks */
1132 if (fsopts->freeblocks) {
1133 stats->ndatablocks += fsopts->freeblocks;
1134 } else if ((n = fsopts->freeblockpc)) {
1135 stats->ndatablocks += (stats->ndatablocks * n) / (100-n);
1136 }
1137
1138 /* rough predictor of minimum disc size */
1139 nblk = stats->ndatablocks + stats->nmetadatablocks;
1140 nblk = (double) nblk * (1.0 + 1.0/8.0); /* free space map */
1141 nblk += 256; /* pre-volume space */
1142 nblk += 256; /* post-volume space */
1143 nblk += 64; /* safeguard */
1144
1145 /* try to honour minimum size */
1146 n = fsopts->minsize / fsopts->sectorsize;
1147 if (nblk < n) {
1148 stats->ndatablocks += (n - nblk);
1149 nblk += n - nblk;
1150 }
1151 fsopts->size = (uint64_t) nblk * fsopts->sectorsize;
1152
1153 /* sanity size */
1154 if (fsopts->size < 512*1024)
1155 fsopts->size = 512*1024;
1156
1157 fsopts->inodes = stats->nfiles + stats->ndirs;
1158 }
1159
1160
1161 void
1162 udf_makefs(const char *image, const char *dir, fsnode *root, fsinfo_t *fsopts)
1163 {
1164 struct udf_stats stats;
1165 uint64_t truncate_len;
1166 int error;
1167
1168 /* determine format */
1169 udf_emulate_discinfo(fsopts, &mmc_discinfo, mmc_profile);
1170 printf("req_enable %d, req_disable %d\n", req_enable, req_disable);
1171
1172 context.sector_size = fsopts->sectorsize;
1173 error = udf_derive_format(req_enable, req_disable, false);
1174 if (error)
1175 err(EINVAL, "makefs_udf: can't determine format");
1176
1177 /* names */
1178 error = udf_proces_names();
1179 if (error)
1180 err(EINVAL, "makefs_udf: bad names given");
1181
1182 /* set return value to 1 indicating error */
1183 error = 1;
1184
1185 /* estimate the amount of space needed */
1186 memset(&stats, 0, sizeof(struct udf_stats));
1187 udf_enumerate_and_estimate(dir, root, fsopts, &stats);
1188
1189 printf("Calculated size of `%s': %lld bytes, %ld inodes\n",
1190 image, (long long)fsopts->size, (long)fsopts->inodes);
1191
1192 /* create file image */
1193 if ((fd = open(image, O_RDWR | O_CREAT | O_TRUNC, 0666)) == -1) {
1194 err(EXIT_FAILURE, "%s", image);
1195 }
1196 if (lseek(fd, fsopts->size - 1, SEEK_SET) == -1) {
1197 goto err_exit;
1198 }
1199 if (write(fd, &fd, 1) != 1) {
1200 goto err_exit;
1201 }
1202 if (lseek(fd, 0, SEEK_SET) == -1) {
1203 goto err_exit;
1204 }
1205 fsopts->fd = fd;
1206
1207 /* calculate metadata percentage */
1208 meta_fract = fsopts->size / (stats.nmetadatablocks*fsopts->sectorsize);
1209 meta_fract = ((int) ((meta_fract + 0.005)*100.0)) / 100;
1210
1211 /* update mmc info but now with correct size */
1212 udf_emulate_discinfo(fsopts, &mmc_discinfo, mmc_profile);
1213
1214 udf_do_newfs_prefix();
1215
1216 /* update context */
1217 context.unique_id = 0;
1218
1219 /* XXX are the next two needed? or should be re-count them? */
1220 context.num_files = stats.nfiles;
1221 context.num_directories = stats.ndirs;
1222
1223 error = udf_populate(dir, root, fsopts, &stats);
1224
1225 udf_do_newfs_postfix();
1226
1227 if (format_flags & FORMAT_VAT) {
1228 truncate_len = context.vtop_offset[context.data_part] +
1229 context.data_alloc_pos;
1230 truncate_len *= context.sector_size;
1231
1232 printf("\nTruncing the disc-image to allow for VAT\n");
1233 ftruncate(fd, truncate_len);
1234 }
1235
1236 if (error) {
1237 error = 2; /* some files couldn't be added */
1238 goto err_exit;
1239 }
1240
1241 close(fd);
1242 return;
1243
1244 err_exit:
1245 close(fd);
1246 if (error == 2) {
1247 errx(error, "Not all files could be added");
1248 } else {
1249 errx(error, "creation of %s failed", image);
1250 }
1251 }
1252
1253