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