hdc9224.c revision 1.10 1 1.10 ragge /* $NetBSD: hdc9224.c,v 1.10 2000/06/25 16:00:44 ragge 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.1 ragge
71 1.10 ragge #include <vm/vm.h>
72 1.10 ragge #include <vm/vm_kern.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.10 ragge volatile u_char sc_status; /* last status from interrupt */
156 1.10 ragge };
157 1.10 ragge
158 1.10 ragge struct hdc_attach_args {
159 1.10 ragge int ha_drive;
160 1.1 ragge };
161 1.1 ragge
162 1.1 ragge /*
163 1.10 ragge * prototypes for (almost) all the internal routines
164 1.1 ragge */
165 1.10 ragge static int hdcmatch(struct device *, struct cfdata *, void *);
166 1.10 ragge static void hdcattach(struct device *, struct device *, void *);
167 1.10 ragge static int hdcprint(void *, const char *);
168 1.10 ragge static int rdmatch(struct device *, struct cfdata *, void *);
169 1.10 ragge static void rdattach(struct device *, struct device *, void *);
170 1.10 ragge static void hdcintr(void *);
171 1.10 ragge static int hdc_command(struct hdcsoftc *, int);
172 1.10 ragge static void rd_readgeom(struct hdcsoftc *, struct rdsoftc *);
173 1.10 ragge #ifdef RDDEBUG
174 1.10 ragge static void hdc_printgeom( struct rdgeom *);
175 1.10 ragge #endif
176 1.10 ragge static void hdc_writeregs(struct hdcsoftc *);
177 1.10 ragge static void hdcstart(struct hdcsoftc *, struct buf *);
178 1.10 ragge static int hdc_rdselect(struct hdcsoftc *, int);
179 1.10 ragge static void rdmakelabel(struct disklabel *, struct rdgeom *);
180 1.10 ragge static void hdc_writeregs(struct hdcsoftc *);
181 1.10 ragge static void hdc_readregs(struct hdcsoftc *);
182 1.10 ragge static void hdc_qstart(void *);
183 1.10 ragge
184 1.10 ragge bdev_decl(rd);
185 1.10 ragge cdev_decl(rd);
186 1.1 ragge
187 1.1 ragge struct cfattach hdc_ca = {
188 1.1 ragge sizeof(struct hdcsoftc), hdcmatch, hdcattach
189 1.1 ragge };
190 1.1 ragge
191 1.1 ragge struct cfattach rd_ca = {
192 1.1 ragge sizeof(struct rdsoftc), rdmatch, rdattach
193 1.1 ragge };
194 1.7 thorpej
195 1.1 ragge
196 1.10 ragge /* At least 0.7 uS between register accesses */
197 1.10 ragge static int rd_dmasize, inq = 0;
198 1.10 ragge static int u;
199 1.10 ragge #define WAIT asm("movl _u,_u;movl _u,_u;movl _u,_u; movl _u,_u")
200 1.10 ragge
201 1.10 ragge #define HDC_WREG(x) *(volatile char *)(sc->sc_regs) = (x)
202 1.10 ragge #define HDC_RREG *(volatile char *)(sc->sc_regs)
203 1.10 ragge #define HDC_WCMD(x) *(volatile char *)(sc->sc_regs + 4) = (x)
204 1.10 ragge #define HDC_RSTAT *(volatile char *)(sc->sc_regs + 4)
205 1.1 ragge
206 1.1 ragge /*
207 1.1 ragge * new-config's hdcmatch() is similiar to old-config's hdcprobe(),
208 1.1 ragge * thus we probe for the existence of the controller and reset it.
209 1.1 ragge * NB: we can't initialize the controller yet, since space for hdcsoftc
210 1.1 ragge * is not yet allocated. Thus we do this in hdcattach()...
211 1.1 ragge */
212 1.1 ragge int
213 1.10 ragge hdcmatch(struct device *parent, struct cfdata *cf, void *aux)
214 1.1 ragge {
215 1.10 ragge struct vsbus_attach_args *va = aux;
216 1.10 ragge volatile char *hdc_csr = (char *)va->va_addr;
217 1.10 ragge int i;
218 1.1 ragge
219 1.10 ragge u = 8; /* !!! - GCC */
220 1.1 ragge
221 1.10 ragge if (vax_boardtype == VAX_BTYP_49 || vax_boardtype == VAX_BTYP_46
222 1.10 ragge || vax_boardtype == VAX_BTYP_48)
223 1.10 ragge return 0;
224 1.10 ragge
225 1.10 ragge hdc_csr[4] = DKC_CMD_RESET; /* reset chip */
226 1.10 ragge for (i = 0; i < 1000; i++) {
227 1.10 ragge DELAY(1000);
228 1.10 ragge if (hdc_csr[4] & DKC_ST_DONE)
229 1.10 ragge break;
230 1.1 ragge }
231 1.10 ragge if (i == 100)
232 1.10 ragge return 0; /* No response to reset */
233 1.1 ragge
234 1.10 ragge hdc_csr[4] = DKC_CMD_SETREGPTR|UDC_TERM;
235 1.10 ragge WAIT;
236 1.10 ragge hdc_csr[0] = UDC_TC_CRCPRE|UDC_TC_INTDONE;
237 1.10 ragge WAIT;
238 1.10 ragge hdc_csr[4] = DKC_CMD_DRDESELECT; /* Should be harmless */
239 1.10 ragge DELAY(1000);
240 1.1 ragge return (1);
241 1.1 ragge }
242 1.1 ragge
243 1.1 ragge int
244 1.10 ragge hdcprint(void *aux, const char *name)
245 1.1 ragge {
246 1.1 ragge struct hdc_attach_args *ha = aux;
247 1.1 ragge
248 1.10 ragge if (name)
249 1.10 ragge printf ("RD?? at %s drive %d", name, ha->ha_drive);
250 1.10 ragge return UNCONF;
251 1.1 ragge }
252 1.1 ragge
253 1.1 ragge /*
254 1.1 ragge * hdc_attach() probes for all possible devices
255 1.1 ragge */
256 1.1 ragge void
257 1.10 ragge hdcattach(struct device *parent, struct device *self, void *aux)
258 1.1 ragge {
259 1.10 ragge struct vsbus_attach_args *va = aux;
260 1.10 ragge struct hdcsoftc *sc = (void *)self;
261 1.1 ragge struct hdc_attach_args ha;
262 1.10 ragge int status, i;
263 1.1 ragge
264 1.4 christos printf ("\n");
265 1.1 ragge /*
266 1.10 ragge * Get interrupt vector, enable instrumentation.
267 1.1 ragge */
268 1.10 ragge scb_vecalloc(va->va_cvec, hdcintr, sc, SCB_ISTACK, &sc->sc_intrcnt);
269 1.10 ragge evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, NULL,
270 1.10 ragge self->dv_xname, "intr");
271 1.10 ragge
272 1.10 ragge sc->sc_regs = vax_map_physmem(va->va_paddr, 1);
273 1.10 ragge sc->sc_dmabase = (caddr_t)va->va_dmaaddr;
274 1.10 ragge sc->sc_dmasize = va->va_dmasize;
275 1.10 ragge rd_dmasize = min(MAXPHYS, sc->sc_dmasize); /* Used in rd_minphys */
276 1.10 ragge
277 1.10 ragge sc->sc_vd.vd_go = hdc_qstart;
278 1.10 ragge sc->sc_vd.vd_arg = sc;
279 1.10 ragge /*
280 1.10 ragge * Reset controller.
281 1.10 ragge */
282 1.10 ragge HDC_WCMD(DKC_CMD_RESET);
283 1.10 ragge DELAY(1000);
284 1.10 ragge status = HDC_RSTAT;
285 1.10 ragge if (status != (DKC_ST_DONE|DKC_TC_SUCCESS)) {
286 1.10 ragge printf("%s: RESET failed, status 0x%x\n",
287 1.10 ragge sc->sc_dev.dv_xname, status);
288 1.10 ragge return;
289 1.10 ragge }
290 1.10 ragge BUFQ_INIT(&sc->sc_q);
291 1.10 ragge
292 1.10 ragge /*
293 1.10 ragge * now probe for all possible hard drives
294 1.10 ragge */
295 1.10 ragge for (i = 0; i < 4; i++) {
296 1.10 ragge if (i == 2) /* Floppy, needs special handling */
297 1.10 ragge continue;
298 1.10 ragge HDC_WCMD(DKC_CMD_DRSELECT | i);
299 1.10 ragge DELAY(1000);
300 1.10 ragge status = HDC_RSTAT;
301 1.10 ragge ha.ha_drive = i;
302 1.10 ragge if ((status & DKC_ST_TERMCOD) == DKC_TC_SUCCESS)
303 1.10 ragge config_found(self, (void *)&ha, hdcprint);
304 1.1 ragge }
305 1.1 ragge }
306 1.1 ragge
307 1.1 ragge /*
308 1.1 ragge * rdmatch() probes for the existence of a RD-type disk/floppy
309 1.1 ragge */
310 1.1 ragge int
311 1.8 ragge rdmatch(parent, cf, aux)
312 1.1 ragge struct device *parent;
313 1.8 ragge struct cfdata *cf;
314 1.8 ragge void *aux;
315 1.1 ragge {
316 1.1 ragge struct hdc_attach_args *ha = aux;
317 1.1 ragge
318 1.10 ragge if (cf->cf_loc[HDCCF_DRIVE] != HDCCF_DRIVE_DEFAULT &&
319 1.10 ragge cf->cf_loc[HDCCF_DRIVE] != ha->ha_drive)
320 1.10 ragge return 0;
321 1.1 ragge
322 1.10 ragge if (ha->ha_drive == 2) /* Always floppy, not supported */
323 1.10 ragge return 0;
324 1.1 ragge
325 1.10 ragge return 1;
326 1.10 ragge }
327 1.1 ragge
328 1.10 ragge #define RDMAJOR 19
329 1.1 ragge
330 1.1 ragge void
331 1.10 ragge rdattach(struct device *parent, struct device *self, void *aux)
332 1.1 ragge {
333 1.10 ragge struct hdcsoftc *sc = (void*)parent;
334 1.1 ragge struct rdsoftc *rd = (void*)self;
335 1.1 ragge struct hdc_attach_args *ha = aux;
336 1.10 ragge struct disklabel *dl;
337 1.10 ragge char *msg;
338 1.1 ragge
339 1.1 ragge rd->sc_drive = ha->ha_drive;
340 1.1 ragge /*
341 1.1 ragge * Initialize and attach the disk structure.
342 1.1 ragge */
343 1.10 ragge rd->sc_disk.dk_name = rd->sc_dev.dv_xname;
344 1.10 ragge disk_attach(&rd->sc_disk);
345 1.10 ragge
346 1.1 ragge /*
347 1.1 ragge * if it's not a floppy then evaluate the on-disk geometry.
348 1.1 ragge * if neccessary correct the label...
349 1.1 ragge */
350 1.10 ragge rd_readgeom(sc, rd);
351 1.10 ragge disk_printtype(rd->sc_drive, rd->sc_xbn.media_id);
352 1.10 ragge dl = rd->sc_disk.dk_label;
353 1.10 ragge rdmakelabel(dl, &rd->sc_xbn);
354 1.10 ragge printf("%s", rd->sc_dev.dv_xname);
355 1.10 ragge msg = readdisklabel(MAKEDISKDEV(RDMAJOR, rd->sc_dev.dv_unit, RAW_PART),
356 1.10 ragge rdstrategy, dl, NULL);
357 1.10 ragge if (msg)
358 1.10 ragge printf(": %s", msg);
359 1.10 ragge printf(": size %d sectors\n", dl->d_secperunit);
360 1.10 ragge #ifdef RDDEBUG
361 1.10 ragge hdc_printgeom(&rd->sc_xbn);
362 1.10 ragge #endif
363 1.10 ragge }
364 1.10 ragge
365 1.10 ragge void
366 1.10 ragge hdcintr(void *arg)
367 1.10 ragge {
368 1.10 ragge struct hdcsoftc *sc = arg;
369 1.10 ragge struct buf *bp;
370 1.10 ragge
371 1.10 ragge sc->sc_status = HDC_RSTAT;
372 1.10 ragge if (sc->sc_active == 0)
373 1.10 ragge return; /* Complain? */
374 1.10 ragge
375 1.10 ragge if ((sc->sc_status & (DKC_ST_INTPEND|DKC_ST_DONE)) !=
376 1.10 ragge (DKC_ST_INTPEND|DKC_ST_DONE))
377 1.10 ragge return; /* Why spurious ints sometimes??? */
378 1.10 ragge
379 1.10 ragge bp = sc->sc_active;
380 1.10 ragge sc->sc_active = 0;
381 1.10 ragge if ((sc->sc_status & DKC_ST_TERMCOD) != DKC_TC_SUCCESS) {
382 1.10 ragge int i;
383 1.10 ragge u_char *g = (u_char *)&sc->sc_sreg;
384 1.10 ragge printf("%s: failed, status 0x%x\n",
385 1.10 ragge sc->sc_dev.dv_xname, sc->sc_status);
386 1.10 ragge hdc_readregs(sc);
387 1.10 ragge for (i = 0; i < 10; i++)
388 1.10 ragge printf("%i: %x\n", i, g[i]);
389 1.10 ragge bp->b_flags |= B_ERROR;
390 1.10 ragge bp->b_error = ENXIO;
391 1.10 ragge bp->b_resid = bp->b_bcount;
392 1.10 ragge biodone(bp);
393 1.10 ragge vsbus_dma_intr();
394 1.10 ragge return;
395 1.10 ragge }
396 1.10 ragge
397 1.10 ragge if (bp->b_flags & B_READ) {
398 1.10 ragge vsbus_copytoproc(bp->b_proc, sc->sc_dmabase, sc->sc_bufaddr,
399 1.10 ragge sc->sc_xfer);
400 1.10 ragge }
401 1.10 ragge sc->sc_bufaddr += sc->sc_xfer;
402 1.10 ragge
403 1.10 ragge if (sc->sc_bytecnt == 0) { /* Finished transfer */
404 1.10 ragge biodone(bp);
405 1.10 ragge vsbus_dma_intr();
406 1.10 ragge } else
407 1.10 ragge hdcstart(sc, bp);
408 1.1 ragge }
409 1.1 ragge
410 1.1 ragge /*
411 1.10 ragge *
412 1.1 ragge */
413 1.1 ragge void
414 1.10 ragge rdstrategy(struct buf *bp)
415 1.1 ragge {
416 1.10 ragge struct rdsoftc *rd;
417 1.10 ragge struct hdcsoftc *sc;
418 1.10 ragge struct disklabel *lp;
419 1.10 ragge int unit, s;
420 1.1 ragge
421 1.10 ragge unit = DISKUNIT(bp->b_dev);
422 1.10 ragge if (unit > rd_cd.cd_ndevs || (rd = rd_cd.cd_devs[unit]) == NULL) {
423 1.10 ragge bp->b_error = ENXIO;
424 1.10 ragge bp->b_flags |= B_ERROR;
425 1.10 ragge goto done;
426 1.10 ragge }
427 1.10 ragge sc = (void *)rd->sc_dev.dv_parent;
428 1.1 ragge
429 1.10 ragge lp = rd->sc_disk.dk_label;
430 1.10 ragge if ((bounds_check_with_label(bp, lp, 1)) <= 0)
431 1.10 ragge goto done;
432 1.1 ragge
433 1.1 ragge if (bp->b_bcount == 0)
434 1.1 ragge goto done;
435 1.10 ragge
436 1.10 ragge bp->b_rawblkno =
437 1.10 ragge bp->b_blkno + lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
438 1.10 ragge bp->b_cylinder = bp->b_rawblkno / lp->d_secpercyl;
439 1.10 ragge
440 1.10 ragge s = splimp();
441 1.10 ragge disksort_cylinder(&sc->sc_q, bp);
442 1.10 ragge if (inq == 0) {
443 1.10 ragge inq = 1;
444 1.10 ragge vsbus_dma_start(&sc->sc_vd);
445 1.10 ragge }
446 1.10 ragge splx(s);
447 1.10 ragge return;
448 1.10 ragge
449 1.10 ragge done: biodone(bp);
450 1.1 ragge }
451 1.1 ragge
452 1.10 ragge void
453 1.10 ragge hdc_qstart(void *arg)
454 1.1 ragge {
455 1.10 ragge struct hdcsoftc *sc = arg;
456 1.1 ragge
457 1.10 ragge inq = 0;
458 1.1 ragge
459 1.10 ragge hdcstart(sc, 0);
460 1.10 ragge if (BUFQ_FIRST(&sc->sc_q)) {
461 1.10 ragge vsbus_dma_start(&sc->sc_vd); /* More to go */
462 1.10 ragge inq = 1;
463 1.10 ragge }
464 1.10 ragge }
465 1.1 ragge
466 1.10 ragge void
467 1.10 ragge hdcstart(struct hdcsoftc *sc, struct buf *ob)
468 1.10 ragge {
469 1.10 ragge struct hdc9224_UDCreg *p = &sc->sc_creg;
470 1.10 ragge struct disklabel *lp;
471 1.10 ragge struct rdsoftc *rd;
472 1.10 ragge struct buf *bp;
473 1.10 ragge int cn, sn, tn, bn, blks;
474 1.1 ragge
475 1.10 ragge if (sc->sc_active)
476 1.10 ragge return; /* Already doing something */
477 1.1 ragge
478 1.1 ragge
479 1.10 ragge if (ob == 0) {
480 1.10 ragge bp = BUFQ_FIRST(&sc->sc_q);
481 1.10 ragge if (bp == NULL)
482 1.10 ragge return; /* Nothing to do */
483 1.10 ragge BUFQ_REMOVE(&sc->sc_q, bp);
484 1.10 ragge sc->sc_bufaddr = bp->b_data;
485 1.10 ragge sc->sc_diskblk = bp->b_rawblkno;
486 1.10 ragge sc->sc_bytecnt = bp->b_bcount;
487 1.10 ragge bp->b_resid = 0;
488 1.10 ragge } else
489 1.10 ragge bp = ob;
490 1.10 ragge
491 1.10 ragge rd = rd_cd.cd_devs[DISKUNIT(bp->b_dev)];
492 1.10 ragge hdc_rdselect(sc, rd->sc_drive);
493 1.10 ragge sc->sc_active = bp;
494 1.10 ragge
495 1.10 ragge bn = sc->sc_diskblk;
496 1.10 ragge lp = rd->sc_disk.dk_label;
497 1.10 ragge if (bn) {
498 1.10 ragge cn = bn / lp->d_secpercyl;
499 1.10 ragge sn = bn % lp->d_secpercyl;
500 1.10 ragge tn = sn / lp->d_nsectors;
501 1.10 ragge sn = sn % lp->d_nsectors;
502 1.10 ragge } else
503 1.10 ragge cn = sn = tn = 0;
504 1.10 ragge
505 1.10 ragge cn++; /* first cylinder is reserved */
506 1.10 ragge
507 1.10 ragge bzero(p, sizeof(struct hdc9224_UDCreg));
508 1.10 ragge
509 1.10 ragge /*
510 1.10 ragge * Tricky thing: the controller do itself only increase the sector
511 1.10 ragge * number, not the track or cylinder number. Therefore the driver
512 1.10 ragge * is not allowed to have transfers that crosses track boundaries.
513 1.10 ragge */
514 1.10 ragge blks = sc->sc_bytecnt/DEV_BSIZE;
515 1.10 ragge if ((sn + blks) > lp->d_nsectors)
516 1.10 ragge blks = lp->d_nsectors - sn;
517 1.10 ragge
518 1.10 ragge p->udc_dsect = sn;
519 1.10 ragge p->udc_dcyl = cn & 0xff;
520 1.10 ragge p->udc_dhead = ((cn >> 4) & 0x70) | tn;
521 1.10 ragge p->udc_scnt = blks;
522 1.10 ragge
523 1.10 ragge p->udc_rtcnt = UDC_RC_RTRYCNT;
524 1.10 ragge p->udc_mode = UDC_MD_HDD;
525 1.10 ragge p->udc_term = UDC_TC_CRCPRE|UDC_TC_INTDONE|UDC_TC_TDELDAT|UDC_TC_TWRFLT;
526 1.10 ragge hdc_writeregs(sc);
527 1.10 ragge
528 1.10 ragge /* Count up vars */
529 1.10 ragge sc->sc_xfer = blks * DEV_BSIZE;
530 1.10 ragge sc->sc_diskblk += blks;
531 1.10 ragge sc->sc_bytecnt -= sc->sc_xfer;
532 1.10 ragge
533 1.10 ragge if (bp->b_flags & B_READ) {
534 1.10 ragge HDC_WCMD(DKC_CMD_READ_HDD);
535 1.10 ragge } else {
536 1.10 ragge vsbus_copyfromproc(bp->b_proc, sc->sc_bufaddr, sc->sc_dmabase,
537 1.10 ragge sc->sc_xfer);
538 1.10 ragge HDC_WCMD(DKC_CMD_WRITE_HDD);
539 1.10 ragge }
540 1.10 ragge }
541 1.1 ragge
542 1.10 ragge void
543 1.10 ragge rd_readgeom(struct hdcsoftc *sc, struct rdsoftc *rd)
544 1.10 ragge {
545 1.10 ragge struct hdc9224_UDCreg *p = &sc->sc_creg;
546 1.1 ragge
547 1.10 ragge hdc_rdselect(sc, rd->sc_drive); /* select drive right now */
548 1.1 ragge
549 1.10 ragge bzero(p, sizeof(struct hdc9224_UDCreg));
550 1.1 ragge
551 1.10 ragge p->udc_scnt = 1;
552 1.10 ragge p->udc_rtcnt = UDC_RC_RTRYCNT;
553 1.10 ragge p->udc_mode = UDC_MD_HDD;
554 1.10 ragge p->udc_term = UDC_TC_CRCPRE|UDC_TC_INTDONE|UDC_TC_TDELDAT|UDC_TC_TWPROT;
555 1.10 ragge hdc_writeregs(sc);
556 1.10 ragge sc->sc_status = 0;
557 1.10 ragge HDC_WCMD(DKC_CMD_READ_HDD|2);
558 1.10 ragge while ((sc->sc_status & DKC_ST_INTPEND) == 0)
559 1.10 ragge ;
560 1.10 ragge bcopy(sc->sc_dmabase, &rd->sc_xbn, sizeof(struct rdgeom));
561 1.1 ragge }
562 1.1 ragge
563 1.10 ragge #ifdef RDDEBUG
564 1.1 ragge /*
565 1.1 ragge * display the contents of the on-disk geometry structure
566 1.1 ragge */
567 1.9 ragge void
568 1.1 ragge hdc_printgeom(p)
569 1.1 ragge struct rdgeom *p;
570 1.1 ragge {
571 1.9 ragge printf ("**DiskData** XBNs: %ld, DBNs: %ld, LBNs: %ld, RBNs: %ld\n",
572 1.1 ragge p->xbn_count, p->dbn_count, p->lbn_count, p->rbn_count);
573 1.4 christos printf ("sec/track: %d, tracks: %d, cyl: %d, precomp/reduced: %d/%d\n",
574 1.1 ragge p->nspt, p->ntracks, p->ncylinders, p->precomp, p->reduced);
575 1.4 christos printf ("seek-rate: %d, crc/eec: %s, RCT: %d, RCT-copies: %d\n",
576 1.1 ragge p->seek_rate, p->crc_eec?"EEC":"CRC", p->rct, p->rct_ncopies);
577 1.10 ragge printf ("media-ID: %lx, interleave: %d, headskew: %d, cylskew: %d\n",
578 1.10 ragge p->media_id, p->interleave, p->headskew, p->cylskew);
579 1.4 christos printf ("gap0: %d, gap1: %d, gap2: %d, gap3: %d, sync-value: %d\n",
580 1.1 ragge p->gap0_size, p->gap1_size, p->gap2_size, p->gap3_size,
581 1.1 ragge p->sync_value);
582 1.1 ragge }
583 1.1 ragge #endif
584 1.1 ragge
585 1.1 ragge /*
586 1.10 ragge * Return the size of a partition, if known, or -1 if not.
587 1.1 ragge */
588 1.1 ragge int
589 1.10 ragge rdsize(dev_t dev)
590 1.1 ragge {
591 1.1 ragge struct rdsoftc *rd;
592 1.10 ragge int unit = DISKUNIT(dev);
593 1.1 ragge int size;
594 1.1 ragge
595 1.10 ragge if (unit >= rd_cd.cd_ndevs || rd_cd.cd_devs[unit] == 0)
596 1.10 ragge return -1;
597 1.10 ragge rd = rd_cd.cd_devs[unit];
598 1.10 ragge size = rd->sc_disk.dk_label->d_partitions[DISKPART(dev)].p_size *
599 1.10 ragge (rd->sc_disk.dk_label->d_secsize / DEV_BSIZE);
600 1.1 ragge
601 1.1 ragge return (size);
602 1.1 ragge }
603 1.1 ragge
604 1.1 ragge /*
605 1.1 ragge *
606 1.1 ragge */
607 1.1 ragge int
608 1.10 ragge rdopen(dev_t dev, int flag, int fmt, struct proc *p)
609 1.1 ragge {
610 1.1 ragge struct rdsoftc *rd;
611 1.10 ragge int unit, part;
612 1.1 ragge
613 1.10 ragge unit = DISKUNIT(dev);
614 1.10 ragge if (unit >= rd_cd.cd_ndevs)
615 1.10 ragge return ENXIO;
616 1.10 ragge rd = rd_cd.cd_devs[unit];
617 1.10 ragge if (rd == 0)
618 1.10 ragge return ENXIO;
619 1.1 ragge
620 1.10 ragge part = DISKPART(dev);
621 1.10 ragge if (part >= rd->sc_disk.dk_label->d_npartitions)
622 1.1 ragge return ENXIO;
623 1.10 ragge
624 1.10 ragge switch (fmt) {
625 1.10 ragge case S_IFCHR:
626 1.10 ragge rd->sc_disk.dk_copenmask |= (1 << part);
627 1.10 ragge break;
628 1.10 ragge case S_IFBLK:
629 1.10 ragge rd->sc_disk.dk_bopenmask |= (1 << part);
630 1.10 ragge break;
631 1.1 ragge }
632 1.10 ragge rd->sc_disk.dk_openmask =
633 1.10 ragge rd->sc_disk.dk_copenmask | rd->sc_disk.dk_bopenmask;
634 1.1 ragge
635 1.10 ragge return 0;
636 1.1 ragge }
637 1.1 ragge
638 1.1 ragge /*
639 1.1 ragge *
640 1.1 ragge */
641 1.1 ragge int
642 1.10 ragge rdclose(dev_t dev, int flag, int fmt, struct proc *p)
643 1.1 ragge {
644 1.10 ragge struct rdsoftc *rd;
645 1.10 ragge int part;
646 1.10 ragge
647 1.10 ragge rd = rd_cd.cd_devs[DISKUNIT(dev)];
648 1.10 ragge part = DISKPART(dev);
649 1.10 ragge
650 1.10 ragge switch (fmt) {
651 1.10 ragge case S_IFCHR:
652 1.10 ragge rd->sc_disk.dk_copenmask &= ~(1 << part);
653 1.10 ragge break;
654 1.10 ragge case S_IFBLK:
655 1.10 ragge rd->sc_disk.dk_bopenmask &= ~(1 << part);
656 1.10 ragge break;
657 1.10 ragge }
658 1.10 ragge rd->sc_disk.dk_openmask =
659 1.10 ragge rd->sc_disk.dk_copenmask | rd->sc_disk.dk_bopenmask;
660 1.10 ragge
661 1.1 ragge return (0);
662 1.1 ragge }
663 1.1 ragge
664 1.1 ragge /*
665 1.1 ragge *
666 1.1 ragge */
667 1.1 ragge int
668 1.10 ragge rdioctl(dev_t dev, u_long cmd, caddr_t addr, int flag, struct proc *p)
669 1.1 ragge {
670 1.10 ragge struct rdsoftc *rd = rd_cd.cd_devs[DISKUNIT(dev)];
671 1.10 ragge struct disklabel *lp = rd->sc_disk.dk_label;
672 1.10 ragge int err = 0;
673 1.1 ragge
674 1.1 ragge switch (cmd) {
675 1.1 ragge case DIOCGDINFO:
676 1.10 ragge bcopy(lp, addr, sizeof (struct disklabel));
677 1.10 ragge break;
678 1.1 ragge
679 1.1 ragge case DIOCGPART:
680 1.10 ragge ((struct partinfo *)addr)->disklab = lp;
681 1.10 ragge ((struct partinfo *)addr)->part =
682 1.10 ragge &lp->d_partitions[DISKPART(dev)];
683 1.10 ragge break;
684 1.1 ragge
685 1.1 ragge case DIOCWDINFO:
686 1.1 ragge case DIOCSDINFO:
687 1.1 ragge if ((flag & FWRITE) == 0)
688 1.1 ragge return EBADF;
689 1.10 ragge else
690 1.10 ragge err = (cmd == DIOCSDINFO ?
691 1.10 ragge setdisklabel(lp, (struct disklabel *)addr, 0, 0) :
692 1.10 ragge writedisklabel(dev, rdstrategy, lp, 0));
693 1.10 ragge break;
694 1.1 ragge
695 1.10 ragge case DIOCGDEFLABEL:
696 1.10 ragge bzero(lp, sizeof(struct disklabel));
697 1.10 ragge rdmakelabel(lp, &rd->sc_xbn);
698 1.10 ragge break;
699 1.1 ragge
700 1.1 ragge case DIOCWLABEL:
701 1.1 ragge if ((flag & FWRITE) == 0)
702 1.10 ragge err = EBADF;
703 1.10 ragge break;
704 1.10 ragge
705 1.1 ragge default:
706 1.10 ragge err = ENOTTY;
707 1.1 ragge }
708 1.10 ragge return err;
709 1.1 ragge }
710 1.1 ragge
711 1.1 ragge /*
712 1.1 ragge *
713 1.1 ragge */
714 1.1 ragge int
715 1.10 ragge rdread(dev_t dev, struct uio *uio, int flag)
716 1.1 ragge {
717 1.10 ragge return (physio (rdstrategy, NULL, dev, B_READ, minphys, uio));
718 1.1 ragge }
719 1.1 ragge
720 1.1 ragge /*
721 1.1 ragge *
722 1.1 ragge */
723 1.1 ragge int
724 1.10 ragge rdwrite(dev_t dev, struct uio *uio, int flag)
725 1.1 ragge {
726 1.10 ragge return (physio (rdstrategy, NULL, dev, B_WRITE, minphys, uio));
727 1.1 ragge }
728 1.1 ragge
729 1.1 ragge /*
730 1.1 ragge *
731 1.1 ragge */
732 1.1 ragge int
733 1.10 ragge rddump(dev_t dev, daddr_t daddr, caddr_t addr, size_t size)
734 1.1 ragge {
735 1.9 ragge return 0;
736 1.1 ragge }
737 1.1 ragge
738 1.1 ragge /*
739 1.1 ragge * we have to wait 0.7 usec between two accesses to any of the
740 1.1 ragge * dkc-registers, on a VS2000 with 1 MIPS, this is roughly one
741 1.1 ragge * instruction. Thus the loop-overhead will be enough...
742 1.1 ragge */
743 1.10 ragge static void
744 1.10 ragge hdc_readregs(struct hdcsoftc *sc)
745 1.1 ragge {
746 1.1 ragge int i;
747 1.1 ragge char *p;
748 1.1 ragge
749 1.10 ragge HDC_WCMD(DKC_CMD_SETREGPTR);
750 1.10 ragge WAIT;
751 1.1 ragge p = (void*)&sc->sc_sreg;
752 1.10 ragge for (i=0; i<10; i++) {
753 1.10 ragge *p++ = HDC_RREG; /* dkc_reg auto-increments */
754 1.10 ragge WAIT;
755 1.10 ragge }
756 1.1 ragge }
757 1.1 ragge
758 1.10 ragge static void
759 1.10 ragge hdc_writeregs(struct hdcsoftc *sc)
760 1.1 ragge {
761 1.1 ragge int i;
762 1.1 ragge char *p;
763 1.1 ragge
764 1.10 ragge HDC_WCMD(DKC_CMD_SETREGPTR);
765 1.1 ragge p = (void*)&sc->sc_creg;
766 1.10 ragge for (i=0; i<10; i++) {
767 1.10 ragge HDC_WREG(*p++); /* dkc_reg auto-increments */
768 1.10 ragge WAIT;
769 1.10 ragge }
770 1.1 ragge }
771 1.1 ragge
772 1.1 ragge /*
773 1.1 ragge * hdc_command() issues a command and polls the intreq-register
774 1.1 ragge * to find when command has completed
775 1.1 ragge */
776 1.1 ragge int
777 1.10 ragge hdc_command(struct hdcsoftc *sc, int cmd)
778 1.1 ragge {
779 1.1 ragge hdc_writeregs(sc); /* write the prepared registers */
780 1.10 ragge HDC_WCMD(cmd);
781 1.10 ragge WAIT;
782 1.1 ragge return (0);
783 1.1 ragge }
784 1.1 ragge
785 1.1 ragge int
786 1.10 ragge hdc_rdselect(struct hdcsoftc *sc, int unit)
787 1.1 ragge {
788 1.10 ragge struct hdc9224_UDCreg *p = &sc->sc_creg;
789 1.1 ragge int error;
790 1.1 ragge
791 1.1 ragge /*
792 1.1 ragge * bring "creg" in some known-to-work state and
793 1.1 ragge * select the drive with the DRIVE SELECT command.
794 1.1 ragge */
795 1.10 ragge bzero(p, sizeof(struct hdc9224_UDCreg));
796 1.1 ragge
797 1.1 ragge p->udc_rtcnt = UDC_RC_HDD_READ;
798 1.1 ragge p->udc_mode = UDC_MD_HDD;
799 1.1 ragge p->udc_term = UDC_TC_HDD;
800 1.1 ragge
801 1.10 ragge error = hdc_command(sc, DKC_CMD_DRSEL_HDD | unit);
802 1.10 ragge
803 1.1 ragge return (error);
804 1.1 ragge }
805 1.1 ragge
806 1.10 ragge void
807 1.10 ragge rdmakelabel(struct disklabel *dl, struct rdgeom *g)
808 1.1 ragge {
809 1.10 ragge int n, p = 0;
810 1.1 ragge
811 1.10 ragge dl->d_bbsize = BBSIZE;
812 1.10 ragge dl->d_sbsize = SBSIZE;
813 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(2, g->media_id);
814 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(1, g->media_id);
815 1.10 ragge if (MSCP_MID_ECH(0, g->media_id))
816 1.10 ragge dl->d_typename[p++] = MSCP_MID_CHAR(0, g->media_id);
817 1.10 ragge n = MSCP_MID_NUM(g->media_id);
818 1.10 ragge if (n > 99) {
819 1.10 ragge dl->d_typename[p++] = '1';
820 1.10 ragge n -= 100;
821 1.10 ragge }
822 1.10 ragge if (n > 9) {
823 1.10 ragge dl->d_typename[p++] = (n / 10) + '0';
824 1.10 ragge n %= 10;
825 1.10 ragge }
826 1.10 ragge dl->d_typename[p++] = n + '0';
827 1.10 ragge dl->d_typename[p] = 0;
828 1.10 ragge dl->d_type = DTYPE_MSCP; /* XXX - what to use here??? */
829 1.10 ragge dl->d_rpm = 3600;
830 1.10 ragge dl->d_secsize = DEV_BSIZE;
831 1.10 ragge
832 1.10 ragge dl->d_secperunit = g->lbn_count;
833 1.10 ragge dl->d_nsectors = g->nspt;
834 1.10 ragge dl->d_ntracks = g->ntracks;
835 1.10 ragge dl->d_secpercyl = dl->d_nsectors * dl->d_ntracks;
836 1.10 ragge dl->d_ncylinders = dl->d_secperunit / dl->d_secpercyl;
837 1.10 ragge
838 1.10 ragge dl->d_npartitions = MAXPARTITIONS;
839 1.10 ragge dl->d_partitions[0].p_size = dl->d_partitions[2].p_size =
840 1.10 ragge dl->d_secperunit;
841 1.10 ragge dl->d_partitions[0].p_offset = dl->d_partitions[2].p_offset = 0;
842 1.10 ragge dl->d_interleave = dl->d_headswitch = 1;
843 1.10 ragge dl->d_magic = dl->d_magic2 = DISKMAGIC;
844 1.10 ragge dl->d_checksum = dkcksum(dl);
845 1.1 ragge }
846