d663c0b00b34ef146556d9e5a57d4a87dd812fbb
[dvdrip] / dvd-sector-copy.c
1 #define _GNU_SOURCE
2 #define _FILE_OFFSET_BITS 64
3
4 #include <assert.h>
5 #include <ctype.h>
6 #include <errno.h>
7 #include <inttypes.h>
8 #include <math.h>
9 #include <stdarg.h>
10 #include <stdint.h>
11 #include <stdio.h>
12 #include <stdlib.h>
13 #include <string.h>
14 #include <time.h>
15
16 #include <unistd.h>
17 #include <fcntl.h>
18 #include <sys/ioctl.h>
19 #include <sys/stat.h>
20 #include <sys/time.h>
21
22 #include <getopt.h>
23
24 #include <linux/fs.h>
25
26 #include <dvdread/dvd_reader.h>
27 #include <dvdread/dvd_udf.h>
28 #include <dvdread/ifo_read.h>
29 #include <dvdread/ifo_types.h>
30
31 #define CTYPE_HACK(fn, ch) fn((unsigned char)(ch))
32 #define ISDIGIT(ch) CTYPE_HACK(isdigit, ch)
33 #define ISSPACE(ch) CTYPE_HACK(isspace, ch)
34
35 #ifdef DEBUG
36 # define D(x) x
37 #else
38 # define D(x)
39 #endif
40
41 #define N(v) (sizeof(v)/sizeof((v)[0]))
42
43 #define SECTORSZ 2048
44 #define SECTORS(n) (((n) + (SECTORSZ - 1))/SECTORSZ)
45
46 static const char *prog = "<unset>";
47 static int status = 0;
48
49 static void usage(FILE *fp)
50 {
51 fprintf(fp,
52 "usage: %s [-c] [-R MAP] [-b OUTMAP] [-r [START]-[END]]\n"
53 "\tDEVICE OUTFILE\n",
54 prog);
55 }
56
57 static void vmoan(const char *fmt, va_list ap)
58 { fprintf(stderr, "%s: ", prog); vfprintf(stderr, fmt, ap); }
59
60 __attribute__((format(printf, 1, 2)))
61 static void moan(const char *fmt, ...)
62 {
63 va_list ap;
64
65 va_start(ap, fmt); vmoan(fmt, ap); va_end(ap);
66 fputc('\n', stderr);
67 }
68
69 __attribute__((noreturn, format(printf, 1, 2)))
70 static void bail(const char *fmt, ...)
71 {
72 va_list ap;
73
74 va_start(ap, fmt); vmoan(fmt, ap); va_end(ap);
75 fputc('\n', stderr);
76 exit(2);
77 }
78
79 __attribute__((noreturn, format(printf, 2, 3)))
80 static void bail_syserr(int err, const char *fmt, ...)
81 {
82 va_list ap;
83
84 va_start(ap, fmt); vmoan(fmt, ap); va_end(ap);
85 if (err) fprintf(stderr, ": %s", strerror(errno));
86 fputc('\n', stderr);
87 exit(2);
88 }
89
90 static void carefully_write(int fd, const void *buf, size_t sz)
91 {
92 const unsigned char *p = buf;
93 ssize_t n;
94
95 if (fd < 0) return;
96 while (sz) {
97 n = write(fd, p, sz);
98 if (n < 0) {
99 if (errno == EINTR) continue;
100 bail_syserr(errno, "failed to write to output file");
101 }
102 if (!n) bail("unexpected short write to output file");
103 p += n; sz -= n;
104 }
105 }
106
107 #define DEFVEC(vtype, etype) \
108 typedef struct { etype *v; size_t n, sz; } vtype
109 #define VEC_INIT { 0, 0, 0 }
110 #define VEC_FREE(vv) do { \
111 free((vv)->v); (vv)->v 0; (vv)->n = (vv)->sz = 0; \
112 } while (0)
113 #define VEC_PUSH(p, vv) do { \
114 size_t _want; \
115 if ((vv)->n >= (vv)->sz) { \
116 (vv)->sz = (vv)->sz ? 2*(vv)->sz : 32; \
117 _want = (vv)->sz*sizeof(*(vv)->v); \
118 (vv)->v = realloc((vv)->v, _want); \
119 if (!(vv)->v) bail("out of memory allocating %zu bytes", _want); \
120 } \
121 (p) = &(vv)->v[(vv)->n++]; \
122 } while (0)
123
124 enum { RAW, IFO, VOB, BUP };
125 typedef uint_least32_t ident;
126
127 static inline ident mkident(unsigned kind, unsigned title, unsigned part)
128 { return (((ident)kind << 0) | ((ident)title << 8) | ((ident)part << 16)); }
129 static inline unsigned id_kind(ident id) { return ((id >> 0)&0x0ff); }
130 static inline unsigned id_title(ident id) { return ((id >> 8)&0x0ff); }
131 static inline unsigned id_part(ident id) { return ((id >> 16)&0x0ff); }
132
133 #define MAXFNSZ (1 + 8 + 1 + 12 + 1)
134
135 static void store_filename(char *buf, ident id)
136 {
137 switch (id_kind(id)) {
138 case RAW:
139 sprintf(buf, "#<raw device>");
140 break;
141 case IFO:
142 if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.IFO");
143 else sprintf(buf, "/VIDEO_TS/VTS_%02u_0.IFO", id_title(id));
144 break;
145 case BUP:
146 if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.BUP");
147 else sprintf(buf, "/VIDEO_TS/VTS_%02u_0.BUP", id_title(id));
148 break;
149 case VOB:
150 if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.VOB");
151 else
152 sprintf(buf, "/VIDEO_TS/VTS_%02u_%u.VOB", id_title(id), id_part(id));
153 break;
154 default:
155 abort();
156 }
157 }
158
159 typedef uint_least32_t secaddr;
160 #define PRIuSEC PRIuLEAST32
161 #define SECLIMIT 0x00400000
162
163 #define MAXFILES (1 + 2*99 + 1)
164 struct file {
165 ident id;
166 secaddr start, end;
167 };
168 DEFVEC(file_v, struct file);
169 static file_v filetab = VEC_INIT;
170
171 enum { EV_STOP, EV_BEGIN, EV_END, EV_WRITE };
172 struct event {
173 unsigned char ev, file;
174 secaddr pos;
175 };
176 DEFVEC(event_v, struct event);
177 static event_v eventq = VEC_INIT;
178
179 static int compare_event(const void *a, const void *b)
180 {
181 const struct event *eva = a, *evb = b;
182
183 if (eva->pos < evb->pos) return (-1);
184 else if (eva->pos > evb->pos) return (+1);
185
186 if (eva->ev < evb->ev) return (-1);
187 else if (eva->ev > evb->ev) return (+1);
188
189 if (eva->file < evb->file) return (-1);
190 else if (eva->file > evb->file) return (+1);
191
192 return (0);
193 }
194
195 typedef uint_least32_t bits;
196 static bits live[(MAXFILES + 31)/32];
197
198 static inline int livep(unsigned i)
199 { return (live[i/32]&((bits)1 << (i%32))); }
200 static inline void set_live(unsigned i)
201 { live[i/32] |= (bits)1 << (i%32); }
202 static inline void clear_live(unsigned i)
203 { live[i/32] &= ~((bits)1 << (i%32)); }
204 static inline int least_live(void)
205 {
206 unsigned i, n = (filetab.n + 32)/32;
207 bits b;
208
209 for (i = 0; i < n; i++) { b = live[i]; if (b) goto found; }
210 return (-1);
211 found:
212 i *= 32;
213 if (!(b&0x0000ffff)) { b >>= 16; i += 16; }
214 if (!(b&0x000000ff)) { b >>= 8; i += 8; }
215 if (!(b&0x0000000f)) { b >>= 4; i += 4; }
216 if (!(b&0x00000003)) { b >>= 2; i += 2; }
217 if (!(b&0x00000001)) { b >>= 1; i += 1; }
218 assert(b&1);
219 return (i);
220 }
221
222 static void put_event(unsigned evtype, unsigned file, secaddr pos)
223 {
224 struct event *ev;
225
226 VEC_PUSH(ev, &eventq);
227 ev->ev = evtype; ev->file = file; ev->pos = pos;
228 }
229
230 static void put_file(ident id, secaddr start, secaddr end)
231 {
232 struct file *f;
233 size_t i;
234
235 VEC_PUSH(f, &filetab); i = f - filetab.v;
236 f->id = id; f->start = start; f->end = end;
237 put_event(EV_BEGIN, i, start);
238 put_event(EV_END, i, end);
239 }
240
241 static void put_menu(dvd_reader_t *dvd, unsigned title)
242 {
243 ident id = mkident(VOB, title, 0);
244 char fn[MAXFNSZ];
245 secaddr start, len;
246
247 store_filename(fn, id);
248 start = UDFFindFile(dvd, fn, &len); if (!start) return;
249 #ifdef DEBUG
250 printf(";; %8"PRIuSEC" .. %-8"PRIuSEC": %s\n",
251 start, start + SECTORS(len), fn);
252 #endif
253 put_file(id, start, start + SECTORS(len));
254 }
255
256 static void put_title(dvd_reader_t *dvd, unsigned title)
257 {
258 char fn[MAXFNSZ];
259 secaddr start[9], len[9];
260 unsigned i, npart;
261
262 for (i = 0; i < 9; i++) {
263 store_filename(fn, mkident(VOB, title, i + 1));
264 start[i] = UDFFindFile(dvd, fn, &len[i]); if (!start[i]) break;
265 }
266 npart = i; if (!npart) return;
267
268 #ifdef DEBUG
269 for (i = 0; i < npart; i++) {
270 store_filename(fn, mkident(VOB, title, i + 1));
271 printf(";; %8"PRIuSEC" .. %-8"PRIuSEC": %s\n",
272 start[i], start[i] + SECTORS(len[i]), fn);
273 }
274 #endif
275
276 if (npart > 1)
277 for (i = 0; i < npart - 1; i++) {
278 if (len[i]%SECTORSZ)
279 bail("title %u part %u length = %"PRIuSEC" not a multiple of %d",
280 title, i, len[i], SECTORSZ);
281 if (start[i] + len[i]/SECTORSZ != start[i + 1])
282 bail
283 ("title %u part %u end = %"PRIuSEC" /= part %u start = %"PRIuSEC"",
284 title, i, start[i] + len[i]/SECTORSZ, i + 1, start[i + 1]);
285 }
286
287 put_file(mkident(VOB, title, 1),
288 start[0], start[npart - 1] + SECTORS(len[npart - 1]));
289 }
290
291 static int progresslen = 0;
292
293 static void clear_progress_internal(void)
294 {
295 while (progresslen) { fputs("\b \b", stdout); progresslen--; }
296 putchar('\r');
297 }
298 static void clear_progress(void)
299 { clear_progress_internal(); fflush(stdout); }
300 static void vappend_progress(const char *fmt, va_list ap)
301 { progresslen += vprintf(fmt, ap); }
302 __attribute__((format(printf, 1, 2)))
303 static void append_progress(const char *fmt, ...)
304 {
305 va_list ap;
306
307 va_start(ap, fmt);
308 vappend_progress(fmt, ap);
309 va_end(ap);
310 }
311 __attribute__((format(printf, 1, 2)))
312 static void print_progress(const char *fmt, ...)
313 {
314 va_list ap;
315
316 va_start(ap, fmt);
317 clear_progress_internal();
318 vappend_progress(fmt, ap);
319 va_end(ap);
320 }
321
322 unsigned flags;
323 # define F_ALLPROGRESS 1u
324 static secaddr last_pos, limit, nsectors, ndone;
325 static struct timeval last_time;
326 static double wsum, wcount;
327 static struct file *file;
328
329 static void report_progress(secaddr pos)
330 {
331 char etastr[32];
332 struct timeval now;
333 int eta;
334 double percent, t, f, g, rate;
335 char *unit;
336
337 #define ALPHA 0.02
338 #define BETA (1 - ALPHA)
339
340 gettimeofday(&now, 0);
341 t = (now.tv_sec - last_time.tv_sec) +
342 (now.tv_usec - last_time.tv_usec)/1000000.0;
343
344 if (t) {
345 g = wcount ? pow(BETA, t) : 0.0; f = (1 - g)/(1 - BETA);
346 wsum = f*(pos - last_pos)/t + g*wsum;
347 wcount = f + g*wcount;
348 ndone += pos - last_pos;
349 last_time = now; last_pos = pos;
350 }
351
352 if (!wsum || !wcount)
353 { rate = 0; strcpy(etastr, "???"); }
354 else {
355 rate = wsum/wcount;
356 eta = (int)((nsectors - ndone)/rate);
357 sprintf(etastr, "%d:%02d:%02d", eta/3600, (eta/60)%60, eta%60);
358 }
359
360 rate *= SECTORSZ; unit = "";
361 if (rate > 128) { rate /= 1024; unit = "k"; }
362 if (rate > 128) { rate /= 1024; unit = "M"; }
363 if (rate > 128) { rate /= 1024; unit = "G"; }
364
365 if (flags&F_ALLPROGRESS) percent = pos*100.0/limit;
366 else percent = ndone*100.0/nsectors;
367 print_progress
368 ("copied %.1f%% (%"PRIuSEC" of %"PRIuSEC"; %.1f %sB/s, ETA %s)",
369 percent, pos, limit, rate, unit, etastr);
370 if (file && id_kind(file->id) == VOB) {
371 append_progress(" -- %s %d %3.1f%%",
372 id_part(file->id) ? "title" : "menu",
373 id_title(file->id),
374 (pos - file->start)*100.0/
375 (file->end - file->start));
376 }
377
378 #undef ALPHA
379 #undef BETA
380 }
381
382 static dvd_reader_t *dvd;
383 static int dvdfd = -1, outfd = -1;
384 static dvd_file_t *vob;
385 static const char *mapfile; static FILE *mapfp;
386
387 struct badblock { secaddr start, end; };
388 DEFVEC(badblock_v, struct badblock);
389 static badblock_v badblocks = VEC_INIT;
390
391 static int compare_badblock(const void *a, const void *b)
392 {
393 const struct badblock *ba = a, *bb = b;
394
395 if (ba->start < bb->start) return (-1);
396 else if (ba->start > bb->start) return (+1);
397
398 if (ba->end < bb->end) return (-1);
399 else if (ba->end > bb->end) return (+1);
400
401 return (0);
402 }
403
404 static ssize_t read_sectors(secaddr pos, void *buf, secaddr want)
405 {
406 ssize_t n, done;
407 size_t lo, mid, hi;
408 int fakeerr = 0;
409 struct badblock *bad, *best;
410 unsigned char *p = buf;
411
412 best = 0; lo = 0; hi = badblocks.n;
413 #ifdef DEBUG
414 clear_progress();
415 printf(";; searching badblocks for %"PRIuSEC" .. %"PRIuSEC"\n",
416 pos, pos + want);
417 #endif
418 while (lo < hi) {
419 mid = lo + (hi - lo)/2; bad = &badblocks.v[mid];
420 #ifdef DEBUG
421 printf(";; try %zu (%"PRIuSEC" .. %"PRIuSEC")... ",
422 mid, bad->start, bad->end);
423 #endif
424 if (pos < bad->start) { D( printf("high\n"); ) best = bad; hi = mid; }
425 else if (pos >= bad->end) { D( printf("low\n"); ) lo = mid + 1; }
426 else { D( printf("match!\n"); ) errno = EIO; return (-1); }
427 }
428 #ifdef DEBUG
429 if (best)
430 printf(";; next is %"PRIuSEC" .. %"PRIuSEC"\n",
431 best->start, best->end);
432 #endif
433 if (best && pos + want > best->start)
434 { want = best->start - pos; fakeerr = EIO; }
435
436 done = 0;
437 while (want) {
438 if (vob)
439 { errno = 0; n = DVDReadBlocks(vob, pos - file->start, want, p); }
440 else if (file) {
441 if (lseek(dvdfd, (off_t)pos*SECTORSZ, SEEK_SET) < 0)
442 bail_syserr(errno, "failed to seek to sector %"PRIuSEC"", pos);
443 errno = 0; n = read(dvdfd, p, want*SECTORSZ);
444 if (n >= 0) n /= SECTORSZ;
445 } else {
446 memset(p, 0, want*SECTORSZ);
447 n = want;
448 }
449
450 if (n > 0) { done += n; pos += n; p += n*SECTORSZ; want -= n; }
451 else if (!n || errno != EINTR) break;
452 }
453 if (fakeerr && !errno) errno = fakeerr;
454 return (!done && errno ? -1 : done);
455 }
456
457 static void report_bad_blocks_progress(secaddr lo, secaddr hi, int err)
458 {
459 report_progress(hi);
460
461 if (lo == hi) append_progress(": retrying bad sector");
462 else
463 append_progress(": %"PRIuSEC" bad %s",
464 hi - lo, hi == lo + 1 ? "sector" : "sectors");
465 if (err && err != EIO) append_progress(" (%s)", strerror(err));
466 fflush(stdout);
467 }
468
469 static void recovered(secaddr bad_lo, secaddr bad_hi)
470 {
471 clear_progress();
472 moan("skipping %"PRIuSEC" bad sectors (%"PRIuSEC" .. %"PRIuSEC")",
473 bad_hi - bad_lo, bad_lo, bad_hi);
474 if (mapfile) {
475 if (!mapfp) {
476 mapfp = fopen(mapfile, "w");
477 if (!mapfp)
478 bail_syserr(errno, "failed to open bad-sector map file `%s'",
479 optarg);
480 fprintf(mapfp, "## bad sector map\n\n");
481 }
482 fprintf(mapfp, "%"PRIuSEC" %"PRIuSEC"\n", bad_lo, bad_hi);
483 fflush(mapfp);
484 if (ferror(mapfp))
485 bail_syserr(errno, "error writing bad-sector map file");
486 }
487 if (lseek(outfd, (off_t)(bad_hi - bad_lo)*SECTORSZ, SEEK_CUR) < 0)
488 bail_syserr(errno, "failed to seek past bad sectors");
489 status = 1;
490 }
491
492 static ssize_t find_good_sector(secaddr *pos_inout, secaddr end,
493 unsigned char *buf, secaddr sz)
494 {
495 int i;
496 secaddr pos = *pos_inout, bad_lo, bad_hi, good, step;
497 ssize_t n;
498
499 report_bad_blocks_progress(pos, pos, errno);
500 for (i = 0; i < 4; i++) {
501 n = read_sectors(pos, buf, 1);
502 if (n > 0) {
503 clear_progress();
504 moan("sector %"PRIuSEC" read ok after retry", pos);
505 bad_lo = bad_hi = pos;
506 return (n);
507 }
508 }
509
510 bad_lo = pos; step = 1; bad_hi = pos + 1;
511 for (;;) {
512 report_bad_blocks_progress(bad_lo, bad_hi, errno);
513 if (bad_hi >= end) {
514 clear_progress();
515 moan("giving up on this extent");
516 recovered(bad_lo, end); *pos_inout = end; return (0);
517 }
518 step *= 2;
519 if (step > end - bad_lo) step = end - bad_lo;
520 pos = bad_lo + step - 1;
521 n = read_sectors(pos, buf, 1);
522 if (n > 0) break;
523 bad_hi = pos + 1;
524 }
525
526 good = pos;
527 while (good > bad_hi) {
528 report_bad_blocks_progress(bad_lo, bad_hi, errno);
529 pos = bad_hi + (good - bad_hi)/2;
530 n = read_sectors(pos, buf, 1);
531 if (n > 0) good = pos;
532 else bad_hi = pos + 1;
533 }
534 recovered(bad_lo, bad_hi); *pos_inout = good;
535 return (n);
536 }
537
538 static void emit(secaddr start, secaddr end)
539 {
540 #define BUFSECTORS 512
541
542 int least;
543 unsigned char buf[BUFSECTORS*SECTORSZ];
544 secaddr pos;
545 size_t want;
546 ssize_t n;
547 static int first_time = 1;
548 #ifdef DEBUG
549 struct file *f;
550 char fn[MAXFNSZ];
551 int act = -1;
552 int i;
553 #endif
554
555 least = least_live();
556
557 #ifdef DEBUG
558 printf(";; %8"PRIuSEC" .. %"PRIuSEC"\n", start, end);
559
560 for (i = 0; i < filetab.n; i++) {
561 if (!livep(i)) continue;
562 if (act == -1) act = i;
563 f = &filetab.v[i]; store_filename(fn, f->id);
564 printf(";;\t\t%8"PRIuSEC" .. %-8"PRIuSEC" %s\n",
565 start - f->start, end - f->start, fn);
566 }
567 if (act == -1) printf(";;\t\t#<no live source>\n");
568 assert(act == least);
569 #endif
570
571 if (least == -1)
572 { file = 0; vob = 0; }
573 else {
574 file = &filetab.v[least];
575 switch (id_kind(file->id)) {
576 case RAW:
577 vob = 0;
578 break;
579 case VOB:
580 if (first_time) { clear_progress(); first_time = 0; }
581 vob = DVDOpenFile(dvd, id_title(file->id),
582 id_part(file->id)
583 ? DVD_READ_TITLE_VOBS
584 : DVD_READ_MENU_VOBS);
585 if (!vob)
586 bail("failed to open %s %u",
587 id_part(file->id) ? "title" : "menu",
588 id_title(file->id));
589 break;
590 default:
591 abort();
592 }
593 }
594
595 pos = start;
596 while (pos < end) {
597 want = end - pos; if (want > BUFSECTORS) want = BUFSECTORS;
598 n = read_sectors(pos, buf, want);
599
600 if (n <= 0) n = find_good_sector(&pos, end, buf, BUFSECTORS);
601 if (n > 0) { carefully_write(outfd, buf, n*SECTORSZ); pos += n; }
602 report_progress(pos); fflush(stdout);
603 }
604
605 if (vob) { DVDCloseFile(vob); vob = 0; }
606
607 #undef BUFSECTORS
608 }
609
610 #ifdef notdef
611 static void logfn(void *p, dvd_logger_level_t lev,
612 const char *fmt, va_list ap)
613 {
614 switch (lev) {
615 case DVD_LOGGER_LEVEL_ERROR:
616 fprintf("%s (libdvdread error): ", prog);
617 break;
618 case DVD_LOGGER_LEVEL_WARN:
619 fprintf("%s (libdvdread warning): ", prog);
620 break;
621 default:
622 return;
623 }
624 vfprintf(stderr, fmt, ap);
625 fputc('\n', stderr);
626 }
627 static const dvd_logger_cb logger = { logfn };
628 #endif
629
630 struct buf {
631 char *p;
632 size_t n, sz;
633 };
634 #define BUF_INIT { 0, 0, 0 }
635 #define BUF_REWIND(b) do { (b)->n = 0; } while (0)
636 #define BUF_FREE(b) do { \
637 buf *_b = (b); \
638 free(_b->p); _b->p = 0; _b->n = _b->sz = 0; \
639 } while (0)
640 #define BUF_PUTC(b, ch) do { \
641 struct buf *_b = (b); \
642 if (_b->n >= _b->sz) { \
643 _b->sz = _b->sz ? 2*_b->sz : 32; \
644 _b->p = realloc(_b->p, _b->sz); \
645 if (!_b->p) bail("out of memory allocating %zu bytes", _b->sz); \
646 } \
647 _b->p[_b->n] = (ch); \
648 } while (0)
649
650 static int read_line(FILE *fp, struct buf *b)
651 {
652 int ch;
653
654 ch = getc(fp);
655 if (ch == EOF)
656 return (-1);
657 else if (ch != '\n') do {
658 BUF_PUTC(b, ch); b->n++;
659 ch = getc(fp);
660 } while (ch != EOF && ch != '\n');
661 BUF_PUTC(b, 0);
662 return (0);
663 }
664
665 #define PRF_HYPHEN 1u
666 static int parse_range(const char *p, unsigned f,
667 secaddr *start_out, secaddr *end_out)
668 {
669 char *q;
670 int err, rc;
671 unsigned long start, end;
672
673 err = errno;
674
675 if (ISDIGIT(*p)) {
676 start = strtoul(p, &q, 0);
677 if (errno || start >= SECLIMIT) { rc = -1; goto end; }
678 *start_out = start; p = q;
679 } else if (!(f&PRF_HYPHEN))
680 { rc = -1; goto end; }
681 else
682 start = 0;
683
684 if (f&PRF_HYPHEN) {
685 if (*p != '-') { rc = -1; goto end; }
686 p++;
687 } else {
688 if (!ISSPACE(*p)) { rc = -1; goto end; }
689 do p++; while (ISSPACE(*p));
690 }
691
692 if (ISDIGIT(*p)) {
693 end = strtoul(p, &q, 0);
694 if (errno || end > SECLIMIT || end < start) { rc = -1; goto end; }
695 *end_out = end; p = q;
696 } else if (!(f&PRF_HYPHEN))
697 { rc = -1; goto end; }
698
699 if (!(f&PRF_HYPHEN)) while (ISSPACE(*p)) p++;
700 if (*p) { rc = -1; goto end; }
701
702 rc = 0;
703 end:
704 errno = err;
705 return (rc);
706 }
707
708 int main(int argc, char *argv[])
709 {
710 unsigned f = 0;
711 char *p;
712 uint64_t volsz;
713 secaddr pos;
714 off_t off;
715 secaddr start, end, last;
716 const struct event *ev;
717 const char *device, *outfile;
718 struct badblock *bad;
719 int opt, blksz;
720 unsigned n;
721 size_t i;
722 FILE *fp;
723 struct buf buf = BUF_INIT;
724 struct stat st;
725 #ifdef DEBUG
726 const struct file *file;
727 char fn[MAXFNSZ];
728 #endif
729
730 #define f_bogus 1u
731 #define f_continue 2u
732 #define f_fixup 4u
733 #define f_write 256u
734
735 p = strrchr(argv[0], '/'); prog = p ? p + 1 : argv[0];
736 for (;;) {
737 opt = getopt(argc, argv, "hFR:X:b:cr:"); if (opt < 0) break;
738 switch (opt) {
739 case 'h': usage(stderr); exit(0);
740 case 'F': f |= f_fixup; break;
741 case 'R':
742 fp = fopen(optarg, "r");
743 if (!fp)
744 bail_syserr(errno, "failed to open ranges file `%s'", optarg);
745 i = 0; last = -1;
746 for (;;) {
747 BUF_REWIND(&buf); if (read_line(fp, &buf)) break;
748 p = buf.p; i++;
749 while (ISSPACE(*p)) p++;
750 if (!*p || *p == '#') continue;
751 if (parse_range(p, 0, &start, &end) ||
752 (last <= SECLIMIT && start < last))
753 bail("bad range `%s' at `%s' line %zu", buf.p, optarg, i);
754 if (start < end) {
755 if (start == last)
756 eventq.v[eventq.n - 1].pos = end;
757 else {
758 put_event(EV_WRITE, 0, start);
759 put_event(EV_STOP, 0, end);
760 }
761 last = end;
762 }
763 }
764 if (ferror(fp))
765 bail_syserr(errno, "failed to read ranges file `%s'", optarg);
766 break;
767 case 'X':
768 fp = fopen(optarg, "r");
769 if (!fp)
770 bail_syserr(errno, "failed to open bad-blocks file `%s'", optarg);
771 i = 0; last = -1;
772 for (;;) {
773 BUF_REWIND(&buf); if (read_line(fp, &buf)) break;
774 p = buf.p; i++;
775 while (ISSPACE(*p)) p++;
776 if (!*p || *p == '#') continue;
777 if (parse_range(p, 0, &start, &end) ||
778 (last <= SECLIMIT && start < last))
779 bail("bad range `%s' at `%s' line %zu", buf.p, optarg, i);
780 if (start < end)
781 { VEC_PUSH(bad, &badblocks); bad->start = start; bad->end = end; }
782 }
783 if (ferror(fp))
784 bail_syserr(errno, "failed to read bad-blocks file `%s'", optarg);
785 break;
786 case 'b':
787 if (mapfile) bail("can't have multiple map files");
788 mapfile = optarg;
789 break;
790 case 'c': f |= f_continue; break;
791 case 'r':
792 start = 0; end = -1;
793 if (parse_range(optarg, PRF_HYPHEN, &start, &end))
794 bail("bad range `%s'", optarg);
795 if (start < end) {
796 put_event(EV_WRITE, 0, start);
797 if (end <= SECLIMIT) put_event(EV_STOP, 0, end);
798 }
799 break;
800 default: f |= f_bogus; break;
801 }
802 }
803 if (argc - optind != 2) f |= f_bogus;
804 if (f&f_bogus) { usage(stderr); exit(2); }
805
806 device = argv[optind]; outfile = argv[optind + 1];
807
808 if (badblocks.n) {
809 qsort(badblocks.v, badblocks.n, sizeof(struct badblock),
810 compare_badblock);
811 #ifdef DEBUG
812 printf(";; fake bad blocks:\n");
813 for (i = 0; i < badblocks.n; i++)
814 printf(";;\t%8"PRIuSEC" .. %"PRIuSEC"\n",
815 badblocks.v[i].start, badblocks.v[i].end);
816 #endif
817 }
818
819 dvdfd = open(device, O_RDONLY);
820 if (dvdfd < 0)
821 bail_syserr(errno, "failed to open device `%s'", device);
822 if (fstat(dvdfd, &st))
823 bail_syserr(errno, "failed to stat device `%s'", device);
824 if (S_ISREG(st.st_mode)) {
825 blksz = SECTORSZ;
826 volsz = st.st_size;
827 } else if (S_ISBLK(st.st_mode)) {
828 if (ioctl(dvdfd, BLKSSZGET, &blksz))
829 bail_syserr(errno, "failed to get block size for `%s'", device);
830 if (ioctl(dvdfd, BLKGETSIZE64, &volsz))
831 bail_syserr(errno, "failed to get volume size for `%s'", device);
832 } else
833 bail("can't use `%s' as source: expected file or block device", device);
834
835 if (blksz != SECTORSZ)
836 bail("device `%s' block size %d /= %d", device, blksz, SECTORSZ);
837 if (volsz%SECTORSZ)
838 bail("device `%s' volume size %"PRIu64" not a multiple of %d",
839 device, volsz, SECTORSZ);
840
841 if (outfile) {
842 outfd = open(outfile, O_WRONLY | O_CREAT, 0666);
843 if (outfd < 0)
844 bail_syserr(errno, "failed to create output file `%s'", outfile);
845 }
846
847 if (f&f_continue) {
848 off = lseek(outfd, 0, SEEK_END);
849 if (off < 0)
850 bail_syserr(errno, "failed to seek to end of output file `%s'",
851 outfile);
852 put_event(EV_WRITE, 0, off/SECTORSZ);
853 } else if (!eventq.n && !(f&f_fixup))
854 put_event(EV_WRITE, 0, 0);
855
856 #ifdef notdef
857 dvd = DVDOpen2(0, &logger, device);
858 #else
859 dvd = DVDOpen(device);
860 #endif
861 if (!dvd) bail("failed to open DVD on `%s'", device);
862
863 /* It's fast enough just to check everything. */
864 put_menu(dvd, 0);
865 for (i = 1; i < 100; i++) {
866 put_menu(dvd, i);
867 put_title(dvd, i);
868 }
869 put_file(mkident(RAW, 0, 0), 0, volsz/SECTORSZ);
870 assert(filetab.n <= MAXFILES);
871
872 for (i = 0, limit = 0; i < filetab.n; i++)
873 if (filetab.v[i].end > limit) limit = filetab.v[i].end;
874
875 if (end > limit) end = limit;
876
877 #ifdef DEBUG
878 printf("\n;; files:\n");
879 for (i = 0; i < filetab.n; i++) {
880 file = &filetab.v[i];
881 store_filename(fn, file->id);
882 printf(";;\t%8"PRIuSEC" %s\n", file->start, fn);
883 }
884 #endif
885
886 qsort(eventq.v, eventq.n, sizeof(struct event), compare_event);
887
888 f &= ~f_write; start = 0; n = 0;
889 for (i = 0; i < eventq.n; i++) {
890 ev = &eventq.v[i];
891 switch (ev->ev) {
892 case EV_WRITE:
893 if (f&f_write)
894 bail("overlapping ranges: range from %"PRIuSEC" still open at %"PRIuSEC"",
895 start, ev->pos);
896 n++; f |= f_write; start = ev->pos;
897 break;
898 case EV_STOP:
899 f &= ~f_write;
900 break;
901 }
902 }
903
904 f &= ~f_write; start = 0;
905 for (i = 0; i < eventq.n; i++) {
906 ev = &eventq.v[i];
907 switch (ev->ev) {
908 case EV_WRITE: start = ev->pos; f |= f_write; break;
909 case EV_STOP: nsectors += ev->pos - start; f &= ~f_write; break;
910 }
911 if (ev->pos >= limit) break;
912 if (f&f_fixup) start = ev->pos;
913 }
914 eventq.n = i;
915 if (f&f_fixup) {
916 put_event(EV_WRITE, 0, start);
917 n++; f |= f_write;
918 }
919 if (f&f_write) {
920 nsectors += limit - start;
921 put_event(EV_STOP, 0, limit);
922 }
923 if (n == 1 && (f&f_write)) flags |= F_ALLPROGRESS;
924 f &= ~f_write;
925
926 #ifdef DEBUG
927 printf("\n;; event sweep:\n");
928 #endif
929 for (pos = 0, i = 0; i < eventq.n; i++) {
930 ev = &eventq.v[i];
931 if (ev->pos > pos) {
932 if (f&f_write) emit(pos, ev->pos);
933 pos = ev->pos;
934 #ifdef DEBUG
935 clear_progress();
936 printf(";;\n");
937 #endif
938 }
939 switch (ev->ev) {
940 case EV_BEGIN:
941 set_live(ev->file);
942 #ifdef DEBUG
943 store_filename(fn, filetab.v[ev->file].id);
944 clear_progress();
945 printf(";; %8"PRIuSEC": begin `%s'\n", pos, fn);
946 #endif
947 break;
948 case EV_WRITE:
949 gettimeofday(&last_time, 0); last_pos = pos;
950 if (lseek(outfd, (off_t)ev->pos*SECTORSZ, SEEK_SET) < 0)
951 bail_syserr(errno,
952 "failed to seek to resume position "
953 "(sector %"PRIuSEC") in output file `%s'",
954 ev->pos, outfile);
955 #ifdef DEBUG
956 clear_progress();
957 printf(";; %8"PRIuSEC": begin write\n", pos);
958 #endif
959 f |= f_write;
960 break;
961 case EV_STOP:
962 f &= ~f_write;
963 #ifdef DEBUG
964 clear_progress();
965 printf(";; %8"PRIuSEC": end write\n", pos);
966 #endif
967 break;
968 case EV_END:
969 clear_live(ev->file);
970 #ifdef DEBUG
971 store_filename(fn, filetab.v[ev->file].id);
972 clear_progress();
973 printf(";; %8"PRIuSEC": end `%s'\n", pos, fn);
974 #endif
975 break;
976 default: abort();
977 }
978 }
979
980 if (progresslen) putchar('\n');
981
982 if (ftruncate(outfd, (off_t)limit*SECTORSZ) < 0)
983 bail_syserr(errno, "failed to set output file `%s' length", outfile);
984
985 if (dvd) DVDClose(dvd);
986 if (dvdfd >= 0) close(dvdfd);
987 if (outfd >= 0) close(outfd);
988 if (mapfp) {
989 if (ferror(mapfp) || fclose(mapfp))
990 bail_syserr(errno, "error writing bad-sector map file");
991 }
992
993 #undef f_bogus
994 #undef f_continue
995 #undef f_fixup
996 #undef f_write
997
998 return (status);
999 }