134528Skarels /* 234528Skarels * Copyright (c) 1988 Regents of the University of California. 334528Skarels * All rights reserved. 434528Skarels * 534528Skarels * Redistribution and use in source and binary forms are permitted 6*34866Sbostic * provided that the above copyright notice and this paragraph are 7*34866Sbostic * duplicated in all such forms and that any documentation, 8*34866Sbostic * advertising materials, and other materials related to such 9*34866Sbostic * distribution and use acknowledge that the software was developed 10*34866Sbostic * by the University of California, Berkeley. The name of the 11*34866Sbostic * University may not be used to endorse or promote products derived 12*34866Sbostic * from this software without specific prior written permission. 13*34866Sbostic * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR 14*34866Sbostic * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED 15*34866Sbostic * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE. 1634528Skarels * 17*34866Sbostic * @(#)vd.c 7.5 (Berkeley) 06/29/88 1834528Skarels */ 1924004Ssam 2029564Ssam #include "dk.h" 2124004Ssam #if NVD > 0 2224004Ssam /* 2330519Ssam * Versabus VDDC/SMDE driver. 2425675Ssam */ 2525675Ssam #include "param.h" 2625675Ssam #include "buf.h" 2725675Ssam #include "cmap.h" 2825675Ssam #include "conf.h" 2925675Ssam #include "dir.h" 3029564Ssam #include "dkstat.h" 3130519Ssam #include "disklabel.h" 3225675Ssam #include "map.h" 3330519Ssam #include "file.h" 3425675Ssam #include "systm.h" 3525675Ssam #include "user.h" 3625675Ssam #include "vmmac.h" 3725675Ssam #include "proc.h" 3825675Ssam #include "uio.h" 3930370Skarels #include "syslog.h" 4030370Skarels #include "kernel.h" 4130519Ssam #include "ioctl.h" 4230756Skarels #include "stat.h" 4324004Ssam 4429951Skarels #include "../tahoe/cpu.h" 4529951Skarels #include "../tahoe/mtpr.h" 4629951Skarels #include "../tahoe/pte.h" 4729951Skarels 4825675Ssam #include "../tahoevba/vbavar.h" 4925928Ssam #include "../tahoevba/vdreg.h" 5024004Ssam 5132211Skarels #ifndef COMPAT_42 5230519Ssam #define COMPAT_42 5332211Skarels #endif 5434396Skarels #define B_FORMAT B_XXX /* XXX */ 5530519Ssam 5630519Ssam #define vdunit(dev) (minor(dev) >> 3) 5730519Ssam #define vdpart(dev) (minor(dev) & 0x07) 5830519Ssam #define vdminor(unit,part) (((unit) << 3) | (part)) 5924004Ssam 6024004Ssam struct vba_ctlr *vdminfo[NVD]; 6129564Ssam struct vba_device *vddinfo[NDK]; 6230756Skarels int vdprobe(), vdslave(), vdattach(), vddgo(), vdstrategy(); 6334528Skarels long vdstd[] = { 0xffff2000, 0xffff2100, 0xffff2200, 0xffff2300, 0 }; 6425675Ssam struct vba_driver vddriver = 6534528Skarels { vdprobe, vdslave, vdattach, vddgo, vdstd, "dk", vddinfo, "vd", vdminfo }; 6624004Ssam 6724004Ssam /* 6830519Ssam * Per-controller state. 6930519Ssam */ 7030519Ssam struct vdsoftc { 7130519Ssam u_short vd_flags; 7230519Ssam #define VD_INIT 0x1 /* controller initialized */ 7330519Ssam #define VD_STARTED 0x2 /* start command issued */ 7430519Ssam #define VD_DOSEEKS 0x4 /* should overlap seeks */ 7530756Skarels #define VD_SCATGATH 0x8 /* can do scatter-gather commands (correctly) */ 7630519Ssam u_short vd_type; /* controller type */ 7730519Ssam u_short vd_wticks; /* timeout */ 7830519Ssam struct mdcb vd_mdcb; /* master command block */ 7930519Ssam u_long vd_mdcbphys; /* physical address of vd_mdcb */ 8030519Ssam struct dcb vd_dcb; /* i/o command block */ 8130519Ssam u_long vd_dcbphys; /* physical address of vd_dcb */ 8230601Skarels struct vb_buf vd_rbuf; /* vba resources */ 8330519Ssam } vdsoftc[NVD]; 8430519Ssam 8534396Skarels #define VDMAXTIME 20 /* max time for operation, sec. */ 8634396Skarels 8730519Ssam /* 8825675Ssam * Per-drive state. 8925675Ssam */ 9030519Ssam struct dksoftc { 9134076Skarels int dk_state; /* open fsm */ 9230756Skarels #ifndef SECSIZE 9330756Skarels u_short dk_bshift; /* shift for * (DEV_BSIZE / sectorsize) XXX */ 9430756Skarels #endif SECSIZE 9534076Skarels int dk_wlabel; /* label sector is currently writable */ 9632576Skarels u_long dk_copenpart; /* character units open on this drive */ 9732576Skarels u_long dk_bopenpart; /* block units open on this drive */ 9832576Skarels u_long dk_openpart; /* all units open on this drive */ 9930519Ssam u_int dk_curcyl; /* last selected cylinder */ 10030756Skarels struct skdcb dk_dcb; /* seek command block */ 10130519Ssam u_long dk_dcbphys; /* physical address of dk_dcb */ 10234396Skarels int df_reg[3]; /* for formatting, in-out parameters */ 10330519Ssam } dksoftc[NDK]; 10424004Ssam 10524004Ssam /* 10630519Ssam * Drive states. Used during steps of open/initialization. 10730519Ssam * States < OPEN (> 0) are transient, during an open operation. 10834076Skarels * OPENRAW is used for unlabeled disks, to allow format operations. 10925675Ssam */ 11030519Ssam #define CLOSED 0 /* disk is closed */ 11130519Ssam #define WANTOPEN 1 /* open requested, not started */ 11230519Ssam #define WANTOPENRAW 2 /* open requested, no label */ 11330519Ssam #define RDLABEL 3 /* reading pack label */ 11430519Ssam #define OPEN 4 /* intialized and ready */ 11530519Ssam #define OPENRAW 5 /* open, no label */ 11624004Ssam 11730519Ssam struct buf dkutab[NDK]; /* i/o queue headers */ 11830519Ssam struct disklabel dklabel[NDK]; /* pack labels */ 11924004Ssam 12030519Ssam #define b_cylin b_resid 12130574Skarels #define b_track b_error /* used for seek commands */ 12230574Skarels #define b_seekf b_forw /* second queue on um_tab */ 12330574Skarels #define b_seekl b_back /* second queue on um_tab */ 12430519Ssam 12530519Ssam int vdwstart, vdwatch(); 12630519Ssam 12724004Ssam /* 12825675Ssam * See if the controller is really there; if so, initialize it. 12925675Ssam */ 13025857Ssam vdprobe(reg, vm) 13125857Ssam caddr_t reg; 13225857Ssam struct vba_ctlr *vm; 13325675Ssam { 13425857Ssam register br, cvec; /* must be r12, r11 */ 13530519Ssam register struct vddevice *vdaddr = (struct vddevice *)reg; 13630519Ssam struct vdsoftc *vd; 13730573Skarels int s; 13825857Ssam 13930370Skarels #ifdef lint 14030370Skarels br = 0; cvec = br; br = cvec; 14130370Skarels vdintr(0); 14230370Skarels #endif 14325857Ssam if (badaddr((caddr_t)reg, 2)) 14425675Ssam return (0); 14530519Ssam vd = &vdsoftc[vm->um_ctlr]; 14630519Ssam vdaddr->vdreset = 0xffffffff; 14725675Ssam DELAY(1000000); 14830519Ssam if (vdaddr->vdreset != (unsigned)0xffffffff) { 14930519Ssam vd->vd_type = VDTYPE_VDDC; 15030519Ssam vd->vd_flags &= ~VD_DOSEEKS; 15125675Ssam DELAY(1000000); 15225675Ssam } else { 15330519Ssam vd->vd_type = VDTYPE_SMDE; 15430519Ssam vd->vd_flags |= VD_DOSEEKS; 15530519Ssam vdaddr->vdrstclr = 0; 15625675Ssam DELAY(3000000); 15730519Ssam vdaddr->vdcsr = 0; 15830519Ssam vdaddr->vdtcf_mdcb = AM_ENPDA; 15930519Ssam vdaddr->vdtcf_dcb = AM_ENPDA; 16030519Ssam vdaddr->vdtcf_trail = AM_ENPDA; 16130519Ssam vdaddr->vdtcf_data = AM_ENPDA; 16230519Ssam vdaddr->vdccf = CCF_SEN | CCF_DER | CCF_STS | 16329921Skarels XMD_32BIT | BSZ_16WRD | 16425925Ssam CCF_ENP | CCF_EPE | CCF_EDE | CCF_ECE | CCF_ERR; 16525675Ssam } 16630519Ssam vd->vd_mdcbphys = vtoph((struct proc *)0, (unsigned)&vd->vd_mdcb); 16730519Ssam vd->vd_dcbphys = vtoph((struct proc *)0, (unsigned)&vd->vd_dcb); 16830519Ssam vm->um_addr = reg; /* XXX */ 16930573Skarels s = spl7(); 17030519Ssam if (!vdcmd(vm, VDOP_INIT, 10) || !vdcmd(vm, VDOP_DIAG, 10)) { 17130519Ssam printf("vd%d: %s cmd failed\n", vm->um_ctlr, 17230519Ssam vd->vd_dcb.opcode == VDOP_INIT ? "init" : "diag"); 17330573Skarels splx(s); 17430519Ssam return (0); 17530519Ssam } 17630756Skarels if (vd->vd_type == VDTYPE_SMDE) { 17730756Skarels vd->vd_dcb.trail.idtrail.date = 0; 17830756Skarels if (vdcmd(vm, VDOP_IDENT, 10)) { 17930756Skarels uncache(&vd->vd_dcb.trail.idtrail.date); 18030756Skarels if (vd->vd_dcb.trail.idtrail.date != 0) 18130756Skarels vd->vd_flags |= VD_SCATGATH; 18230756Skarels } 18330756Skarels } 18430573Skarels splx(s); 18525925Ssam /* 18625950Ssam * Allocate page tables and i/o buffer. 18725925Ssam */ 18832211Skarels if (vbainit(&vd->vd_rbuf, MAXPHYS, 18932211Skarels vd->vd_type == VDTYPE_VDDC ? VB_24BIT : VB_32BIT) == 0) { 19032211Skarels printf("vd%d: vbainit failed\n", vm->um_ctlr); 19132211Skarels return (0); 19232211Skarels } 19325857Ssam br = 0x17, cvec = 0xe0 + vm->um_ctlr; /* XXX */ 19430519Ssam return (sizeof (struct vddevice)); 19525675Ssam } 19624004Ssam 19724004Ssam /* 19830519Ssam * See if a drive is really there. 19930519Ssam * 20030519Ssam * Can't read pack label here as various data structures 20130519Ssam * aren't setup for doing a read in a straightforward 20230519Ssam * manner. Instead just probe for the drive and leave 20330519Ssam * the pack label stuff to the attach routine. 20425675Ssam */ 20534076Skarels /* ARGSUSED */ 20634076Skarels vdslave(vi, vdaddr) 20725675Ssam register struct vba_device *vi; 20830519Ssam struct vddevice *vdaddr; 20925675Ssam { 21030519Ssam register struct disklabel *lp = &dklabel[vi->ui_unit]; 21132211Skarels register struct dksoftc *dk = &dksoftc[vi->ui_unit]; 21230519Ssam struct vdsoftc *vd = &vdsoftc[vi->ui_ctlr]; 21324004Ssam 21430519Ssam if ((vd->vd_flags&VD_INIT) == 0) { 21530756Skarels printf("vd%d: %s controller%s\n", vi->ui_ctlr, 21630756Skarels vd->vd_type == VDTYPE_VDDC ? "VDDC" : "SMDE", 21730756Skarels (vd->vd_flags & VD_SCATGATH) ? " with scatter-gather" : ""); 21830519Ssam vd->vd_flags |= VD_INIT; 21925675Ssam } 22030519Ssam 22125675Ssam /* 22230519Ssam * Initialize label enough to do a reset on 22330519Ssam * the drive. The remainder of the default 22430519Ssam * label values will be filled in in vdinit 22530519Ssam * at attach time. 22625675Ssam */ 22732211Skarels if (vd->vd_type == VDTYPE_SMDE) 22832211Skarels lp->d_secsize = VD_MAXSECSIZE; 22932211Skarels else 23032211Skarels lp->d_secsize = VDDC_SECSIZE; 23134396Skarels lp->d_nsectors = 66; /* only used on smd-e */ 23234076Skarels lp->d_ntracks = 23; 23334396Skarels lp->d_ncylinders = 850; 23434396Skarels lp->d_secpercyl = 66*23; 23534592Skarels lp->d_npartitions = 1; 23634592Skarels lp->d_partitions[0].p_offset = 0; 23734592Skarels lp->d_partitions[0].p_size = LABELSECTOR + 1; 23824004Ssam 23930519Ssam /* 24030519Ssam * Initialize invariant portion of 24130519Ssam * dcb used for overlapped seeks. 24230519Ssam */ 24330519Ssam dk->dk_dcb.opcode = VDOP_SEEK; 24430519Ssam dk->dk_dcb.intflg = DCBINT_NONE | DCBINT_PBA; 24530519Ssam dk->dk_dcb.devselect = vi->ui_slave; 24630756Skarels dk->dk_dcb.trailcnt = sizeof (struct trseek) / sizeof (long); 24730519Ssam dk->dk_dcb.trail.sktrail.skaddr.sector = 0; 24830519Ssam dk->dk_dcbphys = vtoph((struct proc *)0, (unsigned)&dk->dk_dcb); 24932211Skarels #ifndef SECSIZE 25032211Skarels vd_setsecsize(dk, lp); 25132211Skarels #endif 25232211Skarels return (vdreset_drive(vi)); 25332211Skarels } 25432211Skarels 25532211Skarels vdattach(vi) 25632211Skarels register struct vba_device *vi; 25732211Skarels { 25832211Skarels register int unit = vi->ui_unit; 25932211Skarels register struct disklabel *lp = &dklabel[unit]; 26032211Skarels 26130601Skarels /* 26230601Skarels * Try to initialize device and read pack label. 26330601Skarels */ 26430601Skarels if (vdinit(vdminor(unit, 0), 0) != 0) { 26530601Skarels printf(": unknown drive type"); 26630601Skarels return; 26730601Skarels } 26832211Skarels if (dksoftc[unit].dk_state == OPEN) 26932211Skarels printf(": %s <secsize %d, ntrak %d, ncyl %d, nsec %d>", 27032211Skarels lp->d_typename, lp->d_secsize, 27132211Skarels lp->d_ntracks, lp->d_ncylinders, lp->d_nsectors); 27230519Ssam /* 27330519Ssam * (60 / rpm) / (sectors per track * (bytes per sector / 2)) 27430519Ssam */ 27530519Ssam if (vi->ui_dk >= 0) 27630519Ssam dk_mspw[vi->ui_dk] = 120.0 / 27730519Ssam (lp->d_rpm * lp->d_nsectors * lp->d_secsize); 27830519Ssam #ifdef notyet 27930573Skarels addswap(makedev(VDMAJOR, vdminor(unit, 0)), lp); 28030519Ssam #endif 28124004Ssam } 28224004Ssam 28330756Skarels vdopen(dev, flags, fmt) 28430519Ssam dev_t dev; 28530756Skarels int flags, fmt; 28624004Ssam { 28730519Ssam register unit = vdunit(dev); 28830519Ssam register struct disklabel *lp; 28930519Ssam register struct dksoftc *dk; 29030519Ssam register struct partition *pp; 29130519Ssam struct vba_device *vi; 29230756Skarels int s, error, part = vdpart(dev), mask = 1 << part; 29330519Ssam daddr_t start, end; 29424004Ssam 29530519Ssam if (unit >= NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0) 29630519Ssam return (ENXIO); 29730519Ssam lp = &dklabel[unit]; 29830519Ssam dk = &dksoftc[unit]; 29930519Ssam 30030519Ssam s = spl7(); 30130519Ssam while (dk->dk_state != OPEN && dk->dk_state != OPENRAW && 30230519Ssam dk->dk_state != CLOSED) 30330519Ssam sleep((caddr_t)dk, PZERO+1); 30430519Ssam splx(s); 30530519Ssam if (dk->dk_state != OPEN && dk->dk_state != OPENRAW) 30630519Ssam if (error = vdinit(dev, flags)) 30730519Ssam return (error); 30830573Skarels 30930573Skarels if (vdwstart == 0) { 31030573Skarels timeout(vdwatch, (caddr_t)0, hz); 31130573Skarels vdwstart++; 31230573Skarels } 31330519Ssam /* 31430519Ssam * Warn if a partion is opened 31530519Ssam * that overlaps another partition which is open 31630519Ssam * unless one is the "raw" partition (whole disk). 31730519Ssam */ 31832211Skarels #define RAWPART 8 /* 'x' partition */ /* XXX */ 31932576Skarels if ((dk->dk_openpart & mask) == 0 && part != RAWPART) { 32030519Ssam pp = &lp->d_partitions[part]; 32130519Ssam start = pp->p_offset; 32230519Ssam end = pp->p_offset + pp->p_size; 32330519Ssam for (pp = lp->d_partitions; 32430519Ssam pp < &lp->d_partitions[lp->d_npartitions]; pp++) { 32530519Ssam if (pp->p_offset + pp->p_size <= start || 32630519Ssam pp->p_offset >= end) 32730519Ssam continue; 32830519Ssam if (pp - lp->d_partitions == RAWPART) 32930519Ssam continue; 33030519Ssam if (dk->dk_openpart & (1 << (pp - lp->d_partitions))) 33130519Ssam log(LOG_WARNING, 33230519Ssam "dk%d%c: overlaps open partition (%c)\n", 33330519Ssam unit, part + 'a', 33430519Ssam pp - lp->d_partitions + 'a'); 33530519Ssam } 33624004Ssam } 33730519Ssam if (part >= lp->d_npartitions) 33830519Ssam return (ENXIO); 33930756Skarels dk->dk_openpart |= mask; 34030756Skarels switch (fmt) { 34130756Skarels case S_IFCHR: 34230756Skarels dk->dk_copenpart |= mask; 34330756Skarels break; 34430756Skarels case S_IFBLK: 34530756Skarels dk->dk_bopenpart |= mask; 34630756Skarels break; 34730756Skarels } 34830519Ssam return (0); 34925675Ssam } 35024004Ssam 35134528Skarels /* ARGSUSED */ 35230756Skarels vdclose(dev, flags, fmt) 35330519Ssam dev_t dev; 35430756Skarels int flags, fmt; 35524004Ssam { 35630519Ssam register int unit = vdunit(dev); 35730519Ssam register struct dksoftc *dk = &dksoftc[unit]; 35830756Skarels int part = vdpart(dev), mask = 1 << part; 35924004Ssam 36030756Skarels switch (fmt) { 36130756Skarels case S_IFCHR: 36230756Skarels dk->dk_copenpart &= ~mask; 36330756Skarels break; 36430756Skarels case S_IFBLK: 36530756Skarels dk->dk_bopenpart &= ~mask; 36630756Skarels break; 36730756Skarels } 36830756Skarels if (((dk->dk_copenpart | dk->dk_bopenpart) & mask) == 0) 36930756Skarels dk->dk_openpart &= ~mask; 37030519Ssam /* 37130519Ssam * Should wait for i/o to complete on this partition 37230519Ssam * even if others are open, but wait for work on blkflush(). 37330519Ssam */ 37430519Ssam if (dk->dk_openpart == 0) { 37530573Skarels int s = spl7(); 37630573Skarels while (dkutab[unit].b_actf) 37730573Skarels sleep((caddr_t)dk, PZERO-1); 37830519Ssam splx(s); 37930519Ssam dk->dk_state = CLOSED; 38034076Skarels dk->dk_wlabel = 0; 38124004Ssam } 38230756Skarels return (0); 38325675Ssam } 38424004Ssam 38530519Ssam vdinit(dev, flags) 38630519Ssam dev_t dev; 38730519Ssam int flags; 38825675Ssam { 38930519Ssam register struct disklabel *lp; 39030519Ssam register struct dksoftc *dk; 39130519Ssam struct vba_device *vi; 39230519Ssam int unit = vdunit(dev), error = 0; 39330756Skarels char *msg, *readdisklabel(); 39430519Ssam extern int cold; 39525675Ssam 39630519Ssam dk = &dksoftc[unit]; 39730519Ssam if (flags & O_NDELAY) { 39830519Ssam dk->dk_state = OPENRAW; 39934528Skarels return (0); 40030519Ssam } 40130519Ssam dk->dk_state = RDLABEL; 40230519Ssam lp = &dklabel[unit]; 40330519Ssam vi = vddinfo[unit]; 40430756Skarels if (msg = readdisklabel(dev, vdstrategy, lp)) { 40534076Skarels if (cold) { 40630601Skarels printf(": %s", msg); 40734076Skarels dk->dk_state = CLOSED; 40834076Skarels } else { 40932211Skarels log(LOG_ERR, "dk%d: %s\n", unit, msg); 41034076Skarels dk->dk_state = OPENRAW; 41134076Skarels } 41230519Ssam #ifdef COMPAT_42 41334076Skarels if (vdmaptype(vi, lp)) 41430519Ssam dk->dk_state = OPEN; 41530519Ssam #endif 41630756Skarels } else { 41730756Skarels /* 41830756Skarels * Now that we have the label, configure 41930756Skarels * the correct drive parameters. 42030756Skarels */ 42132211Skarels if (vdreset_drive(vi)) 42232211Skarels dk->dk_state = OPEN; 42332211Skarels else { 42430756Skarels dk->dk_state = CLOSED; 42530756Skarels error = ENXIO; 42632211Skarels } 42725675Ssam } 42830756Skarels #ifndef SECSIZE 42932211Skarels vd_setsecsize(dk, lp); 43032211Skarels #endif 43130519Ssam wakeup((caddr_t)dk); 43230519Ssam return (error); 43324004Ssam } 43424004Ssam 43532211Skarels #ifndef SECSIZE 43632211Skarels vd_setsecsize(dk, lp) 43732211Skarels register struct dksoftc *dk; 43832211Skarels register struct disklabel *lp; 43932211Skarels { 44032211Skarels int mul; 44132211Skarels 44232211Skarels /* 44332211Skarels * Calculate scaling shift for mapping 44432211Skarels * DEV_BSIZE blocks to drive sectors. 44532211Skarels */ 44632211Skarels mul = DEV_BSIZE / lp->d_secsize; 44732211Skarels dk->dk_bshift = 0; 44832211Skarels while ((mul >>= 1) > 0) 44932211Skarels dk->dk_bshift++; 45032211Skarels } 45132211Skarels #endif SECSIZE 45232211Skarels 45325675Ssam /*ARGSUSED*/ 45430519Ssam vddgo(vm) 45530519Ssam struct vba_device *vm; 45624004Ssam { 45724004Ssam 45824004Ssam } 45924004Ssam 46024004Ssam vdstrategy(bp) 46125675Ssam register struct buf *bp; 46224004Ssam { 46330519Ssam register struct vba_device *vi; 46430519Ssam register struct disklabel *lp; 46530519Ssam register struct dksoftc *dk; 46630519Ssam register int unit; 46730573Skarels register daddr_t sn; 46830519Ssam struct buf *dp; 46930573Skarels daddr_t sz, maxsz; 47030519Ssam int part, s; 47124004Ssam 47230519Ssam unit = vdunit(bp->b_dev); 47332211Skarels if (unit >= NDK) { 47429954Skarels bp->b_error = ENXIO; 47525675Ssam goto bad; 47629954Skarels } 47730519Ssam vi = vddinfo[unit]; 47830519Ssam lp = &dklabel[unit]; 47930519Ssam if (vi == 0 || vi->ui_alive == 0) { 48030519Ssam bp->b_error = ENXIO; 48130519Ssam goto bad; 48230519Ssam } 48330519Ssam dk = &dksoftc[unit]; 48430519Ssam if (dk->dk_state < OPEN) 48530519Ssam goto q; 48634076Skarels if (dk->dk_state != OPEN && (bp->b_flags & B_READ) == 0) { 48734076Skarels bp->b_error = EROFS; 48834076Skarels goto bad; 48934076Skarels } 49030519Ssam part = vdpart(bp->b_dev); 49130519Ssam if ((dk->dk_openpart & (1 << part)) == 0) { 49230519Ssam bp->b_error = ENODEV; 49330519Ssam goto bad; 49430519Ssam } 49532211Skarels sz = (bp->b_bcount + lp->d_secsize - 1) / lp->d_secsize; 49630519Ssam maxsz = lp->d_partitions[part].p_size; 49730756Skarels #ifndef SECSIZE 49830756Skarels sn = bp->b_blkno << dk->dk_bshift; 49930756Skarels #else SECSIZE 50030573Skarels sn = bp->b_blkno; 50130756Skarels #endif SECSIZE 50234076Skarels if (sn + lp->d_partitions[part].p_offset <= LABELSECTOR && 50334076Skarels #if LABELSECTOR != 0 50434076Skarels sn + lp->d_partitions[part].p_offset + sz > LABELSECTOR && 50534076Skarels #endif 50634076Skarels (bp->b_flags & B_READ) == 0 && dk->dk_wlabel == 0) { 50734076Skarels bp->b_error = EROFS; 50834076Skarels goto bad; 50934076Skarels } 51030519Ssam if (sn < 0 || sn + sz > maxsz) { 51130519Ssam if (sn == maxsz) { 51229954Skarels bp->b_resid = bp->b_bcount; 51329954Skarels goto done; 51429954Skarels } 51530756Skarels sz = maxsz - sn; 51630573Skarels if (sz <= 0) { 51730573Skarels bp->b_error = EINVAL; 51830573Skarels goto bad; 51930573Skarels } 52030573Skarels bp->b_bcount = sz * lp->d_secsize; 52125675Ssam } 52230519Ssam bp->b_cylin = (sn + lp->d_partitions[part].p_offset) / lp->d_secpercyl; 52330756Skarels #ifdef SECSIZE 52430756Skarels if (bp->b_blksize != lp->d_secsize && (bp->b_flags & B_PGIN) == 0) 52530756Skarels panic("vdstrat blksize"); 52630756Skarels #endif SECSIZE 52730519Ssam q: 52825675Ssam s = spl7(); 52930519Ssam dp = &dkutab[vi->ui_unit]; 53030519Ssam disksort(dp, bp); 53130519Ssam if (!dp->b_active) { 53230519Ssam (void) vdustart(vi); 53330573Skarels if (!vi->ui_mi->um_tab.b_active) 53430519Ssam vdstart(vi->ui_mi); 53524004Ssam } 53630519Ssam splx(s); 53724004Ssam return; 53825675Ssam bad: 53929954Skarels bp->b_flags |= B_ERROR; 54029954Skarels done: 54130519Ssam biodone(bp); 54230519Ssam return; 54324004Ssam } 54424004Ssam 54530519Ssam vdustart(vi) 54630519Ssam register struct vba_device *vi; 54724004Ssam { 54830519Ssam register struct buf *bp, *dp; 54930519Ssam register struct vba_ctlr *vm; 55030519Ssam register int unit = vi->ui_unit; 55130519Ssam register struct dksoftc *dk; 55230519Ssam register struct vdsoftc *vd; 55330519Ssam struct disklabel *lp; 55424004Ssam 55530519Ssam dp = &dkutab[unit]; 55630519Ssam /* 55730519Ssam * If queue empty, nothing to do. 55830519Ssam */ 55930519Ssam if ((bp = dp->b_actf) == NULL) 56030519Ssam return; 56130519Ssam /* 56230574Skarels * If drive is off-cylinder and controller supports seeks, 56330574Skarels * place drive on seek queue for controller. 56430574Skarels * Otherwise, place on transfer queue. 56530519Ssam */ 56630519Ssam vd = &vdsoftc[vi->ui_ctlr]; 56730519Ssam dk = &dksoftc[unit]; 56830574Skarels vm = vi->ui_mi; 56930519Ssam if (bp->b_cylin != dk->dk_curcyl && vd->vd_flags&VD_DOSEEKS) { 57030519Ssam lp = &dklabel[unit]; 57130574Skarels bp->b_track = (bp->b_blkno % lp->d_secpercyl) / lp->d_nsectors; 57230574Skarels if (vm->um_tab.b_seekf == NULL) 57330574Skarels vm->um_tab.b_seekf = dp; 57430574Skarels else 57530574Skarels vm->um_tab.b_seekl->b_forw = dp; 57630574Skarels vm->um_tab.b_seekl = dp; 57730574Skarels } else { 57830574Skarels if (vm->um_tab.b_actf == NULL) 57930574Skarels vm->um_tab.b_actf = dp; 58030574Skarels else 58130574Skarels vm->um_tab.b_actl->b_forw = dp; 58230574Skarels vm->um_tab.b_actl = dp; 58330519Ssam } 58430573Skarels dp->b_forw = NULL; 58530573Skarels dp->b_active++; 58625675Ssam } 58725675Ssam 58825675Ssam /* 58930519Ssam * Start next transfer on a controller. 59030574Skarels * There are two queues of drives, the first on-cylinder 59130574Skarels * and the second off-cylinder from their next transfers. 59230574Skarels * Perform the first transfer for the first drive on the on-cylinder 59330574Skarels * queue, if any, otherwise the first transfer for the first drive 59430574Skarels * on the second queue. Initiate seeks on remaining drives on the 59530574Skarels * off-cylinder queue, then move them all to the on-cylinder queue. 59625675Ssam */ 59730519Ssam vdstart(vm) 59830519Ssam register struct vba_ctlr *vm; 59925675Ssam { 60025675Ssam register struct buf *bp; 60130519Ssam register struct vba_device *vi; 60230519Ssam register struct vdsoftc *vd; 60330519Ssam register struct dksoftc *dk; 60430519Ssam register struct disklabel *lp; 60530519Ssam register struct dcb **dcbp; 60630519Ssam struct buf *dp; 60730519Ssam int sn, tn; 60825675Ssam 60930519Ssam loop: 61030519Ssam /* 61130519Ssam * Pull a request off the controller queue. 61230519Ssam */ 61330574Skarels if ((dp = vm->um_tab.b_actf) == NULL && 61430574Skarels (dp = vm->um_tab.b_seekf) == NULL) 61530519Ssam return; 61630519Ssam if ((bp = dp->b_actf) == NULL) { 61730601Skarels if (dp == vm->um_tab.b_actf) 61830601Skarels vm->um_tab.b_actf = dp->b_forw; 61930601Skarels else 62030601Skarels vm->um_tab.b_seekf = dp->b_forw; 62130519Ssam goto loop; 62230519Ssam } 62325675Ssam 62424004Ssam /* 62530519Ssam * Mark controller busy, and determine 62630519Ssam * destination of this request. 62724004Ssam */ 62830519Ssam vm->um_tab.b_active++; 62930519Ssam vi = vddinfo[vdunit(bp->b_dev)]; 63030519Ssam dk = &dksoftc[vi->ui_unit]; 63130756Skarels #ifndef SECSIZE 63230756Skarels sn = bp->b_blkno << dk->dk_bshift; 63330756Skarels #else SECSIZE 63430573Skarels sn = bp->b_blkno; 63530756Skarels #endif SECSIZE 63630519Ssam lp = &dklabel[vi->ui_unit]; 63730519Ssam sn %= lp->d_secpercyl; 63830519Ssam tn = sn / lp->d_nsectors; 63930519Ssam sn %= lp->d_nsectors; 64030519Ssam 64130519Ssam /* 64230519Ssam * Construct dcb for read/write command. 64330519Ssam */ 64430519Ssam vd = &vdsoftc[vm->um_ctlr]; 64530519Ssam vd->vd_dcb.intflg = DCBINT_DONE; 64632211Skarels vd->vd_dcb.devselect = dk->dk_dcb.devselect; 64730519Ssam vd->vd_dcb.operrsta = 0; 64830519Ssam vd->vd_dcb.nxtdcb = (struct dcb *)0; /* end of chain */ 64930519Ssam vd->vd_dcb.trail.rwtrail.disk.cylinder = bp->b_cylin; 65030519Ssam vd->vd_dcb.trail.rwtrail.disk.track = tn; 65130519Ssam vd->vd_dcb.trail.rwtrail.disk.sector = sn; 65230574Skarels dk->dk_curcyl = bp->b_cylin; 65330574Skarels bp->b_track = 0; /* init overloaded field */ 65430756Skarels vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long); 65534396Skarels if (bp->b_flags & B_FORMAT) 65634396Skarels vd->vd_dcb.opcode = dk->dk_op; 65734396Skarels else if (vd->vd_flags & VD_SCATGATH && 65834396Skarels ((int)bp->b_un.b_addr & (sizeof(long) - 1)) == 0) 65930756Skarels vd->vd_dcb.opcode = (bp->b_flags & B_READ)? VDOP_RAS : VDOP_GAW; 66034396Skarels else 66130756Skarels vd->vd_dcb.opcode = (bp->b_flags & B_READ)? VDOP_RD : VDOP_WD; 66234396Skarels 66334396Skarels switch (vd->vd_dcb.opcode) { 66434396Skarels case VDOP_FSECT: 66534396Skarels vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long); 66634396Skarels vd->vd_dcb.trail.fmtrail.nsectors = bp->b_bcount / 66734396Skarels lp->d_secsize; 66834396Skarels vd->vd_dcb.trail.fmtrail.hdr = *(dskadr *)&dk->dk_althdr; 66934396Skarels vd->vd_dcb.trail.rwtrail.disk.cylinder |= dk->dk_fmtflags; 67034396Skarels goto setupaddr; 67134396Skarels 67234396Skarels case VDOP_RDRAW: 67334396Skarels case VDOP_RD: 67434396Skarels case VDOP_WD: 67534396Skarels vd->vd_dcb.trail.rwtrail.wcount = (bp->b_bcount+1) >> 1; 67634396Skarels setupaddr: 67730756Skarels vd->vd_dcb.trail.rwtrail.memadr = 67834528Skarels vbasetup(bp, &vd->vd_rbuf, (int)lp->d_secsize); 67934396Skarels break; 68034396Skarels 68134396Skarels case VDOP_RAS: 68234396Skarels case VDOP_GAW: 68334396Skarels vd->vd_dcb.trailcnt += vba_sgsetup(bp, &vd->vd_rbuf, 68434396Skarels &vd->vd_dcb.trail.sgtrail); 68534396Skarels break; 68630756Skarels } 68730574Skarels if (vi->ui_dk >= 0) { 68830574Skarels dk_busy |= 1<<vi->ui_dk; 68930574Skarels dk_xfer[vi->ui_dk]++; 69030574Skarels dk_wds[vi->ui_dk] += bp->b_bcount>>6; 69130574Skarels } 69230519Ssam 69330519Ssam /* 69430519Ssam * Look for any seeks to be performed on other drives on this 69530519Ssam * controller. If overlapped seeks exist, insert seek commands 69630519Ssam * on the controller's command queue before the transfer. 69730519Ssam */ 69830519Ssam dcbp = &vd->vd_mdcb.mdcb_head; 69930519Ssam 70030574Skarels if (dp == vm->um_tab.b_seekf) 70130574Skarels dp = dp->b_forw; 70230574Skarels else 70330574Skarels dp = vm->um_tab.b_seekf; 70430574Skarels for (; dp != NULL; dp = dp->b_forw) { 70530574Skarels if ((bp = dp->b_actf) == NULL) 70630574Skarels continue; 70730574Skarels vi = vddinfo[vdunit(bp->b_dev)]; 70830574Skarels dk = &dksoftc[vi->ui_unit]; 70930519Ssam dk->dk_curcyl = bp->b_cylin; 71030574Skarels if (vi->ui_dk >= 0) 71130574Skarels dk_seek[vi->ui_dk]++; 71230574Skarels dk->dk_dcb.operrsta = 0; 71330574Skarels dk->dk_dcb.trail.sktrail.skaddr.cylinder = bp->b_cylin; 71430574Skarels dk->dk_dcb.trail.sktrail.skaddr.track = bp->b_track; 71530574Skarels *dcbp = (struct dcb *)dk->dk_dcbphys; 71630574Skarels dcbp = &dk->dk_dcb.nxtdcb; 71724004Ssam } 71830519Ssam *dcbp = (struct dcb *)vd->vd_dcbphys; 71930574Skarels if (vm->um_tab.b_actf) 72030574Skarels vm->um_tab.b_actl->b_forw = vm->um_tab.b_seekf; 72130574Skarels else 72230574Skarels vm->um_tab.b_actf = vm->um_tab.b_seekf; 72330601Skarels if (vm->um_tab.b_seekf) 72430601Skarels vm->um_tab.b_actl = vm->um_tab.b_seekl; 72530574Skarels vm->um_tab.b_seekf = 0; 72624004Ssam 72730519Ssam /* 72830519Ssam * Initiate operation. 72930519Ssam */ 73030519Ssam vd->vd_mdcb.mdcb_status = 0; 73130519Ssam VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type); 73224004Ssam } 73324004Ssam 73430519Ssam #define DONTCARE (DCBS_DSE|DCBS_DSL|DCBS_TOP|DCBS_TOM|DCBS_FAIL|DCBS_DONE) 73524004Ssam /* 73624004Ssam * Handle a disk interrupt. 73724004Ssam */ 73825675Ssam vdintr(ctlr) 73930519Ssam register ctlr; 74024004Ssam { 74130519Ssam register struct buf *bp, *dp; 74230519Ssam register struct vba_ctlr *vm = vdminfo[ctlr]; 74330519Ssam register struct vba_device *vi; 74430519Ssam register struct vdsoftc *vd = &vdsoftc[ctlr]; 74530519Ssam register status; 74634528Skarels int timedout; 74730573Skarels struct dksoftc *dk; 74824004Ssam 74930519Ssam if (!vm->um_tab.b_active) { 75025675Ssam printf("vd%d: stray interrupt\n", ctlr); 75124004Ssam return; 75224004Ssam } 75325675Ssam /* 75430519Ssam * Get device and block structures, and a pointer 75530519Ssam * to the vba_device for the drive. 75625675Ssam */ 75730519Ssam dp = vm->um_tab.b_actf; 75830519Ssam bp = dp->b_actf; 75930519Ssam vi = vddinfo[vdunit(bp->b_dev)]; 76034528Skarels dk = &dksoftc[vi->ui_unit]; 76130574Skarels if (vi->ui_dk >= 0) 76230574Skarels dk_busy &= ~(1<<vi->ui_dk); 76334396Skarels timedout = (vd->vd_wticks >= VDMAXTIME); 76430519Ssam /* 76530519Ssam * Check for and process errors on 76630519Ssam * either the drive or the controller. 76730519Ssam */ 76830519Ssam uncache(&vd->vd_dcb.operrsta); 76930519Ssam status = vd->vd_dcb.operrsta; 77034396Skarels if (bp->b_flags & B_FORMAT) { 77134396Skarels dk->dk_operrsta = status; 77234396Skarels uncache(&vd->vd_dcb.err_code); 77334396Skarels dk->dk_ecode = vd->vd_dcb.err_code; 77434396Skarels } 77534396Skarels if (status & VDERR_HARD || timedout) { 77634528Skarels if (vd->vd_type == VDTYPE_SMDE) 77730601Skarels uncache(&vd->vd_dcb.err_code); 77830519Ssam if (status & DCBS_WPT) { 77930519Ssam /* 78030519Ssam * Give up on write locked devices immediately. 78130519Ssam */ 78230573Skarels printf("dk%d: write locked\n", vi->ui_unit); 78330519Ssam bp->b_flags |= B_ERROR; 78434396Skarels } else if (status & VDERR_RETRY || timedout) { 78532211Skarels int endline = 1; 78632211Skarels 78734396Skarels if (status & VDERR_CTLR || timedout) { 78834396Skarels vdharderr("controller err", 78934396Skarels vd, bp, &vd->vd_dcb); 79034396Skarels printf("; resetting controller..."); 79134396Skarels vdreset_ctlr(vm); 79234396Skarels } else if (status & VDERR_DRIVE) { 79334396Skarels vdharderr("drive err", vd, bp, &vd->vd_dcb); 79434396Skarels printf("; resetting drive..."); 79530519Ssam if (!vdreset_drive(vi)) 79630519Ssam vi->ui_alive = 0; 79732211Skarels } else 79832211Skarels endline = 0; 79930519Ssam /* 80030519Ssam * Retry transfer once, unless reset failed. 80130519Ssam */ 80234396Skarels if (!vi->ui_alive || dp->b_errcnt++ >= 2 || 80334396Skarels bp->b_flags & B_FORMAT) { 80432211Skarels if (endline) 80532211Skarels printf("\n"); 80630519Ssam goto hard; 80732211Skarels } 80832211Skarels 80932211Skarels if (endline) 81032211Skarels printf(" retrying\n"); 81130519Ssam vm->um_tab.b_active = 0; /* force retry */ 81230519Ssam } else { 81330519Ssam hard: 81430519Ssam bp->b_flags |= B_ERROR; 81534396Skarels vdharderr("hard error", vd, bp, &vd->vd_dcb); 81630519Ssam printf("\n"); 81730519Ssam } 81830519Ssam } else if (status & DCBS_SOFT) 81934528Skarels vdsofterr(bp, &vd->vd_dcb); 82034396Skarels vd->vd_wticks = 0; 82130519Ssam if (vm->um_tab.b_active) { 82230519Ssam vm->um_tab.b_active = 0; 82330519Ssam vm->um_tab.b_actf = dp->b_forw; 82430519Ssam dp->b_active = 0; 82530519Ssam dp->b_errcnt = 0; 82630519Ssam dp->b_actf = bp->av_forw; 82730519Ssam bp->b_resid = 0; 82830601Skarels vbadone(bp, &vd->vd_rbuf); 82930519Ssam biodone(bp); 83030370Skarels /* 83130519Ssam * If this unit has more work to do, 83230519Ssam * then start it up right away. 83330370Skarels */ 83430519Ssam if (dp->b_actf) 83530519Ssam vdustart(vi); 83634528Skarels else if (dk->dk_openpart == 0) 83730573Skarels wakeup((caddr_t)dk); 83824004Ssam } 83925675Ssam /* 84030519Ssam * If there are devices ready to 84130519Ssam * transfer, start the controller. 84225675Ssam */ 84330601Skarels if (vm->um_tab.b_actf || vm->um_tab.b_seekf) 84430519Ssam vdstart(vm); 84524004Ssam } 84624004Ssam 84734396Skarels vdharderr(what, vd, bp, dcb) 84834396Skarels char *what; 84934396Skarels struct vdsoftc *vd; 85034396Skarels register struct buf *bp; 85134396Skarels register struct dcb *dcb; 85234396Skarels { 85334396Skarels int unit = vdunit(bp->b_dev), status = dcb->operrsta; 85434396Skarels register struct disklabel *lp = &dklabel[unit]; 85534528Skarels int blkdone; 85634396Skarels 85734396Skarels if (vd->vd_wticks < VDMAXTIME) 85834396Skarels status &= ~DONTCARE; 85934710Skarels blkdone = ((((dcb->err_cyl & 0xfff) * lp->d_ntracks + dcb->err_trk) * 86034710Skarels lp->d_nsectors + dcb->err_sec - 86134710Skarels lp->d_partitions[vdpart(bp->b_dev)].p_offset) >> 86234710Skarels dksoftc[unit].dk_bshift) - bp->b_blkno; 86334528Skarels diskerr(bp, "dk", what, LOG_PRINTF, blkdone, lp); 86434528Skarels printf(", status %b", status, VDERRBITS); 86534396Skarels if (vd->vd_type == VDTYPE_SMDE) 86634396Skarels printf(" ecode %x", dcb->err_code); 86734396Skarels } 86834396Skarels 86934528Skarels vdsofterr(bp, dcb) 87025675Ssam register struct buf *bp; 87130519Ssam register struct dcb *dcb; 87225675Ssam { 87334562Skarels int unit = vdunit(bp->b_dev); 87434562Skarels struct disklabel *lp = &dklabel[unit]; 87534528Skarels int status = dcb->operrsta; 87634528Skarels int blkdone; 87725675Ssam 87834710Skarels blkdone = ((((dcb->err_cyl & 0xfff) * lp->d_ntracks + dcb->err_trk) * 87934710Skarels lp->d_nsectors + dcb->err_sec - 88034710Skarels lp->d_partitions[vdpart(bp->b_dev)].p_offset) >> 88134710Skarels dksoftc[unit].dk_bshift) - bp->b_blkno; 88234528Skarels 88334528Skarels if (status != (DCBS_CCD|DCBS_SOFT|DCBS_ERR|DCBS_DONE)) { 88434528Skarels diskerr(bp, "dk", "soft error", LOG_WARNING, blkdone, lp); 88534528Skarels addlog(", status %b ecode %x\n", status, VDERRBITS, 88634396Skarels dcb->err_code); 88734528Skarels } else { 88834528Skarels diskerr(bp, "dk", "soft ecc", LOG_WARNING, blkdone, lp); 88934528Skarels addlog("\n"); 89034528Skarels } 89125675Ssam } 89225675Ssam 89330519Ssam vdioctl(dev, cmd, data, flag) 89425675Ssam dev_t dev; 89530519Ssam int cmd; 89630519Ssam caddr_t data; 89730519Ssam int flag; 89824004Ssam { 89932576Skarels register int unit = vdunit(dev); 90030519Ssam register struct disklabel *lp = &dklabel[unit]; 90134076Skarels register struct dksoftc *dk = &dksoftc[unit]; 90234640Skarels int error = 0, vdformat(); 90324004Ssam 90430519Ssam switch (cmd) { 90530519Ssam 90630519Ssam case DIOCGDINFO: 90730519Ssam *(struct disklabel *)data = *lp; 90830519Ssam break; 90930519Ssam 91030573Skarels case DIOCGPART: 91130573Skarels ((struct partinfo *)data)->disklab = lp; 91230573Skarels ((struct partinfo *)data)->part = 91330573Skarels &lp->d_partitions[vdpart(dev)]; 91430519Ssam break; 91530519Ssam 91630519Ssam case DIOCSDINFO: 91730519Ssam if ((flag & FWRITE) == 0) 91830519Ssam error = EBADF; 91930519Ssam else 92032576Skarels error = setdisklabel(lp, (struct disklabel *)data, 92134076Skarels (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart); 92234396Skarels if (error == 0 && dk->dk_state == OPENRAW && 92334396Skarels vdreset_drive(vddinfo[unit])) 92434076Skarels dk->dk_state = OPEN; 92530519Ssam break; 92630519Ssam 92734076Skarels case DIOCWLABEL: 92834076Skarels if ((flag & FWRITE) == 0) 92934076Skarels error = EBADF; 93034076Skarels else 93134076Skarels dk->dk_wlabel = *(int *)data; 93234076Skarels break; 93334076Skarels 93432576Skarels case DIOCWDINFO: 93532576Skarels if ((flag & FWRITE) == 0) 93630519Ssam error = EBADF; 93732576Skarels else if ((error = setdisklabel(lp, (struct disklabel *)data, 93834076Skarels (dk->dk_state == OPENRAW) ? 0 : dk->dk_openpart)) == 0) { 93934640Skarels int wlab; 94034640Skarels 94134076Skarels dk->dk_state = OPEN; 94234640Skarels /* simulate opening partition 0 so write succeeds */ 94334640Skarels dk->dk_openpart |= (1 << 0); /* XXX */ 94434640Skarels wlab = dk->dk_wlabel; 94534640Skarels dk->dk_wlabel = 1; 94632576Skarels error = writedisklabel(dev, vdstrategy, lp); 94734640Skarels dk->dk_openpart = dk->dk_copenpart | dk->dk_bopenpart; 94834640Skarels dk->dk_wlabel = wlab; 94934076Skarels } 95030519Ssam break; 95130519Ssam 95234396Skarels case DIOCWFORMAT: 95334396Skarels { 95434396Skarels register struct format_op *fop; 95534396Skarels struct uio auio; 95634396Skarels struct iovec aiov; 95734396Skarels 95834396Skarels if ((flag & FWRITE) == 0) { 95934396Skarels error = EBADF; 96034396Skarels break; 96134396Skarels } 96234396Skarels fop = (struct format_op *)data; 96334396Skarels aiov.iov_base = fop->df_buf; 96434396Skarels aiov.iov_len = fop->df_count; 96534396Skarels auio.uio_iov = &aiov; 96634396Skarels auio.uio_iovcnt = 1; 96734396Skarels auio.uio_resid = fop->df_count; 96834396Skarels auio.uio_segflg = UIO_USERSPACE; 96934396Skarels auio.uio_offset = fop->df_startblk * lp->d_secsize; 97034396Skarels dk->dk_operrsta = fop->dk_operrsta; 97134396Skarels dk->dk_ecode = fop->dk_ecode; 97234396Skarels /* 97334396Skarels * Don't return errors, as the format op won't get copied 97434396Skarels * out if we return nonzero. Callers must check the returned 97534396Skarels * count. 97634396Skarels */ 97734396Skarels (void) physio(vdformat, (struct buf *)NULL, dev, 97834396Skarels (cmd == DIOCWFORMAT ? B_WRITE : B_READ), minphys, &auio); 97934396Skarels fop->df_count -= auio.uio_resid; 98034396Skarels fop->dk_operrsta = dk->dk_operrsta; 98134396Skarels fop->dk_ecode = dk->dk_ecode; 98234396Skarels break; 98334396Skarels } 98434396Skarels 98530519Ssam default: 98630519Ssam error = ENOTTY; 98730519Ssam break; 98824004Ssam } 98932606Skarels return (error); 99024004Ssam } 99124004Ssam 99234396Skarels vdformat(bp) 99334396Skarels struct buf *bp; 99434396Skarels { 99534396Skarels bp->b_flags |= B_FORMAT; 99634396Skarels vdstrategy(bp); 99734396Skarels } 99834396Skarels 99925675Ssam /* 100030519Ssam * Watch for lost interrupts. 100125675Ssam */ 100230519Ssam vdwatch() 100330519Ssam { 100430519Ssam register struct vdsoftc *vd; 100530519Ssam register struct vba_ctlr *vm; 100634528Skarels register int ctlr; 100734396Skarels int s; 100830519Ssam 100930519Ssam timeout(vdwatch, (caddr_t)0, hz); 101030519Ssam for (ctlr = 0; ctlr < NVD; ctlr++) { 101130519Ssam vm = vdminfo[ctlr]; 101230519Ssam if (vm == 0 || vm->um_alive == 0) 101330519Ssam continue; 101430519Ssam vd = &vdsoftc[ctlr]; 101534396Skarels s = spl7(); 101634396Skarels if (vm->um_tab.b_active && vd->vd_wticks++ >= VDMAXTIME) { 101730519Ssam printf("vd%d: lost interrupt\n", ctlr); 101834396Skarels #ifdef maybe 101934396Skarels VDABORT((struct vddevice *)vm->um_addr, vd->vd_type); 102034396Skarels #endif 102134396Skarels vdintr(ctlr); 102230519Ssam } 102334396Skarels splx(s); 102430519Ssam } 102530519Ssam } 102630519Ssam 102730519Ssam #define DBSIZE 64 /* controller limit with 1K sectors */ 102830519Ssam /* 102930519Ssam * Crash dump. 103030519Ssam */ 103130519Ssam vddump(dev) 103230519Ssam dev_t dev; 103324004Ssam { 103430519Ssam register struct vba_device *vi; 103530519Ssam register struct vba_ctlr *vm; 103630519Ssam register struct disklabel *lp; 103730519Ssam register struct vdsoftc *vd; 103830519Ssam struct dksoftc *dk; 103930519Ssam int part, unit, num; 104030601Skarels u_long start; 104124004Ssam 104230519Ssam start = 0; 104330519Ssam unit = vdunit(dev); 104430519Ssam if (unit > NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0) 104530519Ssam return (ENXIO); 104630519Ssam dk = &dksoftc[unit]; 104734076Skarels if (dk->dk_state != OPEN && dk->dk_state != OPENRAW && 104834076Skarels vdinit(vdminor(unit, 0), 0) != 0) 104930519Ssam return (ENXIO); 105030519Ssam lp = &dklabel[unit]; 105130519Ssam part = vdpart(dev); 105230519Ssam if (part >= lp->d_npartitions) 105330519Ssam return (ENXIO); 105432211Skarels vm = vi->ui_mi; 105530519Ssam vdreset_ctlr(vm); 105630519Ssam if (dumplo < 0) 105730519Ssam return (EINVAL); 105830519Ssam /* 105930756Skarels * Maxfree is in pages, dumplo is in DEV_BSIZE units. 106030519Ssam */ 106130519Ssam num = maxfree * (NBPG / lp->d_secsize); 106230756Skarels dumplo *= DEV_BSIZE / lp->d_secsize; 106330519Ssam if (dumplo + num >= lp->d_partitions[vdpart(dev)].p_size) 106430519Ssam num = lp->d_partitions[vdpart(dev)].p_size - dumplo; 106530519Ssam vd = &vdsoftc[vm->um_ctlr]; 106630519Ssam vd->vd_dcb.intflg = DCBINT_NONE; 106730519Ssam vd->vd_dcb.opcode = VDOP_WD; 106832211Skarels vd->vd_dcb.devselect = dk->dk_dcb.devselect; 106930756Skarels vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long); 107030519Ssam while (num > 0) { 107130519Ssam int nsec, cn, sn, tn; 107230519Ssam 107330519Ssam nsec = MIN(num, DBSIZE); 107430601Skarels sn = dumplo + start / lp->d_secsize; 107530519Ssam cn = (sn + lp->d_partitions[vdpart(dev)].p_offset) / 107630519Ssam lp->d_secpercyl; 107730519Ssam sn %= lp->d_secpercyl; 107830519Ssam tn = sn / lp->d_nsectors; 107930519Ssam sn %= lp->d_nsectors; 108030519Ssam vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys; 108130519Ssam vd->vd_dcb.trail.rwtrail.memadr = start; 108230519Ssam vd->vd_dcb.trail.rwtrail.wcount = (nsec * lp->d_secsize) >> 1; 108330519Ssam vd->vd_dcb.trail.rwtrail.disk.cylinder = cn; 108430519Ssam vd->vd_dcb.trail.rwtrail.disk.track = tn; 108530519Ssam vd->vd_dcb.trail.rwtrail.disk.sector = sn; 108630519Ssam vd->vd_dcb.operrsta = 0; 108730519Ssam VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type); 108830519Ssam if (!vdpoll(vm, 5)) { 108930519Ssam printf(" during dump\n"); 109030519Ssam return (EIO); 109130519Ssam } 109230519Ssam if (vd->vd_dcb.operrsta & VDERR_HARD) { 109330519Ssam printf("dk%d: hard error, status=%b\n", unit, 109430519Ssam vd->vd_dcb.operrsta, VDERRBITS); 109530519Ssam return (EIO); 109630519Ssam } 109730519Ssam start += nsec * lp->d_secsize; 109830519Ssam num -= nsec; 109925675Ssam } 110030519Ssam return (0); 110124004Ssam } 110224004Ssam 110324004Ssam vdsize(dev) 110425675Ssam dev_t dev; 110524004Ssam { 110630519Ssam register int unit = vdunit(dev); 110730519Ssam register struct dksoftc *dk; 110830519Ssam struct vba_device *vi; 110930519Ssam struct disklabel *lp; 111024004Ssam 111130519Ssam if (unit >= NDK || (vi = vddinfo[unit]) == 0 || vi->ui_alive == 0 || 111230519Ssam (dk = &dksoftc[unit])->dk_state != OPEN) 111325675Ssam return (-1); 111430519Ssam lp = &dklabel[unit]; 111530756Skarels #ifdef SECSIZE 111630573Skarels return ((int)lp->d_partitions[vdpart(dev)].p_size); 111730756Skarels #else SECSIZE 111830756Skarels return ((int)lp->d_partitions[vdpart(dev)].p_size >> dk->dk_bshift); 111930756Skarels #endif SECSIZE 112024004Ssam } 112124004Ssam 112225675Ssam /* 112325675Ssam * Perform a controller reset. 112425675Ssam */ 112530519Ssam vdreset_ctlr(vm) 112630519Ssam register struct vba_ctlr *vm; 112724004Ssam { 112830519Ssam register struct vddevice *vdaddr = (struct vddevice *)vm->um_addr; 112930519Ssam register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr]; 113030519Ssam register int unit; 113130519Ssam struct vba_device *vi; 113225675Ssam 113330519Ssam VDRESET(vdaddr, vd->vd_type); 113430519Ssam if (vd->vd_type == VDTYPE_SMDE) { 113530519Ssam vdaddr->vdcsr = 0; 113630519Ssam vdaddr->vdtcf_mdcb = AM_ENPDA; 113730519Ssam vdaddr->vdtcf_dcb = AM_ENPDA; 113830519Ssam vdaddr->vdtcf_trail = AM_ENPDA; 113930519Ssam vdaddr->vdtcf_data = AM_ENPDA; 114030519Ssam vdaddr->vdccf = CCF_STS | XMD_32BIT | BSZ_16WRD | 114125675Ssam CCF_ENP | CCF_EPE | CCF_EDE | CCF_ECE | CCF_ERR; 114225675Ssam } 114330519Ssam if (!vdcmd(vm, VDOP_INIT, 10) || !vdcmd(vm, VDOP_DIAG, 10)) { 114430519Ssam printf("%s cmd failed\n", 114530519Ssam vd->vd_dcb.opcode == VDOP_INIT ? "init" : "diag"); 114630370Skarels return; 114725675Ssam } 114830519Ssam for (unit = 0; unit < NDK; unit++) 114930519Ssam if ((vi = vddinfo[unit])->ui_mi == vm && vi->ui_alive) 115030519Ssam (void) vdreset_drive(vi); 115130519Ssam } 115230519Ssam 115330519Ssam vdreset_drive(vi) 115430519Ssam register struct vba_device *vi; 115530519Ssam { 115630519Ssam register struct disklabel *lp = &dklabel[vi->ui_unit]; 115730519Ssam struct vba_ctlr *vm = vdminfo[vi->ui_ctlr]; 115830519Ssam struct vddevice *vdaddr = (struct vddevice *)vm->um_addr; 115932211Skarels register struct vdsoftc *vd = &vdsoftc[vi->ui_ctlr]; 116032211Skarels register struct dksoftc *dk = &dksoftc[vi->ui_unit]; 116130519Ssam 116230519Ssam top: 116330519Ssam vd->vd_dcb.opcode = VDOP_CONFIG; /* command */ 116430519Ssam vd->vd_dcb.intflg = DCBINT_NONE; 116530519Ssam vd->vd_dcb.nxtdcb = (struct dcb *)0; /* end of chain */ 116630519Ssam vd->vd_dcb.operrsta = 0; 116732211Skarels vd->vd_dcb.devselect = vi->ui_slave | lp->d_devflags; 116830519Ssam vd->vd_dcb.trail.rstrail.ncyl = lp->d_ncylinders; 116930519Ssam vd->vd_dcb.trail.rstrail.nsurfaces = lp->d_ntracks; 117030519Ssam if (vd->vd_type == VDTYPE_SMDE) { 117130756Skarels vd->vd_dcb.trailcnt = sizeof (struct treset) / sizeof (long); 117230519Ssam vd->vd_dcb.trail.rstrail.nsectors = lp->d_nsectors; 117330601Skarels vd->vd_dcb.trail.rstrail.slip_sec = lp->d_sparespertrack; 117432211Skarels vd->vd_dcb.trail.rstrail.recovery = VDRF_NORMAL; 117530519Ssam } else 117630519Ssam vd->vd_dcb.trailcnt = 2; /* XXX */ 117730519Ssam vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys; 117830519Ssam vd->vd_mdcb.mdcb_status = 0; 117930519Ssam VDGO(vdaddr, vd->vd_mdcbphys, vd->vd_type); 118030519Ssam if (!vdpoll(vm, 5)) { 118130519Ssam printf(" during config\n"); 118230519Ssam return (0); 118325675Ssam } 118430519Ssam if (vd->vd_dcb.operrsta & VDERR_HARD) { 118532211Skarels if (vd->vd_type == VDTYPE_SMDE) { 118632211Skarels if (lp->d_devflags == 0) { 118732211Skarels lp->d_devflags = VD_ESDI; 118832211Skarels goto top; 118932211Skarels } 119032211Skarels #ifdef notdef 119132211Skarels /* this doesn't work, STA_US isn't set(?) */ 119232211Skarels if ((vdaddr->vdstatus[vi->ui_slave] & STA_US) == 0) 119332211Skarels return (0); 119432211Skarels #endif 119532211Skarels } 119630519Ssam if ((vd->vd_dcb.operrsta & (DCBS_OCYL|DCBS_NRDY)) == 0) 119732211Skarels printf("dk%d: config error %b ecode %x\n", vi->ui_unit, 119834396Skarels vd->vd_dcb.operrsta, VDERRBITS, 119934396Skarels (u_char) vd->vd_dcb.err_code); 120032211Skarels else if ((vd->vd_flags & VD_STARTED) == 0) { 120130519Ssam int started; 120230519Ssam 120332211Skarels printf(" starting drives, wait ... "); 120430519Ssam vd->vd_flags |= VD_STARTED; 120530519Ssam started = (vdcmd(vm, VDOP_START, 10) == 1); 120630519Ssam DELAY(62000000); 120732211Skarels printf("done"); 120832211Skarels lp->d_devflags = 0; 120930519Ssam if (started) 121030519Ssam goto top; 121130519Ssam } 121230519Ssam return (0); 121330519Ssam } 121432211Skarels dk->dk_dcb.devselect |= lp->d_devflags; 121530519Ssam return (1); 121625675Ssam } 121724004Ssam 121825675Ssam /* 121930519Ssam * Perform a command w/o trailer. 122025675Ssam */ 122130519Ssam vdcmd(vm, cmd, t) 122230519Ssam register struct vba_ctlr *vm; 122325675Ssam { 122430519Ssam register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr]; 122525675Ssam 122630519Ssam vd->vd_dcb.opcode = cmd; /* command */ 122730519Ssam vd->vd_dcb.intflg = DCBINT_NONE; 122830519Ssam vd->vd_dcb.nxtdcb = (struct dcb *)0; /* end of chain */ 122930519Ssam vd->vd_dcb.operrsta = 0; 123030519Ssam vd->vd_dcb.devselect = 0; 123130519Ssam vd->vd_dcb.trailcnt = 0; 123230519Ssam vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys; 123330519Ssam vd->vd_mdcb.mdcb_status = 0; 123430519Ssam VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type); 123530519Ssam if (!vdpoll(vm, t)) { 123630519Ssam printf(" during init\n"); 123730370Skarels return (0); 123830370Skarels } 123930519Ssam return ((vd->vd_dcb.operrsta&VDERR_HARD) == 0); 124025675Ssam } 124125675Ssam 124225925Ssam /* 124330519Ssam * Poll controller until operation 124430519Ssam * completes or timeout expires. 124525925Ssam */ 124630519Ssam vdpoll(vm, t) 124730519Ssam register struct vba_ctlr *vm; 124825925Ssam register int t; 124925925Ssam { 125030519Ssam register struct vdsoftc *vd = &vdsoftc[vm->um_ctlr]; 125130519Ssam register struct vddevice *vdaddr = (struct vddevice *)vm->um_addr; 125225925Ssam 125325925Ssam t *= 1000; 125430370Skarels for (;;) { 125530519Ssam uncache(&vd->vd_dcb.operrsta); 125630519Ssam if (vd->vd_dcb.operrsta & (DCBS_DONE|DCBS_ABORT)) 125730370Skarels break; 125825925Ssam if (--t <= 0) { 125930519Ssam printf("vd%d: controller timeout", vm->um_ctlr); 126030519Ssam VDABORT(vdaddr, vd->vd_type); 126125925Ssam return (0); 126225925Ssam } 126330370Skarels DELAY(1000); 126425925Ssam } 126530519Ssam if (vd->vd_type == VDTYPE_SMDE) { 126630519Ssam do { 126725925Ssam DELAY(50); 126830519Ssam uncache(&vdaddr->vdcsr); 126930519Ssam } while (vdaddr->vdcsr & CS_GO); 127032211Skarels DELAY(300); 127132211Skarels uncache(&vd->vd_dcb.err_code); 127225925Ssam } 127325925Ssam DELAY(200); 127430519Ssam uncache(&vd->vd_dcb.operrsta); 127525925Ssam return (1); 127625925Ssam } 127725925Ssam 127830519Ssam #ifdef COMPAT_42 127930519Ssam struct vdst { 128030519Ssam int nsec; /* sectors/track */ 128130519Ssam int ntrack; /* tracks/cylinder */ 128230519Ssam int ncyl; /* cylinders */ 128332211Skarels int secsize; /* sector size */ 128430519Ssam char *name; /* type name */ 128530519Ssam struct { 128630519Ssam int off; /* partition offset in sectors */ 128730519Ssam int size; /* partition size in sectors */ 128830573Skarels } parts[8]; 128930519Ssam } vdst[] = { 129032211Skarels { 66, 23, 850, 512, "NEC 800", 129132211Skarels {0, 1290300}, /* a cyl 0 - 849 */ 129232211Skarels }, 129334737Sbostic { 64, 20, 842, 512, "2361a", 129434737Sbostic {0, 61440}, /* a cyl 0 - 47 */ 129534737Sbostic {61440, 67840}, /* b cyl 48 - 100 */ 129634737Sbostic {129280, 942080}, /* c cyl 101 - 836 */ 129734737Sbostic {0, 1071360}, /* d cyl 0 - 836 */ 129834737Sbostic {449280, 311040}, /* e cyl 351 - 593 */ 129934737Sbostic {760320, 311040}, /* f cyl 594 - 836 */ 130034737Sbostic {449280, 622080}, /* g cyl 351 - 836 */ 130134737Sbostic {129280, 320000} /* h cyl 101 - 350 */ 130234737Sbostic }, 130332211Skarels { 48, 24, 711, 512, "xsd", 130431039Skarels {0, 61056}, /* a cyl 0 - 52 */ 130531039Skarels {61056, 61056}, /* b cyl 53 - 105 */ 130631039Skarels {122112, 691200}, /* c cyl 106 - 705 */ 130731039Skarels {237312, 576000}, /* d cyl 206 - 705 */ 130831039Skarels {352512, 460800}, /* e cyl 306 - 705 */ 130931039Skarels {467712, 345600}, /* f cyl 406 - 705 */ 131031039Skarels {582912, 230400}, /* g cyl 506 - 705 */ 131131039Skarels {698112, 115200} /* h cyl 606 - 705 */ 131230573Skarels }, 131332211Skarels { 44, 20, 842, 512, "eagle", 131430601Skarels {0, 52800}, /* egl0a cyl 0 - 59 */ 131530601Skarels {52800, 66000}, /* egl0b cyl 60 - 134 */ 131630601Skarels {118800, 617760}, /* egl0c cyl 135 - 836 */ 131730756Skarels {736560, 4400}, /* egl0d cyl 837 - 841 */ 131831039Skarels {0, 736560}, /* egl0e cyl 0 - 836 */ 131931039Skarels {0, 740960}, /* egl0f cyl 0 - 841 */ 132030601Skarels {118800, 310640}, /* egl0g cyl 135 - 487 */ 132130601Skarels {429440, 307120} /* egl0h cyl 488 - 836 */ 132230573Skarels }, 132332211Skarels { 64, 10, 823, 512, "fuj", 132431039Skarels {0, 38400}, /* fuj0a cyl 0 - 59 */ 132531039Skarels {38400, 48000}, /* fuj0b cyl 60 - 134 */ 132631039Skarels {86400, 437120}, /* fuj0c cyl 135 - 817 */ 132731039Skarels {159360, 364160}, /* fuj0d cyl 249 - 817 */ 132831039Skarels {232320, 291200}, /* fuj0e cyl 363 - 817 */ 132931039Skarels {305280, 218240}, /* fuj0f cyl 477 - 817 */ 133031039Skarels {378240, 145280}, /* fuj0g cyl 591 - 817 */ 133131039Skarels {451200, 72320} /* fug0h cyl 705 - 817 */ 133230573Skarels }, 133332211Skarels { 32, 24, 711, 512, "xfd", 133430756Skarels { 0, 40704 }, /* a cyl 0 - 52 */ 133530756Skarels { 40704, 40704 }, /* b cyl 53 - 105 */ 133630756Skarels { 81408, 460800 }, /* c cyl 106 - 705 */ 133730756Skarels { 0, 81408 }, /* d cyl 709 - 710 (a & b) */ 133830756Skarels { 0, 542208 }, /* e cyl 0 - 705 */ 133930756Skarels { 40704, 501504 }, /* f cyl 53 - 705 (b & c) */ 134030756Skarels { 81408, 230400 }, /* g cyl 106 - 405 (1/2 of c) */ 134130756Skarels { 311808,230400 } /* h cyl 406 - 705 (1/2 of c) */ 134230573Skarels }, 134332211Skarels { 32, 19, 823, 512, "smd", 134431039Skarels {0, 40128}, /* a cyl 0-65 */ 134531039Skarels {40128, 27360}, /* b cyl 66-110 */ 134631039Skarels {67488, 429856}, /* c cyl 111-817 */ 134731039Skarels {139232, 358112}, /* d cyl 229 - 817 */ 134831039Skarels {210976, 286368}, /* e cyl 347 - 817 */ 134931039Skarels {282720, 214624}, /* f cyl 465 - 817 */ 135031039Skarels {354464, 142880}, /* g cyl 583 - 817 */ 135131039Skarels {426208, 71136} /* h cyl 701 - 817 */ 135230573Skarels }, 135332211Skarels { 18, 15, 1224, 1024, "mxd", 135432211Skarels {0, 21600}, /* a cyl 0-79 */ 135532211Skarels {21600, 22410}, /* b cyl 80-162 */ 135632211Skarels {44010, 285120}, /* c cyl 163-1217 */ 135732211Skarels #ifdef notyet 135832211Skarels {x, 237600}, /* d cyl y - 1217 */ 135932211Skarels {x, 190080}, /* e cyl y - 1217 */ 136032211Skarels {x, 142560}, /* f cyl y - 1217 */ 136132211Skarels {x, 95040}, /* g cyl y - 1217 */ 136232211Skarels {x, 47520} /* h cyl 701 - 817 */ 136332211Skarels #endif 136432211Skarels }, 136532211Skarels { 32, 10, 823, 512, "fsd", 136630756Skarels {0, 19200}, /* a cyl 0 - 59 */ 136730756Skarels {19200, 24000}, /* b cyl 60 - 134 */ 136830756Skarels {43200, 218560}, /* c cyl 135 - 817 */ 136930573Skarels } 137030519Ssam }; 137130519Ssam #define NVDST (sizeof (vdst) / sizeof (vdst[0])) 137230519Ssam 137325675Ssam /* 137430519Ssam * Construct a label for an unlabeled pack. We 137530519Ssam * deduce the drive type by reading from the last 137630519Ssam * track on successively smaller drives until we 137730519Ssam * don't get an error. 137825675Ssam */ 137930519Ssam vdmaptype(vi, lp) 138030519Ssam register struct vba_device *vi; 138130519Ssam register struct disklabel *lp; 138225675Ssam { 138330519Ssam register struct vdsoftc *vd; 138430519Ssam register struct vdst *p; 138532211Skarels struct vba_ctlr *vm = vi->ui_mi; 138630519Ssam int i; 138725675Ssam 138830519Ssam vd = &vdsoftc[vi->ui_ctlr]; 138930519Ssam for (p = vdst; p < &vdst[NVDST]; p++) { 139030519Ssam if (vd->vd_type == VDTYPE_VDDC && p->nsec != 32) 139130519Ssam continue; 139230519Ssam lp->d_nsectors = p->nsec; 139330519Ssam lp->d_ntracks = p->ntrack; 139430519Ssam lp->d_ncylinders = p->ncyl; 139532211Skarels lp->d_secsize = p->secsize; 139630519Ssam if (!vdreset_drive(vi)) 139730519Ssam return (0); 139830519Ssam vd->vd_dcb.opcode = VDOP_RD; 139930519Ssam vd->vd_dcb.intflg = DCBINT_NONE; 140030519Ssam vd->vd_dcb.nxtdcb = (struct dcb *)0; /* end of chain */ 140132211Skarels vd->vd_dcb.devselect = dksoftc[vi->ui_unit].dk_dcb.devselect; 140230756Skarels vd->vd_dcb.trailcnt = sizeof (struct trrw) / sizeof (long); 140330601Skarels vd->vd_dcb.trail.rwtrail.memadr = 140430601Skarels vtoph((struct proc *)0, (unsigned)vd->vd_rbuf.vb_rawbuf); 140532211Skarels vd->vd_dcb.trail.rwtrail.wcount = lp->d_secsize / sizeof(short); 140630519Ssam vd->vd_dcb.operrsta = 0; 140730519Ssam vd->vd_dcb.trail.rwtrail.disk.cylinder = p->ncyl - 2; 140830519Ssam vd->vd_dcb.trail.rwtrail.disk.track = p->ntrack - 1; 140930519Ssam vd->vd_dcb.trail.rwtrail.disk.sector = p->nsec - 1; 141030519Ssam vd->vd_mdcb.mdcb_head = (struct dcb *)vd->vd_dcbphys; 141130519Ssam vd->vd_mdcb.mdcb_status = 0; 141230519Ssam VDGO(vm->um_addr, vd->vd_mdcbphys, vd->vd_type); 141330519Ssam if (!vdpoll(vm, 60)) 141430519Ssam printf(" during probe\n"); 141530519Ssam if ((vd->vd_dcb.operrsta & VDERR_HARD) == 0) 141630519Ssam break; 141724004Ssam } 141832211Skarels if (p >= &vdst[NVDST]) 141930519Ssam return (0); 142032211Skarels 142130573Skarels for (i = 0; i < 8; i++) { 142230519Ssam lp->d_partitions[i].p_offset = p->parts[i].off; 142330519Ssam lp->d_partitions[i].p_size = p->parts[i].size; 142430519Ssam } 142530573Skarels lp->d_npartitions = 8; 142630519Ssam lp->d_secpercyl = lp->d_nsectors * lp->d_ntracks; 142730519Ssam lp->d_rpm = 3600; 142830519Ssam bcopy(p->name, lp->d_typename, 4); 142930519Ssam return (1); 143024004Ssam } 143130519Ssam #endif COMPAT_42 143224004Ssam #endif 1433