xref: /netbsd-src/sys/dev/qbus/rf.c (revision b5677b36047b601b9addaaa494a58ceae82c2a6c)
1 /*	$NetBSD: rf.c,v 1.24 2009/01/22 17:34:22 cegger Exp $	*/
2 /*
3  * Copyright (c) 2002 Jochen Kunz.
4  * All rights reserved.
5  *
6  * Redistribution and use in source and binary forms, with or without
7  * modification, are permitted provided that the following conditions
8  * are met:
9  * 1. Redistributions of source code must retain the above copyright
10  *    notice, this list of conditions and the following disclaimer.
11  * 2. Redistributions in binary form must reproduce the above copyright
12  *    notice, this list of conditions and the following disclaimer in the
13  *    documentation and/or other materials provided with the distribution.
14  * 3. The name of Jochen Kunz may not be used to endorse or promote
15  *    products derived from this software without specific prior
16  *    written permission.
17  *
18  * THIS SOFTWARE IS PROVIDED BY JOCHEN KUNZ
19  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
20  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
21  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL JOCHEN KUNZ
22  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
28  * POSSIBILITY OF SUCH DAMAGE.
29  */
30 
31 /*
32 TODO:
33 - Better LBN bound checking, block padding for SD disks.
34 - Formatting / "Set Density"
35 - Better error handling / detailed error reason reportnig.
36 */
37 
38 #include <sys/cdefs.h>
39 __KERNEL_RCSID(0, "$NetBSD: rf.c,v 1.24 2009/01/22 17:34:22 cegger Exp $");
40 
41 /* autoconfig stuff */
42 #include <sys/param.h>
43 #include <sys/device.h>
44 #include <sys/conf.h>
45 #include "locators.h"
46 #include "ioconf.h"
47 
48 /* bus_space / bus_dma */
49 #include <sys/bus.h>
50 
51 /* UniBus / QBus specific stuff */
52 #include <dev/qbus/ubavar.h>
53 
54 /* disk interface */
55 #include <sys/types.h>
56 #include <sys/disklabel.h>
57 #include <sys/disk.h>
58 
59 /* general system data and functions */
60 #include <sys/systm.h>
61 #include <sys/ioctl.h>
62 #include <sys/ioccom.h>
63 
64 /* physio / buffer handling */
65 #include <sys/buf.h>
66 #include <sys/bufq.h>
67 
68 /* tsleep / sleep / wakeup */
69 #include <sys/proc.h>
70 /* hz for above */
71 #include <sys/kernel.h>
72 
73 /* bitdefinitions for RX211 */
74 #include <dev/qbus/rfreg.h>
75 
76 
77 #define	RFS_DENS	0x0001		/* single or double density */
78 #define	RFS_AD		0x0002		/* density auto detect */
79 #define	RFS_NOTINIT	0x0000		/* not initialized */
80 #define	RFS_PROBING	0x0010		/* density detect / verify started */
81 #define	RFS_FBUF	0x0020		/* Fill Buffer */
82 #define	RFS_EBUF	0x0030		/* Empty Buffer */
83 #define	RFS_WSEC	0x0040		/* Write Sector */
84 #define	RFS_RSEC	0x0050		/* Read Sector */
85 #define	RFS_SMD		0x0060		/* Set Media Density */
86 #define	RFS_RSTAT	0x0070		/* Read Status */
87 #define	RFS_WDDS	0x0080		/* Write Deleted Data Sector */
88 #define	RFS_REC		0x0090		/* Read Error Code */
89 #define	RFS_IDLE	0x00a0		/* controller is idle */
90 #define	RFS_CMDS	0x00f0		/* command mask */
91 #define	RFS_OPEN_A	0x0100		/* partition a open */
92 #define	RFS_OPEN_B	0x0200		/* partition b open */
93 #define	RFS_OPEN_C	0x0400		/* partition c open */
94 #define	RFS_OPEN_MASK	0x0f00		/* mask for open partitions */
95 #define RFS_OPEN_SHIFT	8		/* to shift 1 to get RFS_OPEN_A */
96 #define	RFS_SETCMD(rf, state)	((rf) = ((rf) & ~RFS_CMDS) | (state))
97 
98 
99 
100 /* autoconfig stuff */
101 static int rfc_match(device_t, cfdata_t, void *);
102 static void rfc_attach(device_t, device_t, void *);
103 static int rf_match(device_t, cfdata_t, void *);
104 static void rf_attach(device_t, device_t, void *);
105 static int rf_print(void *, const char *);
106 
107 /* device interface functions / interface to disk(9) */
108 dev_type_open(rfopen);
109 dev_type_close(rfclose);
110 dev_type_read(rfread);
111 dev_type_write(rfwrite);
112 dev_type_ioctl(rfioctl);
113 dev_type_strategy(rfstrategy);
114 dev_type_dump(rfdump);
115 dev_type_size(rfsize);
116 
117 
118 /* Entries in block and character major device number switch table. */
119 const struct bdevsw rf_bdevsw = {
120 	rfopen,
121 	rfclose,
122 	rfstrategy,
123 	rfioctl,
124 	rfdump,
125 	rfsize,
126 	D_DISK
127 };
128 
129 const struct cdevsw rf_cdevsw = {
130 	rfopen,
131 	rfclose,
132 	rfread,
133 	rfwrite,
134 	rfioctl,
135 	nostop,
136 	notty,
137 	nopoll,
138 	nommap,
139 	nokqfilter,
140 	D_DISK
141 };
142 
143 
144 
145 struct rfc_softc {
146 	device_t sc_dev;		/* common device data */
147 	device_t sc_childs[2];		/* child devices */
148 	struct evcnt sc_intr_count;	/* Interrupt counter for statistics */
149 	struct buf *sc_curbuf;		/* buf that is currently in work */
150 	bus_space_tag_t sc_iot;		/* bus_space I/O tag */
151 	bus_space_handle_t sc_ioh;	/* bus_space I/O handle */
152 	bus_dma_tag_t sc_dmat;		/* bus_dma DMA tag */
153 	bus_dmamap_t sc_dmam;		/* bus_dma DMA map */
154 	void *sc_bufidx;		/* current position in buffer data */
155 	int sc_curchild;		/* child whos bufq is in work */
156 	int sc_bytesleft;		/* bytes left to transfer */
157 	u_int8_t type;			/* controller type, 1 or 2 */
158 };
159 
160 
161 
162 CFATTACH_DECL_NEW(
163 	rfc,
164 	sizeof(struct rfc_softc),
165 	rfc_match,
166 	rfc_attach,
167 	NULL,
168 	NULL
169 );
170 
171 
172 
173 struct rf_softc {
174 	device_t sc_dev;		/* common device data */
175 	struct disk sc_disk;		/* common disk device data */
176 	struct rfc_softc *sc_rfc;	/* our parent */
177 	struct bufq_state *sc_bufq;	/* queue of pending transfers */
178 	int sc_state;			/* state of drive */
179 	u_int8_t sc_dnum;		/* drive number, 0 or 1 */
180 };
181 
182 
183 
184 CFATTACH_DECL_NEW(
185 	rf,
186 	sizeof(struct rf_softc),
187 	rf_match,
188 	rf_attach,
189 	NULL,
190 	NULL
191 );
192 
193 
194 
195 struct rfc_attach_args {
196 	u_int8_t type;		/* controller type, 1 or 2 */
197 	u_int8_t dnum;		/* drive number, 0 or 1 */
198 };
199 
200 
201 
202 const struct dkdriver rfdkdriver = {
203 	rfstrategy
204 };
205 
206 
207 
208 /* helper functions */
209 int rfc_sendcmd(struct rfc_softc *, int, int, int);
210 struct rf_softc* get_new_buf( struct rfc_softc *);
211 static void rfc_intr(void *);
212 
213 
214 
215 /*
216  * Issue a reset command to the controller and look for the bits in
217  * RX2CS and RX2ES.
218  * RX2CS_RX02 and / or RX2CS_DD can be set,
219  * RX2ES has to be set, all other bits must be 0
220  */
221 int
222 rfc_match(device_t parent, cfdata_t match, void *aux)
223 {
224 	struct uba_attach_args *ua = aux;
225 	int i;
226 
227 	/* Issue reset command. */
228 	bus_space_write_2(ua->ua_iot, ua->ua_ioh, RX2CS, RX2CS_INIT);
229 	/* Wait for the controller to become ready, that is when
230 	 * RX2CS_DONE, RX2ES_RDY and RX2ES_ID are set. */
231 	for (i = 0 ; i < 20 ; i++) {
232 		if ((bus_space_read_2(ua->ua_iot, ua->ua_ioh, RX2CS)
233 		    & RX2CS_DONE) != 0
234 		    && (bus_space_read_2(ua->ua_iot, ua->ua_ioh, RX2ES)
235 		    & (RX2ES_RDY | RX2ES_ID)) != 0)
236 			break;
237 		DELAY(100000);	/* wait 100ms */
238 	}
239 	/*
240 	 * Give up if the timeout has elapsed
241 	 * and the controller is not ready.
242 	 */
243 	if (i >= 20)
244 		return(0);
245 	/*
246 	 * Issue a Read Status command with interrupt enabled.
247 	 * The uba(4) driver wants to catch the interrupt to get the
248 	 * interrupt vector and level of the device
249 	 */
250 	bus_space_write_2(ua->ua_iot, ua->ua_ioh, RX2CS,
251 	    RX2CS_RSTAT | RX2CS_IE);
252 	/*
253 	 * Wait for command to finish, ignore errors and
254 	 * abort if the controller does not respond within the timeout
255 	 */
256 	for (i = 0 ; i < 20 ; i++) {
257 		if ((bus_space_read_2(ua->ua_iot, ua->ua_ioh, RX2CS)
258 		    & (RX2CS_DONE | RX2CS_IE)) != 0
259 		    && (bus_space_read_2(ua->ua_iot, ua->ua_ioh, RX2ES)
260 		    & RX2ES_RDY) != 0 )
261 			return(1);
262 		DELAY(100000);	/* wait 100ms */
263 	}
264 	return(0);
265 }
266 
267 
268 
269 /* #define RX02_PROBE 1 */
270 #ifdef RX02_PROBE
271 /*
272  * Probe the density of an inserted floppy disk.
273  * This is done by reading a sector from disk.
274  * Return -1 on error, 0 on SD and 1 on DD.
275  */
276 int rfcprobedens(struct rfc_softc *, int);
277 int
278 rfcprobedens(struct rfc_softc *rfc_sc, int dnum)
279 {
280 	int dens_flag;
281 	int i;
282 
283 	dens_flag = 0;
284 	do {
285 		bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS,
286 		    RX2CS_RSEC | (dens_flag == 0 ? 0 : RX2CS_DD)
287 		    | (dnum == 0 ? 0 : RX2CS_US));
288 		/*
289 		 * Transfer request set?
290 		 * Wait 50us, the controller needs this time to setle
291 		 */
292 		DELAY(50);
293 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
294 		    & RX2CS_TR) == 0) {
295 			printf("%s: did not respond to Read Sector CMD(1)\n",
296 			    device_xname(rfc_sc->sc_dev));
297 			return(-1);
298 		}
299 		bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2SA, 1);
300 		/* Wait 50us, the controller needs this time to setle */
301 		DELAY(50);
302 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
303 		    & RX2CS_TR) == 0) {
304 			printf("%s: did not respond to Read Sector CMD(2)\n",
305 			    device_xname(rfc_sc->sc_dev));
306 			return(-1);
307 		}
308 		bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2TA, 1);
309 		/* Wait for the command to finish */
310 		for (i = 0 ; i < 200 ; i++) {
311 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
312 			    RX2CS) & RX2CS_DONE) != 0)
313 				break;
314 			DELAY(10000);	/* wait 10ms */
315 		}
316 		if (i >= 200) {
317 			printf("%s: did not respond to Read Sector CMD(3)\n",
318 			    device_xname(rfc_sc->sc_dev));
319 			return(-1);
320 		}
321 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
322 		    & RX2CS_ERR) == 0)
323 			return(dens_flag);
324 	} while (rfc_sc->type == 2 && dens_flag++ == 0);
325 	return(-1);
326 }
327 #endif /* RX02_PROBE */
328 
329 
330 
331 void
332 rfc_attach(device_t parent, device_t self, void *aux)
333 {
334 	struct rfc_softc *rfc_sc = device_private(self);
335 	struct uba_attach_args *ua = aux;
336 	struct rfc_attach_args rfc_aa;
337 	int i;
338 
339 	rfc_sc->sc_dev = self;
340 	rfc_sc->sc_iot = ua->ua_iot;
341 	rfc_sc->sc_ioh = ua->ua_ioh;
342 	rfc_sc->sc_dmat = ua->ua_dmat;
343 	rfc_sc->sc_curbuf = NULL;
344 	/* Tell the QBus busdriver about our interrupt handler. */
345 	uba_intr_establish(ua->ua_icookie, ua->ua_cvec, rfc_intr, rfc_sc,
346 	    &rfc_sc->sc_intr_count);
347 	/* Attach to the interrupt counter, see evcnt(9) */
348 	evcnt_attach_dynamic(&rfc_sc->sc_intr_count, EVCNT_TYPE_INTR,
349 	    ua->ua_evcnt, device_xname(rfc_sc->sc_dev), "intr");
350 	/* get a bus_dma(9) handle */
351 	i = bus_dmamap_create(rfc_sc->sc_dmat, RX2_BYTE_DD, 1, RX2_BYTE_DD, 0,
352 	    BUS_DMA_ALLOCNOW, &rfc_sc->sc_dmam);
353 	if (i != 0) {
354 		printf("rfc_attach: Error creating bus dma map: %d\n", i);
355 		return;
356 	}
357 
358 	/* Issue reset command. */
359 	bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS, RX2CS_INIT);
360 	/*
361 	 * Wait for the controller to become ready, that is when
362 	 * RX2CS_DONE, RX2ES_RDY and RX2ES_ID are set.
363 	 */
364 	for (i = 0 ; i < 20 ; i++) {
365 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
366 		    & RX2CS_DONE) != 0
367 		    && (bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2ES)
368 		    & (RX2ES_RDY | RX2ES_ID)) != 0)
369 			break;
370 		DELAY(100000);	/* wait 100ms */
371 	}
372 	/*
373 	 * Give up if the timeout has elapsed
374 	 * and the controller is not ready.
375 	 */
376 	if (i >= 20) {
377 		printf(": did not respond to INIT CMD\n");
378 		return;
379 	}
380 	/* Is ths a RX01 or a RX02? */
381 	if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
382 	    & RX2CS_RX02) != 0) {
383 		rfc_sc->type = 2;
384 		rfc_aa.type = 2;
385 	} else {
386 		rfc_sc->type = 1;
387 		rfc_aa.type = 1;
388 	}
389 	printf(": RX0%d\n", rfc_sc->type);
390 
391 #ifndef RX02_PROBE
392 	/*
393 	 * Bouth disk drievs and the controller are one physical unit.
394 	 * If we found the controller, there will be bouth disk drievs.
395 	 * So attach them.
396 	 */
397 	rfc_aa.dnum = 0;
398 	rfc_sc->sc_childs[0] = config_found(rfc_sc->sc_dev, &rfc_aa, rf_print);
399 	rfc_aa.dnum = 1;
400 	rfc_sc->sc_childs[1] = config_found(rfc_sc->sc_dev, &rfc_aa, rf_print);
401 #else /* RX02_PROBE */
402 	/*
403 	 * There are clones of the DEC RX system with standard shugart
404 	 * interface. In this case we can not be sure that there are
405 	 * bouth disk drievs. So we want to do a detection of attached
406 	 * drives. This is done by reading a sector from disk. This means
407 	 * that there must be a formatted disk in the drive at boot time.
408 	 * This is bad, but I did not find another way to detect the
409 	 * (non)existence of a floppy drive.
410 	 */
411 	if (rfcprobedens(rfc_sc, 0) >= 0) {
412 		rfc_aa.dnum = 0;
413 		rfc_sc->sc_childs[0] = config_found(&rfc_sc->sc_dev, &rfc_aa,
414 		    rf_print);
415 	} else
416 		rfc_sc->sc_childs[0] = NULL;
417 	if (rfcprobedens(rfc_sc, 1) >= 0) {
418 		rfc_aa.dnum = 1;
419 		rfc_sc->sc_childs[1] = config_found(&rfc_sc->sc_dev, &rfc_aa,
420 		    rf_print);
421 	} else
422 		rfc_sc->sc_childs[1] = NULL;
423 #endif /* RX02_PROBE */
424 	return;
425 }
426 
427 
428 
429 int
430 rf_match(device_t parent, cfdata_t match, void *aux)
431 {
432 	struct rfc_attach_args *rfc_aa = aux;
433 
434 	/*
435 	 * Only attach if the locator is wildcarded or
436 	 * if the specified locator addresses the current device.
437 	 */
438 	if (match->cf_loc[RFCCF_DRIVE] == RFCCF_DRIVE_DEFAULT ||
439 	    match->cf_loc[RFCCF_DRIVE] == rfc_aa->dnum)
440 		return(1);
441 	return(0);
442 }
443 
444 
445 
446 void
447 rf_attach(device_t parent, device_t self, void *aux)
448 {
449 	struct rf_softc *rf_sc = device_private(self);
450 	struct rfc_softc *rfc_sc = device_private(parent);
451 	struct rfc_attach_args *rfc_aa = (struct rfc_attach_args *)aux;
452 	struct disklabel *dl;
453 
454 	rf_sc->sc_dev = self;
455 	rf_sc->sc_rfc = rfc_sc;
456 	rf_sc->sc_dnum = rfc_aa->dnum;
457 	rf_sc->sc_state = 0;
458 	disk_init(&rf_sc->sc_disk, device_xname(rf_sc->sc_dev), &rfdkdriver);
459 	disk_attach(&rf_sc->sc_disk);
460 	dl = rf_sc->sc_disk.dk_label;
461 	dl->d_type = DTYPE_FLOPPY;		/* drive type */
462 	dl->d_magic = DISKMAGIC;		/* the magic number */
463 	dl->d_magic2 = DISKMAGIC;
464 	dl->d_typename[0] = 'R';
465 	dl->d_typename[1] = 'X';
466 	dl->d_typename[2] = '0';
467 	dl->d_typename[3] = rfc_sc->type == 1 ? '1' : '2';	/* type name */
468 	dl->d_typename[4] = '\0';
469 	dl->d_secsize = DEV_BSIZE;		/* bytes per sector */
470 	/*
471 	 * Fill in some values to have a initialized data structure. Some
472 	 * values will be reset by rfopen() depending on the actual density.
473 	 */
474 	dl->d_nsectors = RX2_SECTORS;		/* sectors per track */
475 	dl->d_ntracks = 1;								/* tracks per cylinder */
476 	dl->d_ncylinders = RX2_TRACKS;		/* cylinders per unit */
477 	dl->d_secpercyl = RX2_SECTORS;		/* sectors per cylinder */
478 	dl->d_secperunit = RX2_SECTORS * RX2_TRACKS;	/* sectors per unit */
479 	dl->d_rpm = 360;			/* rotational speed */
480 	dl->d_interleave = 1;			/* hardware sector interleave */
481 	/* number of partitions in following */
482 	dl->d_npartitions = MAXPARTITIONS;
483 	dl->d_bbsize = 0;		/* size of boot area at sn0, bytes */
484 	dl->d_sbsize = 0;		/* max size of fs superblock, bytes */
485 	/* number of sectors in partition */
486 	dl->d_partitions[0].p_size = 501;
487 	dl->d_partitions[0].p_offset = 0;	/* starting sector */
488 	dl->d_partitions[0].p_fsize = 0;	/* fs basic fragment size */
489 	dl->d_partitions[0].p_fstype = 0;	/* fs type */
490 	dl->d_partitions[0].p_frag = 0;		/* fs fragments per block */
491 	dl->d_partitions[1].p_size = RX2_SECTORS * RX2_TRACKS / 2;
492 	dl->d_partitions[1].p_offset = 0;	/* starting sector */
493 	dl->d_partitions[1].p_fsize = 0;	/* fs basic fragment size */
494 	dl->d_partitions[1].p_fstype = 0;	/* fs type */
495 	dl->d_partitions[1].p_frag = 0;		/* fs fragments per block */
496 	dl->d_partitions[2].p_size = RX2_SECTORS * RX2_TRACKS;
497 	dl->d_partitions[2].p_offset = 0;	/* starting sector */
498 	dl->d_partitions[2].p_fsize = 0;	/* fs basic fragment size */
499 	dl->d_partitions[2].p_fstype = 0;	/* fs type */
500 	dl->d_partitions[2].p_frag = 0;		/* fs fragments per block */
501 	bufq_alloc(&rf_sc->sc_bufq, "disksort", BUFQ_SORT_CYLINDER);
502 	printf("\n");
503 	return;
504 }
505 
506 
507 
508 int
509 rf_print(void *aux, const char *name)
510 {
511 	struct rfc_attach_args *rfc_aa = aux;
512 
513 	if (name != NULL)
514 		aprint_normal("RX0%d at %s", rfc_aa->type, name);
515 	aprint_normal(" drive %d", rfc_aa->dnum);
516 	return(UNCONF);
517 }
518 
519 
520 
521 /* Send a command to the controller */
522 int
523 rfc_sendcmd(struct rfc_softc *rfc_sc, int cmd, int data1, int data2)
524 {
525 
526 	/* Write command to CSR. */
527 	bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS, cmd);
528 	/* Wait 50us, the controller needs this time to setle. */
529 	DELAY(50);
530 	/* Write parameter 1 to DBR */
531 	if ((cmd & RX2CS_FC) != RX2CS_RSTAT) {
532 		/* Transfer request set? */
533 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
534 		    & RX2CS_TR) == 0) {
535 			printf("%s: did not respond to CMD %x (1)\n",
536 			    device_xname(rfc_sc->sc_dev), cmd);
537 			return(-1);
538 		}
539 		bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2DB,
540 		    data1);
541 	}
542 	/* Write parameter 2 to DBR */
543 	if ((cmd & RX2CS_FC) <= RX2CS_RSEC || (cmd & RX2CS_FC) == RX2CS_WDDS) {
544 		/* Wait 50us, the controller needs this time to setle. */
545 		DELAY(50);
546 		/* Transfer request set? */
547 		if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2CS)
548 		    & RX2CS_TR) == 0) {
549 			printf("%s: did not respond to CMD %x (2)\n",
550 			    device_xname(rfc_sc->sc_dev), cmd);
551 			return(-1);
552 		}
553 		bus_space_write_2(rfc_sc->sc_iot, rfc_sc->sc_ioh, RX2DB,
554 		    data2);
555 	}
556 	return(1);
557 }
558 
559 
560 
561 void
562 rfstrategy(struct buf *buf)
563 {
564 	struct rf_softc *rf_sc;
565 	struct rfc_softc *rfc_sc;
566 	int s;
567 
568 	if ((rf_sc = device_lookup_private(&rf_cd, DISKUNIT(buf->b_dev))) == NULL) {
569 		buf->b_error = ENXIO;
570 		biodone(buf);
571 		return;
572 	}
573 	rfc_sc = rf_sc->sc_rfc;
574 	/* We are going to operate on a non-open dev? PANIC! */
575 	if ((rf_sc->sc_state & (1 << (DISKPART(buf->b_dev) + RFS_OPEN_SHIFT)))
576 	    == 0)
577 		panic("rfstrategy: can not operate on non-open drive %s "
578 		    "partition %"PRIu32, device_xname(rf_sc->sc_dev),
579 		    DISKPART(buf->b_dev));
580 	if (buf->b_bcount == 0) {
581 		biodone(buf);
582 		return;
583 	}
584 	/*
585 	 * bufq_put() operates on b_rawblkno. rfstrategy() gets
586 	 * only b_blkno that is partition relative. As a floppy does not
587 	 * have partitions b_rawblkno == b_blkno.
588 	 */
589 	buf->b_rawblkno = buf->b_blkno;
590 	/*
591 	 * from sys/kern/subr_disk.c:
592 	 * Seek sort for disks.  We depend on the driver which calls us using
593 	 * b_resid as the current cylinder number.
594 	 */
595 	s = splbio();
596 	if (rfc_sc->sc_curbuf == NULL) {
597 		rfc_sc->sc_curchild = rf_sc->sc_dnum;
598 		rfc_sc->sc_curbuf = buf;
599 		rfc_sc->sc_bufidx = buf->b_data;
600 		rfc_sc->sc_bytesleft = buf->b_bcount;
601 		rfc_intr(rfc_sc);
602 	} else {
603 		buf->b_resid = buf->b_blkno / RX2_SECTORS;
604 		bufq_put(rf_sc->sc_bufq, buf);
605 		buf->b_resid = 0;
606 	}
607 	splx(s);
608 }
609 
610 /*
611  * Look if there is another buffer in the bufferqueue of this drive
612  * and start to process it if there is one.
613  * If the bufferqueue is empty, look at the bufferqueue of the other drive
614  * that is attached to this controller.
615  * Start procesing the bufferqueue of the other drive if it isn't empty.
616  * Return a pointer to the softc structure of the drive that is now
617  * ready to process a buffer or NULL if there is no buffer in either queues.
618  */
619 struct rf_softc*
620 get_new_buf( struct rfc_softc *rfc_sc)
621 {
622 	struct rf_softc *rf_sc;
623 	struct rf_softc *other_drive;
624 
625 	rf_sc = device_private(rfc_sc->sc_childs[rfc_sc->sc_curchild]);
626 	rfc_sc->sc_curbuf = bufq_get(rf_sc->sc_bufq);
627 	if (rfc_sc->sc_curbuf != NULL) {
628 		rfc_sc->sc_bufidx = rfc_sc->sc_curbuf->b_data;
629 		rfc_sc->sc_bytesleft = rfc_sc->sc_curbuf->b_bcount;
630 	} else {
631 		RFS_SETCMD(rf_sc->sc_state, RFS_IDLE);
632 		other_drive = device_private(
633 		    rfc_sc->sc_childs[ rfc_sc->sc_curchild == 0 ? 1 : 0]);
634 		if (other_drive != NULL
635 		    && bufq_peek(other_drive->sc_bufq) != NULL) {
636 			rfc_sc->sc_curchild = rfc_sc->sc_curchild == 0 ? 1 : 0;
637 			rf_sc = other_drive;
638 			rfc_sc->sc_curbuf = bufq_get(rf_sc->sc_bufq);
639 			rfc_sc->sc_bufidx = rfc_sc->sc_curbuf->b_data;
640 			rfc_sc->sc_bytesleft = rfc_sc->sc_curbuf->b_bcount;
641 		} else
642 			return(NULL);
643 	}
644 	return(rf_sc);
645 }
646 
647 
648 
649 void
650 rfc_intr(void *intarg)
651 {
652 	struct rfc_softc *rfc_sc = intarg;
653 	struct rf_softc *rf_sc;
654 	int i;
655 
656 	rf_sc = device_private(rfc_sc->sc_childs[rfc_sc->sc_curchild]);
657 	for (;;) {
658 		/*
659 		 * First clean up from previous command...
660 		 */
661 		switch (rf_sc->sc_state & RFS_CMDS) {
662 		case RFS_PROBING:	/* density detect / verify started */
663 			disk_unbusy(&rf_sc->sc_disk, 0, 1);
664 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
665 			    RX2CS) & RX2CS_ERR) == 0) {
666 				RFS_SETCMD(rf_sc->sc_state, RFS_IDLE);
667 				wakeup(rf_sc);
668 			} else {
669 				if (rfc_sc->type == 2
670 				    && (rf_sc->sc_state & RFS_DENS) == 0
671 				    && (rf_sc->sc_state & RFS_AD) != 0) {
672 					/* retry at DD */
673 					rf_sc->sc_state |= RFS_DENS;
674 					disk_busy(&rf_sc->sc_disk);
675 					if (rfc_sendcmd(rfc_sc, RX2CS_RSEC
676 					    | RX2CS_IE | RX2CS_DD |
677 					    (rf_sc->sc_dnum == 0 ? 0 :
678 					    RX2CS_US), 1, 1) < 0) {
679 						disk_unbusy(&rf_sc->sc_disk,
680 						    0, 1);
681 						RFS_SETCMD(rf_sc->sc_state,
682 						    RFS_NOTINIT);
683 						wakeup(rf_sc);
684 					}
685 				} else {
686 					printf("%s: density error.\n",
687 					    device_xname(rf_sc->sc_dev));
688 					RFS_SETCMD(rf_sc->sc_state,RFS_NOTINIT);
689 					wakeup(rf_sc);
690 				}
691 			}
692 			return;
693 		case RFS_IDLE:	/* controller is idle */
694 			if (rfc_sc->sc_curbuf->b_bcount
695 			    % ((rf_sc->sc_state & RFS_DENS) == 0
696 			    ? RX2_BYTE_SD : RX2_BYTE_DD) != 0) {
697 				/*
698 				 * can only handle blocks that are a multiple
699 				 * of the physical block size
700 				 */
701 				rfc_sc->sc_curbuf->b_error = EIO;
702 			}
703 			RFS_SETCMD(rf_sc->sc_state, (rfc_sc->sc_curbuf->b_flags
704 			    & B_READ) != 0 ? RFS_RSEC : RFS_FBUF);
705 			break;
706 		case RFS_RSEC:	/* Read Sector */
707 			disk_unbusy(&rf_sc->sc_disk, 0, 1);
708 			/* check for errors */
709 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
710 			    RX2CS) & RX2CS_ERR) != 0) {
711 				/* should do more verbose error reporting */
712 				printf("rfc_intr: Error reading secotr: %x\n",
713 				    bus_space_read_2(rfc_sc->sc_iot,
714 				    rfc_sc->sc_ioh, RX2ES) );
715 				rfc_sc->sc_curbuf->b_error = EIO;
716 			}
717 			RFS_SETCMD(rf_sc->sc_state, RFS_EBUF);
718 			break;
719 		case RFS_WSEC:	/* Write Sector */
720 			i = (rf_sc->sc_state & RFS_DENS) == 0
721 				? RX2_BYTE_SD : RX2_BYTE_DD;
722 			disk_unbusy(&rf_sc->sc_disk, i, 0);
723 			/* check for errors */
724 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
725 			    RX2CS) & RX2CS_ERR) != 0) {
726 				/* should do more verbose error reporting */
727 				printf("rfc_intr: Error writing secotr: %x\n",
728 				    bus_space_read_2(rfc_sc->sc_iot,
729 				    rfc_sc->sc_ioh, RX2ES) );
730 				rfc_sc->sc_curbuf->b_error = EIO;
731 				break;
732 			}
733 			if (rfc_sc->sc_bytesleft > i) {
734 				rfc_sc->sc_bytesleft -= i;
735 				rfc_sc->sc_bufidx =
736 				    (char *)rfc_sc->sc_bufidx + i;
737 			} else {
738 				biodone(rfc_sc->sc_curbuf);
739 				rf_sc = get_new_buf( rfc_sc);
740 				if (rf_sc == NULL)
741 					return;
742 			}
743 			RFS_SETCMD(rf_sc->sc_state,
744 			    (rfc_sc->sc_curbuf->b_flags & B_READ) != 0
745 			    ? RFS_RSEC : RFS_FBUF);
746 			break;
747 		case RFS_FBUF:	/* Fill Buffer */
748 			disk_unbusy(&rf_sc->sc_disk, 0, 0);
749 			bus_dmamap_unload(rfc_sc->sc_dmat, rfc_sc->sc_dmam);
750 			/* check for errors */
751 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
752 			    RX2CS) & RX2CS_ERR) != 0) {
753 				/* should do more verbose error reporting */
754 				printf("rfc_intr: Error while DMA: %x\n",
755 				    bus_space_read_2(rfc_sc->sc_iot,
756 				    rfc_sc->sc_ioh, RX2ES));
757 				rfc_sc->sc_curbuf->b_error = EIO;
758 			}
759 			RFS_SETCMD(rf_sc->sc_state, RFS_WSEC);
760 			break;
761 		case RFS_EBUF:	/* Empty Buffer */
762 			i = (rf_sc->sc_state & RFS_DENS) == 0
763 			    ? RX2_BYTE_SD : RX2_BYTE_DD;
764 			disk_unbusy(&rf_sc->sc_disk, i, 1);
765 			bus_dmamap_unload(rfc_sc->sc_dmat, rfc_sc->sc_dmam);
766 			/* check for errors */
767 			if ((bus_space_read_2(rfc_sc->sc_iot, rfc_sc->sc_ioh,
768 			    RX2CS) & RX2CS_ERR) != 0) {
769 				/* should do more verbose error reporting */
770 				printf("rfc_intr: Error while DMA: %x\n",
771 				    bus_space_read_2(rfc_sc->sc_iot,
772 				    rfc_sc->sc_ioh, RX2ES));
773 				rfc_sc->sc_curbuf->b_error = EIO;
774 				break;
775 			}
776 			if (rfc_sc->sc_bytesleft > i) {
777 				rfc_sc->sc_bytesleft -= i;
778 				rfc_sc->sc_bufidx =
779 				    (char *)rfc_sc->sc_bufidx + i;
780 			} else {
781 				biodone(rfc_sc->sc_curbuf);
782 				rf_sc = get_new_buf( rfc_sc);
783 				if (rf_sc == NULL)
784 					return;
785 			}
786 			RFS_SETCMD(rf_sc->sc_state,
787 			    (rfc_sc->sc_curbuf->b_flags & B_READ) != 0
788 			    ? RFS_RSEC : RFS_FBUF);
789 			break;
790 		case RFS_NOTINIT: /* Device is not open */
791 		case RFS_SMD:	/* Set Media Density */
792 		case RFS_RSTAT:	/* Read Status */
793 		case RFS_WDDS:	/* Write Deleted Data Sector */
794 		case RFS_REC:	/* Read Error Code */
795 		default:
796 			panic("Impossible state in rfc_intr(1): 0x%x\n",
797 			    rf_sc->sc_state & RFS_CMDS);
798 		}
799 
800 		if (rfc_sc->sc_curbuf->b_error != 0) {
801 			/*
802 			 * An error occurred while processing this buffer.
803 			 * Finish it and try to get a new buffer to process.
804 			 * Return if there are no buffers in the queues.
805 			 * This loops until the queues are empty or a new
806 			 * action was successfully scheduled.
807 			 */
808 			rfc_sc->sc_curbuf->b_resid = rfc_sc->sc_bytesleft;
809 			rfc_sc->sc_curbuf->b_error = EIO;
810 			biodone(rfc_sc->sc_curbuf);
811 			rf_sc = get_new_buf( rfc_sc);
812 			if (rf_sc == NULL)
813 				return;
814 			continue;
815 		}
816 
817 		/*
818 		 * ... then initiate next command.
819 		 */
820 		switch (rf_sc->sc_state & RFS_CMDS) {
821 		case RFS_EBUF:	/* Empty Buffer */
822 			i = bus_dmamap_load(rfc_sc->sc_dmat, rfc_sc->sc_dmam,
823 			    rfc_sc->sc_bufidx, (rf_sc->sc_state & RFS_DENS) == 0
824 			    ? RX2_BYTE_SD : RX2_BYTE_DD,
825 			    rfc_sc->sc_curbuf->b_proc, BUS_DMA_NOWAIT);
826 			if (i != 0) {
827 				printf("rfc_intr: Error loading dmamap: %d\n",
828 				i);
829 				rfc_sc->sc_curbuf->b_error = EIO;
830 				break;
831 			}
832 			disk_busy(&rf_sc->sc_disk);
833 			if (rfc_sendcmd(rfc_sc, RX2CS_EBUF | RX2CS_IE
834 			    | ((rf_sc->sc_state & RFS_DENS) == 0 ? 0 : RX2CS_DD)
835 			    | (rf_sc->sc_dnum == 0 ? 0 : RX2CS_US)
836 			    | ((rfc_sc->sc_dmam->dm_segs[0].ds_addr
837 			    & 0x30000) >>4), ((rf_sc->sc_state & RFS_DENS) == 0
838 			    ? RX2_BYTE_SD : RX2_BYTE_DD) / 2,
839 			    rfc_sc->sc_dmam->dm_segs[0].ds_addr & 0xffff) < 0) {
840 				disk_unbusy(&rf_sc->sc_disk, 0, 1);
841 				rfc_sc->sc_curbuf->b_error = EIO;
842 				bus_dmamap_unload(rfc_sc->sc_dmat,
843 				rfc_sc->sc_dmam);
844 			}
845 			break;
846 		case RFS_FBUF:	/* Fill Buffer */
847 			i = bus_dmamap_load(rfc_sc->sc_dmat, rfc_sc->sc_dmam,
848 			    rfc_sc->sc_bufidx, (rf_sc->sc_state & RFS_DENS) == 0
849 			    ? RX2_BYTE_SD : RX2_BYTE_DD,
850 			    rfc_sc->sc_curbuf->b_proc, BUS_DMA_NOWAIT);
851 			if (i != 0) {
852 				printf("rfc_intr: Error loading dmamap: %d\n",
853 				    i);
854 				rfc_sc->sc_curbuf->b_error = EIO;
855 				break;
856 			}
857 			disk_busy(&rf_sc->sc_disk);
858 			if (rfc_sendcmd(rfc_sc, RX2CS_FBUF | RX2CS_IE
859 			    | ((rf_sc->sc_state & RFS_DENS) == 0 ? 0 : RX2CS_DD)
860 			    | (rf_sc->sc_dnum == 0 ? 0 : RX2CS_US)
861 			    | ((rfc_sc->sc_dmam->dm_segs[0].ds_addr
862 			    & 0x30000)>>4), ((rf_sc->sc_state & RFS_DENS) == 0
863 			    ? RX2_BYTE_SD : RX2_BYTE_DD) / 2,
864 			    rfc_sc->sc_dmam->dm_segs[0].ds_addr & 0xffff) < 0) {
865 				disk_unbusy(&rf_sc->sc_disk, 0, 0);
866 				rfc_sc->sc_curbuf->b_error = EIO;
867 				bus_dmamap_unload(rfc_sc->sc_dmat,
868 				    rfc_sc->sc_dmam);
869 			}
870 			break;
871 		case RFS_WSEC:	/* Write Sector */
872 			i = (rfc_sc->sc_curbuf->b_bcount - rfc_sc->sc_bytesleft
873 			    + rfc_sc->sc_curbuf->b_blkno * DEV_BSIZE) /
874 			    ((rf_sc->sc_state & RFS_DENS) == 0
875 			    ? RX2_BYTE_SD : RX2_BYTE_DD);
876 			if (i > RX2_TRACKS * RX2_SECTORS) {
877 				rfc_sc->sc_curbuf->b_error = EIO;
878 				break;
879 			}
880 			disk_busy(&rf_sc->sc_disk);
881 			if (rfc_sendcmd(rfc_sc, RX2CS_WSEC | RX2CS_IE
882 			    | (rf_sc->sc_dnum == 0 ? 0 : RX2CS_US)
883 			    | ((rf_sc->sc_state& RFS_DENS) == 0 ? 0 : RX2CS_DD),
884 			    i % RX2_SECTORS + 1, i / RX2_SECTORS) < 0) {
885 				disk_unbusy(&rf_sc->sc_disk, 0, 0);
886 				rfc_sc->sc_curbuf->b_error = EIO;
887 			}
888 			break;
889 		case RFS_RSEC:	/* Read Sector */
890 			i = (rfc_sc->sc_curbuf->b_bcount - rfc_sc->sc_bytesleft
891 			    + rfc_sc->sc_curbuf->b_blkno * DEV_BSIZE) /
892 			    ((rf_sc->sc_state & RFS_DENS) == 0
893 			    ? RX2_BYTE_SD : RX2_BYTE_DD);
894 			if (i > RX2_TRACKS * RX2_SECTORS) {
895 				rfc_sc->sc_curbuf->b_error = EIO;
896 				break;
897 			}
898 			disk_busy(&rf_sc->sc_disk);
899 			if (rfc_sendcmd(rfc_sc, RX2CS_RSEC | RX2CS_IE
900 			    | (rf_sc->sc_dnum == 0 ? 0 : RX2CS_US)
901 			    | ((rf_sc->sc_state& RFS_DENS) == 0 ? 0 : RX2CS_DD),
902 			    i % RX2_SECTORS + 1, i / RX2_SECTORS) < 0) {
903 				disk_unbusy(&rf_sc->sc_disk, 0, 1);
904 				rfc_sc->sc_curbuf->b_error = EIO;
905 			}
906 			break;
907 		case RFS_NOTINIT: /* Device is not open */
908 		case RFS_PROBING: /* density detect / verify started */
909 		case RFS_IDLE:	/* controller is idle */
910 		case RFS_SMD:	/* Set Media Density */
911 		case RFS_RSTAT:	/* Read Status */
912 		case RFS_WDDS:	/* Write Deleted Data Sector */
913 		case RFS_REC:	/* Read Error Code */
914 		default:
915 			panic("Impossible state in rfc_intr(2): 0x%x\n",
916 			    rf_sc->sc_state & RFS_CMDS);
917 		}
918 
919 		if (rfc_sc->sc_curbuf->b_error != 0) {
920 			/*
921 			 * An error occurred while processing this buffer.
922 			 * Finish it and try to get a new buffer to process.
923 			 * Return if there are no buffers in the queues.
924 			 * This loops until the queues are empty or a new
925 			 * action was successfully scheduled.
926 			 */
927 			rfc_sc->sc_curbuf->b_resid = rfc_sc->sc_bytesleft;
928 			rfc_sc->sc_curbuf->b_error = EIO;
929 			biodone(rfc_sc->sc_curbuf);
930 			rf_sc = get_new_buf( rfc_sc);
931 			if (rf_sc == NULL)
932 				return;
933 			continue;
934 		}
935 		break;
936 	}
937 	return;
938 }
939 
940 
941 
942 int
943 rfdump(dev_t dev, daddr_t blkno, void *va, size_t size)
944 {
945 
946 	/* A 0.5MB floppy is much to small to take a system dump... */
947 	return(ENXIO);
948 }
949 
950 
951 
952 int
953 rfsize(dev_t dev)
954 {
955 
956 	return(-1);
957 }
958 
959 
960 
961 int
962 rfopen(dev_t dev, int oflags, int devtype, struct lwp *l)
963 {
964 	struct rf_softc *rf_sc;
965 	struct rfc_softc *rfc_sc;
966 	struct disklabel *dl;
967 
968 	if ((rf_sc = device_lookup_private(&rf_cd, DISKUNIT(dev))) == NULL)
969 		return ENXIO;
970 
971 	rfc_sc = rf_sc->sc_rfc;
972 	dl = rf_sc->sc_disk.dk_label;
973 	switch (DISKPART(dev)) {
974 		case 0:			/* Part. a is single density. */
975 			/* opening in single and double density is senseless */
976 			if ((rf_sc->sc_state & RFS_OPEN_B) != 0 )
977 				return(ENXIO);
978 			rf_sc->sc_state &= ~RFS_DENS;
979 			rf_sc->sc_state &= ~RFS_AD;
980 			rf_sc->sc_state |= RFS_OPEN_A;
981 		break;
982 		case 1:			/* Part. b is double density. */
983 			/*
984 			 * Opening a single density only drive in double
985 			 * density or simultaneous opening in single and
986 			 * double density is senseless.
987 			 */
988 			if (rfc_sc->type == 1
989 			    || (rf_sc->sc_state & RFS_OPEN_A) != 0 )
990 				return(ENXIO);
991 			rf_sc->sc_state |= RFS_DENS;
992 			rf_sc->sc_state &= ~RFS_AD;
993 			rf_sc->sc_state |= RFS_OPEN_B;
994 		break;
995 		case 2:			/* Part. c is auto density. */
996 			rf_sc->sc_state |= RFS_AD;
997 			rf_sc->sc_state |= RFS_OPEN_C;
998 		break;
999 		default:
1000 			return(ENXIO);
1001 		break;
1002 	}
1003 	if ((rf_sc->sc_state & RFS_CMDS) == RFS_NOTINIT) {
1004 		rfc_sc->sc_curchild = rf_sc->sc_dnum;
1005 		/*
1006 		 * Controller is idle and density is not detected.
1007 		 * Start a density probe by issuing a read sector command
1008 		 * and sleep until the density probe finished.
1009 		 * Due to this it is imposible to open unformatted media.
1010 		 * As the RX02/02 is not able to format its own media,
1011 		 * media must be purchased preformatted. fsck DEC makreting!
1012 		 */
1013 		RFS_SETCMD(rf_sc->sc_state, RFS_PROBING);
1014 		disk_busy(&rf_sc->sc_disk);
1015 		if (rfc_sendcmd(rfc_sc, RX2CS_RSEC | RX2CS_IE
1016 		    | (rf_sc->sc_dnum == 0 ? 0 : RX2CS_US)
1017 		    | ((rf_sc->sc_state & RFS_DENS) == 0 ? 0 : RX2CS_DD),
1018 		    1, 1) < 0) {
1019 			rf_sc->sc_state = 0;
1020 			return(ENXIO);
1021 		}
1022 		/* wait max. 2 sec for density probe to finish */
1023 		if (tsleep(rf_sc, PRIBIO | PCATCH, "density probe", 2 * hz)
1024 		    != 0 || (rf_sc->sc_state & RFS_CMDS) == RFS_NOTINIT) {
1025 			/* timeout elapsed and / or something went wrong */
1026 			rf_sc->sc_state = 0;
1027 			return(ENXIO);
1028 		}
1029 	}
1030 	/* disklabel. We use different fake geometries for SD and DD. */
1031 	if ((rf_sc->sc_state & RFS_DENS) == 0) {
1032 		dl->d_nsectors = 10;		/* sectors per track */
1033 		dl->d_secpercyl = 10;		/* sectors per cylinder */
1034 		dl->d_ncylinders = 50;		/* cylinders per unit */
1035 		dl->d_secperunit = 501; /* sectors per unit */
1036 		/* number of sectors in partition */
1037 		dl->d_partitions[2].p_size = 500;
1038 	} else {
1039 		dl->d_nsectors = RX2_SECTORS / 2;  /* sectors per track */
1040 		dl->d_secpercyl = RX2_SECTORS / 2; /* sectors per cylinder */
1041 		dl->d_ncylinders = RX2_TRACKS;	   /* cylinders per unit */
1042 		/* sectors per unit */
1043 		dl->d_secperunit = RX2_SECTORS * RX2_TRACKS / 2;
1044 		/* number of sectors in partition */
1045 		dl->d_partitions[2].p_size = RX2_SECTORS * RX2_TRACKS / 2;
1046 	}
1047 	return(0);
1048 }
1049 
1050 
1051 
1052 int
1053 rfclose(dev_t dev, int fflag, int devtype, struct lwp *l)
1054 {
1055 	struct rf_softc *rf_sc = device_lookup_private(&rf_cd, DISKUNIT(dev));
1056 
1057 	if ((rf_sc->sc_state & 1 << (DISKPART(dev) + RFS_OPEN_SHIFT)) == 0)
1058 		panic("rfclose: can not close non-open drive %s "
1059 		    "partition %"PRIu32, device_xname(rf_sc->sc_dev), DISKPART(dev));
1060 	else
1061 		rf_sc->sc_state &= ~(1 << (DISKPART(dev) + RFS_OPEN_SHIFT));
1062 	if ((rf_sc->sc_state & RFS_OPEN_MASK) == 0)
1063 		rf_sc->sc_state = 0;
1064 	return(0);
1065 }
1066 
1067 
1068 
1069 int
1070 rfread(dev_t dev, struct uio *uio, int ioflag)
1071 {
1072 
1073 	return(physio(rfstrategy, NULL, dev, B_READ, minphys, uio));
1074 }
1075 
1076 
1077 
1078 int
1079 rfwrite(dev_t dev, struct uio *uio, int ioflag)
1080 {
1081 
1082 	return(physio(rfstrategy, NULL, dev, B_WRITE, minphys, uio));
1083 }
1084 
1085 
1086 
1087 int
1088 rfioctl(dev_t dev, u_long cmd, void *data, int fflag, struct lwp *l)
1089 {
1090 	struct rf_softc *rf_sc = device_lookup_private(&rf_cd, DISKUNIT(dev));
1091 
1092 	/* We are going to operate on a non-open dev? PANIC! */
1093 	if ((rf_sc->sc_state & 1 << (DISKPART(dev) + RFS_OPEN_SHIFT)) == 0)
1094 		panic("rfioctl: can not operate on non-open drive %s "
1095 		    "partition %"PRIu32, device_xname(rf_sc->sc_dev), DISKPART(dev));
1096 	switch (cmd) {
1097 	/* get and set disklabel; DIOCGPART used internally */
1098 	case DIOCGDINFO: /* get */
1099 		memcpy(data, rf_sc->sc_disk.dk_label,
1100 		    sizeof(struct disklabel));
1101 		return(0);
1102 	case DIOCSDINFO: /* set */
1103 		return(0);
1104 	case DIOCWDINFO: /* set, update disk */
1105 		return(0);
1106 	case DIOCGPART:  /* get partition */
1107 		((struct partinfo *)data)->disklab = rf_sc->sc_disk.dk_label;
1108 		((struct partinfo *)data)->part =
1109 		    &rf_sc->sc_disk.dk_label->d_partitions[DISKPART(dev)];
1110 		return(0);
1111 
1112 	/* do format operation, read or write */
1113 	case DIOCRFORMAT:
1114 	break;
1115 	case DIOCWFORMAT:
1116 	break;
1117 
1118 	case DIOCSSTEP: /* set step rate */
1119 	break;
1120 	case DIOCSRETRIES: /* set # of retries */
1121 	break;
1122 	case DIOCKLABEL: /* keep/drop label on close? */
1123 	break;
1124 	case DIOCWLABEL: /* write en/disable label */
1125 	break;
1126 
1127 /*	case DIOCSBAD: / * set kernel dkbad */
1128 	break; /* */
1129 	case DIOCEJECT: /* eject removable disk */
1130 	break;
1131 	case ODIOCEJECT: /* eject removable disk */
1132 	break;
1133 	case DIOCLOCK: /* lock/unlock pack */
1134 	break;
1135 
1136 	/* get default label, clear label */
1137 	case DIOCGDEFLABEL:
1138 	break;
1139 	case DIOCCLRLABEL:
1140 	break;
1141 	default:
1142 		return(ENOTTY);
1143 	}
1144 
1145 	return(ENOTTY);
1146 }
1147 
1148 
1149