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