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