2 * Copyright (C) 1992-1994,2001 by Joerg Wunsch, Dresden
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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.
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.
26 * $FreeBSD: src/usr.sbin/fdformat/fdformat.c,v 1.11.2.4 2001/07/19 13:20:42 joerg Exp $
31 * format a floppy disk
33 * Added FD_GTYPE ioctl, verifying, proportional indicators.
34 * Serge Vakulenko, vak@zebub.msk.su
35 * Sat Dec 18 17:45:47 MSK 1993
37 * Final adaptation, change format/verify logic, add separate
38 * format gap/interleave values
39 * Andrew A. Chernov, ache@astral.msk.su
40 * Thu Jan 27 00:47:24 MSK 1994
53 #include <machine/ioctl_fd.h>
56 format_track(int fd
, int cyl
, int secs
, int head
, int rate
,
57 int gaplen
, int secsize
, int fill
,int interleave
)
61 int il
[FD_MAX_NSEC
+ 1];
63 memset(il
, 0, sizeof(il
));
64 for (j
= 0, i
= 1; i
<= secs
; i
++) {
65 while (il
[(j
% secs
) + 1])
67 il
[(j
% secs
) + 1] = i
;
71 f
.format_version
= FD_FORMAT_VERSION
;
74 f
.transfer_rate
= rate
;
76 f
.fd_formb_secshift
= secsize
;
77 f
.fd_formb_nsecs
= secs
;
78 f
.fd_formb_gaplen
= gaplen
;
79 f
.fd_formb_fillbyte
= fill
;
80 for (i
= 0; i
< secs
; i
++) {
81 f
.fd_formb_cylno(i
) = cyl
;
82 f
.fd_formb_headno(i
) = head
;
83 f
.fd_formb_secno(i
) = il
[i
+1];
84 f
.fd_formb_secsize(i
) = secsize
;
86 if (ioctl(fd
, FD_FORM
, (caddr_t
)&f
) < 0)
87 err(1, "ioctl(FD_FORM)");
91 verify_track(int fd
, int track
, int tracksize
)
93 static char *buf
= NULL
;
95 int fdopts
= -1, ofdopts
, rv
= 0;
97 if (ioctl(fd
, FD_GOPTS
, &fdopts
) < 0)
98 warn("warning: ioctl(FD_GOPTS)");
101 fdopts
|= FDOPT_NORETRY
;
102 ioctl(fd
, FD_SOPTS
, &fdopts
);
105 if (bufsz
< tracksize
) {
106 if (buf
!= NULL
) /* XXX why would this ever be? */
114 errx(2, "out of memory");
115 if (lseek(fd
, (long)track
* tracksize
, 0) < 0)
117 /* try twice reading it, without using the normal retrier */
118 else if (read(fd
, buf
, tracksize
) != tracksize
119 && read(fd
, buf
, tracksize
) != tracksize
)
122 ioctl(fd
, FD_SOPTS
, &ofdopts
);
127 makename(const char *arg
, const char *suffix
)
129 static char namebuff
[20]; /* big enough for "/dev/fd0a"... */
131 memset(namebuff
, 0, 20);
132 if(*arg
== '\0') /* ??? */
134 if(*arg
== '/') /* do not convert absolute pathnames */
136 strcpy(namebuff
, _PATH_DEV
);
137 strncat(namebuff
, arg
, 3);
138 strcat(namebuff
, suffix
);
145 fprintf(stderr
, "%s\n%s\n",
146 "usage: fdformat [-y] [-q] [-n | -v] [-f #] [-c #] [-s #] [-h #]",
147 " [-r #] [-g #] [-i #] [-S #] [-F #] [-t #] devname");
156 reply
[sizeof(reply
) - 1] = 0;
159 if (fgets(reply
, sizeof(reply
) - 1, stdin
) == NULL
)
161 for (p
= reply
; *p
== ' ' || *p
== '\t'; ++p
)
163 if (*p
== 'y' || *p
== 'Y')
165 if (*p
== 'n' || *p
== 'N' || *p
== '\n' || *p
== '\r')
167 printf("Answer `yes' or `no': ");
172 * Some definitions imported from /sys/isa/ic/nec765.h for convenience.
175 /* Status register ST0 */
176 #define NE7_ST0_IC 0xc0 /* interrupt completion code */
177 #define NE7_ST0_IC_AT 0x40 /* abnormal termination, check error stat */
178 #define NE7_ST0_IC_RC 0xc0 /* terminated due to ready changed, n/a */
180 /* Status register ST1 */
181 #define NE7_ST1_EN 0x80 /* end of cylinder, access past last record */
182 #define NE7_ST1_DE 0x20 /* data error, CRC fail in ID or data */
183 #define NE7_ST1_ND 0x04 /* no data, sector not found or CRC in ID f. */
184 #define NE7_ST1_MA 0x01 /* missing address mark (in ID or data field)*/
186 /* Status register ST2 */
187 #define NE7_ST2_DD 0x20 /* data error in data field, CRC fail */
188 #define NE7_ST2_WC 0x10 /* wrong cylinder, ID field mismatches cmd */
189 #define NE7_ST2_MD 0x01 /* missing address mark in data field */
192 * Decode the FDC status pointed to by `fdcsp', and print a textual
193 * translation to stderr.
196 printstatus(struct fdc_status
*fdcsp
)
200 if ((fdcsp
->status
[0] & NE7_ST0_IC_RC
) != NE7_ST0_IC_AT
) {
201 sprintf(msgbuf
, "unexcpted interrupt code %#x",
202 fdcsp
->status
[0] & NE7_ST0_IC_RC
);
204 strcpy(msgbuf
, "unexpected error code in ST1/ST2");
206 if (fdcsp
->status
[1] & NE7_ST1_EN
)
207 strcpy(msgbuf
, "end of cylinder (wrong format)");
208 else if (fdcsp
->status
[1] & NE7_ST1_DE
) {
209 if (fdcsp
->status
[2] & NE7_ST2_DD
)
210 strcpy(msgbuf
, "CRC error in data field");
212 strcpy(msgbuf
, "CRC error in ID field");
213 } else if (fdcsp
->status
[1] & NE7_ST1_MA
) {
214 if (fdcsp
->status
[2] & NE7_ST2_MD
)
215 strcpy(msgbuf
, "no address mark in data field");
217 strcpy(msgbuf
, "no address mark in ID field");
218 } else if (fdcsp
->status
[2] & NE7_ST2_WC
)
219 strcpy(msgbuf
, "wrong cylinder (format mismatch)");
220 else if (fdcsp
->status
[1] & NE7_ST1_ND
)
221 strcpy(msgbuf
, "no data (sector not found)");
223 fputs(msgbuf
, stderr
);
227 main(int argc
, char **argv
)
229 int format
= -1, cyls
= -1, secs
= -1, heads
= -1, intleave
= -1;
230 int rate
= -1, gaplen
= -1, secsize
= -1, steps
= -1;
231 int fill
= 0xf6, quiet
= 0, verify
= 1, verify_only
= 0, confirm
= 0;
232 int fd
, c
, i
, track
, error
, tracks_per_dot
, bytes_per_track
, errs
;
234 const char *dev_name
, *suffix
;
236 #define MAXPRINTERRS 10
237 struct fdc_status fdcs
[MAXPRINTERRS
];
239 while ((c
= getopt(argc
, argv
, "f:c:s:h:r:g:S:F:t:i:qyvn")) != -1)
241 case 'f': /* format in kilobytes */
242 format
= atoi(optarg
);
245 case 'c': /* # of cyls */
249 case 's': /* # of secs per track */
253 case 'h': /* # of heads */
254 heads
= atoi(optarg
);
257 case 'r': /* transfer rate, kilobyte/sec */
261 case 'g': /* length of GAP3 to format with */
262 gaplen
= atoi(optarg
);
265 case 'S': /* sector size shift factor (1 << S)*128 */
266 secsize
= atoi(optarg
);
269 case 'F': /* fill byte, C-like notation allowed */
270 fill
= (int)strtol(optarg
, NULL
, 0);
273 case 't': /* steps per track */
274 steps
= atoi(optarg
);
277 case 'i': /* interleave factor */
278 intleave
= atoi(optarg
);
302 if (optind
!= argc
- 1)
307 errx(2, "bad floppy size: %dK", format
);
308 case -1: suffix
= ""; break;
309 case 360: suffix
= ".360"; break;
310 case 640: suffix
= ".640"; break;
311 case 720: suffix
= ".720"; break;
312 case 800: suffix
= ".800"; break;
313 case 820: suffix
= ".820"; break;
314 case 1200: suffix
= ".1200"; break;
315 case 1232: suffix
= ".1232"; break;
316 case 1440: suffix
= ".1440"; break;
317 case 1480: suffix
= ".1480"; break;
318 case 1720: suffix
= ".1720"; break;
321 dev_name
= makename(argv
[optind
], suffix
);
323 if ((fd
= open(dev_name
, O_RDWR
)) < 0)
324 err(1, "%s", dev_name
);
326 if (ioctl(fd
, FD_GTYPE
, &fdt
) < 0)
327 errx(1, "not a floppy disk: %s", dev_name
);
328 fdopts
= FDOPT_NOERRLOG
;
329 if (ioctl(fd
, FD_SOPTS
, &fdopts
) == -1)
330 err(1, "ioctl(FD_SOPTS, FDOPT_NOERRLOG)");
334 case 250: fdt
.trans
= FDC_250KBPS
; break;
335 case 300: fdt
.trans
= FDC_300KBPS
; break;
336 case 500: fdt
.trans
= FDC_500KBPS
; break;
338 errx(2, "invalid transfer rate: %d", rate
);
341 if (cyls
>= 0) fdt
.tracks
= cyls
;
342 if (secs
>= 0) fdt
.sectrac
= secs
;
343 if (fdt
.sectrac
> FD_MAX_NSEC
)
344 errx(2, "too many sectors per track, max value is %d", FD_MAX_NSEC
);
345 if (heads
>= 0) fdt
.heads
= heads
;
346 if (gaplen
>= 0) fdt
.f_gap
= gaplen
;
347 if (secsize
>= 0) fdt
.secsize
= secsize
;
348 if (steps
>= 0) fdt
.steptrac
= steps
;
349 if (intleave
>= 0) fdt
.f_inter
= intleave
;
351 bytes_per_track
= fdt
.sectrac
* (1 << fdt
.secsize
) * 128;
353 /* XXX 20/40 = 0.5 */
354 tracks_per_dot
= (fdt
.tracks
* fdt
.heads
+ 20) / 40;
358 printf("Verify %dK floppy `%s'.\n",
359 fdt
.tracks
* fdt
.heads
* bytes_per_track
/ 1024,
362 else if (!quiet
&& !confirm
) {
363 printf("Format %dK floppy `%s'? (y/n): ",
364 fdt
.tracks
* fdt
.heads
* bytes_per_track
/ 1024,
367 printf("Not confirmed.\n");
376 printf("Processing ");
377 for (i
= 0; i
< (fdt
.tracks
* fdt
.heads
) / tracks_per_dot
; i
++)
379 printf("\rProcessing ");
385 for (track
= 0; track
< fdt
.tracks
* fdt
.heads
; track
++) {
387 format_track(fd
, track
/ fdt
.heads
, fdt
.sectrac
,
388 track
% fdt
.heads
, fdt
.trans
, fdt
.f_gap
,
389 fdt
.secsize
, fill
, fdt
.f_inter
);
390 if(!quiet
&& !((track
+ 1) % tracks_per_dot
)) {
396 if (verify_track(fd
, track
, bytes_per_track
) < 0) {
398 if (errs
< MAXPRINTERRS
&& errno
== EIO
) {
399 if (ioctl(fd
, FD_GSTAT
, fdcs
+ errs
) ==
402 "floppy IO error, but no FDC status");
406 if(!quiet
&& !((track
+ 1) % tracks_per_dot
)) {
422 if (!quiet
&& errs
) {
424 fprintf(stderr
, "Errors encountered:\nCyl Head Sect Error\n");
425 for (i
= 0; i
< errs
&& i
< MAXPRINTERRS
; i
++) {
426 fprintf(stderr
, " %2d %2d %2d ",
427 fdcs
[i
].status
[3], fdcs
[i
].status
[4],
429 printstatus(fdcs
+ i
);
432 if (errs
>= MAXPRINTERRS
)
433 fprintf(stderr
, "(Further errors not printed.)\n");