1 /*
2 * CDDL HEADER START
3 *
4 * The contents of this file are subject to the terms of the
5 * Common Development and Distribution License (the "License").
6 * You may not use this file except in compliance with the License.
7 *
8 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
9 * or http://www.opensolaris.org/os/licensing.
10 * See the License for the specific language governing permissions
11 * and limitations under the License.
12 *
13 * When distributing Covered Code, include this CDDL HEADER in each
14 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
15 * If applicable, add the following below this CDDL HEADER, with the
16 * fields enclosed by brackets "[]" replaced with your own identifying
17 * information: Portions Copyright [yyyy] [name of copyright owner]
18 *
19 * CDDL HEADER END
20 */
21 /*
22 * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
23 * Use is subject to license terms.
24 */
25
26
27 /*
28 * Floppy Disk driver
29 */
30
31 /*
32 * Set CMOS feature:
33 * CMOS_CONF_MEM: CMOS memory contains configuration info
34 */
35 #define CMOS_CONF_MEM
36
37 #include <sys/types.h>
38 #include <sys/param.h>
39 #include <sys/systm.h>
40 #include <sys/buf.h>
41 #include <sys/file.h>
42 #include <sys/open.h>
43 #include <sys/ioctl.h>
44 #include <sys/uio.h>
45 #include <sys/conf.h>
46 #include <sys/stat.h>
47 #include <sys/autoconf.h>
48 #include <sys/vtoc.h>
49 #include <sys/dkio.h>
50 #include <sys/ddi.h>
51 #include <sys/sunddi.h>
52 #include <sys/kstat.h>
53 #include <sys/kmem.h>
54 #include <sys/ddidmareq.h>
55 #include <sys/fdio.h>
56 #include <sys/fdc.h>
57 #include <sys/fd_debug.h>
58 #include <sys/fdmedia.h>
59 #include <sys/debug.h>
60 #include <sys/modctl.h>
61
62 /*
63 * Local Function Prototypes
64 */
65 static int fd_unit_is_open(struct fdisk *);
66 static int fdgetlabel(struct fcu_obj *, int);
67 static void fdstart(struct fcu_obj *);
68 static int fd_build_label_vtoc(struct fcu_obj *, struct fdisk *,
69 struct vtoc *, struct dk_label *);
70 static void fd_build_user_vtoc(struct fcu_obj *, struct fdisk *,
71 struct vtoc *);
72 static int fd_rawioctl(struct fcu_obj *, int, caddr_t, int);
73 static void fd_media_watch(void *);
74
75 static int fd_open(dev_t *, int, int, cred_t *);
76 static int fd_close(dev_t, int, int, cred_t *);
77 static int fd_strategy(struct buf *);
78 static int fd_read(dev_t, struct uio *, cred_t *);
79 static int fd_write(dev_t, struct uio *, cred_t *);
80 static int fd_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
81 static int fd_prop_op(dev_t, dev_info_t *, ddi_prop_op_t, int, char *,
82 caddr_t, int *);
83 static int fd_check_media(dev_t dev, enum dkio_state state);
84 static int fd_get_media_info(struct fcu_obj *fjp, caddr_t buf, int flag);
85
86 static struct cb_ops fd_cb_ops = {
87 fd_open, /* open */
88 fd_close, /* close */
89 fd_strategy, /* strategy */
90 nodev, /* print */
91 nodev, /* dump */
92 fd_read, /* read */
93 fd_write, /* write */
94 fd_ioctl, /* ioctl */
95 nodev, /* devmap */
96 nodev, /* mmap */
97 nodev, /* segmap */
98 nochpoll, /* poll */
99 fd_prop_op, /* cb_prop_op */
100 0, /* streamtab */
101 D_NEW | D_MP /* Driver compatibility flag */
102 };
103
104 static int fd_getinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
105 static int fd_probe(dev_info_t *);
106 static int fd_attach(dev_info_t *, ddi_attach_cmd_t);
107 static int fd_detach(dev_info_t *, ddi_detach_cmd_t);
108
109 static struct dev_ops fd_ops = {
110 DEVO_REV, /* devo_rev, */
111 0, /* refcnt */
112 fd_getinfo, /* getinfo */
113 nulldev, /* identify */
114 fd_probe, /* probe */
115 fd_attach, /* attach */
116 fd_detach, /* detach */
117 nodev, /* reset */
118 &fd_cb_ops, /* driver operations */
119 (struct bus_ops *)0, /* bus operations */
120 NULL, /* power */
121 ddi_quiesce_not_supported, /* devo_quiesce */
122 };
123
124
125 /*
126 * static data
127 */
128 static void *fd_state_head; /* opaque handle top of state structs */
129 static int fd_check_media_time = 5000000; /* 5 second state check */
130
131 /*
132 * error handling
133 *
134 * for debugging,
135 * set fderrlevel to 1
136 * set fderrmask to 224 or 644
137 */
138 #ifdef DEBUG
139 static uint_t fderrmask = FDEM_ALL;
140 #endif
141 static int fderrlevel = 5;
142
143 #define KIOSP KSTAT_IO_PTR(fdp->d_iostat)
144
145 static struct driver_minor_data {
146 char *name;
147 int minor;
148 int type;
149 } fd_minor [] = {
150 { "a", 0, S_IFBLK},
151 { "b", 1, S_IFBLK},
152 { "c", 2, S_IFBLK},
153 { "a,raw", 0, S_IFCHR},
154 { "b,raw", 1, S_IFCHR},
155 { "c,raw", 2, S_IFCHR},
156 {0}
157 };
158
159 static struct modldrv modldrv = {
160 &mod_driverops, /* Type of module. This one is a driver */
161 "Floppy Disk driver", /* Name of the module. */
162 &fd_ops, /* driver ops */
163 };
164
165 static struct modlinkage modlinkage = {
166 MODREV_1, (void *)&modldrv, NULL
167 };
168
169
170 int
_init(void)171 _init(void)
172 {
173 int retval;
174
175 if ((retval = ddi_soft_state_init(&fd_state_head,
176 sizeof (struct fdisk) + sizeof (struct fd_drive) +
177 sizeof (struct fd_char) + sizeof (struct fdattr), 0)) != 0)
178 return (retval);
179
180 if ((retval = mod_install(&modlinkage)) != 0)
181 ddi_soft_state_fini(&fd_state_head);
182 return (retval);
183 }
184
185 int
_fini(void)186 _fini(void)
187 {
188 int retval;
189
190 if ((retval = mod_remove(&modlinkage)) != 0)
191 return (retval);
192 ddi_soft_state_fini(&fd_state_head);
193 return (retval);
194 }
195
196 int
_info(struct modinfo * modinfop)197 _info(struct modinfo *modinfop)
198 {
199 return (mod_info(&modlinkage, modinfop));
200 }
201
202
203 static int
fd_getdrive(dev_t dev,struct fcu_obj ** fjpp,struct fdisk ** fdpp)204 fd_getdrive(dev_t dev, struct fcu_obj **fjpp, struct fdisk **fdpp)
205 {
206 if (fdpp) {
207 *fdpp = ddi_get_soft_state(fd_state_head, DRIVE(dev));
208 if (*fdpp && fjpp) {
209 *fjpp = (*fdpp)->d_obj;
210 if (*fjpp)
211 return ((*fjpp)->fj_unit);
212 }
213 }
214 return (-1);
215 }
216
217 /*ARGSUSED*/
218 static int
fd_getinfo(dev_info_t * dip,ddi_info_cmd_t cmd,void * arg,void ** result)219 fd_getinfo(dev_info_t *dip, ddi_info_cmd_t cmd, void *arg, void **result)
220 {
221 dev_t dev = (dev_t)arg;
222 struct fcu_obj *fjp = NULL;
223 struct fdisk *fdp = NULL;
224 int rval;
225
226 switch (cmd) {
227 case DDI_INFO_DEVT2DEVINFO:
228 (void) fd_getdrive(dev, &fjp, &fdp);
229 /*
230 * Ignoring return value because success is checked by
231 * verifying fjp and fdp and returned unit value is not used.
232 */
233 if (fjp && fdp) {
234 *result = fjp->fj_dip;
235 rval = DDI_SUCCESS;
236 } else
237 rval = DDI_FAILURE;
238 break;
239 case DDI_INFO_DEVT2INSTANCE:
240 *result = (void *)(uintptr_t)DRIVE(dev);
241 rval = DDI_SUCCESS;
242 break;
243 default:
244 rval = DDI_FAILURE;
245 }
246 return (rval);
247 }
248
249 #ifdef CMOS_CONF_MEM
250 #define CMOS_ADDR 0x70
251 #define CMOS_DATA 0x71
252 #define CMOS_FDRV 0x10
253 #endif /* CMOS_CONF_MEM */
254
255 static int
fd_probe(dev_info_t * dip)256 fd_probe(dev_info_t *dip)
257 {
258 #ifdef CMOS_CONF_MEM
259 int cmos;
260 int drive_type;
261 #endif /* CMOS_CONF_MEM */
262 int debug[2];
263 int drive_size;
264 int len;
265 int unit_num;
266 char density[8];
267
268 len = sizeof (debug);
269 if (ddi_prop_op(DDI_DEV_T_ANY, dip, PROP_LEN_AND_VAL_BUF,
270 DDI_PROP_DONTPASS, "debug", (caddr_t)debug, &len) ==
271 DDI_PROP_SUCCESS) {
272 fderrlevel = debug[0];
273 #ifdef DEBUG
274 fderrmask = (uint_t)debug[1];
275 #endif
276 }
277 len = sizeof (unit_num);
278 if (ddi_prop_op(DDI_DEV_T_ANY, dip, PROP_LEN_AND_VAL_BUF,
279 DDI_PROP_DONTPASS, "unit", (caddr_t)&unit_num, &len) !=
280 DDI_PROP_SUCCESS) {
281 FDERRPRINT(FDEP_L3, FDEM_ATTA,
282 (CE_WARN, "fd_probe failed: dip %p", (void *)dip));
283 return (DDI_PROBE_FAILURE);
284 }
285
286 #ifdef CMOS_CONF_MEM
287 /* get the cmos memory values quick and dirty */
288 outb(CMOS_ADDR, CMOS_FDRV);
289 cmos = drive_type = (int)inb(CMOS_DATA);
290 #endif /* CMOS_CONF_MEM */
291
292 switch (unit_num) {
293 #ifdef CMOS_CONF_MEM
294 case 0:
295 drive_type = drive_type >> 4;
296 /* FALLTHROUGH */
297 case 1:
298 if (cmos && (drive_type & 0x0F)) {
299 break;
300 }
301 /*
302 * Some enhanced floppy-disk controller adaptor cards
303 * require NO drives defined in the CMOS configuration
304 * memory.
305 * So fall through
306 */
307 #endif /* CMOS_CONF_MEM */
308 default: /* need to check conf file */
309 len = sizeof (density);
310 if (ddi_prop_op(DDI_DEV_T_ANY, dip, PROP_LEN_AND_VAL_BUF,
311 DDI_PROP_DONTPASS, "density", (caddr_t)&density, &len) !=
312 DDI_PROP_SUCCESS) {
313 FDERRPRINT(FDEP_L3, FDEM_ATTA,
314 (CE_WARN,
315 "fd_probe failed density: dip %p unit %d",
316 (void *)dip, unit_num));
317 return (DDI_PROBE_FAILURE);
318 }
319 len = sizeof (drive_size);
320 if (ddi_prop_op(DDI_DEV_T_ANY, dip, PROP_LEN_AND_VAL_BUF,
321 DDI_PROP_DONTPASS, "size", (caddr_t)&drive_size, &len) !=
322 DDI_PROP_SUCCESS) {
323 FDERRPRINT(FDEP_L3, FDEM_ATTA,
324 (CE_WARN, "fd_probe failed size: dip %p unit %d",
325 (void *)dip, unit_num));
326 return (DDI_PROBE_FAILURE);
327 }
328 }
329 FDERRPRINT(FDEP_L3, FDEM_ATTA,
330 (CE_WARN, "fd_probe dip %p unit %d", (void *)dip, unit_num));
331 return (DDI_PROBE_SUCCESS);
332 }
333
334
335 /* ARGSUSED */
336 static int
fd_attach(dev_info_t * dip,ddi_attach_cmd_t cmd)337 fd_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
338 {
339 struct fcu_obj *fjp;
340 struct fdisk *fdp;
341 struct driver_minor_data *dmdp;
342 int mode_3D;
343 int drive_num, drive_size, drive_type;
344 #ifdef CMOS_CONF_MEM
345 int cmos;
346 #endif /* CMOS_CONF_MEM */
347 int len, sig_minor;
348 int unit_num;
349 char density[8];
350 char name[MAXNAMELEN];
351
352 switch (cmd) {
353 case DDI_ATTACH:
354 len = sizeof (unit_num);
355 if (ddi_prop_op(DDI_DEV_T_ANY, dip, PROP_LEN_AND_VAL_BUF,
356 DDI_PROP_DONTPASS, "unit", (caddr_t)&unit_num, &len) !=
357 DDI_PROP_SUCCESS) {
358 FDERRPRINT(FDEP_L3, FDEM_ATTA,
359 (CE_WARN, "fd_attach failed: dip %p", (void *)dip));
360 return (DDI_FAILURE);
361 }
362
363 #ifdef CMOS_CONF_MEM
364 outb(CMOS_ADDR, CMOS_FDRV);
365 cmos = drive_type = (int)inb(CMOS_DATA);
366 #endif /* CMOS_CONF_MEM */
367
368 switch (unit_num) {
369 #ifdef CMOS_CONF_MEM
370 case 0:
371 drive_type = drive_type >> 4;
372 /* FALLTHROUGH */
373 case 1:
374 drive_type = drive_type & 0x0F;
375 if (cmos)
376 break;
377 /*
378 * Some enhanced floppy-disk controller adaptor cards
379 * require NO drives defined in the CMOS configuration
380 * memory.
381 * So fall through
382 */
383 #endif /* CMOS_CONF_MEM */
384 default: /* need to check .conf file */
385 drive_type = 0;
386 len = sizeof (density);
387 if (ddi_prop_op(DDI_DEV_T_ANY, dip,
388 PROP_LEN_AND_VAL_BUF, DDI_PROP_DONTPASS, "density",
389 (caddr_t)&density, &len) != DDI_PROP_SUCCESS)
390 density[0] = '\0';
391 len = sizeof (drive_size);
392 if (ddi_prop_op(DDI_DEV_T_ANY, dip,
393 PROP_LEN_AND_VAL_BUF, DDI_PROP_DONTPASS, "size",
394 (caddr_t)&drive_size, &len) != DDI_PROP_SUCCESS)
395 drive_size = 0;
396 if (strcmp(density, "DSDD") == 0) {
397 if (drive_size == 5)
398 drive_type = 1;
399 else if (drive_size == 3)
400 drive_type = 3;
401 } else if (strcmp(density, "DSHD") == 0) {
402 if (drive_size == 5)
403 drive_type = 2;
404 else if (drive_size == 3)
405 drive_type = 4;
406 } else if (strcmp(density, "DSED") == 0 &&
407 drive_size == 3) {
408 drive_type = 6;
409 }
410 break;
411 }
412 if (drive_type == 0) {
413 FDERRPRINT(FDEP_L3, FDEM_ATTA,
414 (CE_WARN, "fd_attach failed type: dip %p unit %d",
415 (void *)dip, unit_num));
416 return (DDI_FAILURE);
417 }
418
419 drive_num = ddi_get_instance(dip);
420 if (ddi_soft_state_zalloc(fd_state_head, drive_num) != 0)
421 return (DDI_FAILURE);
422 fdp = ddi_get_soft_state(fd_state_head, drive_num);
423 fjp = fdp->d_obj = ddi_get_driver_private(dip);
424
425 mutex_init(&fjp->fj_lock, NULL, MUTEX_DRIVER, *fjp->fj_iblock);
426 sema_init(&fdp->d_ocsem, 1, NULL, SEMA_DRIVER, NULL);
427
428 fjp->fj_drive = (struct fd_drive *)(fdp + 1);
429 fjp->fj_chars = (struct fd_char *)(fjp->fj_drive + 1);
430 fjp->fj_attr = (struct fdattr *)(fjp->fj_chars + 1);
431
432 /*
433 * set default floppy drive characteristics & geometry
434 */
435 switch (drive_type) { /* assume doubled sided */
436 case 2: /* 5.25 high density */
437 *fjp->fj_drive = dfd_525HD;
438 fdp->d_media = 1<<FMT_5H | 1<<FMT_5D9 | 1<<FMT_5D8 |
439 1<<FMT_5D4 | 1<<FMT_5D16;
440 fdp->d_deffdtype = fdp->d_curfdtype = FMT_5H;
441 break;
442 case 4: /* 3.5 high density */
443 *fjp->fj_drive = dfd_350HD;
444 fdp->d_media = 1<<FMT_3H | 1<<FMT_3I | 1<<FMT_3D;
445 len = sizeof (mode_3D);
446 if (ddi_prop_op(DDI_DEV_T_ANY, dip,
447 PROP_LEN_AND_VAL_BUF, DDI_PROP_DONTPASS, "mode_3D",
448 (caddr_t)&mode_3D, &len) != DDI_PROP_SUCCESS)
449 mode_3D = 0;
450 if (mode_3D && (fjp->fj_fdc->c_flags & FCFLG_3DMODE))
451 /*
452 * 3D mode should be enabled only if a dual-
453 * speed 3.5" high-density drive and a
454 * supported floppy controller are installed.
455 */
456 fdp->d_media |= 1 << FMT_3M;
457 fdp->d_deffdtype = fdp->d_curfdtype = FMT_3H;
458 break;
459 case 1: /* 5.25 double density */
460 *fjp->fj_drive = dfd_525DD;
461 fdp->d_media = 1<<FMT_5D9 | 1<<FMT_5D8 | 1<<FMT_5D4 |
462 1<<FMT_5D16;
463 fdp->d_deffdtype = fdp->d_curfdtype = FMT_5D9;
464 break;
465 case 3: /* 3.5 double density */
466 *fjp->fj_drive = dfd_350HD;
467 fdp->d_media = 1<<FMT_3D;
468 fdp->d_deffdtype = fdp->d_curfdtype = FMT_3D;
469 break;
470 case 5: /* 3.5 extended density */
471 case 6:
472 case 7:
473 *fjp->fj_drive = dfd_350ED;
474 fdp->d_media = 1<<FMT_3E | 1<<FMT_3H | 1<<FMT_3I |
475 1<<FMT_3D;
476 fdp->d_deffdtype = fdp->d_curfdtype = FMT_3E;
477 break;
478 case 0: /* no drive defined */
479 default:
480 goto no_attach;
481 }
482 *fjp->fj_chars = *defchar[fdp->d_deffdtype];
483 *fjp->fj_attr = fdtypes[fdp->d_deffdtype];
484 bcopy(fdparts[fdp->d_deffdtype], fdp->d_part,
485 sizeof (struct partition) * NDKMAP);
486 fjp->fj_rotspd = fdtypes[fdp->d_deffdtype].fda_rotatespd;
487
488 sig_minor = drive_num << 3;
489 for (dmdp = fd_minor; dmdp->name != NULL; dmdp++) {
490 if (ddi_create_minor_node(dip, dmdp->name, dmdp->type,
491 sig_minor | dmdp->minor, DDI_NT_FD, NULL)
492 == DDI_FAILURE) {
493 ddi_remove_minor_node(dip, NULL);
494 goto no_attach;
495 }
496 }
497
498 FDERRPRINT(FDEP_L3, FDEM_ATTA,
499 (CE_WARN, "fd_attach: dip %p unit %d",
500 (void *)dip, unit_num));
501 (void) sprintf(name, "fd%d", drive_num);
502 fdp->d_iostat = kstat_create("fd", drive_num, name, "disk",
503 KSTAT_TYPE_IO, 1, KSTAT_FLAG_PERSISTENT);
504 if (fdp->d_iostat) {
505 fdp->d_iostat->ks_lock = &fjp->fj_lock;
506 kstat_install(fdp->d_iostat);
507 }
508
509 fjp->fj_data = (caddr_t)fdp;
510 fjp->fj_flags |= FUNIT_DRVATCH;
511
512 /*
513 * Add a zero-length attribute to tell the world we support
514 * kernel ioctls (for layered drivers)
515 */
516 (void) ddi_prop_create(DDI_DEV_T_NONE, dip, DDI_PROP_CANSLEEP,
517 DDI_KERNEL_IOCTL, NULL, 0);
518
519 /*
520 * We want to get suspend/resume events, so that we can
521 * refuse to suspend when pcfs is mounted.
522 */
523 (void) ddi_prop_update_string(DDI_DEV_T_NONE, dip,
524 "pm-hardware-state", "needs-suspend-resume");
525
526 /*
527 * Ignoring return value because, for passed arguments, only
528 * DDI_SUCCESS is returned.
529 */
530 ddi_report_dev(dip);
531 return (DDI_SUCCESS);
532
533 case DDI_RESUME:
534 /* nothing for us to do */
535 return (DDI_SUCCESS);
536
537 default:
538 return (DDI_FAILURE);
539 }
540 no_attach:
541 fjp->fj_drive = NULL;
542 fjp->fj_chars = NULL;
543 fjp->fj_attr = NULL;
544 mutex_destroy(&fjp->fj_lock);
545 sema_destroy(&fdp->d_ocsem);
546 ddi_soft_state_free(fd_state_head, drive_num);
547 FDERRPRINT(FDEP_L3, FDEM_ATTA,
548 (CE_WARN, "fd_attach failed: dip %p unit %d",
549 (void *)dip, unit_num));
550 return (DDI_FAILURE);
551 }
552
553
554 /* ARGSUSED */
555 static int
fd_detach(dev_info_t * dip,ddi_detach_cmd_t cmd)556 fd_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
557 {
558 struct fcu_obj *fjp;
559 struct fdisk *fdp;
560 int drive_num;
561 int rval = DDI_SUCCESS;
562
563 FDERRPRINT(FDEP_L3, FDEM_ATTA, (CE_WARN, "fd_detach dip %p",
564 (void *)dip));
565
566 drive_num = ddi_get_instance(dip);
567 if (!(fdp = ddi_get_soft_state(fd_state_head, drive_num)))
568 return (rval);
569
570 switch (cmd) {
571 case DDI_DETACH:
572 if (fd_unit_is_open(fdp)) {
573 rval = DDI_FAILURE;
574 break;
575 }
576 kstat_delete(fdp->d_iostat);
577 fdp->d_iostat = NULL;
578 fjp = (struct fcu_obj *)fdp->d_obj;
579 fjp->fj_flags &= ~FUNIT_DRVATCH;
580 fjp->fj_data = NULL;
581 fjp->fj_drive = NULL;
582 fjp->fj_chars = NULL;
583 fjp->fj_attr = NULL;
584 ddi_prop_remove_all(dip);
585 mutex_destroy(&fjp->fj_lock);
586 sema_destroy(&fdp->d_ocsem);
587 ddi_soft_state_free(fd_state_head, drive_num);
588 break;
589
590 case DDI_SUSPEND:
591 /*
592 * Bad, bad, bad things will happen if someone
593 * *changes* the disk in the drive while it is mounted
594 * and the system is suspended. We have no way to
595 * detect that. (Undetected filesystem corruption.
596 * Its akin to changing the boot disk while the system
597 * is suspended. Don't do it!)
598 *
599 * So we refuse to suspend if there is a mounted filesystem.
600 * (We guess this by looking for a block open. Character
601 * opens are fine.) This limits some of the usability of
602 * suspend/resume, but it certainly avoids this
603 * potential filesytem corruption from pilot error.
604 * Given the decreasing popularity of floppy media, we
605 * don't see this as much of a limitation.
606 */
607 if (fdp->d_regopen[OTYP_BLK]) {
608 cmn_err(CE_NOTE,
609 "Unable to suspend while floppy is in use.");
610 rval = DDI_FAILURE;
611 }
612 break;
613
614 default:
615 rval = DDI_FAILURE;
616 break;
617 }
618 return (rval);
619 }
620
621
622 static int
fd_part_is_open(struct fdisk * fdp,int part)623 fd_part_is_open(struct fdisk *fdp, int part)
624 {
625 int i;
626
627 for (i = 0; i < (OTYPCNT - 1); i++)
628 if (fdp->d_regopen[i] & (1 << part))
629 return (1);
630 return (0);
631 }
632
633 static int
fd_unit_is_open(struct fdisk * fdp)634 fd_unit_is_open(struct fdisk *fdp)
635 {
636 int i;
637
638 for (i = 0; i < NDKMAP; i++)
639 if (fdp->d_lyropen[i])
640 return (1);
641 for (i = 0; i < (OTYPCNT - 1); i++)
642 if (fdp->d_regopen[i])
643 return (1);
644 return (0);
645 }
646
647 /*ARGSUSED*/
648 static int
fd_open(dev_t * devp,int flag,int otyp,cred_t * cred_p)649 fd_open(dev_t *devp, int flag, int otyp, cred_t *cred_p)
650 {
651 struct fcu_obj *fjp = NULL;
652 struct fdisk *fdp = NULL;
653 struct partition *pp;
654 dev_t dev;
655 int part, unit;
656 int part_is_open;
657 int rval;
658 uint_t pbit;
659
660 dev = *devp;
661 unit = fd_getdrive(dev, &fjp, &fdp);
662 if (!fjp || !fdp)
663 return (ENXIO);
664 part = PARTITION(dev);
665 pbit = 1 << part;
666 pp = &fdp->d_part[part];
667
668 /*
669 * Serialize opens/closes
670 */
671 sema_p(&fdp->d_ocsem);
672 FDERRPRINT(FDEP_L1, FDEM_OPEN,
673 (CE_CONT, "fd_open: fd%d part %d flag %x otype %x\n", DRIVE(dev),
674 part, flag, otyp));
675
676 /*
677 * Check for previous exclusive open, or trying to exclusive open
678 * An "exclusive open" on any partition is not guaranteed to
679 * protect against opens on another partition that overlaps it.
680 */
681 if (otyp == OTYP_LYR) {
682 part_is_open = (fdp->d_lyropen[part] != 0);
683 } else {
684 part_is_open = fd_part_is_open(fdp, part);
685 }
686 if ((fdp->d_exclmask & pbit) || ((flag & FEXCL) && part_is_open)) {
687 FDERRPRINT(FDEP_L0, FDEM_OPEN, (CE_CONT,
688 "fd_open: exclparts %lx openparts %lx lyrcnt %lx pbit %x\n",
689 fdp->d_exclmask, fdp->d_regopen[otyp], fdp->d_lyropen[part],
690 pbit));
691 sema_v(&fdp->d_ocsem);
692 return (EBUSY);
693 }
694
695 /*
696 * Ensure that drive is recalibrated on first open of new diskette.
697 */
698 fjp->fj_ops->fco_select(fjp, unit, 1);
699 if (fjp->fj_ops->fco_getchng(fjp, unit) != 0) {
700 if (fjp->fj_ops->fco_rcseek(fjp, unit, -1, 0)) {
701 FDERRPRINT(FDEP_L2, FDEM_OPEN,
702 (CE_NOTE, "fd_open fd%d: not ready", DRIVE(dev)));
703 fjp->fj_ops->fco_select(fjp, unit, 0);
704 sema_v(&fdp->d_ocsem);
705 return (ENXIO);
706 }
707 fjp->fj_flags &= ~(FUNIT_LABELOK | FUNIT_UNLABELED);
708 }
709 if (flag & (FNDELAY | FNONBLOCK)) {
710 /* don't attempt access, just return successfully */
711 fjp->fj_ops->fco_select(fjp, unit, 0);
712 goto out;
713 }
714
715 /*
716 * auto-sense the density/format of the diskette
717 */
718 rval = fdgetlabel(fjp, unit);
719 fjp->fj_ops->fco_select(fjp, unit, 0);
720 if (rval) {
721 /* didn't find label (couldn't read anything) */
722 FDERRPRINT(FDEP_L2, FDEM_OPEN,
723 (CE_NOTE, "fd%d: drive not ready", DRIVE(dev)));
724 sema_v(&fdp->d_ocsem);
725 return (EIO);
726 }
727 /* check partition */
728 if (pp->p_size == 0) {
729 sema_v(&fdp->d_ocsem);
730 return (ENXIO);
731 }
732 /*
733 * if opening for writing, check write protect on diskette
734 */
735 if ((flag & FWRITE) && (fdp->d_obj->fj_flags & FUNIT_WPROT)) {
736 sema_v(&fdp->d_ocsem);
737 return (EROFS);
738 }
739
740 out:
741 /*
742 * mark open as having succeeded
743 */
744 if (flag & FEXCL)
745 fdp->d_exclmask |= pbit;
746 if (otyp == OTYP_LYR)
747 fdp->d_lyropen[part]++;
748 else
749 fdp->d_regopen[otyp] |= 1 << part;
750
751 sema_v(&fdp->d_ocsem);
752 return (0);
753 }
754
755 /*
756 * fdgetlabel - read the SunOS label off the diskette
757 * if it can read a valid label it does so, else it will use a
758 * default. If it can`t read the diskette - that is an error.
759 *
760 * RETURNS: 0 for ok - meaning that it could at least read the device,
761 * !0 for error XXX TBD NYD error codes
762 */
763 static int
fdgetlabel(struct fcu_obj * fjp,int unit)764 fdgetlabel(struct fcu_obj *fjp, int unit)
765 {
766 struct dk_label *label;
767 struct fdisk *fdp;
768 char *newlabel;
769 short *sp;
770 short count;
771 short xsum;
772 int tries, try_this;
773 uint_t nexttype;
774 int rval;
775 short oldlvl;
776 int i;
777
778 FDERRPRINT(FDEP_L0, FDEM_GETL,
779 (CE_CONT, "fdgetlabel fd unit %d\n", unit));
780 fdp = (struct fdisk *)fjp->fj_data;
781 fjp->fj_flags &= ~(FUNIT_UNLABELED);
782
783 /*
784 * get some space to play with the label
785 */
786 label = kmem_zalloc(sizeof (struct dk_label), KM_SLEEP);
787 FDERRPRINT(FDEP_L0, FDEM_GETL, (CE_CONT,
788 "fdgetlabel fd unit %d kmem_zalloc: ptr = %p, size = %lx\n",
789 unit, (void *)label, (size_t)sizeof (struct dk_label)));
790
791 /*
792 * read block 0 (0/0/1) to find the label
793 * (disk is potentially not present or unformatted)
794 */
795 /* noerrprint since this is a private cmd */
796 oldlvl = fderrlevel;
797 fderrlevel = FDEP_LMAX;
798 /*
799 * try different characteristics (ie densities)
800 *
801 * if fdp->d_curfdtype is -1 then the current characteristics
802 * were set by ioctl and need to try it as well as everything
803 * in the table
804 */
805 nexttype = fdp->d_deffdtype;
806 try_this = 1; /* always try the current characteristics */
807
808 for (tries = nfdtypes; tries; tries--) {
809 if (try_this) {
810 fjp->fj_flags &= ~FUNIT_CHAROK;
811
812 /* try reading last sector of cyl 1, head 0 */
813 if (!(rval = fjp->fj_ops->fco_rw(fjp, unit,
814 FDREAD, 1, 0, fjp->fj_chars->fdc_secptrack,
815 (caddr_t)label,
816 sizeof (struct dk_label))) &&
817 /* and last sector plus 1 of cylinder 1 */
818 fjp->fj_ops->fco_rw(fjp, unit, FDREAD, 1,
819 0, fjp->fj_chars->fdc_secptrack + 1,
820 (caddr_t)label,
821 sizeof (struct dk_label)) &&
822 /* and label sector on cylinder 0 */
823 !(rval = fjp->fj_ops->fco_rw(fjp, unit,
824 FDREAD, 0, 0, 1, (caddr_t)label,
825 sizeof (struct dk_label))))
826 break;
827 if (rval == ENXIO)
828 break;
829 }
830 /*
831 * try the next entry in the characteristics tbl
832 */
833 fdp->d_curfdtype = (signed char)nexttype;
834 nexttype = (nexttype + 1) % nfdtypes;
835 if ((1 << fdp->d_curfdtype) & fdp->d_media) {
836 *fjp->fj_chars = *defchar[fdp->d_curfdtype];
837 *fjp->fj_attr = fdtypes[fdp->d_curfdtype];
838 bcopy(fdparts[fdp->d_curfdtype], fdp->d_part,
839 sizeof (struct partition) * NDKMAP);
840 /*
841 * check for a double_density diskette
842 * in a high_density 5.25" drive
843 */
844 if (fjp->fj_chars->fdc_transfer_rate == 250 &&
845 fjp->fj_rotspd > fjp->fj_attr->fda_rotatespd) {
846 /*
847 * yes - adjust transfer rate since we don't
848 * know if we have a 5.25" dual-speed drive
849 */
850 fjp->fj_attr->fda_rotatespd = 360;
851 fjp->fj_chars->fdc_transfer_rate = 300;
852 fjp->fj_chars->fdc_medium = 5;
853 }
854 if ((2 * fjp->fj_chars->fdc_ncyl) ==
855 defchar[fdp->d_deffdtype]->fdc_ncyl) {
856 /* yes - adjust steps per cylinder */
857 fjp->fj_chars->fdc_steps = 2;
858 } else
859 fjp->fj_chars->fdc_steps = 1;
860 try_this = 1;
861 } else
862 try_this = 0;
863 }
864 fderrlevel = oldlvl; /* print errors again */
865
866 if (rval) {
867 fdp->d_curfdtype = fdp->d_deffdtype;
868 goto out; /* couldn't read anything */
869 }
870
871 FDERRPRINT(FDEP_L0, FDEM_GETL,
872 (CE_CONT,
873 "fdgetlabel fd unit=%d ncyl=%d nsct=%d step=%d rpm=%d intlv=%d\n",
874 unit, fjp->fj_chars->fdc_ncyl, fjp->fj_chars->fdc_secptrack,
875 fjp->fj_chars->fdc_steps, fjp->fj_attr->fda_rotatespd,
876 fjp->fj_attr->fda_intrlv));
877
878 /*
879 * _something_ was read - look for unixtype label
880 */
881 if (label->dkl_magic != DKL_MAGIC ||
882 label->dkl_vtoc.v_sanity != VTOC_SANE) {
883 /* not a label - no magic number */
884 goto nolabel; /* no errors, but no label */
885 }
886
887 count = sizeof (struct dk_label) / sizeof (short);
888 sp = (short *)label;
889 xsum = 0;
890 while (count--)
891 xsum ^= *sp++; /* should add up to 0 */
892 if (xsum) {
893 /* not a label - checksum didn't compute */
894 goto nolabel; /* no errors, but no label */
895 }
896
897 /*
898 * the SunOS label overrides current diskette characteristics
899 */
900 fjp->fj_chars->fdc_ncyl = label->dkl_pcyl;
901 fjp->fj_chars->fdc_nhead = label->dkl_nhead;
902 fjp->fj_chars->fdc_secptrack = (label->dkl_nsect * DEV_BSIZE) /
903 fjp->fj_chars->fdc_sec_size;
904 if (defchar[fdp->d_deffdtype]->fdc_ncyl == 2 * fjp->fj_chars->fdc_ncyl)
905 fjp->fj_chars->fdc_steps = 2;
906 else
907 fjp->fj_chars->fdc_steps = 1;
908
909 fjp->fj_attr->fda_rotatespd = label->dkl_rpm;
910 fjp->fj_attr->fda_intrlv = label->dkl_intrlv;
911
912 fdp->d_vtoc_version = label->dkl_vtoc.v_version;
913 bcopy(label->dkl_vtoc.v_volume, fdp->d_vtoc_volume, LEN_DKL_VVOL);
914 bcopy(label->dkl_vtoc.v_asciilabel,
915 fdp->d_vtoc_asciilabel, LEN_DKL_ASCII);
916 /*
917 * logical partitions
918 */
919 for (i = 0; i < NDKMAP; i++) {
920 fdp->d_part[i].p_tag = label->dkl_vtoc.v_part[i].p_tag;
921 fdp->d_part[i].p_flag = label->dkl_vtoc.v_part[i].p_flag;
922 fdp->d_part[i].p_start = label->dkl_vtoc.v_part[i].p_start;
923 fdp->d_part[i].p_size = label->dkl_vtoc.v_part[i].p_size;
924
925 fdp->d_vtoc_timestamp[i] = label->dkl_vtoc.timestamp[i];
926 }
927
928 fjp->fj_flags |= FUNIT_LABELOK;
929 goto out;
930
931 nolabel:
932 /*
933 * if not found, fill in label info from default (mark default used)
934 */
935 if (fdp->d_media & (1<<FMT_3D))
936 newlabel = deflabel_35;
937 else /* if (fdp->d_media & (1<<FMT_5D9)) */
938 newlabel = deflabel_525;
939 bzero(fdp->d_vtoc_volume, LEN_DKL_VVOL);
940 (void) sprintf(fdp->d_vtoc_asciilabel, newlabel,
941 fjp->fj_chars->fdc_ncyl, fjp->fj_chars->fdc_nhead,
942 fjp->fj_chars->fdc_secptrack);
943 fjp->fj_flags |= FUNIT_UNLABELED;
944
945 out:
946 kmem_free(label, sizeof (struct dk_label));
947 return (rval);
948 }
949
950
951 /*ARGSUSED*/
952 static int
fd_close(dev_t dev,int flag,int otyp,cred_t * cred_p)953 fd_close(dev_t dev, int flag, int otyp, cred_t *cred_p)
954 {
955 struct fcu_obj *fjp = NULL;
956 struct fdisk *fdp = NULL;
957 int part, part_is_closed;
958
959 #ifdef DEBUG
960 int unit;
961 #define DEBUG_ASSIGN unit=
962 #else
963 #define DEBUG_ASSIGN (void)
964 #endif
965
966 DEBUG_ASSIGN fd_getdrive(dev, &fjp, &fdp);
967 /*
968 * Ignoring return in non DEBUG mode because success is checked by
969 * verifying fjp and fdp and returned unit value is not used.
970 */
971 if (!fjp || !fdp)
972 return (ENXIO);
973 part = PARTITION(dev);
974
975 sema_p(&fdp->d_ocsem);
976 FDERRPRINT(FDEP_L1, FDEM_CLOS,
977 (CE_CONT, "fd_close: fd unit %d part %d otype %x\n",
978 unit, part, otyp));
979
980 if (otyp == OTYP_LYR) {
981 if (fdp->d_lyropen[part])
982 fdp->d_lyropen[part]--;
983 part_is_closed = (fdp->d_lyropen[part] == 0);
984 } else {
985 fdp->d_regopen[otyp] &= ~(1<<part);
986 part_is_closed = 1;
987 }
988 if (part_is_closed) {
989 if (part == 2 && fdp->d_exclmask&(1<<part))
990 fdp->d_exclmask = 0;
991 else
992 fdp->d_exclmask &= ~(1<<part);
993 FDERRPRINT(FDEP_L0, FDEM_CLOS,
994 (CE_CONT,
995 "fd_close: exclparts %lx openparts %lx lyrcnt %lx\n",
996 fdp->d_exclmask, fdp->d_regopen[otyp],
997 fdp->d_lyropen[part]));
998
999 if (fd_unit_is_open(fdp) == 0)
1000 fdp->d_obj->fj_flags &= ~FUNIT_CHANGED;
1001 }
1002 sema_v(&fdp->d_ocsem);
1003 return (0);
1004 }
1005
1006 /* ARGSUSED */
1007 static int
fd_read(dev_t dev,struct uio * uio,cred_t * cred_p)1008 fd_read(dev_t dev, struct uio *uio, cred_t *cred_p)
1009 {
1010 return (physio(fd_strategy, NULL, dev, B_READ, minphys, uio));
1011 }
1012
1013 /* ARGSUSED */
1014 static int
fd_write(dev_t dev,struct uio * uio,cred_t * cred_p)1015 fd_write(dev_t dev, struct uio *uio, cred_t *cred_p)
1016 {
1017 return (physio(fd_strategy, NULL, dev, B_WRITE, minphys, uio));
1018 }
1019
1020 /*
1021 * fd_strategy
1022 * checks operation, hangs buf struct off fdcntlr, calls fdstart
1023 * if not already busy. Note that if we call start, then the operation
1024 * will already be done on return (start sleeps).
1025 */
1026 static int
fd_strategy(struct buf * bp)1027 fd_strategy(struct buf *bp)
1028 {
1029 struct fcu_obj *fjp;
1030 struct fdisk *fdp;
1031 struct partition *pp;
1032
1033 FDERRPRINT(FDEP_L1, FDEM_STRA,
1034 (CE_CONT, "fd_strategy: bp = 0x%p, dev = 0x%lx\n",
1035 (void *)bp, bp->b_edev));
1036
1037 (void) fd_getdrive(bp->b_edev, &fjp, &fdp);
1038
1039 /*
1040 * Ignoring return because device exist.
1041 * Returned unit value is not used.
1042 */
1043 pp = &fdp->d_part[PARTITION(bp->b_edev)];
1044
1045 if (fjp->fj_chars->fdc_sec_size > NBPSCTR && (bp->b_blkno & 1)) {
1046 FDERRPRINT(FDEP_L3, FDEM_STRA,
1047 (CE_WARN, "fd%d: block %ld is not start of sector!",
1048 DRIVE(bp->b_edev), (long)bp->b_blkno));
1049 bp->b_error = EINVAL;
1050 goto bad;
1051 }
1052
1053 if ((bp->b_blkno > pp->p_size)) {
1054 FDERRPRINT(FDEP_L3, FDEM_STRA,
1055 (CE_WARN, "fd%d: block %ld is past the end! (nblk=%ld)",
1056 DRIVE(bp->b_edev), (long)bp->b_blkno, pp->p_size));
1057 bp->b_error = ENOSPC;
1058 goto bad;
1059 }
1060
1061 /* if at end of file, skip out now */
1062 if (bp->b_blkno == pp->p_size) {
1063 if ((bp->b_flags & B_READ) == 0) {
1064 /* a write needs to get an error! */
1065 bp->b_error = ENOSPC;
1066 goto bad;
1067 }
1068 bp->b_resid = bp->b_bcount;
1069 biodone(bp);
1070 return (0);
1071 }
1072
1073 /* if operation not a multiple of sector size, is error! */
1074 if (bp->b_bcount % fjp->fj_chars->fdc_sec_size) {
1075 FDERRPRINT(FDEP_L3, FDEM_STRA,
1076 (CE_WARN, "fd%d: count %ld must be a multiple of %d",
1077 DRIVE(bp->b_edev), bp->b_bcount,
1078 fjp->fj_chars->fdc_sec_size));
1079 bp->b_error = EINVAL;
1080 goto bad;
1081 }
1082
1083 /*
1084 * Put the buf request in the drive's queue, FIFO.
1085 */
1086 bp->av_forw = 0;
1087 mutex_enter(&fjp->fj_lock);
1088 if (fdp->d_iostat)
1089 kstat_waitq_enter(KIOSP);
1090 if (fdp->d_actf)
1091 fdp->d_actl->av_forw = bp;
1092 else
1093 fdp->d_actf = bp;
1094 fdp->d_actl = bp;
1095 if (!(fjp->fj_flags & FUNIT_BUSY)) {
1096 fdstart(fjp);
1097 }
1098 mutex_exit(&fjp->fj_lock);
1099 return (0);
1100
1101 bad:
1102 bp->b_resid = bp->b_bcount;
1103 bp->b_flags |= B_ERROR;
1104 biodone(bp);
1105 return (0);
1106 }
1107
1108 /*
1109 * fdstart
1110 * called from fd_strategy() or from fdXXXX() to setup and
1111 * start operations of read or write only (using buf structs).
1112 * Because the chip doesn't handle crossing cylinder boundaries on
1113 * the fly, this takes care of those boundary conditions. Note that
1114 * it sleeps until the operation is done *within fdstart* - so that
1115 * when fdstart returns, the operation is already done.
1116 */
1117 static void
fdstart(struct fcu_obj * fjp)1118 fdstart(struct fcu_obj *fjp)
1119 {
1120 struct buf *bp;
1121 struct fdisk *fdp = (struct fdisk *)fjp->fj_data;
1122 struct fd_char *chp;
1123 struct partition *pp;
1124 uint_t ptend;
1125 uint_t bincyl; /* (the number of the desired) block in cyl. */
1126 uint_t blk, len, tlen;
1127 uint_t secpcyl; /* number of sectors per cylinder */
1128 int cyl, head, sect;
1129 int sctrshft, unit;
1130 caddr_t addr;
1131
1132 ASSERT(MUTEX_HELD(&fjp->fj_lock));
1133 fjp->fj_flags |= FUNIT_BUSY;
1134
1135 while ((bp = fdp->d_actf) != NULL) {
1136 fdp->d_actf = bp->av_forw;
1137 fdp->d_current = bp;
1138 if (fdp->d_iostat) {
1139 kstat_waitq_to_runq(KIOSP);
1140 }
1141 mutex_exit(&fjp->fj_lock);
1142
1143 FDERRPRINT(FDEP_L0, FDEM_STRT,
1144 (CE_CONT, "fdstart: bp=0x%p blkno=0x%lx bcount=0x%lx\n",
1145 (void *)bp, (long)bp->b_blkno, bp->b_bcount));
1146 bp->b_flags &= ~B_ERROR;
1147 bp->b_error = 0;
1148 bp->b_resid = bp->b_bcount; /* init resid */
1149
1150 ASSERT(DRIVE(bp->b_edev) == ddi_get_instance(fjp->fj_dip));
1151 unit = fjp->fj_unit;
1152 fjp->fj_ops->fco_select(fjp, unit, 1);
1153
1154 bp_mapin(bp); /* map in buffers */
1155
1156 pp = &fdp->d_part[PARTITION(bp->b_edev)];
1157 /* starting blk adjusted for the partition */
1158 blk = bp->b_blkno + pp->p_start;
1159 ptend = pp->p_start + pp->p_size; /* end of the partition */
1160
1161 chp = fjp->fj_chars;
1162 secpcyl = chp->fdc_nhead * chp->fdc_secptrack;
1163 switch (chp->fdc_sec_size) {
1164 /* convert logical block numbers to sector numbers */
1165 case 1024:
1166 sctrshft = SCTRSHFT + 1;
1167 blk >>= 1;
1168 ptend >>= 1;
1169 break;
1170 default:
1171 case NBPSCTR:
1172 sctrshft = SCTRSHFT;
1173 break;
1174 case 256:
1175 sctrshft = SCTRSHFT - 1;
1176 blk <<= 1;
1177 ptend <<= 1;
1178 break;
1179 }
1180
1181 /*
1182 * If off the end, limit to actual amount that
1183 * can be transferred.
1184 */
1185 if ((blk + (bp->b_bcount >> sctrshft)) > ptend)
1186 /* to end of partition */
1187 len = (ptend - blk) << sctrshft;
1188 else
1189 len = bp->b_bcount;
1190 addr = bp->b_un.b_addr; /* data buffer address */
1191
1192 /*
1193 * now we have the real start blk, addr and len for xfer op
1194 */
1195 while (len != 0) {
1196 /* start cyl of req */
1197 cyl = blk / secpcyl;
1198 bincyl = blk % secpcyl;
1199 /* start head of req */
1200 head = bincyl / chp->fdc_secptrack;
1201 /* start sector of req */
1202 sect = (bincyl % chp->fdc_secptrack) + 1;
1203 /*
1204 * If the desired block and length will go beyond the
1205 * cylinder end, then limit it to the cylinder end.
1206 */
1207 if (bp->b_flags & B_READ) {
1208 if (len > ((secpcyl - bincyl) << sctrshft))
1209 tlen = (secpcyl - bincyl) << sctrshft;
1210 else
1211 tlen = len;
1212 } else {
1213 if (len >
1214 ((chp->fdc_secptrack - sect + 1) <<
1215 sctrshft))
1216 tlen =
1217 (chp->fdc_secptrack - sect + 1) <<
1218 sctrshft;
1219 else
1220 tlen = len;
1221 }
1222
1223 FDERRPRINT(FDEP_L0, FDEM_STRT, (CE_CONT,
1224 " blk 0x%x addr 0x%p len 0x%x "
1225 "cyl %d head %d sec %d\n resid 0x%lx, tlen %d\n",
1226 blk, (void *)addr, len, cyl, head, sect,
1227 bp->b_resid, tlen));
1228
1229 /*
1230 * (try to) do the operation - failure returns an errno
1231 */
1232 bp->b_error = fjp->fj_ops->fco_rw(fjp, unit,
1233 bp->b_flags & B_READ, cyl, head, sect, addr, tlen);
1234 if (bp->b_error != 0) {
1235 FDERRPRINT(FDEP_L3, FDEM_STRT, (CE_WARN,
1236 "fdstart: bad exec of bp: 0x%p, err=%d",
1237 (void *)bp, bp->b_error));
1238 bp->b_flags |= B_ERROR;
1239 break;
1240 }
1241 blk += tlen >> sctrshft;
1242 len -= tlen;
1243 addr += tlen;
1244 bp->b_resid -= tlen;
1245 }
1246 FDERRPRINT(FDEP_L0, FDEM_STRT,
1247 (CE_CONT, "fdstart done: b_resid %lu, b_count %lu\n",
1248 bp->b_resid, bp->b_bcount));
1249 if (fdp->d_iostat) {
1250 if (bp->b_flags & B_READ) {
1251 KIOSP->reads++;
1252 KIOSP->nread += (bp->b_bcount - bp->b_resid);
1253 } else {
1254 KIOSP->writes++;
1255 KIOSP->nwritten += (bp->b_bcount - bp->b_resid);
1256 }
1257 kstat_runq_exit(KIOSP);
1258 }
1259 bp_mapout(bp);
1260 biodone(bp);
1261
1262 fjp->fj_ops->fco_select(fjp, unit, 0);
1263 mutex_enter(&fjp->fj_lock);
1264 fdp->d_current = 0;
1265 }
1266 fjp->fj_flags ^= FUNIT_BUSY;
1267 }
1268
1269 /* ARGSUSED */
1270 static int
fd_ioctl(dev_t dev,int cmd,intptr_t arg,int flag,cred_t * cred_p,int * rval_p)1271 fd_ioctl(dev_t dev, int cmd, intptr_t arg, int flag, cred_t *cred_p,
1272 int *rval_p)
1273 {
1274 union {
1275 struct dk_cinfo dki;
1276 struct dk_geom dkg;
1277 struct dk_allmap dka;
1278 struct fd_char fdchar;
1279 struct fd_drive drvchar;
1280 int temp;
1281 } cpy;
1282 struct vtoc vtoc;
1283 struct fcu_obj *fjp = NULL;
1284 struct fdisk *fdp = NULL;
1285 struct dk_map *dmp;
1286 struct dk_label *label;
1287 int nblks, part, unit;
1288 int rval = 0;
1289 enum dkio_state state;
1290
1291 unit = fd_getdrive(dev, &fjp, &fdp);
1292 if (!fjp || !fdp)
1293 return (ENXIO);
1294
1295 FDERRPRINT(FDEP_L1, FDEM_IOCT,
1296 (CE_CONT, "fd_ioctl fd unit %d: cmd %x, arg %lx\n",
1297 unit, cmd, arg));
1298
1299 switch (cmd) {
1300 case DKIOCINFO:
1301 fjp->fj_ops->fco_dkinfo(fjp, &cpy.dki);
1302 cpy.dki.dki_cnum = FDCTLR(fjp->fj_unit);
1303 cpy.dki.dki_unit = FDUNIT(fjp->fj_unit);
1304 cpy.dki.dki_partition = PARTITION(dev);
1305 if (ddi_copyout(&cpy.dki, (void *)arg, sizeof (cpy.dki), flag))
1306 rval = EFAULT;
1307 break;
1308
1309 case DKIOCG_PHYGEOM:
1310 case DKIOCG_VIRTGEOM:
1311 cpy.dkg.dkg_nsect = fjp->fj_chars->fdc_secptrack;
1312 goto get_geom;
1313 case DKIOCGGEOM:
1314 if (fjp->fj_flags & FUNIT_LABELOK)
1315 cpy.dkg.dkg_nsect = (fjp->fj_chars->fdc_secptrack *
1316 fjp->fj_chars->fdc_sec_size) / DEV_BSIZE;
1317 else
1318 cpy.dkg.dkg_nsect = fjp->fj_chars->fdc_secptrack;
1319 get_geom:
1320 cpy.dkg.dkg_pcyl = fjp->fj_chars->fdc_ncyl;
1321 cpy.dkg.dkg_ncyl = fjp->fj_chars->fdc_ncyl;
1322 cpy.dkg.dkg_nhead = fjp->fj_chars->fdc_nhead;
1323 cpy.dkg.dkg_intrlv = fjp->fj_attr->fda_intrlv;
1324 cpy.dkg.dkg_rpm = fjp->fj_attr->fda_rotatespd;
1325 cpy.dkg.dkg_read_reinstruct =
1326 (int)(cpy.dkg.dkg_nsect * cpy.dkg.dkg_rpm * 4) / 60000;
1327 cpy.dkg.dkg_write_reinstruct = cpy.dkg.dkg_read_reinstruct;
1328 if (ddi_copyout(&cpy.dkg, (void *)arg, sizeof (cpy.dkg), flag))
1329 rval = EFAULT;
1330 break;
1331
1332 case DKIOCSGEOM:
1333 if (ddi_copyin((void *)arg, &cpy.dkg,
1334 sizeof (struct dk_geom), flag)) {
1335 rval = EFAULT;
1336 break;
1337 }
1338 mutex_enter(&fjp->fj_lock);
1339 fjp->fj_chars->fdc_ncyl = cpy.dkg.dkg_ncyl;
1340 fjp->fj_chars->fdc_nhead = cpy.dkg.dkg_nhead;
1341 fjp->fj_chars->fdc_secptrack = cpy.dkg.dkg_nsect;
1342 fjp->fj_attr->fda_intrlv = cpy.dkg.dkg_intrlv;
1343 fjp->fj_attr->fda_rotatespd = cpy.dkg.dkg_rpm;
1344 fdp->d_curfdtype = -1;
1345 mutex_exit(&fjp->fj_lock);
1346 break;
1347
1348 /*
1349 * return the map of all logical partitions
1350 */
1351 case DKIOCGAPART:
1352 /*
1353 * Note the conversion from starting sector number
1354 * to starting cylinder number.
1355 * Return error if division results in a remainder.
1356 */
1357 nblks = fjp->fj_chars->fdc_nhead * fjp->fj_chars->fdc_secptrack;
1358
1359 #ifdef _MULTI_DATAMODEL
1360 switch (ddi_model_convert_from(flag & FMODELS)) {
1361 case DDI_MODEL_ILP32:
1362 {
1363 struct dk_allmap32 dka32;
1364
1365 for (part = 0; part < NDKMAP; part++) {
1366 if ((fdp->d_part[part].p_start % nblks) != 0)
1367 return (EINVAL);
1368 dka32.dka_map[part].dkl_cylno =
1369 fdp->d_part[part].p_start / nblks;
1370 dka32.dka_map[part].dkl_nblk =
1371 fdp->d_part[part].p_size;
1372 }
1373
1374 if (ddi_copyout(&dka32, (void *)arg,
1375 sizeof (struct dk_allmap32), flag))
1376 rval = EFAULT;
1377
1378 break;
1379 }
1380 case DDI_MODEL_NONE:
1381
1382 #endif /* _MULTI_DATAMODEL */
1383
1384 dmp = (struct dk_map *)&cpy.dka;
1385 for (part = 0; part < NDKMAP; part++) {
1386 if ((fdp->d_part[part].p_start % nblks) != 0)
1387 return (EINVAL);
1388 dmp->dkl_cylno =
1389 fdp->d_part[part].p_start / nblks;
1390 dmp->dkl_nblk = fdp->d_part[part].p_size;
1391 dmp++;
1392 }
1393
1394 if (ddi_copyout(&cpy.dka, (void *)arg,
1395 sizeof (struct dk_allmap), flag))
1396 rval = EFAULT;
1397 #ifdef _MULTI_DATAMODEL
1398 break;
1399
1400 }
1401 #endif /* _MULTI_DATAMODEL */
1402
1403 break;
1404
1405 /*
1406 * Set the map of all logical partitions
1407 */
1408 case DKIOCSAPART:
1409
1410 #ifdef _MULTI_DATAMODEL
1411 switch (ddi_model_convert_from(flag & FMODELS)) {
1412 case DDI_MODEL_ILP32:
1413 {
1414 struct dk_allmap32 dka32;
1415
1416 if (ddi_copyin((void *)arg, &dka32,
1417 sizeof (dka32), flag)) {
1418 rval = EFAULT;
1419 break;
1420 }
1421 for (part = 0; part < NDKMAP; part++) {
1422 cpy.dka.dka_map[part].dkl_cylno =
1423 dka32.dka_map[part].dkl_cylno;
1424 cpy.dka.dka_map[part].dkl_nblk =
1425 dka32.dka_map[part].dkl_nblk;
1426 }
1427 break;
1428 }
1429 case DDI_MODEL_NONE:
1430
1431 #endif /* _MULTI_DATAMODEL */
1432 if (ddi_copyin((void *)arg, &cpy.dka, sizeof (cpy.dka), flag))
1433 rval = EFAULT;
1434 #ifdef _MULTI_DATAMODEL
1435
1436 break;
1437 }
1438 #endif /* _MULTI_DATAMODEL */
1439
1440 if (rval != 0)
1441 break;
1442
1443 dmp = (struct dk_map *)&cpy.dka;
1444 nblks = fjp->fj_chars->fdc_nhead *
1445 fjp->fj_chars->fdc_secptrack;
1446 mutex_enter(&fjp->fj_lock);
1447 /*
1448 * Note the conversion from starting cylinder number
1449 * to starting sector number.
1450 */
1451 for (part = 0; part < NDKMAP; part++) {
1452 fdp->d_part[part].p_start = dmp->dkl_cylno *
1453 nblks;
1454 fdp->d_part[part].p_size = dmp->dkl_nblk;
1455 dmp++;
1456 }
1457 mutex_exit(&fjp->fj_lock);
1458
1459 break;
1460
1461 case DKIOCGVTOC:
1462 mutex_enter(&fjp->fj_lock);
1463
1464 /*
1465 * Exit if the diskette has no label.
1466 * Also, get the label to make sure the correct one is
1467 * being used since the diskette may have changed
1468 */
1469 fjp->fj_ops->fco_select(fjp, unit, 1);
1470 rval = fdgetlabel(fjp, unit);
1471 fjp->fj_ops->fco_select(fjp, unit, 0);
1472 if (rval) {
1473 mutex_exit(&fjp->fj_lock);
1474 rval = EINVAL;
1475 break;
1476 }
1477
1478 fd_build_user_vtoc(fjp, fdp, &vtoc);
1479 mutex_exit(&fjp->fj_lock);
1480
1481 #ifdef _MULTI_DATAMODEL
1482 switch (ddi_model_convert_from(flag & FMODELS)) {
1483 case DDI_MODEL_ILP32:
1484 {
1485 struct vtoc32 vtoc32;
1486
1487 vtoctovtoc32(vtoc, vtoc32);
1488
1489 if (ddi_copyout(&vtoc32, (void *)arg,
1490 sizeof (vtoc32), flag))
1491 rval = EFAULT;
1492
1493 break;
1494 }
1495 case DDI_MODEL_NONE:
1496
1497 #endif /* _MULTI_DATAMODEL */
1498 if (ddi_copyout(&vtoc, (void *)arg,
1499 sizeof (vtoc), flag))
1500 rval = EFAULT;
1501 #ifdef _MULTI_DATAMODEL
1502 break;
1503 }
1504 #endif /* _MULTI_DATAMODEL */
1505
1506 break;
1507
1508 case DKIOCSVTOC:
1509
1510 #ifdef _MULTI_DATAMODEL
1511 switch (ddi_model_convert_from(flag & FMODELS)) {
1512 case DDI_MODEL_ILP32:
1513 {
1514 struct vtoc32 vtoc32;
1515
1516 if (ddi_copyin((void *)arg, &vtoc32,
1517 sizeof (vtoc32), flag)) {
1518 rval = EFAULT;
1519 break;
1520 }
1521
1522 vtoc32tovtoc(vtoc32, vtoc);
1523
1524 break;
1525 }
1526 case DDI_MODEL_NONE:
1527
1528 #endif /* _MULTI_DATAMODEL */
1529 if (ddi_copyin((void *)arg, &vtoc, sizeof (vtoc), flag))
1530 rval = EFAULT;
1531 #ifdef _MULTI_DATAMODEL
1532 break;
1533 }
1534 #endif /* _MULTI_DATAMODEL */
1535
1536 if (rval != 0)
1537 break;
1538
1539
1540 label = kmem_zalloc(sizeof (struct dk_label), KM_SLEEP);
1541
1542 mutex_enter(&fjp->fj_lock);
1543
1544 if ((rval = fd_build_label_vtoc(fjp, fdp, &vtoc, label)) == 0) {
1545 fjp->fj_ops->fco_select(fjp, unit, 1);
1546 rval = fjp->fj_ops->fco_rw(fjp, unit, FDWRITE,
1547 0, 0, 1, (caddr_t)label, sizeof (struct dk_label));
1548 fjp->fj_ops->fco_select(fjp, unit, 0);
1549 }
1550 mutex_exit(&fjp->fj_lock);
1551 kmem_free(label, sizeof (struct dk_label));
1552 break;
1553
1554 case DKIOCSTATE:
1555 FDERRPRINT(FDEP_L1, FDEM_IOCT,
1556 (CE_CONT, "fd_ioctl fd unit %d: DKIOCSTATE\n", unit));
1557
1558 if (ddi_copyin((void *)arg, &state, sizeof (int), flag)) {
1559 rval = EFAULT;
1560 break;
1561 }
1562
1563 rval = fd_check_media(dev, state);
1564
1565 if (ddi_copyout(&fdp->d_media_state, (void *)arg,
1566 sizeof (int), flag))
1567 rval = EFAULT;
1568 break;
1569
1570 case FDIOGCHAR:
1571 if (ddi_copyout(fjp->fj_chars, (void *)arg,
1572 sizeof (struct fd_char), flag))
1573 rval = EFAULT;
1574 break;
1575
1576 case FDIOSCHAR:
1577 if (ddi_copyin((void *)arg, &cpy.fdchar,
1578 sizeof (struct fd_char), flag)) {
1579 rval = EFAULT;
1580 break;
1581 }
1582 switch (cpy.fdchar.fdc_transfer_rate) {
1583 case 417:
1584 if ((fdp->d_media & (1 << FMT_3M)) == 0) {
1585 cmn_err(CE_CONT,
1586 "fdioschar:Medium density not supported\n");
1587 rval = EINVAL;
1588 break;
1589 }
1590 mutex_enter(&fjp->fj_lock);
1591 fjp->fj_attr->fda_rotatespd = 360;
1592 mutex_exit(&fjp->fj_lock);
1593 /* cpy.fdchar.fdc_transfer_rate = 500; */
1594 /* FALLTHROUGH */
1595 case 1000:
1596 case 500:
1597 case 300:
1598 case 250:
1599 mutex_enter(&fjp->fj_lock);
1600 *(fjp->fj_chars) = cpy.fdchar;
1601 fdp->d_curfdtype = -1;
1602 fjp->fj_flags &= ~FUNIT_CHAROK;
1603 mutex_exit(&fjp->fj_lock);
1604
1605 break;
1606
1607 default:
1608 FDERRPRINT(FDEP_L4, FDEM_IOCT,
1609 (CE_WARN, "fd_ioctl fd unit %d: FDIOSCHAR odd "
1610 "xfer rate %dkbs",
1611 unit, cpy.fdchar.fdc_transfer_rate));
1612 rval = EINVAL;
1613 break;
1614 }
1615 break;
1616
1617 /*
1618 * set all characteristics and geometry to the defaults
1619 */
1620 case FDDEFGEOCHAR:
1621 mutex_enter(&fjp->fj_lock);
1622 fdp->d_curfdtype = fdp->d_deffdtype;
1623 *fjp->fj_chars = *defchar[fdp->d_curfdtype];
1624 *fjp->fj_attr = fdtypes[fdp->d_curfdtype];
1625 bcopy(fdparts[fdp->d_curfdtype],
1626 fdp->d_part, sizeof (struct partition) * NDKMAP);
1627 fjp->fj_flags &= ~FUNIT_CHAROK;
1628 mutex_exit(&fjp->fj_lock);
1629 break;
1630
1631 case FDEJECT: /* eject disk */
1632 case DKIOCEJECT:
1633 fjp->fj_flags &= ~(FUNIT_LABELOK | FUNIT_UNLABELED);
1634 rval = ENOSYS;
1635 break;
1636
1637 case FDGETCHANGE: /* disk changed */
1638 if (ddi_copyin((void *)arg, &cpy.temp, sizeof (int), flag)) {
1639 rval = EFAULT;
1640 break;
1641 }
1642 mutex_enter(&fjp->fj_lock);
1643 fjp->fj_ops->fco_select(fjp, unit, 1);
1644
1645 if (fjp->fj_flags & FUNIT_CHANGED)
1646 cpy.temp |= FDGC_HISTORY;
1647 else
1648 cpy.temp &= ~FDGC_HISTORY;
1649 fjp->fj_flags &= ~FUNIT_CHANGED;
1650
1651 if (fjp->fj_ops->fco_getchng(fjp, unit)) {
1652 cpy.temp |= FDGC_DETECTED;
1653 fjp->fj_ops->fco_resetchng(fjp, unit);
1654 /*
1655 * check diskette again only if it was removed
1656 */
1657 if (fjp->fj_ops->fco_getchng(fjp, unit)) {
1658 /*
1659 * no diskette is present
1660 */
1661 cpy.temp |= FDGC_CURRENT;
1662 if (fjp->fj_flags & FUNIT_CHGDET)
1663 /*
1664 * again no diskette; not a new change
1665 */
1666 cpy.temp ^= FDGC_DETECTED;
1667 else
1668 fjp->fj_flags |= FUNIT_CHGDET;
1669 } else {
1670 /*
1671 * a new diskette is present
1672 */
1673 cpy.temp &= ~FDGC_CURRENT;
1674 fjp->fj_flags &= ~FUNIT_CHGDET;
1675 }
1676 } else {
1677 cpy.temp &= ~(FDGC_DETECTED | FDGC_CURRENT);
1678 fjp->fj_flags &= ~FUNIT_CHGDET;
1679 }
1680 /*
1681 * also get state of write protection
1682 */
1683 if (fjp->fj_flags & FUNIT_WPROT) {
1684 cpy.temp |= FDGC_CURWPROT;
1685 } else {
1686 cpy.temp &= ~FDGC_CURWPROT;
1687 }
1688 fjp->fj_ops->fco_select(fjp, unit, 0);
1689 mutex_exit(&fjp->fj_lock);
1690
1691 if (ddi_copyout(&cpy.temp, (void *)arg, sizeof (int), flag))
1692 rval = EFAULT;
1693 break;
1694
1695 case FDGETDRIVECHAR:
1696 if (ddi_copyout(fjp->fj_drive, (void *)arg,
1697 sizeof (struct fd_drive), flag))
1698 rval = EFAULT;
1699 break;
1700
1701 case FDSETDRIVECHAR:
1702 if (ddi_copyin((void *)arg, &cpy.drvchar,
1703 sizeof (struct fd_drive), flag)) {
1704 rval = EFAULT;
1705 break;
1706 }
1707 mutex_enter(&fjp->fj_lock);
1708 *(fjp->fj_drive) = cpy.drvchar;
1709 fdp->d_curfdtype = -1;
1710 fjp->fj_flags &= ~FUNIT_CHAROK;
1711 mutex_exit(&fjp->fj_lock);
1712 break;
1713
1714 case DKIOCREMOVABLE: {
1715 int i = 1;
1716
1717 /* no brainer: floppies are always removable */
1718 if (ddi_copyout(&i, (void *)arg, sizeof (int), flag)) {
1719 rval = EFAULT;
1720 }
1721 break;
1722 }
1723
1724 case DKIOCGMEDIAINFO:
1725 rval = fd_get_media_info(fjp, (caddr_t)arg, flag);
1726 break;
1727
1728 case FDIOCMD:
1729 {
1730 struct fd_cmd fc;
1731 int cyl, head, spc, spt;
1732
1733 #ifdef _MULTI_DATAMODEL
1734 switch (ddi_model_convert_from(flag & FMODELS)) {
1735 case DDI_MODEL_ILP32:
1736 {
1737 struct fd_cmd32 fc32;
1738
1739 if (ddi_copyin((void *)arg, &fc32,
1740 sizeof (fc32), flag)) {
1741 rval = EFAULT;
1742 break;
1743 }
1744
1745 fc.fdc_cmd = fc32.fdc_cmd;
1746 fc.fdc_flags = fc32.fdc_flags;
1747 fc.fdc_blkno = fc32.fdc_blkno;
1748 fc.fdc_secnt = fc32.fdc_secnt;
1749 fc.fdc_bufaddr = (caddr_t)(uintptr_t)fc32.fdc_bufaddr;
1750 fc.fdc_buflen = fc32.fdc_buflen;
1751
1752 break;
1753 }
1754 case DDI_MODEL_NONE:
1755
1756 #endif /* _MULTI_DATAMODEL */
1757
1758 if (ddi_copyin((void *)arg, &fc, sizeof (fc), flag)) {
1759 rval = EFAULT;
1760 break;
1761 }
1762 #ifdef _MULTI_DATAMODEL
1763 break;
1764 }
1765 #endif /* _MULTI_DATAMODEL */
1766
1767 if (rval != 0)
1768 break;
1769
1770 if (fc.fdc_cmd == FDCMD_READ || fc.fdc_cmd == FDCMD_WRITE) {
1771 auto struct iovec aiov;
1772 auto struct uio auio;
1773 struct uio *uio = &auio;
1774
1775 spc = (fc.fdc_cmd == FDCMD_READ)? B_READ: B_WRITE;
1776
1777 bzero(&auio, sizeof (struct uio));
1778 bzero(&aiov, sizeof (struct iovec));
1779 aiov.iov_base = fc.fdc_bufaddr;
1780 aiov.iov_len = (uint_t)fc.fdc_secnt *
1781 fjp->fj_chars->fdc_sec_size;
1782 uio->uio_iov = &aiov;
1783
1784 uio->uio_iovcnt = 1;
1785 uio->uio_resid = aiov.iov_len;
1786 uio->uio_segflg = UIO_USERSPACE;
1787
1788 rval = physio(fd_strategy, (struct buf *)0, dev,
1789 spc, minphys, uio);
1790 break;
1791 } else if (fc.fdc_cmd == FDCMD_FORMAT_TRACK) {
1792 spt = fjp->fj_chars->fdc_secptrack; /* sec/trk */
1793 spc = fjp->fj_chars->fdc_nhead * spt; /* sec/cyl */
1794 cyl = fc.fdc_blkno / spc;
1795 head = (fc.fdc_blkno % spc) / spt;
1796 if ((cyl | head) == 0)
1797 fjp->fj_flags &=
1798 ~(FUNIT_LABELOK | FUNIT_UNLABELED);
1799
1800 FDERRPRINT(FDEP_L0, FDEM_FORM,
1801 (CE_CONT, "fd_format cyl %d, hd %d\n", cyl, head));
1802 fjp->fj_ops->fco_select(fjp, unit, 1);
1803 rval = fjp->fj_ops->fco_format(fjp, unit, cyl, head,
1804 (int)fc.fdc_flags);
1805 fjp->fj_ops->fco_select(fjp, unit, 0);
1806
1807 break;
1808 }
1809 FDERRPRINT(FDEP_L4, FDEM_IOCT,
1810 (CE_WARN, "fd_ioctl fd unit %d: FDIOCSCMD not yet complete",
1811 unit));
1812 rval = EINVAL;
1813 break;
1814 }
1815
1816 case FDRAW:
1817 rval = fd_rawioctl(fjp, unit, (caddr_t)arg, flag);
1818 break;
1819
1820 default:
1821 FDERRPRINT(FDEP_L4, FDEM_IOCT,
1822 (CE_WARN, "fd_ioctl fd unit %d: invalid ioctl 0x%x",
1823 unit, cmd));
1824 rval = ENOTTY;
1825 break;
1826 }
1827 return (rval);
1828 }
1829
1830 static void
fd_build_user_vtoc(struct fcu_obj * fjp,struct fdisk * fdp,struct vtoc * vtocp)1831 fd_build_user_vtoc(struct fcu_obj *fjp, struct fdisk *fdp, struct vtoc *vtocp)
1832 {
1833 struct partition *vpart;
1834 int i;
1835 int xblk;
1836
1837 /*
1838 * Return vtoc structure fields in the provided VTOC area, addressed
1839 * by *vtocp.
1840 *
1841 */
1842 bzero(vtocp, sizeof (struct vtoc));
1843
1844 bcopy(fdp->d_vtoc_bootinfo,
1845 vtocp->v_bootinfo, sizeof (vtocp->v_bootinfo));
1846
1847 vtocp->v_sanity = VTOC_SANE;
1848 vtocp->v_version = fdp->d_vtoc_version;
1849 bcopy(fdp->d_vtoc_volume, vtocp->v_volume, LEN_DKL_VVOL);
1850 if (fjp->fj_flags & FUNIT_LABELOK) {
1851 vtocp->v_sectorsz = DEV_BSIZE;
1852 xblk = 1;
1853 } else {
1854 vtocp->v_sectorsz = fjp->fj_chars->fdc_sec_size;
1855 xblk = vtocp->v_sectorsz / DEV_BSIZE;
1856 }
1857 vtocp->v_nparts = 3; /* <= NDKMAP; */
1858
1859 /*
1860 * Copy partitioning information.
1861 */
1862 bcopy(fdp->d_part, vtocp->v_part, sizeof (struct partition) * NDKMAP);
1863 for (i = NDKMAP, vpart = vtocp->v_part; i && (xblk > 1); i--, vpart++) {
1864 /* correct partition info if sector size > 512 bytes */
1865 vpart->p_start /= xblk;
1866 vpart->p_size /= xblk;
1867 }
1868
1869 bcopy(fdp->d_vtoc_timestamp,
1870 vtocp->timestamp, sizeof (fdp->d_vtoc_timestamp));
1871 bcopy(fdp->d_vtoc_asciilabel, vtocp->v_asciilabel, LEN_DKL_ASCII);
1872 }
1873
1874
1875 static int
fd_build_label_vtoc(struct fcu_obj * fjp,struct fdisk * fdp,struct vtoc * vtocp,struct dk_label * labelp)1876 fd_build_label_vtoc(struct fcu_obj *fjp, struct fdisk *fdp, struct vtoc *vtocp,
1877 struct dk_label *labelp)
1878 {
1879 struct partition *vpart;
1880 int i;
1881 int nblks;
1882 int ncyl;
1883 ushort_t sum, *sp;
1884
1885
1886 /*
1887 * Sanity-check the vtoc
1888 */
1889 if (vtocp->v_sanity != VTOC_SANE ||
1890 vtocp->v_nparts > NDKMAP || vtocp->v_nparts <= 0) {
1891 FDERRPRINT(FDEP_L3, FDEM_IOCT,
1892 (CE_WARN, "fd_build_label: sanity check on vtoc failed"));
1893 return (EINVAL);
1894 }
1895
1896 /*
1897 * before copying the vtoc, the partition information in it should be
1898 * checked against the information the driver already has on the
1899 * diskette.
1900 */
1901
1902 nblks = (fjp->fj_chars->fdc_nhead * fjp->fj_chars->fdc_secptrack *
1903 fjp->fj_chars->fdc_sec_size) / DEV_BSIZE;
1904 if (nblks == 0 || fjp->fj_chars->fdc_ncyl == 0)
1905 return (EFAULT);
1906 vpart = vtocp->v_part;
1907
1908 /*
1909 * Check the partition information in the vtoc. The starting sectors
1910 * must lie along cylinder boundaries. (NDKMAP entries are checked
1911 * to ensure that the unused entries are set to 0 if vtoc->v_nparts
1912 * is less than NDKMAP)
1913 */
1914 for (i = NDKMAP; i; i--) {
1915 if ((vpart->p_start % nblks) != 0) {
1916 return (EINVAL);
1917 }
1918 ncyl = vpart->p_start / nblks;
1919 ncyl += vpart->p_size / nblks;
1920 if ((vpart->p_size % nblks) != 0)
1921 ncyl++;
1922 if (ncyl > (long)fjp->fj_chars->fdc_ncyl) {
1923 return (EINVAL);
1924 }
1925 vpart++;
1926 }
1927
1928
1929 bcopy(vtocp->v_bootinfo, fdp->d_vtoc_bootinfo,
1930 sizeof (vtocp->v_bootinfo));
1931 fdp->d_vtoc_version = vtocp->v_version;
1932 bcopy(vtocp->v_volume, fdp->d_vtoc_volume, LEN_DKL_VVOL);
1933
1934 /*
1935 * Copy partitioning information.
1936 */
1937 bcopy(vtocp->v_part, fdp->d_part, sizeof (struct partition) * NDKMAP);
1938 bcopy(vtocp->timestamp, fdp->d_vtoc_timestamp,
1939 sizeof (fdp->d_vtoc_timestamp));
1940 bcopy(vtocp->v_asciilabel, fdp->d_vtoc_asciilabel, LEN_DKL_ASCII);
1941
1942 /*
1943 * construct the diskette label in supplied buffer
1944 */
1945
1946 /* Put appropriate vtoc structure fields into the disk label */
1947 labelp->dkl_vtoc.v_bootinfo[0] = (uint32_t)vtocp->v_bootinfo[0];
1948 labelp->dkl_vtoc.v_bootinfo[1] = (uint32_t)vtocp->v_bootinfo[1];
1949 labelp->dkl_vtoc.v_bootinfo[2] = (uint32_t)vtocp->v_bootinfo[2];
1950
1951 labelp->dkl_vtoc.v_sanity = vtocp->v_sanity;
1952 labelp->dkl_vtoc.v_version = vtocp->v_version;
1953
1954 bcopy(vtocp->v_volume, labelp->dkl_vtoc.v_volume, LEN_DKL_VVOL);
1955
1956 labelp->dkl_vtoc.v_nparts = vtocp->v_nparts;
1957
1958 bcopy(vtocp->v_reserved, labelp->dkl_vtoc.v_reserved,
1959 sizeof (labelp->dkl_vtoc.v_reserved));
1960
1961 for (i = 0; i < (int)vtocp->v_nparts; i++) {
1962 labelp->dkl_vtoc.v_part[i].p_tag = vtocp->v_part[i].p_tag;
1963 labelp->dkl_vtoc.v_part[i].p_flag = vtocp->v_part[i].p_flag;
1964 labelp->dkl_vtoc.v_part[i].p_start = vtocp->v_part[i].p_start;
1965 labelp->dkl_vtoc.v_part[i].p_size = vtocp->v_part[i].p_size;
1966 }
1967
1968 for (i = 0; i < NDKMAP; i++) {
1969 labelp->dkl_vtoc.v_timestamp[i] = vtocp->timestamp[i];
1970 }
1971 bcopy(vtocp->v_asciilabel, labelp->dkl_asciilabel, LEN_DKL_ASCII);
1972
1973
1974 labelp->dkl_pcyl = fjp->fj_chars->fdc_ncyl;
1975 labelp->dkl_ncyl = fjp->fj_chars->fdc_ncyl;
1976 labelp->dkl_nhead = fjp->fj_chars->fdc_nhead;
1977 /*
1978 * The fdc_secptrack field of the fd_char structure is the number
1979 * of sectors per track where the sectors are fdc_sec_size.
1980 * The dkl_nsect field of the dk_label structure is the number of
1981 * DEV_BSIZE (512) byte sectors per track.
1982 */
1983 labelp->dkl_nsect = (fjp->fj_chars->fdc_secptrack *
1984 fjp->fj_chars->fdc_sec_size) / DEV_BSIZE;
1985 labelp->dkl_intrlv = fjp->fj_attr->fda_intrlv;
1986 labelp->dkl_rpm = fjp->fj_attr->fda_rotatespd;
1987 labelp->dkl_read_reinstruct =
1988 (int)(labelp->dkl_nsect * labelp->dkl_rpm * 4) / 60000;
1989 labelp->dkl_write_reinstruct = labelp->dkl_read_reinstruct;
1990
1991 labelp->dkl_magic = DKL_MAGIC;
1992
1993 sum = 0;
1994 labelp->dkl_cksum = 0;
1995 sp = (ushort_t *)labelp;
1996 while (sp < &(labelp->dkl_cksum)) {
1997 sum ^= *sp++;
1998 }
1999 labelp->dkl_cksum = sum;
2000
2001 return (0);
2002 }
2003
2004 static int
fd_rawioctl(struct fcu_obj * fjp,int unit,caddr_t arg,int mode)2005 fd_rawioctl(struct fcu_obj *fjp, int unit, caddr_t arg, int mode)
2006 {
2007 struct fd_raw fdr;
2008 char *arg_result = NULL;
2009 int flag = B_READ;
2010 int rval = 0;
2011 caddr_t uaddr;
2012 uint_t ucount;
2013
2014 FDERRPRINT(FDEP_L1, FDEM_RAWI,
2015 (CE_CONT, "fd_rawioctl: cmd[0]=0x%x\n", fdr.fdr_cmd[0]));
2016
2017 if (fjp->fj_chars->fdc_medium != 3 && fjp->fj_chars->fdc_medium != 5) {
2018 cmn_err(CE_CONT, "fd_rawioctl: Medium density not supported\n");
2019 return (ENXIO);
2020 }
2021
2022 #ifdef _MULTI_DATAMODEL
2023 switch (ddi_model_convert_from(mode & FMODELS)) {
2024 case DDI_MODEL_ILP32:
2025 {
2026 struct fd_raw32 fdr32;
2027
2028 if (ddi_copyin(arg, &fdr32, sizeof (fdr32), mode))
2029 return (EFAULT);
2030
2031 bcopy(fdr32.fdr_cmd, fdr.fdr_cmd, sizeof (fdr.fdr_cmd));
2032 fdr.fdr_cnum = fdr32.fdr_cnum;
2033 fdr.fdr_nbytes = fdr32.fdr_nbytes;
2034 fdr.fdr_addr = (caddr_t)(uintptr_t)fdr32.fdr_addr;
2035 arg_result = ((struct fd_raw32 *)arg)->fdr_result;
2036
2037 break;
2038 }
2039 case DDI_MODEL_NONE:
2040 #endif /* ! _MULTI_DATAMODEL */
2041
2042 if (ddi_copyin(arg, &fdr, sizeof (fdr), mode))
2043 return (EFAULT);
2044
2045 arg_result = ((struct fd_raw *)arg)->fdr_result;
2046
2047 #ifdef _MULTI_DATAMODEL
2048 break;
2049 }
2050 #endif /* _MULTI_DATAMODEL */
2051
2052
2053
2054 /*
2055 * copy user address & nbytes from raw_req so that we can
2056 * put kernel address in req structure
2057 */
2058 uaddr = fdr.fdr_addr;
2059 ucount = (uint_t)fdr.fdr_nbytes;
2060 unit &= 3;
2061
2062 switch (fdr.fdr_cmd[0] & 0x0f) {
2063
2064 case FDRAW_FORMAT:
2065 ucount += 16;
2066 fdr.fdr_addr = kmem_zalloc(ucount, KM_SLEEP);
2067 if (ddi_copyin(uaddr, fdr.fdr_addr,
2068 (size_t)fdr.fdr_nbytes, mode)) {
2069 kmem_free(fdr.fdr_addr, ucount);
2070 return (EFAULT);
2071 }
2072 if ((*fdr.fdr_addr | fdr.fdr_addr[1]) == 0)
2073 fjp->fj_flags &= ~(FUNIT_LABELOK | FUNIT_UNLABELED);
2074 flag = B_WRITE;
2075 fdr.fdr_cmd[1] = (fdr.fdr_cmd[1] & ~3) | unit;
2076 break;
2077
2078 case FDRAW_WRCMD:
2079 case FDRAW_WRITEDEL:
2080 flag = B_WRITE;
2081 /* FALLTHROUGH */
2082 case FDRAW_RDCMD:
2083 case FDRAW_READDEL:
2084 case FDRAW_READTRACK:
2085 if (ucount) {
2086 /*
2087 * In SunOS 4.X, we used to as_fault things in.
2088 * We really cannot do this in 5.0/SVr4. Unless
2089 * someone really believes that speed is of the
2090 * essence here, it is just much simpler to do
2091 * this in kernel space and use copyin/copyout.
2092 */
2093 fdr.fdr_addr = kmem_alloc((size_t)ucount, KM_SLEEP);
2094 if (flag == B_WRITE) {
2095 if (ddi_copyin(uaddr, fdr.fdr_addr, ucount,
2096 mode)) {
2097 kmem_free(fdr.fdr_addr, ucount);
2098 return (EFAULT);
2099 }
2100 }
2101 } else
2102 return (EINVAL);
2103 fdr.fdr_cmd[1] = (fdr.fdr_cmd[1] & ~3) | unit;
2104 break;
2105
2106 case FDRAW_READID:
2107 case FDRAW_REZERO:
2108 case FDRAW_SEEK:
2109 case FDRAW_SENSE_DRV:
2110 ucount = 0;
2111 fdr.fdr_cmd[1] = (fdr.fdr_cmd[1] & ~3) | unit;
2112 break;
2113
2114 case FDRAW_SPECIFY:
2115 fdr.fdr_cmd[2] &= 0xfe; /* keep NoDMA bit clear */
2116 /* FALLTHROUGH */
2117 case FDRAW_SENSE_INT:
2118 ucount = 0;
2119 break;
2120
2121 default:
2122 return (EINVAL);
2123 }
2124
2125 /*
2126 * Note that we ignore any error returns from controller
2127 * This is the way the driver has been, and it may be
2128 * that the raw ioctl senders simply don't want to
2129 * see any errors returned in this fashion.
2130 */
2131
2132 fjp->fj_ops->fco_select(fjp, unit, 1);
2133 rval = fjp->fj_ops->fco_rwioctl(fjp, unit, (caddr_t)&fdr);
2134
2135 if (ucount && flag == B_READ && rval == 0) {
2136 if (ddi_copyout(fdr.fdr_addr, uaddr, ucount, mode)) {
2137 rval = EFAULT;
2138 }
2139 }
2140 if (ddi_copyout(fdr.fdr_result, arg_result, sizeof (fdr.fdr_cmd), mode))
2141 rval = EFAULT;
2142
2143 fjp->fj_ops->fco_select(fjp, unit, 0);
2144 if (ucount)
2145 kmem_free(fdr.fdr_addr, ucount);
2146
2147 return (rval);
2148 }
2149
2150 /*
2151 * property operation routine. return the number of blocks for the partition
2152 * in question or forward the request to the property facilities.
2153 */
2154 static int
fd_prop_op(dev_t dev,dev_info_t * dip,ddi_prop_op_t prop_op,int mod_flags,char * name,caddr_t valuep,int * lengthp)2155 fd_prop_op(dev_t dev, dev_info_t *dip, ddi_prop_op_t prop_op, int mod_flags,
2156 char *name, caddr_t valuep, int *lengthp)
2157 {
2158 struct fcu_obj *fjp = NULL;
2159 struct fdisk *fdp = NULL;
2160 uint64_t nblocks64;
2161
2162 FDERRPRINT(FDEP_L1, FDEM_PROP,
2163 (CE_CONT, "fd_prop_op: dip %p %s\n", (void *)dip, name));
2164
2165 /*
2166 * Our dynamic properties are all device specific and size oriented.
2167 * Requests issued under conditions where size is valid are passed
2168 * to ddi_prop_op_nblocks with the size information, otherwise the
2169 * request is passed to ddi_prop_op.
2170 */
2171 if (dev == DDI_DEV_T_ANY) {
2172 pass: return (ddi_prop_op(dev, dip, prop_op, mod_flags,
2173 name, valuep, lengthp));
2174 } else {
2175 /*
2176 * Ignoring return value because success is checked by
2177 * verifying fjp and fdp and returned unit value is not used.
2178 */
2179 (void) fd_getdrive(dev, &fjp, &fdp);
2180 if (!fjp || !fdp)
2181 goto pass;
2182
2183 /* get nblocks value */
2184 nblocks64 = (ulong_t)fdp->d_part[PARTITION(dev)].p_size;
2185
2186 return (ddi_prop_op_nblocks(dev, dip, prop_op, mod_flags,
2187 name, valuep, lengthp, nblocks64));
2188 }
2189 }
2190
2191 static void
fd_media_watch(void * arg)2192 fd_media_watch(void *arg)
2193 {
2194 struct fcu_obj *fjp;
2195 struct fdisk *fdp;
2196
2197 #ifdef DEBUG
2198 int unit;
2199 #define DEBUG_ASSIGN unit=
2200 #else
2201 #define DEBUG_ASSIGN (void)
2202 #endif
2203 DEBUG_ASSIGN fd_getdrive((dev_t)arg, &fjp, &fdp);
2204 /*
2205 * Ignoring return in non DEBUG mode because device exist.
2206 * Returned unit value is not used.
2207 */
2208
2209 FDERRPRINT(FDEP_L0, FDEM_IOCT,
2210 (CE_CONT, "fd_media_watch unit %d\n", unit));
2211
2212 /*
2213 * fd_get_media_state() cannot be called from this timeout function
2214 * because the floppy drive has to be selected first, and that could
2215 * force this function to sleep (while waiting for the select
2216 * semaphore).
2217 * Instead, just wakeup up driver.
2218 */
2219 mutex_enter(&fjp->fj_lock);
2220 cv_broadcast(&fdp->d_statecv);
2221 mutex_exit(&fjp->fj_lock);
2222 }
2223
2224 enum dkio_state
fd_get_media_state(struct fcu_obj * fjp,int unit)2225 fd_get_media_state(struct fcu_obj *fjp, int unit)
2226 {
2227 enum dkio_state state;
2228
2229 if (fjp->fj_ops->fco_getchng(fjp, unit)) {
2230 /* recheck disk only if DSKCHG "high" */
2231 fjp->fj_ops->fco_resetchng(fjp, unit);
2232 if (fjp->fj_ops->fco_getchng(fjp, unit)) {
2233 if (fjp->fj_flags & FUNIT_CHGDET) {
2234 /*
2235 * again no diskette; not a new change
2236 */
2237 state = DKIO_NONE;
2238 } else {
2239 /*
2240 * a new change; diskette was ejected
2241 */
2242 fjp->fj_flags |= FUNIT_CHGDET;
2243 state = DKIO_EJECTED;
2244 }
2245 } else {
2246 fjp->fj_flags &= ~FUNIT_CHGDET;
2247 state = DKIO_INSERTED;
2248 }
2249 } else {
2250 fjp->fj_flags &= ~FUNIT_CHGDET;
2251 state = DKIO_INSERTED;
2252 }
2253 FDERRPRINT(FDEP_L0, FDEM_IOCT,
2254 (CE_CONT, "fd_get_media_state unit %d: state %x\n", unit, state));
2255 return (state);
2256 }
2257
2258 static int
fd_check_media(dev_t dev,enum dkio_state state)2259 fd_check_media(dev_t dev, enum dkio_state state)
2260 {
2261 struct fcu_obj *fjp;
2262 struct fdisk *fdp;
2263 int unit;
2264 int err;
2265
2266 unit = fd_getdrive(dev, &fjp, &fdp);
2267
2268 mutex_enter(&fjp->fj_lock);
2269
2270 fjp->fj_ops->fco_select(fjp, unit, 1);
2271 fdp->d_media_state = fd_get_media_state(fjp, unit);
2272 fdp->d_media_timeout = drv_usectohz(fd_check_media_time);
2273
2274 while (fdp->d_media_state == state) {
2275 /* release the controller and drive */
2276 fjp->fj_ops->fco_select(fjp, unit, 0);
2277
2278 /* turn on timer */
2279 fdp->d_media_timeout_id = timeout(fd_media_watch,
2280 (void *)dev, fdp->d_media_timeout);
2281
2282 if (cv_wait_sig(&fdp->d_statecv, &fjp->fj_lock) == 0) {
2283 fdp->d_media_timeout = 0;
2284 mutex_exit(&fjp->fj_lock);
2285 return (EINTR);
2286 }
2287 fjp->fj_ops->fco_select(fjp, unit, 1);
2288 fdp->d_media_state = fd_get_media_state(fjp, unit);
2289 }
2290
2291 if (fdp->d_media_state == DKIO_INSERTED) {
2292 err = fdgetlabel(fjp, unit);
2293 if (err) {
2294 fjp->fj_ops->fco_select(fjp, unit, 0);
2295 mutex_exit(&fjp->fj_lock);
2296 return (EIO);
2297 }
2298 }
2299 fjp->fj_ops->fco_select(fjp, unit, 0);
2300 mutex_exit(&fjp->fj_lock);
2301 return (0);
2302 }
2303
2304 /*
2305 * fd_get_media_info :
2306 * Collects medium information for
2307 * DKIOCGMEDIAINFO ioctl.
2308 */
2309
2310 static int
fd_get_media_info(struct fcu_obj * fjp,caddr_t buf,int flag)2311 fd_get_media_info(struct fcu_obj *fjp, caddr_t buf, int flag)
2312 {
2313 struct dk_minfo media_info;
2314 int err = 0;
2315
2316 media_info.dki_media_type = DK_FLOPPY;
2317 media_info.dki_lbsize = fjp->fj_chars->fdc_sec_size;
2318 media_info.dki_capacity = fjp->fj_chars->fdc_ncyl *
2319 fjp->fj_chars->fdc_secptrack * fjp->fj_chars->fdc_nhead;
2320
2321 if (ddi_copyout(&media_info, buf, sizeof (struct dk_minfo), flag))
2322 err = EFAULT;
2323 return (err);
2324 }
2325