?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
HAMMER 63/Many: IO Error handling features
[dragonfly.git] / usr.sbin / fdformat / fdformat.c
blob79c2416575e50cf0740856e3326a04f16c7fa591
1 /*
2 * Copyright (C) 1992-1994,2001 by Joerg Wunsch, Dresden
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR(S) ``AS IS'' AND ANY EXPRESS OR
15 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
16 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
17 * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR(S) BE LIABLE FOR ANY DIRECT,
18 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
19 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
20 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
22 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
23 * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
24 * POSSIBILITY OF SUCH DAMAGE.
25 *
26 * $FreeBSD: src/usr.sbin/fdformat/fdformat.c,v 1.11.2.4 2001/07/19 13:20:42 joerg Exp $
27 * $DragonFly: src/usr.sbin/fdformat/fdformat.c,v 1.5 2007/10/01 08:25:12 swildner Exp $
28 */
29
30 /*
31 * FreeBSD:
32 * format a floppy disk
33 *
34 * Added FD_GTYPE ioctl, verifying, proportional indicators.
35 * Serge Vakulenko, vak@zebub.msk.su
36 * Sat Dec 18 17:45:47 MSK 1993
37 *
38 * Final adaptation, change format/verify logic, add separate
39 * format gap/interleave values
40 * Andrew A. Chernov, ache@astral.msk.su
41 * Thu Jan 27 00:47:24 MSK 1994
42 */
43
44 #include <ctype.h>
45 #include <err.h>
46 #include <errno.h>
47 #include <fcntl.h>
48 #include <paths.h>
49 #include <stdio.h>
50 #include <stdlib.h>
51 #include <strings.h>
52 #include <unistd.h>
53
54 #include <machine/ioctl_fd.h>
55
56 static void
57 format_track(int fd, int cyl, int secs, int head, int rate,
58 int gaplen, int secsize, int fill,int interleave)
59 {
60 struct fd_formb f;
61 int i, j;
62 int il[FD_MAX_NSEC + 1];
63
64 memset(il, 0, sizeof(il));
65 for (j = 0, i = 1; i <= secs; i++) {
66 while (il[(j % secs) + 1])
67 j++;
68 il[(j % secs) + 1] = i;
69 j += interleave;
70 }
71
72 f.format_version = FD_FORMAT_VERSION;
73 f.head = head;
74 f.cyl = cyl;
75 f.transfer_rate = rate;
76
77 f.fd_formb_secshift = secsize;
78 f.fd_formb_nsecs = secs;
79 f.fd_formb_gaplen = gaplen;
80 f.fd_formb_fillbyte = fill;
81 for (i = 0; i < secs; i++) {
82 f.fd_formb_cylno(i) = cyl;
83 f.fd_formb_headno(i) = head;
84 f.fd_formb_secno(i) = il[i+1];
85 f.fd_formb_secsize(i) = secsize;
86 }
87 if (ioctl(fd, FD_FORM, (caddr_t)&f) < 0)
88 err(1, "ioctl(FD_FORM)");
89 }
90
91 static int
92 verify_track(int fd, int track, int tracksize)
93 {
94 static char *buf = NULL;
95 static int bufsz = 0;
96 int fdopts = -1, ofdopts, rv = 0;
97
98 if (ioctl(fd, FD_GOPTS, &fdopts) < 0)
99 warn("warning: ioctl(FD_GOPTS)");
100 else {
101 ofdopts = fdopts;
102 fdopts |= FDOPT_NORETRY;
103 ioctl(fd, FD_SOPTS, &fdopts);
104 }
105
106 if (bufsz < tracksize) {
107 if (buf != NULL) /* XXX why would this ever be? */
108 free(buf);
109 bufsz = tracksize;
110 buf = NULL;
111 }
112 if (buf == NULL)
113 buf = malloc(bufsz);
114 if (buf == NULL)
115 errx(2, "out of memory");
116 if (lseek(fd, (long)track * tracksize, 0) < 0)
117 rv = -1;
118 /* try twice reading it, without using the normal retrier */
119 else if (read(fd, buf, tracksize) != tracksize
120 && read(fd, buf, tracksize) != tracksize)
121 rv = -1;
122 if(fdopts != -1)
123 ioctl(fd, FD_SOPTS, &ofdopts);
124 return(rv);
125 }
126
127 static const char *
128 makename(const char *arg, const char *suffix)
129 {
130 static char namebuff[20]; /* big enough for "/dev/fd0a"... */
131
132 memset(namebuff, 0, 20);
133 if(*arg == '\0') /* ??? */
134 return(arg);
135 if(*arg == '/') /* do not convert absolute pathnames */
136 return(arg);
137 strcpy(namebuff, _PATH_DEV);
138 strncat(namebuff, arg, 3);
139 strcat(namebuff, suffix);
140 return(namebuff);
141 }
142
143 static void
144 usage(void)
145 {
146 fprintf(stderr, "%s\n%s\n",
147 "usage: fdformat [-y] [-q] [-n | -v] [-f #] [-c #] [-s #] [-h #]",
148 " [-r #] [-g #] [-i #] [-S #] [-F #] [-t #] devname");
149 exit(2);
150 }
151
152 static int
153 yes(void)
154 {
155 char reply[256], *p;
156
157 reply[sizeof(reply) - 1] = 0;
158 for (;;) {
159 fflush(stdout);
160 if (fgets(reply, sizeof(reply) - 1, stdin) == NULL)
161 return(0);
162 for (p = reply; *p == ' ' || *p == '\t'; ++p)
163 continue;
164 if (*p == 'y' || *p == 'Y')
165 return(1);
166 if (*p == 'n' || *p == 'N' || *p == '\n' || *p == '\r')
167 return(0);
168 printf("Answer `yes' or `no': ");
169 }
170 }
171
172 /*
173 * Some definitions imported from /sys/isa/ic/nec765.h for convenience.
174 */
175
176 /* Status register ST0 */
177 #define NE7_ST0_IC 0xc0 /* interrupt completion code */
178 #define NE7_ST0_IC_AT 0x40 /* abnormal termination, check error stat */
179 #define NE7_ST0_IC_RC 0xc0 /* terminated due to ready changed, n/a */
180
181 /* Status register ST1 */
182 #define NE7_ST1_EN 0x80 /* end of cylinder, access past last record */
183 #define NE7_ST1_DE 0x20 /* data error, CRC fail in ID or data */
184 #define NE7_ST1_ND 0x04 /* no data, sector not found or CRC in ID f. */
185 #define NE7_ST1_MA 0x01 /* missing address mark (in ID or data field)*/
186
187 /* Status register ST2 */
188 #define NE7_ST2_DD 0x20 /* data error in data field, CRC fail */
189 #define NE7_ST2_WC 0x10 /* wrong cylinder, ID field mismatches cmd */
190 #define NE7_ST2_MD 0x01 /* missing address mark in data field */
191
192 /*
193 * Decode the FDC status pointed to by `fdcsp', and print a textual
194 * translation to stderr.
195 */
196 static void
197 printstatus(struct fdc_status *fdcsp)
198 {
199 char msgbuf[100];
200
201 if ((fdcsp->status[0] & NE7_ST0_IC_RC) != NE7_ST0_IC_AT) {
202 sprintf(msgbuf, "unexcpted interrupt code %#x",
203 fdcsp->status[0] & NE7_ST0_IC_RC);
204 } else {
205 strcpy(msgbuf, "unexpected error code in ST1/ST2");
206
207 if (fdcsp->status[1] & NE7_ST1_EN)
208 strcpy(msgbuf, "end of cylinder (wrong format)");
209 else if (fdcsp->status[1] & NE7_ST1_DE) {
210 if (fdcsp->status[2] & NE7_ST2_DD)
211 strcpy(msgbuf, "CRC error in data field");
212 else
213 strcpy(msgbuf, "CRC error in ID field");
214 } else if (fdcsp->status[1] & NE7_ST1_MA) {
215 if (fdcsp->status[2] & NE7_ST2_MD)
216 strcpy(msgbuf, "no address mark in data field");
217 else
218 strcpy(msgbuf, "no address mark in ID field");
219 } else if (fdcsp->status[2] & NE7_ST2_WC)
220 strcpy(msgbuf, "wrong cylinder (format mismatch)");
221 else if (fdcsp->status[1] & NE7_ST1_ND)
222 strcpy(msgbuf, "no data (sector not found)");
223 }
224 fputs(msgbuf, stderr);
225 }
226
227 int
228 main(int argc, char **argv)
229 {
230 int format = -1, cyls = -1, secs = -1, heads = -1, intleave = -1;
231 int rate = -1, gaplen = -1, secsize = -1, steps = -1;
232 int fill = 0xf6, quiet = 0, verify = 1, verify_only = 0, confirm = 0;
233 int fd, c, i, track, error, tracks_per_dot, bytes_per_track, errs;
234 int fdopts;
235 const char *dev_name, *suffix;
236 struct fd_type fdt;
237 #define MAXPRINTERRS 10
238 struct fdc_status fdcs[MAXPRINTERRS];
239
240 while ((c = getopt(argc, argv, "f:c:s:h:r:g:S:F:t:i:qyvn")) != -1)
241 switch (c) {
242 case 'f': /* format in kilobytes */
243 format = atoi(optarg);
244 break;
245
246 case 'c': /* # of cyls */
247 cyls = atoi(optarg);
248 break;
249
250 case 's': /* # of secs per track */
251 secs = atoi(optarg);
252 break;
253
254 case 'h': /* # of heads */
255 heads = atoi(optarg);
256 break;
257
258 case 'r': /* transfer rate, kilobyte/sec */
259 rate = atoi(optarg);
260 break;
261
262 case 'g': /* length of GAP3 to format with */
263 gaplen = atoi(optarg);
264 break;
265
266 case 'S': /* sector size shift factor (1 << S)*128 */
267 secsize = atoi(optarg);
268 break;
269
270 case 'F': /* fill byte, C-like notation allowed */
271 fill = (int)strtol(optarg, (char **)0, 0);
272 break;
273
274 case 't': /* steps per track */
275 steps = atoi(optarg);
276 break;
277
278 case 'i': /* interleave factor */
279 intleave = atoi(optarg);
280 break;
281
282 case 'q':
283 quiet = 1;
284 break;
285
286 case 'y':
287 confirm = 1;
288 break;
289
290 case 'n':
291 verify = 0;
292 break;
293
294 case 'v':
295 verify = 1;
296 verify_only = 1;
297 break;
298
299 case '?': default:
300 usage();
301 }
302
303 if (optind != argc - 1)
304 usage();
305
306 switch (format) {
307 default:
308 errx(2, "bad floppy size: %dK", format);
309 case -1: suffix = ""; break;
310 case 360: suffix = ".360"; break;
311 case 640: suffix = ".640"; break;
312 case 720: suffix = ".720"; break;
313 case 800: suffix = ".800"; break;
314 case 820: suffix = ".820"; break;
315 case 1200: suffix = ".1200"; break;
316 case 1232: suffix = ".1232"; break;
317 case 1440: suffix = ".1440"; break;
318 case 1480: suffix = ".1480"; break;
319 case 1720: suffix = ".1720"; break;
320 }
321
322 dev_name = makename(argv[optind], suffix);
323
324 if ((fd = open(dev_name, O_RDWR)) < 0)
325 err(1, "%s", dev_name);
326
327 if (ioctl(fd, FD_GTYPE, &fdt) < 0)
328 errx(1, "not a floppy disk: %s", dev_name);
329 fdopts = FDOPT_NOERRLOG;
330 if (ioctl(fd, FD_SOPTS, &fdopts) == -1)
331 err(1, "ioctl(FD_SOPTS, FDOPT_NOERRLOG)");
332
333 switch(rate) {
334 case -1: break;
335 case 250: fdt.trans = FDC_250KBPS; break;
336 case 300: fdt.trans = FDC_300KBPS; break;
337 case 500: fdt.trans = FDC_500KBPS; break;
338 default:
339 errx(2, "invalid transfer rate: %d", rate);
340 }
341
342 if (cyls >= 0) fdt.tracks = cyls;
343 if (secs >= 0) fdt.sectrac = secs;
344 if (fdt.sectrac > FD_MAX_NSEC)
345 errx(2, "too many sectors per track, max value is %d", FD_MAX_NSEC);
346 if (heads >= 0) fdt.heads = heads;
347 if (gaplen >= 0) fdt.f_gap = gaplen;
348 if (secsize >= 0) fdt.secsize = secsize;
349 if (steps >= 0) fdt.steptrac = steps;
350 if (intleave >= 0) fdt.f_inter = intleave;
351
352 bytes_per_track = fdt.sectrac * (1 << fdt.secsize) * 128;
353
354 /* XXX 20/40 = 0.5 */
355 tracks_per_dot = (fdt.tracks * fdt.heads + 20) / 40;
356
357 if (verify_only) {
358 if (!quiet)
359 printf("Verify %dK floppy `%s'.\n",
360 fdt.tracks * fdt.heads * bytes_per_track / 1024,
361 dev_name);
362 }
363 else if (!quiet && !confirm) {
364 printf("Format %dK floppy `%s'? (y/n): ",
365 fdt.tracks * fdt.heads * bytes_per_track / 1024,
366 dev_name);
367 if (!yes()) {
368 printf("Not confirmed.\n");
369 return(3);
370 }
371 }
372
373 /*
374 * Formatting.
375 */
376 if (!quiet) {
377 printf("Processing ");
378 for (i = 0; i < (fdt.tracks * fdt.heads) / tracks_per_dot; i++)
379 putchar('-');
380 printf("\rProcessing ");
381 fflush(stdout);
382 }
383
384 error = errs = 0;
385
386 for (track = 0; track < fdt.tracks * fdt.heads; track++) {
387 if (!verify_only) {
388 format_track(fd, track / fdt.heads, fdt.sectrac,
389 track % fdt.heads, fdt.trans, fdt.f_gap,
390 fdt.secsize, fill, fdt.f_inter);
391 if(!quiet && !((track + 1) % tracks_per_dot)) {
392 putchar('F');
393 fflush(stdout);
394 }
395 }
396 if (verify) {
397 if (verify_track(fd, track, bytes_per_track) < 0) {
398 error = 1;
399 if (errs < MAXPRINTERRS && errno == EIO) {
400 if (ioctl(fd, FD_GSTAT, fdcs + errs) ==
401 -1)
402 errx(1,
403 "floppy IO error, but no FDC status");
404 errs++;
405 }
406 }
407 if(!quiet && !((track + 1) % tracks_per_dot)) {
408 if (!verify_only)
409 putchar('\b');
410 if (error) {
411 putchar('E');
412 error = 0;
413 }
414 else
415 putchar('V');
416 fflush(stdout);
417 }
418 }
419 }
420 if (!quiet)
421 printf(" done.\n");
422
423 if (!quiet && errs) {
424 fflush(stdout);
425 fprintf(stderr, "Errors encountered:\nCyl Head Sect Error\n");
426 for (i = 0; i < errs && i < MAXPRINTERRS; i++) {
427 fprintf(stderr, " %2d %2d %2d ",
428 fdcs[i].status[3], fdcs[i].status[4],
429 fdcs[i].status[5]);
430 printstatus(fdcs + i);
431 putc('\n', stderr);
432 }
433 if (errs >= MAXPRINTERRS)
434 fprintf(stderr, "(Further errors not printed.)\n");
435 }
436
437 return(errs != 0);
438 }
439 /*
440 * Local Variables:
441 * c-indent-level: 8
442 * c-continued-statement-offset: 8
443 * c-continued-brace-offset: 0
444 * c-brace-offset: -8
445 * c-brace-imaginary-offset: 0
446 * c-argdecl-indent: 8
447 * c-label-offset: -8
448 * c++-hanging-braces: 1
449 * c++-access-specifier-offset: -8
450 * c++-empty-arglist-indent: 8
451 * c++-friend-offset: 0
452 * End:
453 */
DragonFly BSD