xref: /csrg-svn/sys/tahoe/vba/hd.c (revision 40138)
1 /*
2  * Copyright (c) 1988 The Regents of the University of California.
3  * All rights reserved.
4  *
5  * This code is derived from software contributed to Berkeley by
6  * Harris Corp.
7  *
8  * Redistribution and use in source and binary forms are permitted
9  * provided that the above copyright notice and this paragraph are
10  * duplicated in all such forms and that any documentation,
11  * advertising materials, and other materials related to such
12  * distribution and use acknowledge that the software was developed
13  * by the University of California, Berkeley.  The name of the
14  * University may not be used to endorse or promote products derived
15  * from this software without specific prior written permission.
16  * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
17  * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
19  *
20  *	@(#)hd.c	7.9 (Berkeley) 02/17/90
21  */
22 
23 #include "hd.h"
24 
25 #if NHD > 0
26 #include "param.h"
27 #include "buf.h"
28 #include "conf.h"
29 #include "dkstat.h"
30 #include "disklabel.h"
31 #include "file.h"
32 #include "systm.h"
33 #include "vmmac.h"
34 #include "time.h"
35 #include "proc.h"
36 #include "uio.h"
37 #include "syslog.h"
38 #include "kernel.h"
39 #include "ioctl.h"
40 #include "stat.h"
41 #include "errno.h"
42 
43 #include "../tahoe/cpu.h"
44 #include "../tahoe/mtpr.h"
45 
46 #include "../tahoevba/vbavar.h"
47 #include "../tahoevba/hdreg.h"
48 
49 #define	b_cylin	b_resid
50 
51 #define	hdunit(dev)		(minor(dev)>>3)
52 #define	hdpart(dev)		(minor(dev)&0x07)
53 #define	hdminor(unit, part)	(((unit)<<3)|(part))
54 
55 struct vba_ctlr *hdcminfo[NHDC];
56 struct vba_device *hddinfo[NHD];
57 int hdcprobe(), hdslave(), hdattach(), hddgo(), hdstrategy();
58 long hdstd[] = { 0 };
59 struct vba_driver hdcdriver =
60     { hdcprobe, hdslave, hdattach, hddgo, hdstd, "hd", hddinfo, "hdc", hdcminfo };
61 
62 /*
63  * Per-controller state.
64  */
65 struct hdcsoftc {
66 	u_short	hdc_flags;
67 #define	HDC_INIT	0x01	/* controller initialized */
68 #define	HDC_STARTED	0x02	/* start command issued */
69 #define	HDC_LOCKED	0x04	/* locked for direct controller access */
70 #define	HDC_WAIT	0x08	/* someone needs direct controller access */
71 	u_short	hdc_wticks;		/* timeout */
72 	struct master_mcb *hdc_mcbp;	/* address of controller mcb */
73 	struct registers *hdc_reg;	/* base address of i/o regs */
74 	struct vb_buf hdc_rbuf;		/* vba resources */
75 	struct master_mcb hdc_mcb;	/* controller mcb */
76 } hdcsoftc[NHDC];
77 
78 #define	HDCMAXTIME	20		/* max time for operation, sec. */
79 #define	HDCINTERRUPT	0xf0		/* interrupt vector */
80 
81 /*
82  * Per-drive state; probably everything should be "hd_", not "dk_",
83  * but it's not worth it, and dk is a better mnemonic for disk anyway.
84  */
85 struct dksoftc {
86 #ifdef COMPAT_42
87 	u_short	dk_def_cyl;	/* definition track cylinder address */
88 #endif
89 	int	dk_state;	/* open fsm */
90 	u_short	dk_bshift;	/* shift for * (DEV_BSIZE / sectorsize) XXX */
91 	int	dk_wlabel;	/* if label sector is writeable */
92 	u_long	dk_copenpart;	/* character units open on this drive */
93 	u_long	dk_bopenpart;	/* block units open on this drive */
94 	u_long	dk_openpart;	/* all units open on this drive */
95 	int	dk_unit;	/* unit# */
96 	int	dk_ctlr;	/* controller# */
97 	int	dk_format;	/* if format program is using disk */
98 	struct buf dk_utab;		/* i/o queue header */
99 	struct disklabel dk_label;	/* disklabel for this disk */
100 	struct mcb dk_mcb;		/* disk mcb */
101 } dksoftc[NHD];
102 
103 /*
104  * Drive states.  Used during steps of open/initialization.
105  * States < OPEN (> 0) are transient, during an open operation.
106  * OPENRAW is used for unlabeled disks, to allow format operations.
107  */
108 #define	CLOSED		0		/* disk is closed */
109 #define	WANTOPEN	1		/* open requested, not started */
110 #define	WANTOPENRAW	2		/* open requested, no label */
111 #define	RDLABEL		3		/* reading pack label */
112 #define	OPEN		4		/* intialized and ready */
113 #define	OPENRAW		5		/* open, no label */
114 
115 int hdcwstart, hdcwatch();
116 
117 /* see if the controller is really there, if so, init it. */
118 /* ARGSUSED */
119 hdcprobe(reg, vm)
120 	caddr_t reg;
121 	/* register */ struct vba_ctlr *vm;
122 {
123 	register int br, cvec;		/* must be r12, r11 */
124 	register struct hdcsoftc *hdc;
125 	static struct module_id id;
126 	struct pte *dummypte;
127 	caddr_t putl;
128 
129 	/* initialize the hdc controller structure. */
130 	hdc = &hdcsoftc[vm->um_ctlr];
131 	if (!vbmemalloc(1, reg, &dummypte, &putl)) {
132 		printf("hdc%d: vbmemalloc failed.\n", vm->um_ctlr);
133 		return(0);
134 	}
135 	hdc->hdc_reg = (struct registers *)putl;
136 
137 	/*
138 	 * try and ping the MID register; side effect of wbadaddr is to read
139 	 * the module id; the controller is bad if it's not an hdc, the hdc's
140 	 * writeable control store is not loaded, or the hdc failed the
141 	 * functional integrity test;
142 	 */
143 	if (wbadaddr(&hdc->hdc_reg->module_id, 4,
144 	    vtoph((struct process *)NULL, &id)))
145 		return(0);
146 	DELAY(10000);
147 	mtpr(PADC, 0);
148 	if (id.module_id != (u_char)HDC_MID) {
149 		printf("hdc%d: bad module id; id = %x.\n",
150 		    vm->um_ctlr, id.module_id);
151 		return(0);
152 	}
153 	if (id.code_rev == (u_char)0xff) {
154 		printf("hdc%d: micro-code not loaded.\n", vm->um_ctlr);
155 		return(0);
156 	}
157 	if (id.fit != (u_char)0xff) {
158 		printf("hdc%d: FIT test failed.\n", vm->um_ctlr);
159 		return(0);
160 	}
161 
162 	/* reset that pup; flag as inited */
163 	hdc->hdc_reg->soft_reset = 0;
164 	DELAY(1000000);
165 	hdc->hdc_flags |= HDC_INIT;
166 
167 	/* allocate page tables and i/o buffer. */
168 	if (!vbainit(&hdc->hdc_rbuf, MAXPHYS, VB_32BIT|VB_SCATTER)) {
169 		printf("hdc%d: vbainit failed\n", vm->um_ctlr);
170 		return (0);
171 	}
172 
173 	/* set pointer to master control block */
174 	hdc->hdc_mcbp =
175 	    (struct master_mcb *)vtoph((struct proc *)NULL, &hdc->hdc_mcb);
176 
177 	br = 0x17, cvec = HDCINTERRUPT + vm->um_ctlr;		/* XXX */
178 	return(sizeof(struct registers));
179 }
180 
181 /* ARGSUSED */
182 hdslave(vi, vdaddr)
183 	struct vba_device *vi;
184 	struct vddevice *vdaddr;
185 {
186 	register struct mcb *mcb;
187 	register struct disklabel *lp;
188 	register struct dksoftc *dk;
189 	static struct status status;
190 
191 	dk = &dksoftc[vi->ui_unit];
192 	dk->dk_unit = vi->ui_unit;
193 	dk->dk_ctlr = vi->ui_ctlr;
194 
195 	mcb = &dk->dk_mcb;
196 	mcb->command = HCMD_STATUS;
197 	mcb->chain[0].wcount = sizeof(struct status) / sizeof(long);
198 	mcb->chain[0].memadr  = (u_long)vtoph((struct process *)0, &status);
199 	if (hdimcb(dk)) {
200 		printf(" (no status)\n");
201 		return(0);
202 	}
203 
204 	/*
205 	 * Report the drive down if anything in the drive status looks bad.
206 	 * If the drive is offline and it is not on cylinder, then the drive
207 	 * is not there.  If there is a fault condition, the hdc will try to
208 	 * clear it when we read the disklabel information.
209 	 */
210 	if (!(status.drs&DRS_ONLINE)) {
211 		if (status.drs&DRS_ON_CYLINDER)
212 			printf(" (not online)\n");
213 		return(0);
214 	}
215 	if (status.drs&DRS_FAULT)
216 		printf(" (clearing fault)");
217 
218 	lp = &dk->dk_label;
219 #ifdef RAW_SIZE
220 	lp->d_secsize = status.bytes_per_sec;
221 #else
222 	lp->d_secsize = 512;
223 #endif
224 	lp->d_nsectors = status.max_sector + 1;
225 	lp->d_ntracks = status.max_head + 1;
226 	lp->d_ncylinders = status.max_cyl + 1;
227 	lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
228 	lp->d_npartitions = 1;
229 	lp->d_partitions[0].p_offset = 0;
230 	lp->d_partitions[0].p_size = LABELSECTOR + 1;
231 	lp->d_rpm = status.rpm;
232 	lp->d_typename[0] = 'h';
233 	lp->d_typename[1] = 'd';
234 	lp->d_typename[2] = '\0';
235 #ifdef COMPAT_42
236 	dk->dk_def_cyl = status.def_cyl;
237 #endif
238 	return(1);
239 }
240 
241 hdattach(vi)
242 	register struct vba_device *vi;
243 {
244 	register struct dksoftc *dk;
245 	register struct disklabel *lp;
246 	register int unit;
247 
248 	unit = vi->ui_unit;
249 	if (hdinit(hdminor(unit, 0), 0)) {
250 		printf(": unknown drive type");
251 		return;
252 	}
253 	dk = &dksoftc[unit];
254 	lp = &dk->dk_label;
255 	hd_setsecsize(dk, lp);
256 	if (dk->dk_state == OPEN)
257 		printf(": %s <secsize %d, ntrak %d, ncyl %d, nsec %d>",
258 		    lp->d_typename, lp->d_secsize, lp->d_ntracks,
259 		    lp->d_ncylinders, lp->d_nsectors);
260 
261 	/*
262 	 * (60 / rpm) / (sectors per track * (bytes per sector / 2))
263 	 */
264 	if (vi->ui_dk >= 0)
265 		dk_wpms[vi->ui_dk] =
266 		    (lp->d_rpm * lp->d_nsectors * lp->d_secsize) / 120;
267 #ifdef notyet
268 	addswap(makedev(HDMAJOR, hdminor(unit, 0)), lp);
269 #endif
270 }
271 
272 hdopen(dev, flags, fmt)
273 	dev_t dev;
274 	int flags, fmt;
275 {
276 	register struct disklabel *lp;
277 	register struct dksoftc *dk;
278 	register struct partition *pp;
279 	register int unit;
280 	struct vba_device *vi;
281 	int s, error, part = hdpart(dev), mask = 1 << part;
282 	daddr_t start, end;
283 
284 	unit = hdunit(dev);
285 	if (unit >= NHD || (vi = hddinfo[unit]) == 0 || vi->ui_alive == 0)
286 		return(ENXIO);
287 	dk = &dksoftc[unit];
288 	lp = &dk->dk_label;
289 	s = spl7();
290 	while (dk->dk_state != OPEN && dk->dk_state != OPENRAW &&
291 	    dk->dk_state != CLOSED)
292 		sleep((caddr_t)dk, PZERO+1);
293 	splx(s);
294 	if (dk->dk_state != OPEN && dk->dk_state != OPENRAW)
295 		if (error = hdinit(dev, flags))
296 			return(error);
297 
298 	if (hdcwstart == 0) {
299 		timeout(hdcwatch, (caddr_t)0, hz);
300 		hdcwstart++;
301 	}
302 	/*
303 	 * Warn if a partion is opened that overlaps another partition
304 	 * which is open unless one is the "raw" partition (whole disk).
305 	 */
306 #define	RAWPART		8		/* 'x' partition */	/* XXX */
307 	if ((dk->dk_openpart & mask) == 0 && part != RAWPART) {
308 		pp = &lp->d_partitions[part];
309 		start = pp->p_offset;
310 		end = pp->p_offset + pp->p_size;
311 		for (pp = lp->d_partitions;
312 		     pp < &lp->d_partitions[lp->d_npartitions]; pp++) {
313 			if (pp->p_offset + pp->p_size <= start ||
314 			    pp->p_offset >= end)
315 				continue;
316 			if (pp - lp->d_partitions == RAWPART)
317 				continue;
318 			if (dk->dk_openpart & (1 << (pp - lp->d_partitions)))
319 				log(LOG_WARNING,
320 				    "hd%d%c: overlaps open partition (%c)\n",
321 				    unit, part + 'a',
322 				    pp - lp->d_partitions + 'a');
323 		}
324 	}
325 	if (part >= lp->d_npartitions)
326 		return(ENXIO);
327 	dk->dk_openpart |= mask;
328 	switch (fmt) {
329 	case S_IFCHR:
330 		dk->dk_copenpart |= mask;
331 		break;
332 	case S_IFBLK:
333 		dk->dk_bopenpart |= mask;
334 		break;
335 	}
336 	return(0);
337 }
338 
339 /* ARGSUSED */
340 hdclose(dev, flags, fmt)
341 	dev_t dev;
342 	int flags, fmt;
343 {
344 	register struct dksoftc *dk;
345 	int mask;
346 
347 	dk = &dksoftc[hdunit(dev)];
348 	mask = 1 << hdpart(dev);
349 	switch (fmt) {
350 	case S_IFCHR:
351 		dk->dk_copenpart &= ~mask;
352 		break;
353 	case S_IFBLK:
354 		dk->dk_bopenpart &= ~mask;
355 		break;
356 	}
357 	if (((dk->dk_copenpart | dk->dk_bopenpart) & mask) == 0)
358 		dk->dk_openpart &= ~mask;
359 	/*
360 	 * Should wait for i/o to complete on this partition
361 	 * even if others are open, but wait for work on blkflush().
362 	 */
363 	if (dk->dk_openpart == 0) {
364 		int s = spl7();
365 		while (dk->dk_utab.b_actf)
366 			sleep((caddr_t)dk, PZERO-1);
367 		splx(s);
368 		dk->dk_state = CLOSED;
369 		dk->dk_wlabel = 0;
370 	}
371 	return(0);
372 }
373 
374 hdinit(dev, flags)
375 	dev_t dev;
376 	int flags;
377 {
378 	register struct dksoftc *dk;
379 	register struct disklabel *lp;
380 	struct vba_device *vi;
381 	int error, unit;
382 	char *msg, *readdisklabel();
383 	extern int cold;
384 
385 	vi = hddinfo[unit = hdunit(dev)];
386 	dk = &dksoftc[unit];
387 	dk->dk_unit = vi->ui_slave;
388 	dk->dk_ctlr = vi->ui_ctlr;
389 
390 	if (flags & O_NDELAY) {
391 		dk->dk_state = OPENRAW;
392 		return(0);
393 	}
394 
395 	error = 0;
396 	lp = &dk->dk_label;
397 	dk->dk_state = RDLABEL;
398 	if (msg = readdisklabel(dev, hdstrategy, lp)) {
399 		if (cold) {
400 			printf(": %s\n", msg);
401 			dk->dk_state = CLOSED;
402 		} else {
403 			log(LOG_ERR, "hd%d: %s\n", unit, msg);
404 			dk->dk_state = OPENRAW;
405 		}
406 #ifdef COMPAT_42
407 		hdclock(vi->ui_ctlr);
408 		if (!(error = hdreadgeometry(dk)))
409 			dk->dk_state = OPEN;
410 		hdcunlock(vi->ui_ctlr);
411 #endif
412 	} else
413 		dk->dk_state = OPEN;
414 	wakeup((caddr_t)dk);
415 	return(error);
416 }
417 
418 hd_setsecsize(dk, lp)
419 	register struct dksoftc *dk;
420 	struct disklabel *lp;
421 {
422 	register int mul;
423 
424 	/*
425 	 * Calculate scaling shift for mapping
426 	 * DEV_BSIZE blocks to drive sectors.
427 	 */
428 	mul = DEV_BSIZE / lp->d_secsize;
429 	dk->dk_bshift = 0;
430 	while ((mul >>= 1) > 0)
431 		dk->dk_bshift++;
432 }
433 
434 /* ARGSUSED */
435 hddgo(vm)
436 	struct vba_device *vm;
437 {}
438 
439 extern int name_ext;
440 hdstrategy(bp)
441 	register struct buf *bp;
442 {
443 	register struct vba_device *vi;
444 	register struct disklabel *lp;
445 	register struct dksoftc *dk;
446 	struct buf *dp;
447 	register int unit;
448 	daddr_t sn, sz, maxsz;
449 	int part, s;
450 
451 	vi = hddinfo[unit = hdunit(bp->b_dev)];
452 	if (unit >= NHD || vi == 0 || vi->ui_alive == 0) {
453 		bp->b_error = ENXIO;
454 		goto bad;
455 	}
456 	dk = &dksoftc[unit];
457 	if (dk->dk_state < OPEN)
458 		goto q;
459 	if (dk->dk_state != OPEN && (bp->b_flags & B_READ) == 0) {
460 		bp->b_error = EROFS;
461 		goto bad;
462 	}
463 	part = hdpart(bp->b_dev);
464 	if ((dk->dk_openpart & (1 << part)) == 0) {
465 		bp->b_error = ENODEV;
466 		goto bad;
467 	}
468 	lp = &dk->dk_label;
469 	sz = (bp->b_bcount + lp->d_secsize - 1) / lp->d_secsize;
470 	maxsz = lp->d_partitions[part].p_size;
471 	sn = bp->b_blkno << dk->dk_bshift;
472 	if (sn + lp->d_partitions[part].p_offset <= LABELSECTOR &&
473 #if LABELSECTOR != 0
474 	    sn + lp->d_partitions[part].p_offset + sz > LABELSECTOR &&
475 #endif
476 	    (bp->b_flags & B_READ) == 0 && dk->dk_wlabel == 0) {
477 		bp->b_error = EROFS;
478 		goto bad;
479 	}
480 	if (sn < 0 || sn + sz > maxsz) {
481 		if (sn == maxsz) {
482 			bp->b_resid = bp->b_bcount;
483 			goto done;
484 		}
485 		sz = maxsz - sn;
486 		if (sz <= 0) {
487 			bp->b_error = EINVAL;
488 			goto bad;
489 		}
490 		bp->b_bcount = sz * lp->d_secsize;
491 	}
492 	bp->b_cylin = (sn + lp->d_partitions[part].p_offset) / lp->d_secpercyl;
493 
494 q:	s = spl7();
495 	dp = &dk->dk_utab;
496 	disksort(dp, bp);
497 	if (!dp->b_active) {
498 		(void)hdustart(vi);
499 		if (!vi->ui_mi->um_tab.b_active)
500 			hdcstart(vi->ui_mi);
501 	}
502 	splx(s);
503 	return;
504 bad:
505 	bp->b_flags |= B_ERROR;
506 done:
507 	biodone(bp);
508 }
509 
510 hdustart(vi)
511 	register struct vba_device *vi;
512 {
513 	register struct buf *bp, *dp;
514 	register struct vba_ctlr *vm;
515 	register struct dksoftc *dk;
516 
517 	dk = &dksoftc[vi->ui_unit];
518 	dp = &dk->dk_utab;
519 
520 	/* if queue empty, nothing to do.  impossible? */
521 	if (dp->b_actf == NULL)
522 		return;
523 
524 	/* place on controller transfer queue */
525 	vm = vi->ui_mi;
526 	if (vm->um_tab.b_actf == NULL)
527 		vm->um_tab.b_actf = dp;
528 	else
529 		vm->um_tab.b_actl->b_forw = dp;
530 	vm->um_tab.b_actl = dp;
531 	dp->b_forw = NULL;
532 	dp->b_active++;
533 }
534 
535 hdcstart(vm)
536 	register struct vba_ctlr *vm;
537 {
538 	register struct buf *bp;
539 	register struct dksoftc *dk;
540 	register struct disklabel *lp;
541 	register struct master_mcb *master;
542 	register struct mcb *mcb;
543 	struct vba_device *vi;
544 	struct hdcsoftc *hdc;
545 	struct buf *dp;
546 	int sn;
547 
548 	/* pull a request off the controller queue */
549 	for (;;) {
550 		if ((dp = vm->um_tab.b_actf) == NULL)
551 			return;
552 		if (bp = dp->b_actf)
553 			break;
554 		vm->um_tab.b_actf = dp->b_forw;
555 	}
556 
557 	/* mark controller active */
558 	vm->um_tab.b_active++;
559 
560 	vi = hddinfo[hdunit(bp->b_dev)];
561 	dk = &dksoftc[vi->ui_unit];
562 	lp = &dk->dk_label;
563 	sn = bp->b_blkno << dk->dk_bshift;
564 
565 	/* fill in mcb */
566 	mcb = &dk->dk_mcb;
567 	mcb->forw_phaddr = 0;
568 	/* mcb->priority = 0; */
569 	mcb->interrupt = 1;
570 	mcb->command = (bp->b_flags & B_READ) ? HCMD_READ:HCMD_WRITE;
571 	mcb->cyl = bp->b_cylin;
572 /* assumes partition starts on cylinder boundary */
573 	mcb->head = (sn / lp->d_nsectors) % lp->d_ntracks;
574 	mcb->sector = sn % lp->d_nsectors;
575 	mcb->drive = vi->ui_slave;
576 	/* mcb->context = 0;		/* what do we want on interrupt? */
577 
578 	hdc = &hdcsoftc[vm->um_ctlr];
579 	if (!hd_sgsetup(bp, &hdc->hdc_rbuf, mcb->chain)) {
580 		mcb->chain[0].wcount = (bp->b_bcount+3) >> 2;
581 		mcb->chain[0].memadr =
582 		    vbasetup(bp, &hdc->hdc_rbuf, (int)lp->d_secsize);
583 	}
584 
585 	if (vi->ui_dk >= 0) {
586 		dk_busy |= 1<<vi->ui_dk;
587 		dk_xfer[vi->ui_dk]++;
588 		dk_wds[vi->ui_dk] += bp->b_bcount>>6;
589 	}
590 
591 	master = &hdc->hdc_mcb;
592 	master->mcw = MCL_QUEUED;
593 	master->interrupt = HDCINTERRUPT + vm->um_ctlr;
594 	master->forw_phaddr = (u_long)vtoph((struct proc *)NULL, mcb);
595 	hdc->hdc_reg->master_mcb = (u_long)hdc->hdc_mcbp;
596 }
597 
598 /*
599  * Wait for controller to finish current operation
600  * so that direct controller accesses can be done.
601  */
602 hdclock(ctlr)
603 	int ctlr;
604 {
605 	register struct vba_ctlr *vm = hdcminfo[ctlr];
606 	register struct hdcsoftc *hdc;
607 	int s;
608 
609 	hdc = &hdcsoftc[ctlr];
610 	s = spl7();
611 	while (vm->um_tab.b_active || hdc->hdc_flags & HDC_LOCKED) {
612 		hdc->hdc_flags |= HDC_WAIT;
613 		sleep((caddr_t)hdc, PRIBIO);
614 	}
615 	hdc->hdc_flags |= HDC_LOCKED;
616 	splx(s);
617 }
618 
619 /*
620  * Continue normal operations after pausing for
621  * munging the controller directly.
622  */
623 hdcunlock(ctlr)
624 	int ctlr;
625 {
626 	register struct vba_ctlr *vm;
627 	register struct hdcsoftc *hdc = &hdcsoftc[ctlr];
628 
629 	hdc->hdc_flags &= ~HDC_LOCKED;
630 	if (hdc->hdc_flags & HDC_WAIT) {
631 		hdc->hdc_flags &= ~HDC_WAIT;
632 		wakeup((caddr_t)hdc);
633 	} else {
634 		vm = hdcminfo[ctlr];
635 		if (vm->um_tab.b_actf)
636 			hdcstart(vm);
637 	}
638 }
639 
640 hdintr(ctlr)
641 	int ctlr;
642 {
643 	register struct buf *bp, *dp;
644 	register struct vba_ctlr *vm;
645 	register struct vba_device *vi;
646 	register struct hdcsoftc *hdc;
647 	register struct mcb *mcb;
648 	struct master_mcb *master;
649 	register int status;
650 	int timedout;
651 	struct dksoftc *dk;
652 
653 	hdc = &hdcsoftc[ctlr];
654 	master = &hdc->hdc_mcb;
655 	uncache(&master->mcs);
656 	uncache(&master->context);
657 
658 	vm = hdcminfo[ctlr];
659 	if (!vm->um_tab.b_active || !(master->mcs&MCS_DONE)) {
660 		printf("hd%d: stray interrupt\n", ctlr);
661 		return;
662 	}
663 
664 	dp = vm->um_tab.b_actf;
665 	bp = dp->b_actf;
666 	vi = hddinfo[hdunit(bp->b_dev)];
667 	dk = &dksoftc[vi->ui_unit];
668 	if (vi->ui_dk >= 0)
669 		dk_busy &= ~(1<<vi->ui_dk);
670 	timedout = (hdc->hdc_wticks >= HDCMAXTIME);
671 
672 	mcb = &dk->dk_mcb;
673 
674 	if (master->mcs & (MCS_SOFTERROR | MCS_FATALERROR) || timedout)
675 		hdcerror(ctlr, *(u_long *)master->xstatus);
676 	else
677 		hdc->hdc_wticks = 0;
678 	if (vm->um_tab.b_active) {
679 		vm->um_tab.b_active = 0;
680 		vm->um_tab.b_actf = dp->b_forw;
681 		dp->b_active = 0;
682 		dp->b_errcnt = 0;
683 		dp->b_actf = bp->av_forw;
684 		bp->b_resid = 0;
685 		vbadone(bp, &hdc->hdc_rbuf);
686 		biodone(bp);
687 		/* start up now, if more work to do */
688 		if (dp->b_actf)
689 			hdustart(vi);
690 		else if (dk->dk_openpart == 0)
691 			wakeup((caddr_t)dk);
692 	}
693 	/* if there are devices ready to transfer, start the controller. */
694 	if (hdc->hdc_flags & HDC_WAIT) {
695 		hdc->hdc_flags &= ~HDC_WAIT;
696 		wakeup((caddr_t)hdc);
697 	} else if (vm->um_tab.b_actf)
698 		hdcstart(vm);
699 }
700 
701 hdioctl(dev, cmd, data, flag)
702 	dev_t dev;
703 	int cmd, flag;
704 	caddr_t data;
705 {
706 	register int unit;
707 	register struct dksoftc *dk;
708 	register struct disklabel *lp;
709 	int error;
710 
711 	unit = hdunit(dev);
712 	dk = &dksoftc[unit];
713 	lp = &dk->dk_label;
714 	error = 0;
715 	switch (cmd) {
716 	case DIOCGDINFO:
717 		*(struct disklabel *)data = *lp;
718 		break;
719 	case DIOCGPART:
720 		((struct partinfo *)data)->disklab = lp;
721 		((struct partinfo *)data)->part =
722 		    &lp->d_partitions[hdpart(dev)];
723 		break;
724 	case DIOCSDINFO:
725 		if ((flag & FWRITE) == 0)
726 			error = EBADF;
727 		else
728 			error = setdisklabel(lp, (struct disklabel *)data,
729 			    (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart);
730 		if (error == 0 && dk->dk_state == OPENRAW)
731 			dk->dk_state = OPEN;
732 		break;
733 	case DIOCWLABEL:
734 		if ((flag & FWRITE) == 0)
735 			error = EBADF;
736 		else
737 			dk->dk_wlabel = *(int *)data;
738 		break;
739 	case DIOCWDINFO:
740 		if ((flag & FWRITE) == 0)
741 			error = EBADF;
742 		else if ((error = setdisklabel(lp, (struct disklabel *)data,
743 		    (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart)) == 0) {
744 			int wlab;
745 
746 			if (error == 0 && dk->dk_state == OPENRAW)
747 				dk->dk_state = OPEN;
748 			/* simulate opening partition 0 so write succeeds */
749 			dk->dk_openpart |= (1 << 0);		/* XXX */
750 			wlab = dk->dk_wlabel;
751 			dk->dk_wlabel = 1;
752 			error = writedisklabel(dev, hdstrategy, lp);
753 			dk->dk_openpart = dk->dk_copenpart | dk->dk_bopenpart;
754 			dk->dk_wlabel = wlab;
755 		}
756 		break;
757 	default:
758 		error = ENOTTY;
759 		break;
760 	}
761 	return (error);
762 }
763 
764 /*
765  * Watch for lost interrupts.
766  */
767 hdcwatch()
768 {
769 	register struct hdcsoftc *hdc;
770 	register struct vba_ctlr **vmp;
771 	register int ctlr;
772 	int s;
773 
774 	timeout(hdcwatch, (caddr_t)0, hz);
775 	for (vmp = hdcminfo, hdc = hdcsoftc, ctlr = 0; ctlr < NHDC;
776 	    ++ctlr, ++vmp, ++hdc) {
777 		if (*vmp == 0 || (*vmp)->um_alive == 0)
778 			continue;
779 		s = spl7();
780 		if ((*vmp)->um_tab.b_active &&
781 		    hdc->hdc_wticks++ >= HDCMAXTIME) {
782 			printf("hd%d: lost interrupt\n", ctlr);
783 			hdintr(ctlr);
784 		}
785 		splx(s);
786 	}
787 }
788 
789 hddump(dev)
790 	dev_t dev;
791 {
792 	return(ENXIO);
793 }
794 
795 hdsize(dev)
796 	dev_t dev;
797 {
798 	register int unit = hdunit(dev);
799 	register struct dksoftc *dk;
800 	struct vba_device *vi;
801 	struct disklabel *lp;
802 
803 	if (unit >= NHD || (vi = hddinfo[unit]) == 0 || vi->ui_alive == 0 ||
804 	    (dk = &dksoftc[unit])->dk_state != OPEN)
805 		return (-1);
806 	lp = &dk->dk_label;
807 	return ((int)lp->d_partitions[hdpart(dev)].p_size >> dk->dk_bshift);
808 }
809 
810 hdimcb(dk)
811 	register struct dksoftc *dk;
812 {
813 	register struct master_mcb *master;
814 	register struct mcb *mcb;
815 	register struct hdcsoftc *hdc;
816 	int timeout;
817 
818 	/* fill in mcb */
819 	mcb = &dk->dk_mcb;
820 	mcb->interrupt = 0;
821 	mcb->forw_phaddr = 0;
822 	mcb->drive = dk->dk_unit;
823 
824 	hdc = &hdcsoftc[dk->dk_ctlr];
825 	master = &hdc->hdc_mcb;
826 
827 	/* fill in master mcb */
828 	master->mcw = MCL_IMMEDIATE;
829 	master->forw_phaddr = (u_long)vtoph((struct proc *)NULL, mcb);
830 	master->mcs = 0;
831 
832 	/* kick controller and wait */
833 	hdc->hdc_reg->master_mcb = (u_long)hdc->hdc_mcbp;
834 	for (timeout = 15000; timeout; --timeout) {
835 		DELAY(1000);
836 		mtpr(PADC, 0);
837 		if (master->mcs&MCS_FATALERROR) {
838 			printf("hdc%d: fatal error\n", dk->dk_ctlr);
839 			hdcerror(dk->dk_ctlr, *(u_long *)master->xstatus);
840 			return(1);
841 		}
842 		if (master->mcs&MCS_DONE)
843 			return(0);
844 	}
845 	printf("hdc%d: timed out\n", dk->dk_ctlr);
846 	return(1);
847 }
848 
849 hdcerror(ctlr, code)
850 	int ctlr;
851 	u_long code;
852 {
853 	printf("hd%d: error %lx\n", ctlr, code);
854 }
855 
856 #ifdef COMPAT_42
857 hdreadgeometry(dk)
858 	struct dksoftc *dk;
859 {
860 	static geometry_sector geometry;
861 	register struct mcb *mcb;
862 	register struct disklabel *lp;
863 	geometry_block *geo;
864 	int cnt;
865 
866 	/*
867 	 * Read the geometry block (at head = 0 sector = 0 of the drive
868 	 * definition cylinder), validate it (must have the correct version
869 	 * number, header, and checksum).
870 	 */
871 	mcb = &dk->dk_mcb;
872 	mcb->command = HCMD_READ;
873 	mcb->cyl = dk->dk_def_cyl;
874 	mcb->head = 0;
875 	mcb->sector = 0;
876 	mcb->chain[0].wcount = sizeof(geometry_sector) / sizeof(long);
877 	mcb->chain[0].memadr  = (u_long)vtoph((struct process *)0, &geometry);
878 	/* mcb->chain[0].memadr = (long)&geometry; */
879 	if (hdimcb(dk)) {
880  		printf("hd%d: can't read default geometry.\n", dk->dk_unit);
881 		return(1);
882 	}
883 	geo = &geometry.geometry_block;
884  	if (geo->version > 64000  ||  geo->version < 0) {
885  		printf("hd%d: bad default geometry version#.\n", dk->dk_unit);
886 		return(1);
887 	}
888  	if (bcmp(&geo->id[0], GB_ID, GB_ID_LEN)) {
889  		printf("hd%d: bad default geometry header.\n", dk->dk_unit);
890 		return(1);
891 	}
892 	GB_CHECKSUM(geo, cnt);
893 	if (geometry.checksum != cnt) {
894 		printf("hd%d: bad default geometry checksum.\n", dk->dk_unit);
895 		return(1);
896 	}
897 	lp = &dk->dk_label;
898 
899 	/* 1K block in Harris geometry; convert to sectors for disklabels */
900 	for (cnt = 0; cnt < GB_MAXPART; cnt++) {
901 		lp->d_partitions[cnt].p_offset =
902 		    geo->partition[cnt].start * (1024 / lp->d_secsize);
903 		lp->d_partitions[cnt].p_size =
904 		    geo->partition[cnt].length * (1024 / lp->d_secsize);
905 	}
906 	lp->d_npartitions = GB_MAXPART;
907 	return(0);
908 }
909 #endif /* COMPAT_42 */
910 #endif /* NHD */
911