1 /*- 2 * ---------------------------------------------------------------------------- 3 * "THE BEER-WARE LICENSE" (Revision 42): 4 * <phk@FreeBSD.ORG> wrote this file. As long as you retain this notice you 5 * can do whatever you want with this stuff. If we meet some day, and you think 6 * this stuff is worth it, you can buy me a beer in return. Poul-Henning Kamp 7 * ---------------------------------------------------------------------------- 8 * 9 * $FreeBSD$ 10 */ 11 #include <sys/param.h> 12 #include <sys/queue.h> 13 #include <sys/disk.h> 14 #include <sys/stat.h> 15 16 #include <err.h> 17 #include <errno.h> 18 #include <fcntl.h> 19 #include <signal.h> 20 #include <stdint.h> 21 #include <stdio.h> 22 #include <stdlib.h> 23 #include <string.h> 24 #include <time.h> 25 #include <unistd.h> 26 27 volatile sig_atomic_t aborting = 0; 28 static size_t bigsize = 1024 * 1024; 29 static size_t medsize; 30 static size_t minsize = 512; 31 32 struct lump { 33 off_t start; 34 off_t len; 35 int state; 36 TAILQ_ENTRY(lump) list; 37 }; 38 39 static TAILQ_HEAD(, lump) lumps = TAILQ_HEAD_INITIALIZER(lumps); 40 41 static void 42 new_lump(off_t start, off_t len, int state) 43 { 44 struct lump *lp; 45 46 lp = malloc(sizeof *lp); 47 if (lp == NULL) 48 err(1, "Malloc failed"); 49 lp->start = start; 50 lp->len = len; 51 lp->state = state; 52 TAILQ_INSERT_TAIL(&lumps, lp, list); 53 } 54 55 static struct lump *lp; 56 static char *wworklist = NULL; 57 static char *rworklist = NULL; 58 59 60 #define PRINT_HEADER \ 61 printf("%13s %7s %13s %5s %13s %13s %9s\n", \ 62 "start", "size", "block-len", "state", "done", "remaining", "% done") 63 64 #define PRINT_STATUS(start, i, len, state, d, t) \ 65 printf("\r%13jd %7zu %13jd %5d %13jd %13jd %9.5f", \ 66 (intmax_t)start, \ 67 i, \ 68 (intmax_t)len, \ 69 state, \ 70 (intmax_t)d, \ 71 (intmax_t)(t - d), \ 72 100*(double)d/(double)t) 73 74 /* Save the worklist if -w was given */ 75 static void 76 save_worklist(void) 77 { 78 FILE *file; 79 struct lump *llp; 80 81 if (wworklist != NULL) { 82 (void)fprintf(stderr, "\nSaving worklist ..."); 83 fflush(stderr); 84 85 file = fopen(wworklist, "w"); 86 if (file == NULL) 87 err(1, "Error opening file %s", wworklist); 88 89 TAILQ_FOREACH(llp, &lumps, list) 90 fprintf(file, "%jd %jd %d\n", 91 (intmax_t)llp->start, (intmax_t)llp->len, 92 llp->state); 93 fclose(file); 94 (void)fprintf(stderr, " done.\n"); 95 } 96 } 97 98 /* Read the worklist if -r was given */ 99 static off_t 100 read_worklist(off_t t) 101 { 102 off_t s, l, d; 103 int state, lines; 104 FILE *file; 105 106 (void)fprintf(stderr, "Reading worklist ..."); 107 fflush(stderr); 108 file = fopen(rworklist, "r"); 109 if (file == NULL) 110 err(1, "Error opening file %s", rworklist); 111 112 lines = 0; 113 d = t; 114 for (;;) { 115 ++lines; 116 if (3 != fscanf(file, "%jd %jd %d\n", &s, &l, &state)) { 117 if (!feof(file)) 118 err(1, "Error parsing file %s at line %d", 119 rworklist, lines); 120 else 121 break; 122 } 123 new_lump(s, l, state); 124 d -= l; 125 } 126 (void)fprintf(stderr, " done.\n"); 127 /* 128 * Return the number of bytes already read 129 * (at least not in worklist). 130 */ 131 return (d); 132 } 133 134 static void 135 usage(void) 136 { 137 (void)fprintf(stderr, 138 "usage: recoverdisk [-r worklist] [-w worklist] source-drive [destination]\n"); 139 exit(1); 140 } 141 142 static void 143 sighandler(__unused int sig) 144 { 145 146 aborting = 1; 147 } 148 149 int 150 main(int argc, char * const argv[]) 151 { 152 int ch; 153 int fdr, fdw; 154 off_t t, d, start, len; 155 size_t i, j; 156 int error, flags, state; 157 u_char *buf; 158 u_int sectorsize; 159 time_t t1, t2; 160 struct stat sb; 161 u_int n, snapshot = 60; 162 163 while ((ch = getopt(argc, argv, "b:r:w:s:")) != -1) { 164 switch (ch) { 165 case 'b': 166 bigsize = strtoul(optarg, NULL, 0); 167 break; 168 case 'r': 169 rworklist = strdup(optarg); 170 if (rworklist == NULL) 171 err(1, "Cannot allocate enough memory"); 172 break; 173 case 's': 174 snapshot = strtoul(optarg, NULL, 0); 175 break; 176 case 'w': 177 wworklist = strdup(optarg); 178 if (wworklist == NULL) 179 err(1, "Cannot allocate enough memory"); 180 break; 181 default: 182 usage(); 183 /* NOTREACHED */ 184 } 185 } 186 argc -= optind; 187 argv += optind; 188 189 if (argc < 1 || argc > 2) 190 usage(); 191 192 fdr = open(argv[0], O_RDONLY); 193 if (fdr < 0) 194 err(1, "Cannot open read descriptor %s", argv[0]); 195 196 error = fstat(fdr, &sb); 197 if (error < 0) 198 err(1, "fstat failed"); 199 flags = O_WRONLY; 200 if (S_ISBLK(sb.st_mode) || S_ISCHR(sb.st_mode)) { 201 error = ioctl(fdr, DIOCGSECTORSIZE, §orsize); 202 if (error < 0) 203 err(1, "DIOCGSECTORSIZE failed"); 204 205 minsize = sectorsize; 206 bigsize = (bigsize / sectorsize) * sectorsize; 207 208 error = ioctl(fdr, DIOCGMEDIASIZE, &t); 209 if (error < 0) 210 err(1, "DIOCGMEDIASIZE failed"); 211 } else { 212 t = sb.st_size; 213 flags |= O_CREAT | O_TRUNC; 214 } 215 216 if (bigsize < minsize) 217 bigsize = minsize; 218 219 for (ch = 0; (bigsize >> ch) > minsize; ch++) 220 continue; 221 medsize = bigsize >> (ch / 2); 222 medsize = (medsize / minsize) * minsize; 223 224 fprintf(stderr, "Bigsize = %zu, medsize = %zu, minsize = %zu\n", 225 bigsize, medsize, minsize); 226 227 buf = malloc(bigsize); 228 if (buf == NULL) 229 err(1, "Cannot allocate %zu bytes buffer", bigsize); 230 231 if (argc > 1) { 232 fdw = open(argv[1], flags, DEFFILEMODE); 233 if (fdw < 0) 234 err(1, "Cannot open write descriptor %s", argv[1]); 235 } else 236 fdw = -1; 237 238 if (rworklist != NULL) { 239 d = read_worklist(t); 240 } else { 241 new_lump(0, t, 0); 242 d = 0; 243 } 244 if (wworklist != NULL) 245 signal(SIGINT, sighandler); 246 247 t1 = 0; 248 start = len = i = state = 0; 249 PRINT_HEADER; 250 n = 0; 251 for (;;) { 252 lp = TAILQ_FIRST(&lumps); 253 if (lp == NULL) 254 break; 255 while (lp->len > 0 && !aborting) { 256 /* These are only copied for printing stats */ 257 start = lp->start; 258 len = lp->len; 259 state = lp->state; 260 261 i = MIN(lp->len, (off_t)bigsize); 262 if (lp->state == 1) 263 i = MIN(lp->len, (off_t)medsize); 264 if (lp->state > 1) 265 i = MIN(lp->len, (off_t)minsize); 266 time(&t2); 267 if (t1 != t2 || lp->len < (off_t)bigsize) { 268 PRINT_STATUS(start, i, len, state, d, t); 269 t1 = t2; 270 if (++n == snapshot) { 271 save_worklist(); 272 n = 0; 273 } 274 } 275 if (i == 0) { 276 errx(1, "BOGUS i %10jd", (intmax_t)i); 277 } 278 fflush(stdout); 279 j = pread(fdr, buf, i, lp->start); 280 if (j == i) { 281 d += i; 282 if (fdw >= 0) 283 j = pwrite(fdw, buf, i, lp->start); 284 else 285 j = i; 286 if (j != i) 287 printf("\nWrite error at %jd/%zu\n", 288 lp->start, i); 289 lp->start += i; 290 lp->len -= i; 291 continue; 292 } 293 printf("\n%jd %zu failed (%s)\n", 294 lp->start, i, strerror(errno)); 295 if (errno == ENXIO) 296 aborting = 1; 297 new_lump(lp->start, i, lp->state + 1); 298 lp->start += i; 299 lp->len -= i; 300 } 301 if (aborting) { 302 save_worklist(); 303 return (0); 304 } 305 TAILQ_REMOVE(&lumps, lp, list); 306 free(lp); 307 } 308 PRINT_STATUS(start, i, len, state, d, t); 309 save_worklist(); 310 printf("\nCompleted\n"); 311 return (0); 312 } 313