1 /* 2 * Copyright (C) 1992-1994 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$ 27 */ 28 29 /* 30 * FreeBSD: 31 * format a floppy disk 32 * 33 * Added FD_GTYPE ioctl, verifying, proportional indicators. 34 * Serge Vakulenko, vak@zebub.msk.su 35 * Sat Dec 18 17:45:47 MSK 1993 36 * 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 41 */ 42 43 #include <ctype.h> 44 #include <err.h> 45 #include <fcntl.h> 46 #include <stdio.h> 47 #include <stdlib.h> 48 #include <strings.h> 49 #include <unistd.h> 50 51 #include <machine/ioctl_fd.h> 52 53 static void 54 format_track(int fd, int cyl, int secs, int head, int rate, 55 int gaplen, int secsize, int fill,int interleave) 56 { 57 struct fd_formb f; 58 register int i,j; 59 int il[FD_MAX_NSEC + 1]; 60 61 memset(il,0,sizeof il); 62 for(j = 0, i = 1; i <= secs; i++) { 63 while(il[(j%secs)+1]) j++; 64 il[(j%secs)+1] = i; 65 j += interleave; 66 } 67 68 f.format_version = FD_FORMAT_VERSION; 69 f.head = head; 70 f.cyl = cyl; 71 f.transfer_rate = rate; 72 73 f.fd_formb_secshift = secsize; 74 f.fd_formb_nsecs = secs; 75 f.fd_formb_gaplen = gaplen; 76 f.fd_formb_fillbyte = fill; 77 for(i = 0; i < secs; i++) { 78 f.fd_formb_cylno(i) = cyl; 79 f.fd_formb_headno(i) = head; 80 f.fd_formb_secno(i) = il[i+1]; 81 f.fd_formb_secsize(i) = secsize; 82 } 83 if(ioctl(fd, FD_FORM, (caddr_t)&f) < 0) 84 err(1, "ioctl(FD_FORM)"); 85 } 86 87 static int 88 verify_track(int fd, int track, int tracksize) 89 { 90 static char *buf = 0; 91 static int bufsz = 0; 92 int fdopts = -1, ofdopts, rv = 0; 93 94 if (ioctl(fd, FD_GOPTS, &fdopts) < 0) 95 warn("warning: ioctl(FD_GOPTS)"); 96 else { 97 ofdopts = fdopts; 98 fdopts |= FDOPT_NORETRY; 99 (void)ioctl(fd, FD_SOPTS, &fdopts); 100 } 101 102 if (bufsz < tracksize) { 103 if (buf) 104 free (buf); 105 bufsz = tracksize; 106 buf = 0; 107 } 108 if (! buf) 109 buf = malloc (bufsz); 110 if (! buf) 111 errx(2, "out of memory"); 112 if (lseek (fd, (long) track*tracksize, 0) < 0) 113 rv = -1; 114 /* try twice reading it, without using the normal retrier */ 115 else if (read (fd, buf, tracksize) != tracksize 116 && read (fd, buf, tracksize) != tracksize) 117 rv = -1; 118 if(fdopts != -1) 119 (void)ioctl(fd, FD_SOPTS, &ofdopts); 120 return (rv); 121 } 122 123 static const char * 124 makename(const char *arg, const char *suffix) 125 { 126 static char namebuff[20]; /* big enough for "/dev/fd0a"... */ 127 128 memset(namebuff, 0, 20); 129 if(*arg == '\0') /* ??? */ 130 return arg; 131 if(*arg == '/') /* do not convert absolute pathnames */ 132 return arg; 133 strcpy(namebuff, "/dev/"); 134 strncat(namebuff, arg, 3); 135 strcat(namebuff, suffix); 136 return namebuff; 137 } 138 139 static void 140 usage (void) 141 { 142 fprintf(stderr, "%s\n%s\n", 143 "usage: fdformat [-y] [-q] [-n | -v] [-f #] [-c #] [-s #] [-h #]", 144 " [-r #] [-g #] [-i #] [-S #] [-F #] [-t #] devname"); 145 exit(2); 146 } 147 148 static int 149 yes (void) 150 { 151 char reply [256], *p; 152 153 reply[sizeof(reply)-1] = 0; 154 for (;;) { 155 fflush(stdout); 156 if (! fgets (reply, sizeof(reply)-1, stdin)) 157 return (0); 158 for (p=reply; *p==' ' || *p=='\t'; ++p) 159 continue; 160 if (*p=='y' || *p=='Y') 161 return (1); 162 if (*p=='n' || *p=='N' || *p=='\n' || *p=='\r') 163 return (0); 164 printf("Answer `yes' or `no': "); 165 } 166 } 167 168 int 169 main(int argc, char **argv) 170 { 171 int format = -1, cyls = -1, secs = -1, heads = -1, intleave = -1; 172 int rate = -1, gaplen = -1, secsize = -1, steps = -1; 173 int fill = 0xf6, quiet = 0, verify = 1, verify_only = 0, confirm = 0; 174 int fd, c, track, error, tracks_per_dot, bytes_per_track, errs; 175 const char *devname, *suffix; 176 struct fd_type fdt; 177 178 while((c = getopt(argc, argv, "f:c:s:h:r:g:S:F:t:i:qyvn")) != -1) 179 switch(c) { 180 case 'f': /* format in kilobytes */ 181 format = atoi(optarg); 182 break; 183 184 case 'c': /* # of cyls */ 185 cyls = atoi(optarg); 186 break; 187 188 case 's': /* # of secs per track */ 189 secs = atoi(optarg); 190 break; 191 192 case 'h': /* # of heads */ 193 heads = atoi(optarg); 194 break; 195 196 case 'r': /* transfer rate, kilobyte/sec */ 197 rate = atoi(optarg); 198 break; 199 200 case 'g': /* length of GAP3 to format with */ 201 gaplen = atoi(optarg); 202 break; 203 204 case 'S': /* sector size shift factor (1 << S)*128 */ 205 secsize = atoi(optarg); 206 break; 207 208 case 'F': /* fill byte, C-like notation allowed */ 209 fill = (int)strtol(optarg, (char **)0, 0); 210 break; 211 212 case 't': /* steps per track */ 213 steps = atoi(optarg); 214 break; 215 216 case 'i': /* interleave factor */ 217 intleave = atoi(optarg); 218 break; 219 220 case 'q': 221 quiet = 1; 222 break; 223 224 case 'y': 225 confirm = 1; 226 break; 227 228 case 'n': 229 verify = 0; 230 break; 231 232 case 'v': 233 verify = 1; 234 verify_only = 1; 235 break; 236 237 case '?': default: 238 usage(); 239 } 240 241 if(optind != argc - 1) 242 usage(); 243 244 switch(format) { 245 default: 246 errx(2, "bad floppy size: %dK", format); 247 case -1: suffix = ""; break; 248 case 360: suffix = ".360"; break; 249 case 640: suffix = ".640"; break; 250 case 720: suffix = ".720"; break; 251 case 800: suffix = ".800"; break; 252 case 820: suffix = ".820"; break; 253 case 1200: suffix = ".1200"; break; 254 case 1232: suffix = ".1232"; break; 255 case 1440: suffix = ".1440"; break; 256 case 1480: suffix = ".1480"; break; 257 case 1720: suffix = ".1720"; break; 258 } 259 260 devname = makename(argv[optind], suffix); 261 262 if((fd = open(devname, O_RDWR)) < 0) 263 err(1, "%s", devname); 264 265 if(ioctl(fd, FD_GTYPE, &fdt) < 0) 266 errx(1, "not a floppy disk: %s", devname); 267 268 switch(rate) { 269 case -1: break; 270 case 250: fdt.trans = FDC_250KBPS; break; 271 case 300: fdt.trans = FDC_300KBPS; break; 272 case 500: fdt.trans = FDC_500KBPS; break; 273 default: 274 errx(2, "invalid transfer rate: %d", rate); 275 } 276 277 if (cyls >= 0) fdt.tracks = cyls; 278 if (secs >= 0) fdt.sectrac = secs; 279 if (fdt.sectrac > FD_MAX_NSEC) 280 errx(2, "too many sectors per track, max value is %d", FD_MAX_NSEC); 281 if (heads >= 0) fdt.heads = heads; 282 if (gaplen >= 0) fdt.f_gap = gaplen; 283 if (secsize >= 0) fdt.secsize = secsize; 284 if (steps >= 0) fdt.steptrac = steps; 285 if (intleave >= 0) fdt.f_inter = intleave; 286 287 bytes_per_track = fdt.sectrac * (1<<fdt.secsize) * 128; 288 289 /* XXX 20/40 = 0.5 */ 290 tracks_per_dot = (fdt.tracks * fdt.heads + 20) / 40; 291 292 if (verify_only) { 293 if(!quiet) 294 printf("Verify %dK floppy `%s'.\n", 295 fdt.tracks * fdt.heads * bytes_per_track / 1024, 296 devname); 297 } 298 else if(!quiet && !confirm) { 299 printf("Format %dK floppy `%s'? (y/n): ", 300 fdt.tracks * fdt.heads * bytes_per_track / 1024, 301 devname); 302 if(! yes ()) { 303 printf("Not confirmed.\n"); 304 return 0; 305 } 306 } 307 308 /* 309 * Formatting. 310 */ 311 if(!quiet) { 312 int i; 313 314 printf("Processing "); 315 for (i = 0; i < (fdt.tracks * fdt.heads) / tracks_per_dot; i++) 316 putchar('-'); 317 printf("\rProcessing "); 318 fflush(stdout); 319 } 320 321 error = errs = 0; 322 323 for (track = 0; track < fdt.tracks * fdt.heads; track++) { 324 if (!verify_only) { 325 format_track(fd, track / fdt.heads, fdt.sectrac, 326 track % fdt.heads, fdt.trans, fdt.f_gap, 327 fdt.secsize, fill, fdt.f_inter); 328 if(!quiet && !((track + 1) % tracks_per_dot)) { 329 putchar('F'); 330 fflush(stdout); 331 } 332 } 333 if (verify) { 334 if (verify_track(fd, track, bytes_per_track) < 0) 335 error = errs = 1; 336 if(!quiet && !((track + 1) % tracks_per_dot)) { 337 if (!verify_only) 338 putchar('\b'); 339 if (error) { 340 putchar('E'); 341 error = 0; 342 } 343 else 344 putchar('V'); 345 fflush(stdout); 346 } 347 } 348 } 349 if(!quiet) 350 printf(" done.\n"); 351 352 return errs; 353 } 354 /* 355 * Local Variables: 356 * c-indent-level: 8 357 * c-continued-statement-offset: 8 358 * c-continued-brace-offset: 0 359 * c-brace-offset: -8 360 * c-brace-imaginary-offset: 0 361 * c-argdecl-indent: 8 362 * c-label-offset: -8 363 * c++-hanging-braces: 1 364 * c++-access-specifier-offset: -8 365 * c++-empty-arglist-indent: 8 366 * c++-friend-offset: 0 367 * End: 368 */ 369