| 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 | static void open_file_on_demand(const char *file, FILE **fp_inout, |
| 108 | const char *what) |
| 109 | { |
| 110 | FILE *fp; |
| 111 | |
| 112 | if (!*fp_inout) { |
| 113 | fp = fopen(file, "w"); |
| 114 | if (!fp) |
| 115 | bail_syserr(errno, "failed to open %s file `%s'", what, file); |
| 116 | fprintf(fp, "## %s\n\n", what); |
| 117 | *fp_inout = fp; |
| 118 | } |
| 119 | } |
| 120 | |
| 121 | static void check_write(FILE *fp, const char *what) |
| 122 | { |
| 123 | fflush(fp); |
| 124 | if (ferror(fp)) bail_syserr(errno, "error writing %s file", what); |
| 125 | } |
| 126 | |
| 127 | static void carefully_fclose(FILE *fp, const char *what) |
| 128 | { |
| 129 | if (fp && (ferror(fp) || fclose(fp))) |
| 130 | bail_syserr(errno, "error writing %s file", what); |
| 131 | } |
| 132 | |
| 133 | #define DEFVEC(vtype, etype) \ |
| 134 | typedef struct { etype *v; size_t n, sz; } vtype |
| 135 | #define VEC_INIT { 0, 0, 0 } |
| 136 | #define VEC_FREE(vv) do { \ |
| 137 | free((vv)->v); (vv)->v 0; (vv)->n = (vv)->sz = 0; \ |
| 138 | } while (0) |
| 139 | #define VEC_PUSH(p, vv) do { \ |
| 140 | size_t _want; \ |
| 141 | if ((vv)->n >= (vv)->sz) { \ |
| 142 | (vv)->sz = (vv)->sz ? 2*(vv)->sz : 32; \ |
| 143 | _want = (vv)->sz*sizeof(*(vv)->v); \ |
| 144 | (vv)->v = realloc((vv)->v, _want); \ |
| 145 | if (!(vv)->v) bail("out of memory allocating %zu bytes", _want); \ |
| 146 | } \ |
| 147 | (p) = &(vv)->v[(vv)->n++]; \ |
| 148 | } while (0) |
| 149 | |
| 150 | enum { RAW, IFO, VOB, BUP }; |
| 151 | typedef uint_least32_t ident; |
| 152 | |
| 153 | static inline ident mkident(unsigned kind, unsigned title, unsigned part) |
| 154 | { return (((ident)kind << 0) | ((ident)title << 8) | ((ident)part << 16)); } |
| 155 | static inline unsigned id_kind(ident id) { return ((id >> 0)&0x0ff); } |
| 156 | static inline unsigned id_title(ident id) { return ((id >> 8)&0x0ff); } |
| 157 | static inline unsigned id_part(ident id) { return ((id >> 16)&0x0ff); } |
| 158 | |
| 159 | #define MAXFNSZ (1 + 8 + 1 + 12 + 1) |
| 160 | |
| 161 | static void store_filename(char *buf, ident id) |
| 162 | { |
| 163 | switch (id_kind(id)) { |
| 164 | case RAW: |
| 165 | sprintf(buf, "#<raw device>"); |
| 166 | break; |
| 167 | case IFO: |
| 168 | if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.IFO"); |
| 169 | else sprintf(buf, "/VIDEO_TS/VTS_%02u_0.IFO", id_title(id)); |
| 170 | break; |
| 171 | case BUP: |
| 172 | if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.BUP"); |
| 173 | else sprintf(buf, "/VIDEO_TS/VTS_%02u_0.BUP", id_title(id)); |
| 174 | break; |
| 175 | case VOB: |
| 176 | if (!id_title(id)) sprintf(buf, "/VIDEO_TS/VIDEO_TS.VOB"); |
| 177 | else |
| 178 | sprintf(buf, "/VIDEO_TS/VTS_%02u_%u.VOB", id_title(id), id_part(id)); |
| 179 | break; |
| 180 | default: |
| 181 | abort(); |
| 182 | } |
| 183 | } |
| 184 | |
| 185 | typedef uint_least32_t secaddr; |
| 186 | #define PRIuSEC PRIuLEAST32 |
| 187 | #define SECLIMIT 0x00400000 |
| 188 | |
| 189 | #define MAXFILES (1 + 2*99 + 1) |
| 190 | struct file { |
| 191 | ident id; |
| 192 | secaddr start, end; |
| 193 | }; |
| 194 | DEFVEC(file_v, struct file); |
| 195 | static file_v filetab = VEC_INIT; |
| 196 | |
| 197 | enum { EV_STOP, EV_BEGIN, EV_END, EV_WRITE }; |
| 198 | struct event { |
| 199 | unsigned char ev, file; |
| 200 | secaddr pos; |
| 201 | }; |
| 202 | DEFVEC(event_v, struct event); |
| 203 | static event_v eventq = VEC_INIT; |
| 204 | |
| 205 | static int compare_event(const void *a, const void *b) |
| 206 | { |
| 207 | const struct event *eva = a, *evb = b; |
| 208 | |
| 209 | if (eva->pos < evb->pos) return (-1); |
| 210 | else if (eva->pos > evb->pos) return (+1); |
| 211 | |
| 212 | if (eva->ev < evb->ev) return (-1); |
| 213 | else if (eva->ev > evb->ev) return (+1); |
| 214 | |
| 215 | if (eva->file < evb->file) return (-1); |
| 216 | else if (eva->file > evb->file) return (+1); |
| 217 | |
| 218 | return (0); |
| 219 | } |
| 220 | |
| 221 | typedef uint_least32_t bits; |
| 222 | static bits live[(MAXFILES + 31)/32]; |
| 223 | |
| 224 | static inline int livep(unsigned i) |
| 225 | { return (live[i/32]&((bits)1 << (i%32))); } |
| 226 | static inline void set_live(unsigned i) |
| 227 | { live[i/32] |= (bits)1 << (i%32); } |
| 228 | static inline void clear_live(unsigned i) |
| 229 | { live[i/32] &= ~((bits)1 << (i%32)); } |
| 230 | static inline int least_live(void) |
| 231 | { |
| 232 | unsigned i, n = (filetab.n + 32)/32; |
| 233 | bits b; |
| 234 | |
| 235 | for (i = 0; i < n; i++) { b = live[i]; if (b) goto found; } |
| 236 | return (-1); |
| 237 | found: |
| 238 | i *= 32; |
| 239 | if (!(b&0x0000ffff)) { b >>= 16; i += 16; } |
| 240 | if (!(b&0x000000ff)) { b >>= 8; i += 8; } |
| 241 | if (!(b&0x0000000f)) { b >>= 4; i += 4; } |
| 242 | if (!(b&0x00000003)) { b >>= 2; i += 2; } |
| 243 | if (!(b&0x00000001)) { b >>= 1; i += 1; } |
| 244 | assert(b&1); |
| 245 | return (i); |
| 246 | } |
| 247 | |
| 248 | static void put_event(unsigned evtype, unsigned file, secaddr pos) |
| 249 | { |
| 250 | struct event *ev; |
| 251 | |
| 252 | VEC_PUSH(ev, &eventq); |
| 253 | ev->ev = evtype; ev->file = file; ev->pos = pos; |
| 254 | } |
| 255 | |
| 256 | static void put_file(ident id, secaddr start, secaddr end) |
| 257 | { |
| 258 | struct file *f; |
| 259 | size_t i; |
| 260 | |
| 261 | VEC_PUSH(f, &filetab); i = f - filetab.v; |
| 262 | f->id = id; f->start = start; f->end = end; |
| 263 | put_event(EV_BEGIN, i, start); |
| 264 | put_event(EV_END, i, end); |
| 265 | } |
| 266 | |
| 267 | static void put_menu(dvd_reader_t *dvd, unsigned title) |
| 268 | { |
| 269 | ident id = mkident(VOB, title, 0); |
| 270 | char fn[MAXFNSZ]; |
| 271 | secaddr start, len; |
| 272 | |
| 273 | store_filename(fn, id); |
| 274 | start = UDFFindFile(dvd, fn, &len); if (!start) return; |
| 275 | #ifdef DEBUG |
| 276 | printf(";; %8"PRIuSEC" .. %-8"PRIuSEC": %s\n", |
| 277 | start, start + SECTORS(len), fn); |
| 278 | #endif |
| 279 | put_file(id, start, start + SECTORS(len)); |
| 280 | } |
| 281 | |
| 282 | static void put_title(dvd_reader_t *dvd, unsigned title) |
| 283 | { |
| 284 | char fn[MAXFNSZ]; |
| 285 | secaddr start[9], len[9]; |
| 286 | unsigned i, npart; |
| 287 | |
| 288 | for (i = 0; i < 9; i++) { |
| 289 | store_filename(fn, mkident(VOB, title, i + 1)); |
| 290 | start[i] = UDFFindFile(dvd, fn, &len[i]); if (!start[i]) break; |
| 291 | } |
| 292 | npart = i; if (!npart) return; |
| 293 | |
| 294 | #ifdef DEBUG |
| 295 | for (i = 0; i < npart; i++) { |
| 296 | store_filename(fn, mkident(VOB, title, i + 1)); |
| 297 | printf(";; %8"PRIuSEC" .. %-8"PRIuSEC": %s\n", |
| 298 | start[i], start[i] + SECTORS(len[i]), fn); |
| 299 | } |
| 300 | #endif |
| 301 | |
| 302 | if (npart > 1) |
| 303 | for (i = 0; i < npart - 1; i++) { |
| 304 | if (len[i]%SECTORSZ) |
| 305 | bail("title %u part %u length = %"PRIuSEC" not a multiple of %d", |
| 306 | title, i, len[i], SECTORSZ); |
| 307 | if (start[i] + len[i]/SECTORSZ != start[i + 1]) |
| 308 | bail |
| 309 | ("title %u part %u end = %"PRIuSEC" /= part %u start = %"PRIuSEC"", |
| 310 | title, i, start[i] + len[i]/SECTORSZ, i + 1, start[i + 1]); |
| 311 | } |
| 312 | |
| 313 | put_file(mkident(VOB, title, 1), |
| 314 | start[0], start[npart - 1] + SECTORS(len[npart - 1])); |
| 315 | } |
| 316 | |
| 317 | static int progresslen = 0; |
| 318 | |
| 319 | static void clear_progress_internal(void) |
| 320 | { |
| 321 | while (progresslen) { fputs("\b \b", stdout); progresslen--; } |
| 322 | putchar('\r'); |
| 323 | } |
| 324 | static void clear_progress(void) |
| 325 | { clear_progress_internal(); fflush(stdout); } |
| 326 | #ifdef DEBUG |
| 327 | static void debug_clear_progress(void) |
| 328 | { if (progresslen) { putchar('\n'); progresslen = 0; } } |
| 329 | #endif |
| 330 | static void vappend_progress(const char *fmt, va_list ap) |
| 331 | { progresslen += vprintf(fmt, ap); } |
| 332 | __attribute__((format(printf, 1, 2))) |
| 333 | static void append_progress(const char *fmt, ...) |
| 334 | { |
| 335 | va_list ap; |
| 336 | |
| 337 | va_start(ap, fmt); |
| 338 | vappend_progress(fmt, ap); |
| 339 | va_end(ap); |
| 340 | } |
| 341 | __attribute__((format(printf, 1, 2))) |
| 342 | static void print_progress(const char *fmt, ...) |
| 343 | { |
| 344 | va_list ap; |
| 345 | |
| 346 | va_start(ap, fmt); |
| 347 | clear_progress_internal(); |
| 348 | vappend_progress(fmt, ap); |
| 349 | va_end(ap); |
| 350 | } |
| 351 | |
| 352 | unsigned flags; |
| 353 | # define F_ALLPROGRESS 1u |
| 354 | static secaddr last_pos, limit, nsectors, ndone; |
| 355 | static struct timeval last_time; |
| 356 | static double wsum, wcount; |
| 357 | static struct file *file; |
| 358 | |
| 359 | static void report_progress(secaddr pos) |
| 360 | { |
| 361 | char etastr[32]; |
| 362 | struct timeval now; |
| 363 | int eta; |
| 364 | double percent, t, f, g, rate; |
| 365 | char *unit; |
| 366 | |
| 367 | #define ALPHA 0.02 |
| 368 | #define BETA (1 - ALPHA) |
| 369 | |
| 370 | gettimeofday(&now, 0); |
| 371 | t = (now.tv_sec - last_time.tv_sec) + |
| 372 | (now.tv_usec - last_time.tv_usec)/1000000.0; |
| 373 | |
| 374 | if (t) { |
| 375 | g = wcount ? pow(BETA, t) : 0.0; f = (1 - g)/(1 - BETA); |
| 376 | wsum = f*(pos - last_pos)/t + g*wsum; |
| 377 | wcount = f + g*wcount; |
| 378 | ndone += pos - last_pos; |
| 379 | last_time = now; last_pos = pos; |
| 380 | } |
| 381 | |
| 382 | if (!wsum || !wcount) |
| 383 | { rate = 0; strcpy(etastr, "???"); } |
| 384 | else { |
| 385 | rate = wsum/wcount; |
| 386 | eta = (int)((nsectors - ndone)/rate); |
| 387 | sprintf(etastr, "%d:%02d:%02d", eta/3600, (eta/60)%60, eta%60); |
| 388 | } |
| 389 | |
| 390 | rate *= SECTORSZ; unit = ""; |
| 391 | if (rate > 128) { rate /= 1024; unit = "k"; } |
| 392 | if (rate > 128) { rate /= 1024; unit = "M"; } |
| 393 | if (rate > 128) { rate /= 1024; unit = "G"; } |
| 394 | |
| 395 | if (flags&F_ALLPROGRESS) percent = pos*100.0/limit; |
| 396 | else percent = ndone*100.0/nsectors; |
| 397 | print_progress |
| 398 | ("copied %.1f%% (%"PRIuSEC" of %"PRIuSEC"; %.1f %sB/s, ETA %s)", |
| 399 | percent, pos, limit, rate, unit, etastr); |
| 400 | if (file && id_kind(file->id) == VOB) { |
| 401 | append_progress(" -- %s %d %.1f%%", |
| 402 | id_part(file->id) ? "title" : "menu", |
| 403 | id_title(file->id), |
| 404 | (pos - file->start)*100.0/ |
| 405 | (file->end - file->start)); |
| 406 | } |
| 407 | |
| 408 | #undef ALPHA |
| 409 | #undef BETA |
| 410 | } |
| 411 | |
| 412 | static dvd_reader_t *dvd; |
| 413 | static int dvdfd = -1, outfd = -1; |
| 414 | static dvd_file_t *vob; |
| 415 | static const char *mapfile; static FILE *mapfp; |
| 416 | static const char *errfile; static FILE *errfp; |
| 417 | |
| 418 | struct badblock { secaddr start, end; }; |
| 419 | DEFVEC(badblock_v, struct badblock); |
| 420 | static badblock_v badblocks = VEC_INIT; |
| 421 | |
| 422 | static int compare_badblock(const void *a, const void *b) |
| 423 | { |
| 424 | const struct badblock *ba = a, *bb = b; |
| 425 | |
| 426 | if (ba->start < bb->start) return (-1); |
| 427 | else if (ba->start > bb->start) return (+1); |
| 428 | |
| 429 | if (ba->end < bb->end) return (-1); |
| 430 | else if (ba->end > bb->end) return (+1); |
| 431 | |
| 432 | return (0); |
| 433 | } |
| 434 | |
| 435 | static ssize_t read_sectors(secaddr pos, void *buf, secaddr want) |
| 436 | { |
| 437 | ssize_t n, done; |
| 438 | size_t lo, mid, hi; |
| 439 | int fakeerr = 0; |
| 440 | struct badblock *bad, *best; |
| 441 | unsigned char *p = buf; |
| 442 | |
| 443 | if (badblocks.n) { |
| 444 | best = 0; lo = 0; hi = badblocks.n; |
| 445 | #ifdef DEBUG |
| 446 | debug_clear_progress(); |
| 447 | printf(";; searching badblocks for %"PRIuSEC" .. %"PRIuSEC"\n", |
| 448 | pos, pos + want); |
| 449 | #endif |
| 450 | while (lo < hi) { |
| 451 | mid = lo + (hi - lo)/2; bad = &badblocks.v[mid]; |
| 452 | #ifdef DEBUG |
| 453 | printf(";; try %zu (%"PRIuSEC" .. %"PRIuSEC")... ", |
| 454 | mid, bad->start, bad->end); |
| 455 | #endif |
| 456 | if (pos < bad->start) { D( printf("high\n"); ) best = bad; hi = mid; } |
| 457 | else if (pos >= bad->end) { D( printf("low\n"); ) lo = mid + 1; } |
| 458 | else { D( printf("match!\n"); ) errno = EIO; return (-1); } |
| 459 | } |
| 460 | #ifdef DEBUG |
| 461 | if (best) |
| 462 | printf(";; next is %"PRIuSEC" .. %"PRIuSEC"\n", |
| 463 | best->start, best->end); |
| 464 | #endif |
| 465 | if (best && pos + want > best->start) |
| 466 | { want = best->start - pos; fakeerr = EIO; } |
| 467 | } |
| 468 | done = 0; |
| 469 | while (want) { |
| 470 | if (vob) |
| 471 | { errno = 0; n = DVDReadBlocks(vob, pos - file->start, want, p); } |
| 472 | else if (file) { |
| 473 | if (lseek(dvdfd, (off_t)pos*SECTORSZ, SEEK_SET) < 0) |
| 474 | bail_syserr(errno, "failed to seek to sector %"PRIuSEC"", pos); |
| 475 | errno = 0; n = read(dvdfd, p, want*SECTORSZ); |
| 476 | if (n >= 0) n /= SECTORSZ; |
| 477 | } else { |
| 478 | memset(p, 0, want*SECTORSZ); |
| 479 | n = want; |
| 480 | } |
| 481 | |
| 482 | if (n > 0) { done += n; pos += n; p += n*SECTORSZ; want -= n; } |
| 483 | else if (!n) break; |
| 484 | else if (errno == EIO && errfile) { |
| 485 | open_file_on_demand(errfile, &errfp, "bad-sector error log"); |
| 486 | fprintf(errfp, "%"PRIuSEC" %"PRIuSEC"\n", pos, pos + 1); |
| 487 | check_write(errfp, "bad-sector error log"); |
| 488 | break; |
| 489 | } else if (errno != EINTR) break; |
| 490 | } |
| 491 | if (fakeerr && !errno) errno = fakeerr; |
| 492 | return (!done && errno ? -1 : done); |
| 493 | } |
| 494 | |
| 495 | static void report_bad_blocks_progress(secaddr lo, secaddr hi, int err) |
| 496 | { |
| 497 | report_progress(hi); |
| 498 | |
| 499 | if (lo == hi) append_progress(": retrying bad sector"); |
| 500 | else |
| 501 | append_progress(": %"PRIuSEC" bad %s", |
| 502 | hi - lo, hi == lo + 1 ? "sector" : "sectors"); |
| 503 | if (err && err != EIO) append_progress(" (%s)", strerror(err)); |
| 504 | fflush(stdout); |
| 505 | } |
| 506 | |
| 507 | static void recovered(secaddr bad_lo, secaddr bad_hi) |
| 508 | { |
| 509 | clear_progress(); |
| 510 | moan("skipping %"PRIuSEC" bad sectors (%"PRIuSEC" .. %"PRIuSEC")", |
| 511 | bad_hi - bad_lo, bad_lo, bad_hi); |
| 512 | if (mapfile) { |
| 513 | open_file_on_demand(mapfile, &mapfp, "bad-sector region map"); |
| 514 | fprintf(mapfp, "%"PRIuSEC" %"PRIuSEC"", bad_lo, bad_hi); |
| 515 | if (file) |
| 516 | fprintf(mapfp, " # %s #%d %"PRIuSEC"..%"PRIuSEC" of %"PRIuSEC" (%.1f%%)", |
| 517 | id_part(file->id) ? "title" : "menu", |
| 518 | id_title(file->id), |
| 519 | bad_lo - file->start, bad_hi - file->start, |
| 520 | file->end - file->start, |
| 521 | (bad_lo - file->start)*100.0/(file->end - file->start)); |
| 522 | fputc('\n', mapfp); |
| 523 | check_write(mapfp, "bad-sector region map"); |
| 524 | } |
| 525 | if (lseek(outfd, (off_t)(bad_hi - bad_lo)*SECTORSZ, SEEK_CUR) < 0) |
| 526 | bail_syserr(errno, "failed to seek past bad sectors"); |
| 527 | status = 1; |
| 528 | } |
| 529 | |
| 530 | struct recoverybuf { |
| 531 | unsigned char *buf; |
| 532 | secaddr sz, pos, start, end; |
| 533 | }; |
| 534 | |
| 535 | static void rearrange_sectors(struct recoverybuf *r, |
| 536 | secaddr dest, secaddr src, secaddr len) |
| 537 | { |
| 538 | assert(dest + len <= r->sz); |
| 539 | assert(src + len <= r->sz); |
| 540 | memmove(r->buf + dest*SECTORSZ, r->buf + src*SECTORSZ, len*SECTORSZ); |
| 541 | } |
| 542 | |
| 543 | #ifdef DEBUG |
| 544 | __attribute__((format(printf, 2, 3))) |
| 545 | static void show_recovery_buffer_map(const struct recoverybuf *r, |
| 546 | const char *what, ...) |
| 547 | { |
| 548 | va_list ap; |
| 549 | |
| 550 | va_start(ap, what); |
| 551 | debug_clear_progress(); |
| 552 | printf(";; recovery buffer ("); |
| 553 | vprintf(what, ap); |
| 554 | printf("): " |
| 555 | "(%"PRIuSEC") ..%"PRIuSEC".. " |
| 556 | "[%"PRIuSEC" ..%"PRIuSEC".. %"PRIuSEC"] " |
| 557 | "..%"PRIuSEC".. (%"PRIuSEC")\n", |
| 558 | r->pos, r->start, |
| 559 | r->pos + r->start, r->end - r->start, r->pos + r->end, |
| 560 | r->sz - r->end, r->pos + r->sz); |
| 561 | va_end(ap); |
| 562 | assert(r->start <= r->end); |
| 563 | assert(r->end <= r->sz); |
| 564 | } |
| 565 | #endif |
| 566 | |
| 567 | static ssize_t recovery_read_sectors(struct recoverybuf *r, |
| 568 | secaddr pos, secaddr off, secaddr want) |
| 569 | { |
| 570 | ssize_t n; |
| 571 | |
| 572 | assert(off <= r->sz); assert(want <= r->sz - off); |
| 573 | n = read_sectors(pos, r->buf + off*SECTORSZ, want); |
| 574 | return (n); |
| 575 | } |
| 576 | |
| 577 | static ssize_t recovery_read(struct recoverybuf *r, |
| 578 | secaddr pos, secaddr want) |
| 579 | { |
| 580 | secaddr diff, pp, nn; |
| 581 | ssize_t n; |
| 582 | |
| 583 | #ifdef DEBUG |
| 584 | debug_clear_progress(); |
| 585 | show_recovery_buffer_map(r, "begin(%"PRIuSEC", %"PRIuSEC")", pos, want); |
| 586 | #endif |
| 587 | |
| 588 | if (pos < r->pos) { |
| 589 | diff = r->pos - pos; |
| 590 | if (r->start + diff >= r->sz) { |
| 591 | r->pos = pos; r->start = r->end = 0; |
| 592 | #ifdef DEBUG |
| 593 | show_recovery_buffer_map(r, "cleared; shift up by %"PRIuSEC"", diff); |
| 594 | #endif |
| 595 | } else { |
| 596 | if (r->end + diff > r->sz) r->end = r->sz - diff; |
| 597 | rearrange_sectors(r, r->start + diff, r->start, r->end - r->start); |
| 598 | r->pos -= diff; r->start += diff; r->end += diff; |
| 599 | #ifdef DEBUG |
| 600 | show_recovery_buffer_map(r, "shifted up by %"PRIuSEC"", diff); |
| 601 | #endif |
| 602 | } |
| 603 | } else if (pos > r->pos + r->end) { |
| 604 | r->pos = pos; r->start = r->end = 0; |
| 605 | #ifdef DEBUG |
| 606 | show_recovery_buffer_map(r, "cleared; beyond previous region"); |
| 607 | #endif |
| 608 | } else if (pos + want > r->pos + r->sz) { |
| 609 | diff = (pos + want) - (r->pos + r->sz); |
| 610 | if (r->end <= diff) { |
| 611 | r->pos = pos; r->start = r->end = 0; |
| 612 | #ifdef DEBUG |
| 613 | show_recovery_buffer_map(r, "cleared; shift down by %"PRIuSEC"", diff); |
| 614 | #endif |
| 615 | } else { |
| 616 | if (r->start < diff) r->start = diff; |
| 617 | rearrange_sectors(r, r->start - diff, r->start, r->end - r->start); |
| 618 | r->pos += diff; r->start -= diff; r->end -= diff; |
| 619 | #ifdef DEBUG |
| 620 | show_recovery_buffer_map(r, "shifted down by %"PRIuSEC"", diff); |
| 621 | #endif |
| 622 | } |
| 623 | } |
| 624 | |
| 625 | if (pos < r->pos + r->start) { |
| 626 | pp = pos - r->pos; nn = r->start - pp; |
| 627 | #ifdef DEBUG |
| 628 | printf(";; read low (%"PRIuSEC"@%"PRIuSEC", %"PRIuSEC")", pos, pp, nn); |
| 629 | fflush(stdout); |
| 630 | #endif |
| 631 | n = recovery_read_sectors(r, pos, pp, nn); |
| 632 | #ifdef DEBUG |
| 633 | printf(" -> %zd\n", n); |
| 634 | #endif |
| 635 | if (n != nn) { |
| 636 | if (n >= 0 && n > want) n = want; |
| 637 | goto end; |
| 638 | } |
| 639 | r->start = pp; |
| 640 | #ifdef DEBUG |
| 641 | show_recovery_buffer_map(r, "joined new region"); |
| 642 | #endif |
| 643 | } |
| 644 | |
| 645 | if (pos + want > r->pos + r->end) { |
| 646 | pp = r->end; nn = (pos + want) - (r->pos + r->end); |
| 647 | #ifdef DEBUG |
| 648 | printf(";; read high (%"PRIuSEC"@%"PRIuSEC", %"PRIuSEC")", |
| 649 | r->pos + pp, pp, nn); |
| 650 | fflush(stdout); |
| 651 | #endif |
| 652 | n = recovery_read_sectors(r, r->pos + pp, pp, nn); |
| 653 | #ifdef DEBUG |
| 654 | printf(" -> %zd\n", n); |
| 655 | #endif |
| 656 | if (n > 0) { |
| 657 | r->end += n; |
| 658 | #ifdef DEBUG |
| 659 | show_recovery_buffer_map(r, "joined new region"); |
| 660 | #endif |
| 661 | } |
| 662 | } |
| 663 | |
| 664 | n = r->pos + r->end - pos; |
| 665 | if (!n && want) n = -1; |
| 666 | else if (n > want) n = want; |
| 667 | |
| 668 | end: |
| 669 | #ifdef DEBUG |
| 670 | show_recovery_buffer_map(r, "done; return %zd", n); |
| 671 | #endif |
| 672 | return (n); |
| 673 | } |
| 674 | |
| 675 | static secaddr run_length_wanted(secaddr pos, secaddr badlen, |
| 676 | secaddr sz, secaddr end) |
| 677 | { |
| 678 | secaddr want; |
| 679 | |
| 680 | want = 3*badlen/2; |
| 681 | if (!want) want = 1; |
| 682 | if (want > end - pos) want = end - pos; |
| 683 | if (want > sz) want = sz; |
| 684 | return (want); |
| 685 | } |
| 686 | |
| 687 | static ssize_t find_good_sector(secaddr *pos_inout, secaddr end, |
| 688 | unsigned char *buf, secaddr sz) |
| 689 | { |
| 690 | int i; |
| 691 | secaddr pos = *pos_inout, bad_lo, bad_hi, good, step, want; |
| 692 | struct recoverybuf r; |
| 693 | ssize_t n; |
| 694 | |
| 695 | r.buf = buf; r.sz = sz; r.pos = r.start = r.end = 0; |
| 696 | report_bad_blocks_progress(pos, pos, errno); |
| 697 | |
| 698 | want = sz; if (want > end - pos) want = end - pos; |
| 699 | for (i = 0; i < 4; i++) { |
| 700 | n = recovery_read(&r, pos, want); |
| 701 | #ifdef DEBUG |
| 702 | debug_clear_progress(); |
| 703 | printf(";; [retry] try reading %"PRIuSEC" .. %"PRIuSEC" -> %zd\n", |
| 704 | pos, pos + want, n); |
| 705 | #endif |
| 706 | if (n > 0) { |
| 707 | clear_progress(); |
| 708 | moan("sector %"PRIuSEC" read ok after retry", pos); |
| 709 | return (n); |
| 710 | } |
| 711 | } |
| 712 | |
| 713 | bad_lo = pos; bad_hi = pos + 1; |
| 714 | for (;;) { |
| 715 | report_bad_blocks_progress(bad_lo, bad_hi, errno); |
| 716 | #ifdef DEBUG |
| 717 | debug_clear_progress(); |
| 718 | printf(";; bounding bad-block region: " |
| 719 | "%"PRIuSEC" ..%"PRIuSEC".. %"PRIuSEC"\n", |
| 720 | bad_lo, bad_hi - bad_lo, bad_hi); |
| 721 | #endif |
| 722 | if (bad_hi >= end) { |
| 723 | clear_progress(); |
| 724 | moan("giving up on this extent"); |
| 725 | recovered(bad_lo, end); *pos_inout = end; return (0); |
| 726 | } |
| 727 | step = 2*(bad_hi - bad_lo); if (step > end - bad_lo) step = end - bad_lo; |
| 728 | pos = bad_lo + step - 1; |
| 729 | want = run_length_wanted(pos, step, sz, end); |
| 730 | n = recovery_read(&r, pos, want); |
| 731 | #ifdef DEBUG |
| 732 | printf(";; [bound] try reading %"PRIuSEC" .. %"PRIuSEC" -> %zd\n", |
| 733 | pos, pos + want, n); |
| 734 | #endif |
| 735 | if (n == want) break; |
| 736 | if (n < 0) n = 0; |
| 737 | bad_hi = pos + n + 1; |
| 738 | } |
| 739 | |
| 740 | good = pos; |
| 741 | while (good > bad_hi) { |
| 742 | report_bad_blocks_progress(bad_lo, bad_hi, errno); |
| 743 | #ifdef DEBUG |
| 744 | debug_clear_progress(); |
| 745 | printf(";; limiting bad-block region: " |
| 746 | "%"PRIuSEC" ..%"PRIuSEC".. %"PRIuSEC" ..%"PRIuSEC".. %"PRIuSEC"\n", |
| 747 | bad_lo, bad_hi - bad_lo, bad_hi, good - bad_hi, good); |
| 748 | #endif |
| 749 | pos = bad_hi + (good - bad_hi)/2; |
| 750 | step = pos - bad_lo; |
| 751 | want = run_length_wanted(pos, step, sz, end); |
| 752 | n = recovery_read(&r, pos, want); |
| 753 | #ifdef DEBUG |
| 754 | printf(";; [limit] try reading %"PRIuSEC" .. %"PRIuSEC" -> %zd\n", |
| 755 | pos, pos + want, n); |
| 756 | #endif |
| 757 | if (n < 0) n = 0; |
| 758 | if (n == want) good = pos; |
| 759 | else bad_hi = pos + n + 1; |
| 760 | } |
| 761 | recovered(bad_lo, bad_hi); *pos_inout = good; |
| 762 | if (good < r.pos + r.start || r.pos + r.end <= good) |
| 763 | n = 0; |
| 764 | else { |
| 765 | n = r.pos + r.end - good; |
| 766 | rearrange_sectors(&r, 0, good - r.pos, n); |
| 767 | } |
| 768 | #ifdef DEBUG |
| 769 | show_recovery_buffer_map(&r, "returning %zd good sectors at %"PRIuSEC"", |
| 770 | n, good); |
| 771 | #endif |
| 772 | return (n); |
| 773 | } |
| 774 | |
| 775 | static void emit(secaddr start, secaddr end) |
| 776 | { |
| 777 | #define BUFSECTORS 512 |
| 778 | |
| 779 | int least; |
| 780 | unsigned char buf[BUFSECTORS*SECTORSZ]; |
| 781 | secaddr pos; |
| 782 | size_t want; |
| 783 | ssize_t n; |
| 784 | static int first_time = 1; |
| 785 | #ifdef DEBUG |
| 786 | struct file *f; |
| 787 | char fn[MAXFNSZ]; |
| 788 | int act = -1; |
| 789 | int i; |
| 790 | #endif |
| 791 | |
| 792 | least = least_live(); |
| 793 | |
| 794 | #ifdef DEBUG |
| 795 | printf(";; %8"PRIuSEC" .. %"PRIuSEC"\n", start, end); |
| 796 | |
| 797 | for (i = 0; i < filetab.n; i++) { |
| 798 | if (!livep(i)) continue; |
| 799 | if (act == -1) act = i; |
| 800 | f = &filetab.v[i]; store_filename(fn, f->id); |
| 801 | printf(";;\t\t%8"PRIuSEC" .. %-8"PRIuSEC" %s\n", |
| 802 | start - f->start, end - f->start, fn); |
| 803 | } |
| 804 | if (act == -1) printf(";;\t\t#<no live source>\n"); |
| 805 | assert(act == least); |
| 806 | #endif |
| 807 | |
| 808 | if (least == -1) |
| 809 | { file = 0; vob = 0; } |
| 810 | else { |
| 811 | file = &filetab.v[least]; |
| 812 | switch (id_kind(file->id)) { |
| 813 | case RAW: |
| 814 | vob = 0; |
| 815 | break; |
| 816 | case VOB: |
| 817 | if (first_time) { clear_progress(); first_time = 0; } |
| 818 | vob = DVDOpenFile(dvd, id_title(file->id), |
| 819 | id_part(file->id) |
| 820 | ? DVD_READ_TITLE_VOBS |
| 821 | : DVD_READ_MENU_VOBS); |
| 822 | if (!vob) |
| 823 | bail("failed to open %s %u", |
| 824 | id_part(file->id) ? "title" : "menu", |
| 825 | id_title(file->id)); |
| 826 | break; |
| 827 | default: |
| 828 | abort(); |
| 829 | } |
| 830 | } |
| 831 | |
| 832 | pos = start; |
| 833 | while (pos < end) { |
| 834 | want = end - pos; if (want > BUFSECTORS) want = BUFSECTORS; |
| 835 | n = read_sectors(pos, buf, want); |
| 836 | |
| 837 | if (n <= 0) n = find_good_sector(&pos, end, buf, BUFSECTORS); |
| 838 | if (n > 0) { carefully_write(outfd, buf, n*SECTORSZ); pos += n; } |
| 839 | report_progress(pos); fflush(stdout); |
| 840 | } |
| 841 | |
| 842 | if (vob) { DVDCloseFile(vob); vob = 0; } |
| 843 | |
| 844 | #undef BUFSECTORS |
| 845 | } |
| 846 | |
| 847 | #ifdef notdef |
| 848 | static void logfn(void *p, dvd_logger_level_t lev, |
| 849 | const char *fmt, va_list ap) |
| 850 | { |
| 851 | switch (lev) { |
| 852 | case DVD_LOGGER_LEVEL_ERROR: |
| 853 | fprintf("%s (libdvdread error): ", prog); |
| 854 | break; |
| 855 | case DVD_LOGGER_LEVEL_WARN: |
| 856 | fprintf("%s (libdvdread warning): ", prog); |
| 857 | break; |
| 858 | default: |
| 859 | return; |
| 860 | } |
| 861 | vfprintf(stderr, fmt, ap); |
| 862 | fputc('\n', stderr); |
| 863 | } |
| 864 | static const dvd_logger_cb logger = { logfn }; |
| 865 | #endif |
| 866 | |
| 867 | struct buf { |
| 868 | char *p; |
| 869 | size_t n, sz; |
| 870 | }; |
| 871 | #define BUF_INIT { 0, 0, 0 } |
| 872 | #define BUF_REWIND(b) do { (b)->n = 0; } while (0) |
| 873 | #define BUF_FREE(b) do { \ |
| 874 | buf *_b = (b); \ |
| 875 | free(_b->p); _b->p = 0; _b->n = _b->sz = 0; \ |
| 876 | } while (0) |
| 877 | #define BUF_PUTC(b, ch) do { \ |
| 878 | struct buf *_b = (b); \ |
| 879 | if (_b->n >= _b->sz) { \ |
| 880 | _b->sz = _b->sz ? 2*_b->sz : 32; \ |
| 881 | _b->p = realloc(_b->p, _b->sz); \ |
| 882 | if (!_b->p) bail("out of memory allocating %zu bytes", _b->sz); \ |
| 883 | } \ |
| 884 | _b->p[_b->n] = (ch); \ |
| 885 | } while (0) |
| 886 | |
| 887 | static int read_line(FILE *fp, struct buf *b) |
| 888 | { |
| 889 | int ch; |
| 890 | |
| 891 | ch = getc(fp); |
| 892 | if (ch == EOF) |
| 893 | return (-1); |
| 894 | else if (ch != '\n') do { |
| 895 | BUF_PUTC(b, ch); b->n++; |
| 896 | ch = getc(fp); |
| 897 | } while (ch != EOF && ch != '\n'); |
| 898 | BUF_PUTC(b, 0); |
| 899 | return (0); |
| 900 | } |
| 901 | |
| 902 | #define PRF_HYPHEN 1u |
| 903 | static int parse_range(const char *p, unsigned f, |
| 904 | secaddr *start_out, secaddr *end_out) |
| 905 | { |
| 906 | char *q; |
| 907 | int err, rc; |
| 908 | unsigned long start, end; |
| 909 | |
| 910 | err = errno; |
| 911 | |
| 912 | if (ISDIGIT(*p)) { |
| 913 | start = strtoul(p, &q, 0); |
| 914 | if (errno || start >= SECLIMIT) { rc = -1; goto end; } |
| 915 | *start_out = start; p = q; |
| 916 | } else if (!(f&PRF_HYPHEN)) |
| 917 | { rc = -1; goto end; } |
| 918 | else |
| 919 | start = 0; |
| 920 | |
| 921 | if (f&PRF_HYPHEN) { |
| 922 | if (*p != '-') { rc = -1; goto end; } |
| 923 | p++; |
| 924 | } else { |
| 925 | if (!ISSPACE(*p)) { rc = -1; goto end; } |
| 926 | do p++; while (ISSPACE(*p)); |
| 927 | } |
| 928 | |
| 929 | if (ISDIGIT(*p)) { |
| 930 | end = strtoul(p, &q, 0); |
| 931 | if (errno || end > SECLIMIT || end < start) { rc = -1; goto end; } |
| 932 | *end_out = end; p = q; |
| 933 | } else if (!(f&PRF_HYPHEN)) |
| 934 | { rc = -1; goto end; } |
| 935 | |
| 936 | if (!(f&PRF_HYPHEN)) while (ISSPACE(*p)) p++; |
| 937 | if (*p && ((f&PRF_HYPHEN) || *p != '#')) { rc = -1; goto end; } |
| 938 | |
| 939 | rc = 0; |
| 940 | end: |
| 941 | errno = err; |
| 942 | return (rc); |
| 943 | } |
| 944 | |
| 945 | int main(int argc, char *argv[]) |
| 946 | { |
| 947 | unsigned f = 0; |
| 948 | char *p; |
| 949 | uint64_t volsz; |
| 950 | secaddr pos; |
| 951 | off_t off; |
| 952 | secaddr start, end, last; |
| 953 | const struct event *ev; |
| 954 | const char *device, *outfile; |
| 955 | struct badblock *bad; |
| 956 | int opt, blksz; |
| 957 | unsigned n; |
| 958 | size_t i; |
| 959 | FILE *fp; |
| 960 | struct buf buf = BUF_INIT; |
| 961 | struct stat st; |
| 962 | #ifdef DEBUG |
| 963 | const struct file *file; |
| 964 | char fn[MAXFNSZ]; |
| 965 | #endif |
| 966 | |
| 967 | #define f_bogus 1u |
| 968 | #define f_continue 2u |
| 969 | #define f_fixup 4u |
| 970 | #define f_write 256u |
| 971 | |
| 972 | p = strrchr(argv[0], '/'); prog = p ? p + 1 : argv[0]; |
| 973 | for (;;) { |
| 974 | opt = getopt(argc, argv, "hE:FR:X:b:cr:"); if (opt < 0) break; |
| 975 | switch (opt) { |
| 976 | case 'h': usage(stderr); exit(0); |
| 977 | case 'E': errfile = optarg; break; |
| 978 | case 'F': f |= f_fixup; break; |
| 979 | case 'R': |
| 980 | fp = fopen(optarg, "r"); |
| 981 | if (!fp) |
| 982 | bail_syserr(errno, "failed to open ranges file `%s'", optarg); |
| 983 | i = 0; last = -1; |
| 984 | for (;;) { |
| 985 | BUF_REWIND(&buf); if (read_line(fp, &buf)) break; |
| 986 | p = buf.p; i++; |
| 987 | while (ISSPACE(*p)) p++; |
| 988 | if (!*p || *p == '#') continue; |
| 989 | if (parse_range(p, 0, &start, &end) || |
| 990 | (last <= SECLIMIT && start < last)) |
| 991 | bail("bad range `%s' at `%s' line %zu", buf.p, optarg, i); |
| 992 | if (start < end) { |
| 993 | if (start == last) |
| 994 | eventq.v[eventq.n - 1].pos = end; |
| 995 | else { |
| 996 | put_event(EV_WRITE, 0, start); |
| 997 | put_event(EV_STOP, 0, end); |
| 998 | } |
| 999 | last = end; |
| 1000 | } |
| 1001 | } |
| 1002 | if (ferror(fp)) |
| 1003 | bail_syserr(errno, "failed to read ranges file `%s'", optarg); |
| 1004 | break; |
| 1005 | case 'X': |
| 1006 | fp = fopen(optarg, "r"); |
| 1007 | if (!fp) |
| 1008 | bail_syserr(errno, "failed to open bad-blocks file `%s'", optarg); |
| 1009 | i = 0; last = -1; |
| 1010 | for (;;) { |
| 1011 | BUF_REWIND(&buf); if (read_line(fp, &buf)) break; |
| 1012 | p = buf.p; i++; |
| 1013 | while (ISSPACE(*p)) p++; |
| 1014 | if (!*p || *p == '#') continue; |
| 1015 | if (parse_range(p, 0, &start, &end) || |
| 1016 | (last <= SECLIMIT && start < last)) |
| 1017 | bail("bad range `%s' at `%s' line %zu", buf.p, optarg, i); |
| 1018 | if (start < end) |
| 1019 | { VEC_PUSH(bad, &badblocks); bad->start = start; bad->end = end; } |
| 1020 | } |
| 1021 | if (ferror(fp)) |
| 1022 | bail_syserr(errno, "failed to read bad-blocks file `%s'", optarg); |
| 1023 | break; |
| 1024 | case 'b': |
| 1025 | if (mapfile) bail("can't have multiple map files"); |
| 1026 | mapfile = optarg; |
| 1027 | break; |
| 1028 | case 'c': f |= f_continue; break; |
| 1029 | case 'r': |
| 1030 | start = 0; end = -1; |
| 1031 | if (parse_range(optarg, PRF_HYPHEN, &start, &end)) |
| 1032 | bail("bad range `%s'", optarg); |
| 1033 | if (start < end) { |
| 1034 | put_event(EV_WRITE, 0, start); |
| 1035 | if (end <= SECLIMIT) put_event(EV_STOP, 0, end); |
| 1036 | } |
| 1037 | break; |
| 1038 | default: f |= f_bogus; break; |
| 1039 | } |
| 1040 | } |
| 1041 | if (argc - optind != 2) f |= f_bogus; |
| 1042 | if (f&f_bogus) { usage(stderr); exit(2); } |
| 1043 | |
| 1044 | device = argv[optind]; outfile = argv[optind + 1]; |
| 1045 | |
| 1046 | if (badblocks.n) { |
| 1047 | qsort(badblocks.v, badblocks.n, sizeof(struct badblock), |
| 1048 | compare_badblock); |
| 1049 | #ifdef DEBUG |
| 1050 | printf(";; fake bad blocks:\n"); |
| 1051 | for (i = 0; i < badblocks.n; i++) |
| 1052 | printf(";;\t%8"PRIuSEC" .. %"PRIuSEC"\n", |
| 1053 | badblocks.v[i].start, badblocks.v[i].end); |
| 1054 | #endif |
| 1055 | } |
| 1056 | |
| 1057 | dvdfd = open(device, O_RDONLY); |
| 1058 | if (dvdfd < 0) |
| 1059 | bail_syserr(errno, "failed to open device `%s'", device); |
| 1060 | if (fstat(dvdfd, &st)) |
| 1061 | bail_syserr(errno, "failed to stat device `%s'", device); |
| 1062 | if (S_ISREG(st.st_mode)) { |
| 1063 | blksz = SECTORSZ; |
| 1064 | volsz = st.st_size; |
| 1065 | } else if (S_ISBLK(st.st_mode)) { |
| 1066 | if (ioctl(dvdfd, BLKSSZGET, &blksz)) |
| 1067 | bail_syserr(errno, "failed to get block size for `%s'", device); |
| 1068 | if (ioctl(dvdfd, BLKGETSIZE64, &volsz)) |
| 1069 | bail_syserr(errno, "failed to get volume size for `%s'", device); |
| 1070 | } else |
| 1071 | bail("can't use `%s' as source: expected file or block device", device); |
| 1072 | |
| 1073 | if (blksz != SECTORSZ) |
| 1074 | bail("device `%s' block size %d /= %d", device, blksz, SECTORSZ); |
| 1075 | if (volsz%SECTORSZ) |
| 1076 | bail("device `%s' volume size %"PRIu64" not a multiple of %d", |
| 1077 | device, volsz, SECTORSZ); |
| 1078 | |
| 1079 | if (outfile) { |
| 1080 | outfd = open(outfile, O_WRONLY | O_CREAT, 0666); |
| 1081 | if (outfd < 0) |
| 1082 | bail_syserr(errno, "failed to create output file `%s'", outfile); |
| 1083 | } |
| 1084 | |
| 1085 | if (f&f_continue) { |
| 1086 | off = lseek(outfd, 0, SEEK_END); |
| 1087 | if (off < 0) |
| 1088 | bail_syserr(errno, "failed to seek to end of output file `%s'", |
| 1089 | outfile); |
| 1090 | put_event(EV_WRITE, 0, off/SECTORSZ); |
| 1091 | } else if (!eventq.n && !(f&f_fixup)) |
| 1092 | put_event(EV_WRITE, 0, 0); |
| 1093 | |
| 1094 | #ifdef notdef |
| 1095 | dvd = DVDOpen2(0, &logger, device); |
| 1096 | #else |
| 1097 | dvd = DVDOpen(device); |
| 1098 | #endif |
| 1099 | if (!dvd) bail("failed to open DVD on `%s'", device); |
| 1100 | |
| 1101 | /* It's fast enough just to check everything. */ |
| 1102 | put_menu(dvd, 0); |
| 1103 | for (i = 1; i < 100; i++) { |
| 1104 | put_menu(dvd, i); |
| 1105 | put_title(dvd, i); |
| 1106 | } |
| 1107 | put_file(mkident(RAW, 0, 0), 0, volsz/SECTORSZ); |
| 1108 | assert(filetab.n <= MAXFILES); |
| 1109 | |
| 1110 | for (i = 0, limit = 0; i < filetab.n; i++) |
| 1111 | if (filetab.v[i].end > limit) limit = filetab.v[i].end; |
| 1112 | |
| 1113 | if (end > limit) end = limit; |
| 1114 | |
| 1115 | #ifdef DEBUG |
| 1116 | printf("\n;; files:\n"); |
| 1117 | for (i = 0; i < filetab.n; i++) { |
| 1118 | file = &filetab.v[i]; |
| 1119 | store_filename(fn, file->id); |
| 1120 | printf(";;\t%8"PRIuSEC" %s\n", file->start, fn); |
| 1121 | } |
| 1122 | #endif |
| 1123 | |
| 1124 | qsort(eventq.v, eventq.n, sizeof(struct event), compare_event); |
| 1125 | |
| 1126 | f &= ~f_write; start = 0; n = 0; |
| 1127 | for (i = 0; i < eventq.n; i++) { |
| 1128 | ev = &eventq.v[i]; |
| 1129 | switch (ev->ev) { |
| 1130 | case EV_WRITE: |
| 1131 | if (f&f_write) |
| 1132 | bail("overlapping ranges: range from %"PRIuSEC" still open at %"PRIuSEC"", |
| 1133 | start, ev->pos); |
| 1134 | n++; f |= f_write; start = ev->pos; |
| 1135 | break; |
| 1136 | case EV_STOP: |
| 1137 | f &= ~f_write; |
| 1138 | break; |
| 1139 | } |
| 1140 | } |
| 1141 | |
| 1142 | f &= ~f_write; start = 0; |
| 1143 | for (i = 0; i < eventq.n; i++) { |
| 1144 | ev = &eventq.v[i]; |
| 1145 | switch (ev->ev) { |
| 1146 | case EV_WRITE: start = ev->pos; f |= f_write; break; |
| 1147 | case EV_STOP: nsectors += ev->pos - start; f &= ~f_write; break; |
| 1148 | } |
| 1149 | if (ev->pos >= limit) break; |
| 1150 | if (f&f_fixup) start = ev->pos; |
| 1151 | } |
| 1152 | eventq.n = i; |
| 1153 | if (f&f_fixup) { |
| 1154 | put_event(EV_WRITE, 0, start); |
| 1155 | n++; f |= f_write; |
| 1156 | } |
| 1157 | if (f&f_write) { |
| 1158 | nsectors += limit - start; |
| 1159 | put_event(EV_STOP, 0, limit); |
| 1160 | } |
| 1161 | if (n == 1 && (f&f_write)) flags |= F_ALLPROGRESS; |
| 1162 | f &= ~f_write; |
| 1163 | |
| 1164 | #ifdef DEBUG |
| 1165 | printf("\n;; event sweep:\n"); |
| 1166 | #endif |
| 1167 | for (pos = 0, i = 0; i < eventq.n; i++) { |
| 1168 | ev = &eventq.v[i]; |
| 1169 | if (ev->pos > pos) { |
| 1170 | if (f&f_write) emit(pos, ev->pos); |
| 1171 | pos = ev->pos; |
| 1172 | #ifdef DEBUG |
| 1173 | debug_clear_progress(); |
| 1174 | printf(";;\n"); |
| 1175 | #endif |
| 1176 | } |
| 1177 | switch (ev->ev) { |
| 1178 | case EV_BEGIN: |
| 1179 | set_live(ev->file); |
| 1180 | #ifdef DEBUG |
| 1181 | store_filename(fn, filetab.v[ev->file].id); |
| 1182 | debug_clear_progress(); |
| 1183 | printf(";; %8"PRIuSEC": begin `%s'\n", pos, fn); |
| 1184 | #endif |
| 1185 | break; |
| 1186 | case EV_WRITE: |
| 1187 | gettimeofday(&last_time, 0); last_pos = pos; |
| 1188 | if (lseek(outfd, (off_t)ev->pos*SECTORSZ, SEEK_SET) < 0) |
| 1189 | bail_syserr(errno, |
| 1190 | "failed to seek to resume position " |
| 1191 | "(sector %"PRIuSEC") in output file `%s'", |
| 1192 | ev->pos, outfile); |
| 1193 | #ifdef DEBUG |
| 1194 | debug_clear_progress(); |
| 1195 | printf(";; %8"PRIuSEC": begin write\n", pos); |
| 1196 | #endif |
| 1197 | f |= f_write; |
| 1198 | break; |
| 1199 | case EV_STOP: |
| 1200 | f &= ~f_write; |
| 1201 | #ifdef DEBUG |
| 1202 | debug_clear_progress(); |
| 1203 | printf(";; %8"PRIuSEC": end write\n", pos); |
| 1204 | #endif |
| 1205 | break; |
| 1206 | case EV_END: |
| 1207 | clear_live(ev->file); |
| 1208 | #ifdef DEBUG |
| 1209 | store_filename(fn, filetab.v[ev->file].id); |
| 1210 | debug_clear_progress(); |
| 1211 | printf(";; %8"PRIuSEC": end `%s'\n", pos, fn); |
| 1212 | #endif |
| 1213 | break; |
| 1214 | default: abort(); |
| 1215 | } |
| 1216 | } |
| 1217 | |
| 1218 | if (progresslen) putchar('\n'); |
| 1219 | |
| 1220 | if (ftruncate(outfd, (off_t)limit*SECTORSZ) < 0) |
| 1221 | bail_syserr(errno, "failed to set output file `%s' length", outfile); |
| 1222 | |
| 1223 | if (dvd) DVDClose(dvd); |
| 1224 | if (dvdfd >= 0) close(dvdfd); |
| 1225 | if (outfd >= 0) close(outfd); |
| 1226 | carefully_fclose(mapfp, "bad-sector region map"); |
| 1227 | carefully_fclose(errfp, "bad-sector error log"); |
| 1228 | |
| 1229 | #undef f_bogus |
| 1230 | #undef f_continue |
| 1231 | #undef f_fixup |
| 1232 | #undef f_write |
| 1233 | |
| 1234 | return (status); |
| 1235 | } |