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