1 1.62 thorpej /* $NetBSD: hdc9224.c,v 1.62 2021/08/07 16:19:07 thorpej Exp $ */ 2 1.1 ragge /* 3 1.1 ragge * Copyright (c) 1996 Ludd, University of Lule}, Sweden. 4 1.1 ragge * All rights reserved. 5 1.1 ragge * 6 1.1 ragge * This code is derived from software contributed to Ludd by Bertram Barth. 7 1.1 ragge * 8 1.1 ragge * Redistribution and use in source and binary forms, with or without 9 1.1 ragge * modification, are permitted provided that the following conditions 10 1.1 ragge * are met: 11 1.1 ragge * 1. Redistributions of source code must retain the above copyright 12 1.1 ragge * notice, this list of conditions and the following disclaimer. 13 1.1 ragge * 2. Redistributions in binary form must reproduce the above copyright 14 1.1 ragge * notice, this list of conditions and the following disclaimer in the 15 1.1 ragge * documentation and/or other materials provided with the distribution. 16 1.1 ragge * 17 1.1 ragge * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 18 1.1 ragge * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 19 1.1 ragge * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 20 1.1 ragge * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 21 1.1 ragge * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 22 1.1 ragge * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 23 1.1 ragge * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 24 1.1 ragge * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 25 1.1 ragge * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 26 1.1 ragge * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 1.1 ragge */ 28 1.1 ragge 29 1.1 ragge /* 30 1.1 ragge * with much help from (in alphabetical order): 31 1.1 ragge * Jeremy 32 1.1 ragge * Roger Ivie 33 1.1 ragge * Rick Macklem 34 1.1 ragge * Mike Young 35 1.10 ragge * 36 1.10 ragge * Rewritten by Ragge 25 Jun 2000. New features: 37 1.10 ragge * - Uses interrupts instead of polling to signal ready. 38 1.10 ragge * - Can cooperate with the SCSI routines WRT. the DMA area. 39 1.10 ragge * 40 1.10 ragge * TODO: 41 1.10 ragge * - Floppy support missing. 42 1.10 ragge * - Bad block forwarding missing. 43 1.10 ragge * - Statistics collection. 44 1.1 ragge */ 45 1.10 ragge #undef RDDEBUG 46 1.30 lukem 47 1.30 lukem #include <sys/cdefs.h> 48 1.62 thorpej __KERNEL_RCSID(0, "$NetBSD: hdc9224.c,v 1.62 2021/08/07 16:19:07 thorpej Exp $"); 49 1.1 ragge 50 1.1 ragge #include <sys/param.h> 51 1.1 ragge #include <sys/systm.h> 52 1.1 ragge #include <sys/buf.h> 53 1.31 yamt #include <sys/bufq.h> 54 1.51 matt #include <sys/cpu.h> 55 1.51 matt #include <sys/conf.h> 56 1.1 ragge #include <sys/device.h> 57 1.1 ragge #include <sys/disklabel.h> 58 1.1 ragge #include <sys/disk.h> 59 1.51 matt #include <sys/file.h> 60 1.51 matt #include <sys/ioctl.h> 61 1.51 matt #include <sys/proc.h> 62 1.51 matt #include <sys/stat.h> 63 1.1 ragge #include <sys/syslog.h> 64 1.1 ragge 65 1.13 mrg #include <uvm/uvm_extern.h> 66 1.10 ragge 67 1.10 ragge #include <ufs/ufs/dinode.h> /* For BBSIZE */ 68 1.10 ragge #include <ufs/ffs/fs.h> 69 1.10 ragge 70 1.1 ragge #include <machine/sid.h> 71 1.1 ragge #include <machine/ka410.h> 72 1.1 ragge #include <machine/vsbus.h> 73 1.6 ragge #include <machine/rpb.h> 74 1.10 ragge #include <machine/scb.h> 75 1.10 ragge 76 1.10 ragge #include <dev/mscp/mscp.h> /* For DEC disk encoding */ 77 1.1 ragge 78 1.1 ragge #include <vax/vsa/hdc9224.h> 79 1.1 ragge 80 1.10 ragge #include "ioconf.h" 81 1.10 ragge #include "locators.h" 82 1.1 ragge 83 1.1 ragge 84 1.1 ragge /* 85 1.1 ragge * on-disk geometry block 86 1.1 ragge */ 87 1.1 ragge #define _aP __attribute__ ((packed)) /* force byte-alignment */ 88 1.1 ragge struct rdgeom { 89 1.10 ragge char mbz[10]; /* 10 bytes of zero */ 90 1.10 ragge long xbn_count _aP; /* number of XBNs */ 91 1.10 ragge long dbn_count _aP; /* number of DBNs */ 92 1.10 ragge long lbn_count _aP; /* number of LBNs (Logical-Block-Numbers) */ 93 1.10 ragge long rbn_count _aP; /* number of RBNs (Replacement-Block-Numbers) */ 94 1.10 ragge short nspt; /* number of sectors per track */ 95 1.10 ragge short ntracks; /* number of tracks */ 96 1.10 ragge short ncylinders; /* number of cylinders */ 97 1.10 ragge short precomp; /* first cylinder for write precompensation */ 98 1.10 ragge short reduced; /* first cylinder for reduced write current */ 99 1.10 ragge short seek_rate; /* seek rate or zero for buffered seeks */ 100 1.10 ragge short crc_eec; /* 0 if CRC, 1 if ECC is being used */ 101 1.10 ragge short rct; /* "replacement control table" (RCT) */ 102 1.10 ragge short rct_ncopies; /* number of copies of the RCT */ 103 1.10 ragge long media_id _aP; /* media identifier */ 104 1.10 ragge short interleave; /* sector-to-sector interleave */ 105 1.10 ragge short headskew; /* head-to-head skew */ 106 1.10 ragge short cylskew; /* cylinder-to-cylinder skew */ 107 1.10 ragge short gap0_size; /* size of GAP 0 in the MFM format */ 108 1.10 ragge short gap1_size; /* size of GAP 1 in the MFM format */ 109 1.10 ragge short gap2_size; /* size of GAP 2 in the MFM format */ 110 1.10 ragge short gap3_size; /* size of GAP 3 in the MFM format */ 111 1.10 ragge short sync_value; /* sync value used when formatting */ 112 1.10 ragge char reserved[32]; /* reserved for use by the RQDX formatter */ 113 1.10 ragge short serial_number; /* serial number */ 114 1.1 ragge #if 0 /* we don't need these 412 useless bytes ... */ 115 1.10 ragge char fill[412-2]; /* Filler bytes to the end of the block */ 116 1.10 ragge short checksum; /* checksum over the XBN */ 117 1.1 ragge #endif 118 1.1 ragge }; 119 1.1 ragge 120 1.1 ragge /* 121 1.1 ragge * Software status 122 1.1 ragge */ 123 1.1 ragge struct rdsoftc { 124 1.44 matt device_t sc_dev; /* must be here! (pseudo-OOP:) */ 125 1.44 matt struct hdcsoftc *sc_hdc; 126 1.10 ragge struct disk sc_disk; /* disklabel etc. */ 127 1.10 ragge struct rdgeom sc_xbn; /* on-disk geometry information */ 128 1.10 ragge int sc_drive; /* physical unit number */ 129 1.1 ragge }; 130 1.1 ragge 131 1.1 ragge struct hdcsoftc { 132 1.44 matt device_t sc_dev; /* must be here (pseudo-OOP:) */ 133 1.10 ragge struct evcnt sc_intrcnt; 134 1.10 ragge struct vsbus_dma sc_vd; 135 1.10 ragge vaddr_t sc_regs; /* register addresses */ 136 1.32 yamt struct bufq_state *sc_q; 137 1.10 ragge struct buf *sc_active; 138 1.1 ragge struct hdc9224_UDCreg sc_creg; /* (command) registers to be written */ 139 1.1 ragge struct hdc9224_UDCreg sc_sreg; /* (status) registers being read */ 140 1.38 christos void * sc_dmabase; /* */ 141 1.10 ragge int sc_dmasize; 142 1.38 christos void *sc_bufaddr; /* Current in-core address */ 143 1.10 ragge int sc_diskblk; /* Current block on disk */ 144 1.10 ragge int sc_bytecnt; /* How much left to transfer */ 145 1.10 ragge int sc_xfer; /* Current transfer size */ 146 1.12 ragge int sc_retries; 147 1.10 ragge volatile u_char sc_status; /* last status from interrupt */ 148 1.12 ragge char sc_intbit; 149 1.10 ragge }; 150 1.10 ragge 151 1.10 ragge struct hdc_attach_args { 152 1.10 ragge int ha_drive; 153 1.1 ragge }; 154 1.1 ragge 155 1.1 ragge /* 156 1.10 ragge * prototypes for (almost) all the internal routines 157 1.1 ragge */ 158 1.43 matt static int hdcmatch(device_t, cfdata_t, void *); 159 1.43 matt static void hdcattach(device_t, device_t, void *); 160 1.10 ragge static int hdcprint(void *, const char *); 161 1.43 matt static int rdmatch(device_t, cfdata_t, void *); 162 1.43 matt static void rdattach(device_t, device_t, void *); 163 1.10 ragge static void hdcintr(void *); 164 1.10 ragge static int hdc_command(struct hdcsoftc *, int); 165 1.10 ragge static void rd_readgeom(struct hdcsoftc *, struct rdsoftc *); 166 1.10 ragge #ifdef RDDEBUG 167 1.10 ragge static void hdc_printgeom( struct rdgeom *); 168 1.10 ragge #endif 169 1.10 ragge static void hdc_writeregs(struct hdcsoftc *); 170 1.10 ragge static void hdcstart(struct hdcsoftc *, struct buf *); 171 1.10 ragge static int hdc_rdselect(struct hdcsoftc *, int); 172 1.10 ragge static void rdmakelabel(struct disklabel *, struct rdgeom *); 173 1.10 ragge static void hdc_writeregs(struct hdcsoftc *); 174 1.10 ragge static void hdc_readregs(struct hdcsoftc *); 175 1.10 ragge static void hdc_qstart(void *); 176 1.10 ragge 177 1.44 matt CFATTACH_DECL_NEW(hdc, sizeof(struct hdcsoftc), 178 1.23 thorpej hdcmatch, hdcattach, NULL, NULL); 179 1.1 ragge 180 1.44 matt CFATTACH_DECL_NEW(rd, sizeof(struct rdsoftc), 181 1.23 thorpej rdmatch, rdattach, NULL, NULL); 182 1.7 thorpej 183 1.43 matt static dev_type_open(rdopen); 184 1.43 matt static dev_type_close(rdclose); 185 1.43 matt static dev_type_read(rdread); 186 1.43 matt static dev_type_write(rdwrite); 187 1.43 matt static dev_type_ioctl(rdioctl); 188 1.43 matt static dev_type_strategy(rdstrategy); 189 1.43 matt static dev_type_size(rdpsize); 190 1.19 gehenna 191 1.19 gehenna const struct bdevsw rd_bdevsw = { 192 1.43 matt .d_open = rdopen, 193 1.43 matt .d_close = rdclose, 194 1.43 matt .d_strategy = rdstrategy, 195 1.43 matt .d_ioctl = rdioctl, 196 1.43 matt .d_dump = nulldump, 197 1.43 matt .d_psize = rdpsize, 198 1.53 dholland .d_discard = nodiscard, 199 1.43 matt .d_flag = D_DISK 200 1.19 gehenna }; 201 1.19 gehenna 202 1.19 gehenna const struct cdevsw rd_cdevsw = { 203 1.43 matt .d_open = rdopen, 204 1.43 matt .d_close = rdclose, 205 1.43 matt .d_read = rdread, 206 1.43 matt .d_write = rdwrite, 207 1.43 matt .d_ioctl = rdioctl, 208 1.43 matt .d_stop = nostop, 209 1.43 matt .d_tty = notty, 210 1.43 matt .d_poll = nopoll, 211 1.43 matt .d_mmap = nommap, 212 1.43 matt .d_kqfilter = nokqfilter, 213 1.54 dholland .d_discard = nodiscard, 214 1.43 matt .d_flag = D_DISK 215 1.19 gehenna }; 216 1.1 ragge 217 1.10 ragge /* At least 0.7 uS between register accesses */ 218 1.10 ragge static int rd_dmasize, inq = 0; 219 1.44 matt static volatile int u; 220 1.34 perry #define WAIT __asm("movl %0,%0;movl %0,%0;movl %0,%0; movl %0,%0" :: "m"(u)) 221 1.10 ragge 222 1.10 ragge #define HDC_WREG(x) *(volatile char *)(sc->sc_regs) = (x) 223 1.10 ragge #define HDC_RREG *(volatile char *)(sc->sc_regs) 224 1.10 ragge #define HDC_WCMD(x) *(volatile char *)(sc->sc_regs + 4) = (x) 225 1.10 ragge #define HDC_RSTAT *(volatile char *)(sc->sc_regs + 4) 226 1.1 ragge 227 1.1 ragge /* 228 1.60 msaitoh * new-config's hdcmatch() is similar to old-config's hdcprobe(), 229 1.1 ragge * thus we probe for the existence of the controller and reset it. 230 1.1 ragge * NB: we can't initialize the controller yet, since space for hdcsoftc 231 1.1 ragge * is not yet allocated. Thus we do this in hdcattach()... 232 1.1 ragge */ 233 1.1 ragge int 234 1.43 matt hdcmatch(device_t parent, cfdata_t cf, void *aux) 235 1.1 ragge { 236 1.43 matt struct vsbus_attach_args * const va = aux; 237 1.43 matt volatile char * const hdc_csr = (volatile char *)va->va_addr; 238 1.10 ragge int i; 239 1.1 ragge 240 1.10 ragge u = 8; /* !!! - GCC */ 241 1.1 ragge 242 1.10 ragge if (vax_boardtype == VAX_BTYP_49 || vax_boardtype == VAX_BTYP_46 243 1.14 ragge || vax_boardtype == VAX_BTYP_48 || vax_boardtype == VAX_BTYP_53) 244 1.10 ragge return 0; 245 1.10 ragge 246 1.10 ragge hdc_csr[4] = DKC_CMD_RESET; /* reset chip */ 247 1.10 ragge for (i = 0; i < 1000; i++) { 248 1.10 ragge DELAY(1000); 249 1.10 ragge if (hdc_csr[4] & DKC_ST_DONE) 250 1.10 ragge break; 251 1.1 ragge } 252 1.10 ragge if (i == 100) 253 1.10 ragge return 0; /* No response to reset */ 254 1.1 ragge 255 1.10 ragge hdc_csr[4] = DKC_CMD_SETREGPTR|UDC_TERM; 256 1.10 ragge WAIT; 257 1.10 ragge hdc_csr[0] = UDC_TC_CRCPRE|UDC_TC_INTDONE; 258 1.10 ragge WAIT; 259 1.10 ragge hdc_csr[4] = DKC_CMD_DRDESELECT; /* Should be harmless */ 260 1.10 ragge DELAY(1000); 261 1.1 ragge return (1); 262 1.1 ragge } 263 1.1 ragge 264 1.1 ragge int 265 1.10 ragge hdcprint(void *aux, const char *name) 266 1.1 ragge { 267 1.43 matt struct hdc_attach_args * const ha = aux; 268 1.1 ragge 269 1.10 ragge if (name) 270 1.25 thorpej aprint_normal ("RD?? at %s drive %d", name, ha->ha_drive); 271 1.10 ragge return UNCONF; 272 1.1 ragge } 273 1.1 ragge 274 1.1 ragge /* 275 1.1 ragge * hdc_attach() probes for all possible devices 276 1.1 ragge */ 277 1.1 ragge void 278 1.43 matt hdcattach(device_t parent, device_t self, void *aux) 279 1.1 ragge { 280 1.43 matt struct vsbus_attach_args * const va = aux; 281 1.43 matt struct hdcsoftc * const sc = device_private(self); 282 1.1 ragge struct hdc_attach_args ha; 283 1.10 ragge int status, i; 284 1.1 ragge 285 1.43 matt aprint_normal("\n"); 286 1.44 matt 287 1.44 matt sc->sc_dev = self; 288 1.44 matt 289 1.1 ragge /* 290 1.10 ragge * Get interrupt vector, enable instrumentation. 291 1.1 ragge */ 292 1.10 ragge scb_vecalloc(va->va_cvec, hdcintr, sc, SCB_ISTACK, &sc->sc_intrcnt); 293 1.10 ragge evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, NULL, 294 1.43 matt device_xname(self), "intr"); 295 1.10 ragge 296 1.10 ragge sc->sc_regs = vax_map_physmem(va->va_paddr, 1); 297 1.38 christos sc->sc_dmabase = (void *)va->va_dmaaddr; 298 1.10 ragge sc->sc_dmasize = va->va_dmasize; 299 1.12 ragge sc->sc_intbit = va->va_maskno; 300 1.59 riastrad rd_dmasize = uimin(MAXPHYS, sc->sc_dmasize); /* Used in rd_minphys */ 301 1.10 ragge 302 1.10 ragge sc->sc_vd.vd_go = hdc_qstart; 303 1.10 ragge sc->sc_vd.vd_arg = sc; 304 1.10 ragge /* 305 1.10 ragge * Reset controller. 306 1.10 ragge */ 307 1.10 ragge HDC_WCMD(DKC_CMD_RESET); 308 1.10 ragge DELAY(1000); 309 1.10 ragge status = HDC_RSTAT; 310 1.10 ragge if (status != (DKC_ST_DONE|DKC_TC_SUCCESS)) { 311 1.43 matt aprint_error_dev(self, "RESET failed, status 0x%x\n", status); 312 1.10 ragge return; 313 1.10 ragge } 314 1.32 yamt bufq_alloc(&sc->sc_q, "disksort", BUFQ_SORT_CYLINDER); 315 1.10 ragge 316 1.10 ragge /* 317 1.10 ragge * now probe for all possible hard drives 318 1.10 ragge */ 319 1.10 ragge for (i = 0; i < 4; i++) { 320 1.10 ragge if (i == 2) /* Floppy, needs special handling */ 321 1.10 ragge continue; 322 1.10 ragge HDC_WCMD(DKC_CMD_DRSELECT | i); 323 1.10 ragge DELAY(1000); 324 1.10 ragge status = HDC_RSTAT; 325 1.10 ragge ha.ha_drive = i; 326 1.10 ragge if ((status & DKC_ST_TERMCOD) == DKC_TC_SUCCESS) 327 1.62 thorpej config_found(self, (void *)&ha, hdcprint, CFARGS_NONE); 328 1.1 ragge } 329 1.1 ragge } 330 1.1 ragge 331 1.1 ragge /* 332 1.1 ragge * rdmatch() probes for the existence of a RD-type disk/floppy 333 1.1 ragge */ 334 1.1 ragge int 335 1.43 matt rdmatch(device_t parent, cfdata_t cf, void *aux) 336 1.1 ragge { 337 1.43 matt struct hdc_attach_args * const ha = aux; 338 1.1 ragge 339 1.10 ragge if (cf->cf_loc[HDCCF_DRIVE] != HDCCF_DRIVE_DEFAULT && 340 1.10 ragge cf->cf_loc[HDCCF_DRIVE] != ha->ha_drive) 341 1.10 ragge return 0; 342 1.1 ragge 343 1.10 ragge if (ha->ha_drive == 2) /* Always floppy, not supported */ 344 1.10 ragge return 0; 345 1.1 ragge 346 1.10 ragge return 1; 347 1.10 ragge } 348 1.1 ragge 349 1.1 ragge void 350 1.43 matt rdattach(device_t parent, device_t self, void *aux) 351 1.1 ragge { 352 1.43 matt struct hdcsoftc * const sc = device_private(parent); 353 1.43 matt struct rdsoftc * const rd = device_private(self); 354 1.43 matt struct hdc_attach_args * const ha = aux; 355 1.10 ragge struct disklabel *dl; 356 1.27 dsl const char *msg; 357 1.1 ragge 358 1.44 matt rd->sc_dev = self; 359 1.1 ragge rd->sc_drive = ha->ha_drive; 360 1.44 matt rd->sc_hdc = sc; 361 1.1 ragge /* 362 1.1 ragge * Initialize and attach the disk structure. 363 1.1 ragge */ 364 1.44 matt disk_init(&rd->sc_disk, device_xname(rd->sc_dev), NULL); 365 1.10 ragge disk_attach(&rd->sc_disk); 366 1.10 ragge 367 1.1 ragge /* 368 1.1 ragge * if it's not a floppy then evaluate the on-disk geometry. 369 1.16 wiz * if necessary correct the label... 370 1.1 ragge */ 371 1.10 ragge rd_readgeom(sc, rd); 372 1.10 ragge disk_printtype(rd->sc_drive, rd->sc_xbn.media_id); 373 1.10 ragge dl = rd->sc_disk.dk_label; 374 1.10 ragge rdmakelabel(dl, &rd->sc_xbn); 375 1.19 gehenna msg = readdisklabel(MAKEDISKDEV(cdevsw_lookup_major(&rd_cdevsw), 376 1.44 matt device_unit(rd->sc_dev), RAW_PART), 377 1.19 gehenna rdstrategy, dl, NULL); 378 1.10 ragge if (msg) 379 1.43 matt aprint_normal_dev(self, "%s: size %u sectors", 380 1.43 matt msg, dl->d_secperunit); 381 1.43 matt else 382 1.43 matt aprint_normal_dev(self, "size %u sectors\n", dl->d_secperunit); 383 1.10 ragge #ifdef RDDEBUG 384 1.10 ragge hdc_printgeom(&rd->sc_xbn); 385 1.10 ragge #endif 386 1.10 ragge } 387 1.10 ragge 388 1.10 ragge void 389 1.10 ragge hdcintr(void *arg) 390 1.10 ragge { 391 1.43 matt struct hdcsoftc * const sc = arg; 392 1.10 ragge struct buf *bp; 393 1.10 ragge 394 1.10 ragge sc->sc_status = HDC_RSTAT; 395 1.10 ragge if (sc->sc_active == 0) 396 1.10 ragge return; /* Complain? */ 397 1.10 ragge 398 1.10 ragge if ((sc->sc_status & (DKC_ST_INTPEND|DKC_ST_DONE)) != 399 1.10 ragge (DKC_ST_INTPEND|DKC_ST_DONE)) 400 1.10 ragge return; /* Why spurious ints sometimes??? */ 401 1.10 ragge 402 1.10 ragge bp = sc->sc_active; 403 1.10 ragge sc->sc_active = 0; 404 1.10 ragge if ((sc->sc_status & DKC_ST_TERMCOD) != DKC_TC_SUCCESS) { 405 1.10 ragge int i; 406 1.10 ragge u_char *g = (u_char *)&sc->sc_sreg; 407 1.12 ragge 408 1.12 ragge if (sc->sc_retries++ < 3) { /* Allow 3 retries */ 409 1.12 ragge hdcstart(sc, bp); 410 1.12 ragge return; 411 1.12 ragge } 412 1.44 matt aprint_error_dev(sc->sc_dev, "failed, status 0x%x\n", 413 1.43 matt sc->sc_status); 414 1.10 ragge hdc_readregs(sc); 415 1.10 ragge for (i = 0; i < 10; i++) 416 1.43 matt aprint_error("%i: %x\n", i, g[i]); 417 1.10 ragge bp->b_error = ENXIO; 418 1.10 ragge bp->b_resid = bp->b_bcount; 419 1.10 ragge biodone(bp); 420 1.10 ragge vsbus_dma_intr(); 421 1.10 ragge return; 422 1.10 ragge } 423 1.10 ragge 424 1.10 ragge if (bp->b_flags & B_READ) { 425 1.10 ragge vsbus_copytoproc(bp->b_proc, sc->sc_dmabase, sc->sc_bufaddr, 426 1.10 ragge sc->sc_xfer); 427 1.10 ragge } 428 1.12 ragge sc->sc_diskblk += (sc->sc_xfer/DEV_BSIZE); 429 1.12 ragge sc->sc_bytecnt -= sc->sc_xfer; 430 1.39 christos sc->sc_bufaddr = (char *)sc->sc_bufaddr + sc->sc_xfer; 431 1.10 ragge 432 1.10 ragge if (sc->sc_bytecnt == 0) { /* Finished transfer */ 433 1.10 ragge biodone(bp); 434 1.10 ragge vsbus_dma_intr(); 435 1.10 ragge } else 436 1.10 ragge hdcstart(sc, bp); 437 1.1 ragge } 438 1.1 ragge 439 1.1 ragge /* 440 1.10 ragge * 441 1.1 ragge */ 442 1.1 ragge void 443 1.10 ragge rdstrategy(struct buf *bp) 444 1.1 ragge { 445 1.10 ragge struct rdsoftc *rd; 446 1.10 ragge struct hdcsoftc *sc; 447 1.10 ragge struct disklabel *lp; 448 1.43 matt int s; 449 1.1 ragge 450 1.43 matt if ((rd = device_lookup_private(&rd_cd, DISKUNIT(bp->b_dev))) == NULL) { 451 1.10 ragge bp->b_error = ENXIO; 452 1.10 ragge goto done; 453 1.10 ragge } 454 1.44 matt sc = rd->sc_hdc; 455 1.1 ragge 456 1.10 ragge lp = rd->sc_disk.dk_label; 457 1.28 thorpej if ((bounds_check_with_label(&rd->sc_disk, bp, 1)) <= 0) 458 1.10 ragge goto done; 459 1.1 ragge 460 1.1 ragge if (bp->b_bcount == 0) 461 1.1 ragge goto done; 462 1.10 ragge 463 1.10 ragge bp->b_rawblkno = 464 1.10 ragge bp->b_blkno + lp->d_partitions[DISKPART(bp->b_dev)].p_offset; 465 1.10 ragge bp->b_cylinder = bp->b_rawblkno / lp->d_secpercyl; 466 1.10 ragge 467 1.15 thorpej s = splbio(); 468 1.45 yamt bufq_put(sc->sc_q, bp); 469 1.10 ragge if (inq == 0) { 470 1.10 ragge inq = 1; 471 1.10 ragge vsbus_dma_start(&sc->sc_vd); 472 1.10 ragge } 473 1.10 ragge splx(s); 474 1.10 ragge return; 475 1.10 ragge 476 1.10 ragge done: biodone(bp); 477 1.1 ragge } 478 1.1 ragge 479 1.10 ragge void 480 1.10 ragge hdc_qstart(void *arg) 481 1.1 ragge { 482 1.43 matt struct hdcsoftc * const sc = arg; 483 1.1 ragge 484 1.10 ragge inq = 0; 485 1.1 ragge 486 1.10 ragge hdcstart(sc, 0); 487 1.45 yamt if (bufq_peek(sc->sc_q)) { 488 1.10 ragge vsbus_dma_start(&sc->sc_vd); /* More to go */ 489 1.10 ragge inq = 1; 490 1.10 ragge } 491 1.10 ragge } 492 1.1 ragge 493 1.10 ragge void 494 1.10 ragge hdcstart(struct hdcsoftc *sc, struct buf *ob) 495 1.10 ragge { 496 1.43 matt struct hdc9224_UDCreg * const p = &sc->sc_creg; 497 1.10 ragge struct disklabel *lp; 498 1.10 ragge struct rdsoftc *rd; 499 1.10 ragge struct buf *bp; 500 1.10 ragge int cn, sn, tn, bn, blks; 501 1.1 ragge 502 1.10 ragge if (sc->sc_active) 503 1.10 ragge return; /* Already doing something */ 504 1.1 ragge 505 1.10 ragge if (ob == 0) { 506 1.45 yamt bp = bufq_get(sc->sc_q); 507 1.10 ragge if (bp == NULL) 508 1.10 ragge return; /* Nothing to do */ 509 1.10 ragge sc->sc_bufaddr = bp->b_data; 510 1.10 ragge sc->sc_diskblk = bp->b_rawblkno; 511 1.10 ragge sc->sc_bytecnt = bp->b_bcount; 512 1.12 ragge sc->sc_retries = 0; 513 1.10 ragge bp->b_resid = 0; 514 1.10 ragge } else 515 1.10 ragge bp = ob; 516 1.10 ragge 517 1.43 matt rd = device_lookup_private(&rd_cd, DISKUNIT(bp->b_dev)); 518 1.10 ragge hdc_rdselect(sc, rd->sc_drive); 519 1.10 ragge sc->sc_active = bp; 520 1.10 ragge 521 1.10 ragge bn = sc->sc_diskblk; 522 1.10 ragge lp = rd->sc_disk.dk_label; 523 1.10 ragge if (bn) { 524 1.10 ragge cn = bn / lp->d_secpercyl; 525 1.10 ragge sn = bn % lp->d_secpercyl; 526 1.10 ragge tn = sn / lp->d_nsectors; 527 1.10 ragge sn = sn % lp->d_nsectors; 528 1.10 ragge } else 529 1.10 ragge cn = sn = tn = 0; 530 1.10 ragge 531 1.10 ragge cn++; /* first cylinder is reserved */ 532 1.10 ragge 533 1.47 cegger memset(p, 0, sizeof(struct hdc9224_UDCreg)); 534 1.10 ragge 535 1.10 ragge /* 536 1.10 ragge * Tricky thing: the controller do itself only increase the sector 537 1.10 ragge * number, not the track or cylinder number. Therefore the driver 538 1.10 ragge * is not allowed to have transfers that crosses track boundaries. 539 1.10 ragge */ 540 1.10 ragge blks = sc->sc_bytecnt/DEV_BSIZE; 541 1.10 ragge if ((sn + blks) > lp->d_nsectors) 542 1.10 ragge blks = lp->d_nsectors - sn; 543 1.10 ragge 544 1.10 ragge p->udc_dsect = sn; 545 1.10 ragge p->udc_dcyl = cn & 0xff; 546 1.10 ragge p->udc_dhead = ((cn >> 4) & 0x70) | tn; 547 1.10 ragge p->udc_scnt = blks; 548 1.10 ragge 549 1.10 ragge p->udc_rtcnt = UDC_RC_RTRYCNT; 550 1.10 ragge p->udc_mode = UDC_MD_HDD; 551 1.10 ragge p->udc_term = UDC_TC_CRCPRE|UDC_TC_INTDONE|UDC_TC_TDELDAT|UDC_TC_TWRFLT; 552 1.10 ragge hdc_writeregs(sc); 553 1.10 ragge 554 1.10 ragge /* Count up vars */ 555 1.10 ragge sc->sc_xfer = blks * DEV_BSIZE; 556 1.12 ragge 557 1.52 martin (void)HDC_RSTAT; /* Avoid pending interrupts */ 558 1.12 ragge WAIT; 559 1.12 ragge vsbus_clrintr(sc->sc_intbit); /* Clear pending int's */ 560 1.10 ragge 561 1.10 ragge if (bp->b_flags & B_READ) { 562 1.10 ragge HDC_WCMD(DKC_CMD_READ_HDD); 563 1.10 ragge } else { 564 1.10 ragge vsbus_copyfromproc(bp->b_proc, sc->sc_bufaddr, sc->sc_dmabase, 565 1.10 ragge sc->sc_xfer); 566 1.10 ragge HDC_WCMD(DKC_CMD_WRITE_HDD); 567 1.10 ragge } 568 1.10 ragge } 569 1.1 ragge 570 1.10 ragge void 571 1.10 ragge rd_readgeom(struct hdcsoftc *sc, struct rdsoftc *rd) 572 1.10 ragge { 573 1.43 matt struct hdc9224_UDCreg * const p = &sc->sc_creg; 574 1.1 ragge 575 1.10 ragge hdc_rdselect(sc, rd->sc_drive); /* select drive right now */ 576 1.1 ragge 577 1.43 matt memset(p, 0, sizeof(*p)); 578 1.1 ragge 579 1.10 ragge p->udc_scnt = 1; 580 1.10 ragge p->udc_rtcnt = UDC_RC_RTRYCNT; 581 1.10 ragge p->udc_mode = UDC_MD_HDD; 582 1.10 ragge p->udc_term = UDC_TC_CRCPRE|UDC_TC_INTDONE|UDC_TC_TDELDAT|UDC_TC_TWPROT; 583 1.10 ragge hdc_writeregs(sc); 584 1.10 ragge sc->sc_status = 0; 585 1.10 ragge HDC_WCMD(DKC_CMD_READ_HDD|2); 586 1.10 ragge while ((sc->sc_status & DKC_ST_INTPEND) == 0) 587 1.10 ragge ; 588 1.49 cegger memcpy(&rd->sc_xbn, sc->sc_dmabase, sizeof(struct rdgeom)); 589 1.1 ragge } 590 1.1 ragge 591 1.10 ragge #ifdef RDDEBUG 592 1.1 ragge /* 593 1.1 ragge * display the contents of the on-disk geometry structure 594 1.1 ragge */ 595 1.9 ragge void 596 1.46 dsl hdc_printgeom(struct rdgeom *p) 597 1.1 ragge { 598 1.9 ragge printf ("**DiskData** XBNs: %ld, DBNs: %ld, LBNs: %ld, RBNs: %ld\n", 599 1.1 ragge p->xbn_count, p->dbn_count, p->lbn_count, p->rbn_count); 600 1.4 christos printf ("sec/track: %d, tracks: %d, cyl: %d, precomp/reduced: %d/%d\n", 601 1.1 ragge p->nspt, p->ntracks, p->ncylinders, p->precomp, p->reduced); 602 1.4 christos printf ("seek-rate: %d, crc/eec: %s, RCT: %d, RCT-copies: %d\n", 603 1.1 ragge p->seek_rate, p->crc_eec?"EEC":"CRC", p->rct, p->rct_ncopies); 604 1.10 ragge printf ("media-ID: %lx, interleave: %d, headskew: %d, cylskew: %d\n", 605 1.10 ragge p->media_id, p->interleave, p->headskew, p->cylskew); 606 1.4 christos printf ("gap0: %d, gap1: %d, gap2: %d, gap3: %d, sync-value: %d\n", 607 1.1 ragge p->gap0_size, p->gap1_size, p->gap2_size, p->gap3_size, 608 1.1 ragge p->sync_value); 609 1.1 ragge } 610 1.1 ragge #endif 611 1.1 ragge 612 1.1 ragge /* 613 1.10 ragge * Return the size of a partition, if known, or -1 if not. 614 1.1 ragge */ 615 1.1 ragge int 616 1.43 matt rdpsize(dev_t dev) 617 1.1 ragge { 618 1.43 matt struct rdsoftc * const rd = device_lookup_private(&rd_cd, DISKUNIT(dev)); 619 1.43 matt const int part = DISKPART(dev); 620 1.1 ragge 621 1.43 matt if (rd == NULL || part >= rd->sc_disk.dk_label->d_npartitions) 622 1.10 ragge return -1; 623 1.43 matt 624 1.43 matt return rd->sc_disk.dk_label->d_partitions[part].p_size * 625 1.10 ragge (rd->sc_disk.dk_label->d_secsize / DEV_BSIZE); 626 1.1 ragge } 627 1.1 ragge 628 1.1 ragge /* 629 1.1 ragge * 630 1.1 ragge */ 631 1.1 ragge int 632 1.33 christos rdopen(dev_t dev, int flag, int fmt, struct lwp *l) 633 1.1 ragge { 634 1.43 matt struct rdsoftc * const rd = device_lookup_private(&rd_cd, DISKUNIT(dev)); 635 1.43 matt const int part = DISKPART(dev); 636 1.1 ragge 637 1.43 matt if (rd == NULL || part >= rd->sc_disk.dk_label->d_npartitions) 638 1.1 ragge return ENXIO; 639 1.10 ragge 640 1.10 ragge switch (fmt) { 641 1.10 ragge case S_IFCHR: 642 1.10 ragge rd->sc_disk.dk_copenmask |= (1 << part); 643 1.10 ragge break; 644 1.10 ragge case S_IFBLK: 645 1.10 ragge rd->sc_disk.dk_bopenmask |= (1 << part); 646 1.10 ragge break; 647 1.1 ragge } 648 1.10 ragge rd->sc_disk.dk_openmask = 649 1.10 ragge rd->sc_disk.dk_copenmask | rd->sc_disk.dk_bopenmask; 650 1.1 ragge 651 1.10 ragge return 0; 652 1.1 ragge } 653 1.1 ragge 654 1.1 ragge /* 655 1.1 ragge * 656 1.1 ragge */ 657 1.1 ragge int 658 1.33 christos rdclose(dev_t dev, int flag, int fmt, struct lwp *l) 659 1.1 ragge { 660 1.43 matt struct rdsoftc * const rd = device_lookup_private(&rd_cd, DISKUNIT(dev)); 661 1.43 matt const int part = DISKPART(dev); 662 1.10 ragge 663 1.10 ragge switch (fmt) { 664 1.10 ragge case S_IFCHR: 665 1.10 ragge rd->sc_disk.dk_copenmask &= ~(1 << part); 666 1.10 ragge break; 667 1.10 ragge case S_IFBLK: 668 1.10 ragge rd->sc_disk.dk_bopenmask &= ~(1 << part); 669 1.10 ragge break; 670 1.10 ragge } 671 1.10 ragge rd->sc_disk.dk_openmask = 672 1.10 ragge rd->sc_disk.dk_copenmask | rd->sc_disk.dk_bopenmask; 673 1.10 ragge 674 1.1 ragge return (0); 675 1.1 ragge } 676 1.1 ragge 677 1.1 ragge /* 678 1.1 ragge * 679 1.1 ragge */ 680 1.1 ragge int 681 1.38 christos rdioctl(dev_t dev, u_long cmd, void *addr, int flag, struct lwp *l) 682 1.1 ragge { 683 1.43 matt struct rdsoftc * const rd = device_lookup_private(&rd_cd, DISKUNIT(dev)); 684 1.43 matt struct disklabel * const lp = rd->sc_disk.dk_label; 685 1.56 christos int error; 686 1.55 christos 687 1.55 christos error = disk_ioctl(&rd->sc_disk, dev, cmd, addr, flag, l); 688 1.55 christos if (error != EPASSTHROUGH) 689 1.55 christos return error; 690 1.55 christos else 691 1.55 christos error = 0; 692 1.1 ragge 693 1.1 ragge switch (cmd) { 694 1.1 ragge case DIOCWDINFO: 695 1.1 ragge case DIOCSDINFO: 696 1.1 ragge if ((flag & FWRITE) == 0) 697 1.1 ragge return EBADF; 698 1.43 matt error = (cmd == DIOCSDINFO ? 699 1.43 matt setdisklabel(lp, (struct disklabel *)addr, 0, 0) : 700 1.43 matt writedisklabel(dev, rdstrategy, lp, 0)); 701 1.10 ragge break; 702 1.1 ragge 703 1.10 ragge case DIOCGDEFLABEL: 704 1.43 matt memset(lp, 0, sizeof(*lp)); 705 1.10 ragge rdmakelabel(lp, &rd->sc_xbn); 706 1.10 ragge break; 707 1.1 ragge 708 1.1 ragge case DIOCWLABEL: 709 1.1 ragge if ((flag & FWRITE) == 0) 710 1.43 matt error = EBADF; 711 1.10 ragge break; 712 1.10 ragge 713 1.1 ragge default: 714 1.43 matt error = ENOTTY; 715 1.1 ragge } 716 1.43 matt return error; 717 1.1 ragge } 718 1.1 ragge 719 1.1 ragge /* 720 1.1 ragge * 721 1.1 ragge */ 722 1.1 ragge int 723 1.10 ragge rdread(dev_t dev, struct uio *uio, int flag) 724 1.1 ragge { 725 1.10 ragge return (physio (rdstrategy, NULL, dev, B_READ, minphys, uio)); 726 1.1 ragge } 727 1.1 ragge 728 1.1 ragge /* 729 1.1 ragge * 730 1.1 ragge */ 731 1.1 ragge int 732 1.10 ragge rdwrite(dev_t dev, struct uio *uio, int flag) 733 1.1 ragge { 734 1.10 ragge return (physio (rdstrategy, NULL, dev, B_WRITE, minphys, uio)); 735 1.1 ragge } 736 1.1 ragge 737 1.1 ragge /* 738 1.1 ragge * we have to wait 0.7 usec between two accesses to any of the 739 1.1 ragge * dkc-registers, on a VS2000 with 1 MIPS, this is roughly one 740 1.1 ragge * instruction. Thus the loop-overhead will be enough... 741 1.1 ragge */ 742 1.10 ragge static void 743 1.10 ragge hdc_readregs(struct hdcsoftc *sc) 744 1.1 ragge { 745 1.1 ragge int i; 746 1.1 ragge char *p; 747 1.1 ragge 748 1.10 ragge HDC_WCMD(DKC_CMD_SETREGPTR); 749 1.10 ragge WAIT; 750 1.1 ragge p = (void*)&sc->sc_sreg; 751 1.10 ragge for (i=0; i<10; i++) { 752 1.10 ragge *p++ = HDC_RREG; /* dkc_reg auto-increments */ 753 1.10 ragge WAIT; 754 1.10 ragge } 755 1.1 ragge } 756 1.1 ragge 757 1.10 ragge static void 758 1.10 ragge hdc_writeregs(struct hdcsoftc *sc) 759 1.1 ragge { 760 1.1 ragge int i; 761 1.1 ragge char *p; 762 1.1 ragge 763 1.10 ragge HDC_WCMD(DKC_CMD_SETREGPTR); 764 1.1 ragge p = (void*)&sc->sc_creg; 765 1.10 ragge for (i=0; i<10; i++) { 766 1.10 ragge HDC_WREG(*p++); /* dkc_reg auto-increments */ 767 1.10 ragge WAIT; 768 1.10 ragge } 769 1.1 ragge } 770 1.1 ragge 771 1.1 ragge /* 772 1.1 ragge * hdc_command() issues a command and polls the intreq-register 773 1.1 ragge * to find when command has completed 774 1.1 ragge */ 775 1.1 ragge int 776 1.10 ragge hdc_command(struct hdcsoftc *sc, int cmd) 777 1.1 ragge { 778 1.1 ragge hdc_writeregs(sc); /* write the prepared registers */ 779 1.10 ragge HDC_WCMD(cmd); 780 1.10 ragge WAIT; 781 1.1 ragge return (0); 782 1.1 ragge } 783 1.1 ragge 784 1.1 ragge int 785 1.10 ragge hdc_rdselect(struct hdcsoftc *sc, int unit) 786 1.1 ragge { 787 1.43 matt struct hdc9224_UDCreg * const p = &sc->sc_creg; 788 1.1 ragge int error; 789 1.1 ragge 790 1.1 ragge /* 791 1.1 ragge * bring "creg" in some known-to-work state and 792 1.1 ragge * select the drive with the DRIVE SELECT command. 793 1.1 ragge */ 794 1.43 matt memset(p, 0, sizeof(*p)); 795 1.1 ragge 796 1.1 ragge p->udc_rtcnt = UDC_RC_HDD_READ; 797 1.1 ragge p->udc_mode = UDC_MD_HDD; 798 1.1 ragge p->udc_term = UDC_TC_HDD; 799 1.1 ragge 800 1.10 ragge error = hdc_command(sc, DKC_CMD_DRSEL_HDD | unit); 801 1.10 ragge 802 1.43 matt return error; 803 1.1 ragge } 804 1.1 ragge 805 1.10 ragge void 806 1.10 ragge rdmakelabel(struct disklabel *dl, struct rdgeom *g) 807 1.1 ragge { 808 1.10 ragge int n, p = 0; 809 1.1 ragge 810 1.10 ragge dl->d_bbsize = BBSIZE; 811 1.26 he dl->d_sbsize = SBLOCKSIZE; 812 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(2, g->media_id); 813 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(1, g->media_id); 814 1.10 ragge if (MSCP_MID_ECH(0, g->media_id)) 815 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(0, g->media_id); 816 1.10 ragge n = MSCP_MID_NUM(g->media_id); 817 1.10 ragge if (n > 99) { 818 1.10 ragge dl->d_typename[p++] = '1'; 819 1.10 ragge n -= 100; 820 1.10 ragge } 821 1.10 ragge if (n > 9) { 822 1.10 ragge dl->d_typename[p++] = (n / 10) + '0'; 823 1.10 ragge n %= 10; 824 1.10 ragge } 825 1.10 ragge dl->d_typename[p++] = n + '0'; 826 1.10 ragge dl->d_typename[p] = 0; 827 1.57 christos dl->d_type = DKTYPE_MSCP; /* XXX - what to use here??? */ 828 1.10 ragge dl->d_rpm = 3600; 829 1.10 ragge dl->d_secsize = DEV_BSIZE; 830 1.10 ragge 831 1.10 ragge dl->d_secperunit = g->lbn_count; 832 1.10 ragge dl->d_nsectors = g->nspt; 833 1.10 ragge dl->d_ntracks = g->ntracks; 834 1.10 ragge dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks; 835 1.10 ragge dl->d_ncylinders = dl->d_secperunit / dl->d_secpercyl; 836 1.10 ragge 837 1.10 ragge dl->d_npartitions = MAXPARTITIONS; 838 1.10 ragge dl->d_partitions[0].p_size = dl->d_partitions[2].p_size = 839 1.10 ragge dl->d_secperunit; 840 1.10 ragge dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0; 841 1.10 ragge dl->d_interleave = dl->d_headswitch = 1; 842 1.10 ragge dl->d_magic = dl->d_magic2 = DISKMAGIC; 843 1.10 ragge dl->d_checksum = dkcksum(dl); 844 1.1 ragge } 845