ed_mca.c revision 1.22.2.2 1 1.22.2.2 skrll /* $NetBSD: ed_mca.c,v 1.22.2.2 2004/08/25 06:58:05 skrll Exp $ */
2 1.1 jdolecek
3 1.1 jdolecek /*
4 1.1 jdolecek * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 1.1 jdolecek *
6 1.1 jdolecek * This code is derived from software contributed to The NetBSD Foundation
7 1.1 jdolecek * by Jaromir Dolecek.
8 1.1 jdolecek *
9 1.1 jdolecek * Redistribution and use in source and binary forms, with or without
10 1.1 jdolecek * modification, are permitted provided that the following conditions
11 1.1 jdolecek * are met:
12 1.1 jdolecek * 1. Redistributions of source code must retain the above copyright
13 1.1 jdolecek * notice, this list of conditions and the following disclaimer.
14 1.1 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
15 1.1 jdolecek * notice, this list of conditions and the following disclaimer in the
16 1.1 jdolecek * documentation and/or other materials provided with the distribution.
17 1.1 jdolecek * 3. All advertising materials mentioning features or use of this software
18 1.1 jdolecek * must display the following acknowledgement:
19 1.1 jdolecek * This product includes software developed by the NetBSD
20 1.1 jdolecek * Foundation, Inc. and its contributors.
21 1.1 jdolecek * 4. The name of the author may not be used to endorse or promote products
22 1.1 jdolecek * derived from this software without specific prior written permission.
23 1.1 jdolecek *
24 1.1 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
25 1.1 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
26 1.1 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
27 1.1 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
28 1.1 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
29 1.1 jdolecek * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
30 1.1 jdolecek * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
31 1.1 jdolecek * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
32 1.1 jdolecek * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
33 1.1 jdolecek * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
34 1.1 jdolecek */
35 1.1 jdolecek
36 1.1 jdolecek /*
37 1.10 jdolecek * Disk drive goo for MCA ESDI controller driver.
38 1.1 jdolecek */
39 1.9 lukem
40 1.9 lukem #include <sys/cdefs.h>
41 1.22.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: ed_mca.c,v 1.22.2.2 2004/08/25 06:58:05 skrll Exp $");
42 1.1 jdolecek
43 1.1 jdolecek #include "rnd.h"
44 1.10 jdolecek #include "locators.h"
45 1.1 jdolecek
46 1.1 jdolecek #include <sys/param.h>
47 1.1 jdolecek #include <sys/systm.h>
48 1.1 jdolecek #include <sys/kernel.h>
49 1.1 jdolecek #include <sys/conf.h>
50 1.1 jdolecek #include <sys/file.h>
51 1.1 jdolecek #include <sys/stat.h>
52 1.1 jdolecek #include <sys/ioctl.h>
53 1.1 jdolecek #include <sys/buf.h>
54 1.1 jdolecek #include <sys/uio.h>
55 1.1 jdolecek #include <sys/malloc.h>
56 1.1 jdolecek #include <sys/device.h>
57 1.1 jdolecek #include <sys/disklabel.h>
58 1.1 jdolecek #include <sys/disk.h>
59 1.1 jdolecek #include <sys/syslog.h>
60 1.1 jdolecek #include <sys/proc.h>
61 1.1 jdolecek #include <sys/vnode.h>
62 1.1 jdolecek #if NRND > 0
63 1.1 jdolecek #include <sys/rnd.h>
64 1.1 jdolecek #endif
65 1.1 jdolecek
66 1.1 jdolecek #include <machine/intr.h>
67 1.1 jdolecek #include <machine/bus.h>
68 1.1 jdolecek
69 1.4 jdolecek #include <dev/mca/mcavar.h>
70 1.4 jdolecek
71 1.2 jdolecek #include <dev/mca/edcreg.h>
72 1.1 jdolecek #include <dev/mca/edvar.h>
73 1.2 jdolecek #include <dev/mca/edcvar.h>
74 1.1 jdolecek
75 1.22.2.2 skrll /* #define ATADEBUG */
76 1.1 jdolecek
77 1.22.2.2 skrll #ifdef ATADEBUG
78 1.22.2.2 skrll #define ATADEBUG_PRINT(args, level) printf args
79 1.1 jdolecek #else
80 1.22.2.2 skrll #define ATADEBUG_PRINT(args, level)
81 1.1 jdolecek #endif
82 1.1 jdolecek
83 1.1 jdolecek #define EDLABELDEV(dev) (MAKEDISKDEV(major(dev), DISKUNIT(dev), RAW_PART))
84 1.1 jdolecek
85 1.1 jdolecek static int ed_mca_probe __P((struct device *, struct cfdata *, void *));
86 1.1 jdolecek static void ed_mca_attach __P((struct device *, struct device *, void *));
87 1.1 jdolecek
88 1.16 thorpej CFATTACH_DECL(ed_mca, sizeof(struct ed_softc),
89 1.17 thorpej ed_mca_probe, ed_mca_attach, NULL, NULL);
90 1.1 jdolecek
91 1.1 jdolecek extern struct cfdriver ed_cd;
92 1.1 jdolecek
93 1.10 jdolecek static int ed_get_params __P((struct ed_softc *, int *));
94 1.1 jdolecek static int ed_lock __P((struct ed_softc *));
95 1.1 jdolecek static void ed_unlock __P((struct ed_softc *));
96 1.10 jdolecek static void edgetdisklabel __P((dev_t, struct ed_softc *));
97 1.1 jdolecek static void edgetdefaultlabel __P((struct ed_softc *, struct disklabel *));
98 1.14 gehenna
99 1.14 gehenna dev_type_open(edmcaopen);
100 1.14 gehenna dev_type_close(edmcaclose);
101 1.14 gehenna dev_type_read(edmcaread);
102 1.14 gehenna dev_type_write(edmcawrite);
103 1.14 gehenna dev_type_ioctl(edmcaioctl);
104 1.14 gehenna dev_type_strategy(edmcastrategy);
105 1.14 gehenna dev_type_dump(edmcadump);
106 1.14 gehenna dev_type_size(edmcasize);
107 1.14 gehenna
108 1.14 gehenna const struct bdevsw ed_bdevsw = {
109 1.14 gehenna edmcaopen, edmcaclose, edmcastrategy, edmcaioctl,
110 1.14 gehenna edmcadump, edmcasize, D_DISK
111 1.14 gehenna };
112 1.14 gehenna
113 1.14 gehenna const struct cdevsw ed_cdevsw = {
114 1.14 gehenna edmcaopen, edmcaclose, edmcaread, edmcawrite, edmcaioctl,
115 1.18 jdolecek nostop, notty, nopoll, nommap, nokqfilter, D_DISK
116 1.14 gehenna };
117 1.1 jdolecek
118 1.1 jdolecek static struct dkdriver eddkdriver = { edmcastrategy };
119 1.1 jdolecek
120 1.1 jdolecek /*
121 1.1 jdolecek * Just check if it's possible to identify the disk.
122 1.1 jdolecek */
123 1.1 jdolecek static int
124 1.10 jdolecek ed_mca_probe(parent, cf, aux)
125 1.1 jdolecek struct device *parent;
126 1.10 jdolecek struct cfdata *cf;
127 1.1 jdolecek void *aux;
128 1.1 jdolecek {
129 1.1 jdolecek u_int16_t cmd_args[2];
130 1.2 jdolecek struct edc_mca_softc *sc = (void *) parent;
131 1.10 jdolecek struct ed_attach_args *eda = (struct ed_attach_args *) aux;
132 1.6 jdolecek int found = 1;
133 1.1 jdolecek
134 1.1 jdolecek /*
135 1.10 jdolecek * Check we match hardwired config.
136 1.10 jdolecek */
137 1.10 jdolecek if (cf->edccf_unit != EDCCF_DRIVE_DEFAULT &&
138 1.10 jdolecek cf->edccf_unit != eda->edc_drive)
139 1.10 jdolecek return (0);
140 1.10 jdolecek
141 1.10 jdolecek /*
142 1.1 jdolecek * Get Device Configuration (09).
143 1.1 jdolecek */
144 1.6 jdolecek cmd_args[0] = 14; /* Options: 00s110, s: 0=Physical 1=Pseudo */
145 1.1 jdolecek cmd_args[1] = 0;
146 1.10 jdolecek if (edc_run_cmd(sc, CMD_GET_DEV_CONF, eda->edc_drive, cmd_args, 2, 1))
147 1.6 jdolecek found = 0;
148 1.1 jdolecek
149 1.6 jdolecek return (found);
150 1.1 jdolecek }
151 1.1 jdolecek
152 1.1 jdolecek static void
153 1.1 jdolecek ed_mca_attach(parent, self, aux)
154 1.1 jdolecek struct device *parent, *self;
155 1.1 jdolecek void *aux;
156 1.1 jdolecek {
157 1.1 jdolecek struct ed_softc *ed = (void *) self;
158 1.2 jdolecek struct edc_mca_softc *sc = (void *) parent;
159 1.10 jdolecek struct ed_attach_args *eda = (struct ed_attach_args *) aux;
160 1.10 jdolecek char pbuf[8], lckname[10];
161 1.10 jdolecek int drv_flags;
162 1.1 jdolecek
163 1.2 jdolecek ed->edc_softc = sc;
164 1.10 jdolecek ed->sc_devno = eda->edc_drive;
165 1.10 jdolecek edc_add_disk(sc, ed);
166 1.1 jdolecek
167 1.13 hannken bufq_alloc(&ed->sc_q, BUFQ_DISKSORT|BUFQ_SORT_RAWBLOCK);
168 1.8 sommerfe simple_lock_init(&ed->sc_q_lock);
169 1.10 jdolecek snprintf(lckname, sizeof(lckname), "%slck", ed->sc_dev.dv_xname);
170 1.10 jdolecek lockinit(&ed->sc_lock, PRIBIO | PCATCH, lckname, 0, 0);
171 1.1 jdolecek
172 1.10 jdolecek if (ed_get_params(ed, &drv_flags)) {
173 1.1 jdolecek printf(": IDENTIFY failed, no disk found\n");
174 1.1 jdolecek return;
175 1.1 jdolecek }
176 1.1 jdolecek
177 1.1 jdolecek format_bytes(pbuf, sizeof(pbuf),
178 1.1 jdolecek (u_int64_t) ed->sc_capacity * DEV_BSIZE);
179 1.1 jdolecek printf(": %s, %u cyl, %u head, %u sec, 512 bytes/sect x %u sectors\n",
180 1.1 jdolecek pbuf,
181 1.1 jdolecek ed->cyl, ed->heads, ed->sectors,
182 1.1 jdolecek ed->sc_capacity);
183 1.1 jdolecek
184 1.6 jdolecek printf("%s: %u spares/cyl, %s, %s, %s, %s, %s\n",
185 1.1 jdolecek ed->sc_dev.dv_xname, ed->spares,
186 1.10 jdolecek (drv_flags & (1 << 0)) ? "NoRetries" : "Retries",
187 1.10 jdolecek (drv_flags & (1 << 1)) ? "Removable" : "Fixed",
188 1.10 jdolecek (drv_flags & (1 << 2)) ? "SkewedFormat" : "NoSkew",
189 1.10 jdolecek (drv_flags & (1 << 3)) ? "ZeroDefect" : "Defects",
190 1.10 jdolecek (drv_flags & (1 << 4)) ? "InvalidSecondary" : "SecondaryOK"
191 1.1 jdolecek );
192 1.8 sommerfe
193 1.1 jdolecek /*
194 1.1 jdolecek * Initialize and attach the disk structure.
195 1.1 jdolecek */
196 1.1 jdolecek ed->sc_dk.dk_driver = &eddkdriver;
197 1.1 jdolecek ed->sc_dk.dk_name = ed->sc_dev.dv_xname;
198 1.1 jdolecek disk_attach(&ed->sc_dk);
199 1.1 jdolecek #if NRND > 0
200 1.1 jdolecek rnd_attach_source(&ed->rnd_source, ed->sc_dev.dv_xname,
201 1.1 jdolecek RND_TYPE_DISK, 0);
202 1.1 jdolecek #endif
203 1.1 jdolecek
204 1.6 jdolecek ed->sc_flags |= EDF_INIT;
205 1.1 jdolecek }
206 1.1 jdolecek
207 1.1 jdolecek /*
208 1.1 jdolecek * Read/write routine for a buffer. Validates the arguments and schedules the
209 1.1 jdolecek * transfer. Does not wait for the transfer to complete.
210 1.1 jdolecek */
211 1.1 jdolecek void
212 1.1 jdolecek edmcastrategy(bp)
213 1.1 jdolecek struct buf *bp;
214 1.1 jdolecek {
215 1.10 jdolecek struct ed_softc *ed = device_lookup(&ed_cd, DISKUNIT(bp->b_dev));
216 1.10 jdolecek struct disklabel *lp = ed->sc_dk.dk_label;
217 1.1 jdolecek daddr_t blkno;
218 1.1 jdolecek
219 1.22.2.2 skrll ATADEBUG_PRINT(("edmcastrategy (%s)\n", ed->sc_dev.dv_xname),
220 1.1 jdolecek DEBUG_XFERS);
221 1.8 sommerfe
222 1.1 jdolecek /* Valid request? */
223 1.1 jdolecek if (bp->b_blkno < 0 ||
224 1.1 jdolecek (bp->b_bcount % lp->d_secsize) != 0 ||
225 1.1 jdolecek (bp->b_bcount / lp->d_secsize) >= (1 << NBBY)) {
226 1.1 jdolecek bp->b_error = EINVAL;
227 1.1 jdolecek goto bad;
228 1.1 jdolecek }
229 1.8 sommerfe
230 1.1 jdolecek /* If device invalidated (e.g. media change, door open), error. */
231 1.10 jdolecek if ((ed->sc_flags & WDF_LOADED) == 0) {
232 1.1 jdolecek bp->b_error = EIO;
233 1.1 jdolecek goto bad;
234 1.1 jdolecek }
235 1.1 jdolecek
236 1.1 jdolecek /* If it's a null transfer, return immediately. */
237 1.1 jdolecek if (bp->b_bcount == 0)
238 1.1 jdolecek goto done;
239 1.1 jdolecek
240 1.1 jdolecek /*
241 1.1 jdolecek * Do bounds checking, adjust transfer. if error, process.
242 1.1 jdolecek * If end of partition, just return.
243 1.1 jdolecek */
244 1.1 jdolecek if (DISKPART(bp->b_dev) != RAW_PART &&
245 1.20 thorpej bounds_check_with_label(&ed->sc_dk, bp,
246 1.10 jdolecek (ed->sc_flags & (WDF_WLABEL|WDF_LABELLING)) != 0) <= 0)
247 1.1 jdolecek goto done;
248 1.1 jdolecek
249 1.1 jdolecek /*
250 1.1 jdolecek * Now convert the block number to absolute and put it in
251 1.1 jdolecek * terms of the device's logical block size.
252 1.1 jdolecek */
253 1.1 jdolecek if (lp->d_secsize >= DEV_BSIZE)
254 1.1 jdolecek blkno = bp->b_blkno / (lp->d_secsize / DEV_BSIZE);
255 1.1 jdolecek else
256 1.1 jdolecek blkno = bp->b_blkno * (DEV_BSIZE / lp->d_secsize);
257 1.1 jdolecek
258 1.1 jdolecek if (DISKPART(bp->b_dev) != RAW_PART)
259 1.1 jdolecek blkno += lp->d_partitions[DISKPART(bp->b_dev)].p_offset;
260 1.1 jdolecek
261 1.1 jdolecek bp->b_rawblkno = blkno;
262 1.1 jdolecek
263 1.1 jdolecek /* Queue transfer on drive, activate drive and controller if idle. */
264 1.10 jdolecek simple_lock(&ed->sc_q_lock);
265 1.12 hannken BUFQ_PUT(&ed->sc_q, bp);
266 1.10 jdolecek simple_unlock(&ed->sc_q_lock);
267 1.1 jdolecek
268 1.1 jdolecek /* Ring the worker thread */
269 1.10 jdolecek wakeup_one(ed->edc_softc);
270 1.1 jdolecek
271 1.1 jdolecek return;
272 1.1 jdolecek bad:
273 1.1 jdolecek bp->b_flags |= B_ERROR;
274 1.1 jdolecek done:
275 1.1 jdolecek /* Toss transfer; we're done early. */
276 1.1 jdolecek bp->b_resid = bp->b_bcount;
277 1.1 jdolecek biodone(bp);
278 1.1 jdolecek }
279 1.1 jdolecek
280 1.1 jdolecek int
281 1.1 jdolecek edmcaread(dev, uio, flags)
282 1.1 jdolecek dev_t dev;
283 1.1 jdolecek struct uio *uio;
284 1.1 jdolecek int flags;
285 1.1 jdolecek {
286 1.22.2.2 skrll ATADEBUG_PRINT(("edread\n"), DEBUG_XFERS);
287 1.1 jdolecek return (physio(edmcastrategy, NULL, dev, B_READ, minphys, uio));
288 1.1 jdolecek }
289 1.1 jdolecek
290 1.1 jdolecek int
291 1.1 jdolecek edmcawrite(dev, uio, flags)
292 1.1 jdolecek dev_t dev;
293 1.1 jdolecek struct uio *uio;
294 1.1 jdolecek int flags;
295 1.1 jdolecek {
296 1.22.2.2 skrll ATADEBUG_PRINT(("edwrite\n"), DEBUG_XFERS);
297 1.1 jdolecek return (physio(edmcastrategy, NULL, dev, B_WRITE, minphys, uio));
298 1.1 jdolecek }
299 1.1 jdolecek
300 1.1 jdolecek /*
301 1.1 jdolecek * Wait interruptibly for an exclusive lock.
302 1.1 jdolecek */
303 1.1 jdolecek static int
304 1.3 jdolecek ed_lock(ed)
305 1.3 jdolecek struct ed_softc *ed;
306 1.1 jdolecek {
307 1.1 jdolecek int error;
308 1.1 jdolecek int s;
309 1.1 jdolecek
310 1.22.2.2 skrll ATADEBUG_PRINT(("ed_lock\n"), DEBUG_FUNCS);
311 1.1 jdolecek
312 1.1 jdolecek s = splbio();
313 1.3 jdolecek error = lockmgr(&ed->sc_lock, LK_EXCLUSIVE, NULL);
314 1.3 jdolecek splx(s);
315 1.1 jdolecek
316 1.3 jdolecek return (error);
317 1.1 jdolecek }
318 1.1 jdolecek
319 1.1 jdolecek /*
320 1.1 jdolecek * Unlock and wake up any waiters.
321 1.1 jdolecek */
322 1.1 jdolecek static void
323 1.3 jdolecek ed_unlock(ed)
324 1.3 jdolecek struct ed_softc *ed;
325 1.1 jdolecek {
326 1.22.2.2 skrll ATADEBUG_PRINT(("ed_unlock\n"), DEBUG_FUNCS);
327 1.1 jdolecek
328 1.3 jdolecek (void) lockmgr(&ed->sc_lock, LK_RELEASE, NULL);
329 1.1 jdolecek }
330 1.1 jdolecek
331 1.1 jdolecek int
332 1.22.2.1 darrenr edmcaopen(dev, flag, fmt, l)
333 1.1 jdolecek dev_t dev;
334 1.1 jdolecek int flag, fmt;
335 1.22.2.1 darrenr struct lwp *l;
336 1.1 jdolecek {
337 1.1 jdolecek struct ed_softc *wd;
338 1.1 jdolecek int part, error;
339 1.1 jdolecek
340 1.22.2.2 skrll ATADEBUG_PRINT(("edopen\n"), DEBUG_FUNCS);
341 1.1 jdolecek wd = device_lookup(&ed_cd, DISKUNIT(dev));
342 1.6 jdolecek if (wd == NULL || (wd->sc_flags & EDF_INIT) == 0)
343 1.1 jdolecek return (ENXIO);
344 1.1 jdolecek
345 1.1 jdolecek if ((error = ed_lock(wd)) != 0)
346 1.1 jdolecek goto bad4;
347 1.1 jdolecek
348 1.1 jdolecek if (wd->sc_dk.dk_openmask != 0) {
349 1.1 jdolecek /*
350 1.1 jdolecek * If any partition is open, but the disk has been invalidated,
351 1.1 jdolecek * disallow further opens.
352 1.1 jdolecek */
353 1.1 jdolecek if ((wd->sc_flags & WDF_LOADED) == 0) {
354 1.1 jdolecek error = EIO;
355 1.1 jdolecek goto bad3;
356 1.1 jdolecek }
357 1.1 jdolecek } else {
358 1.1 jdolecek if ((wd->sc_flags & WDF_LOADED) == 0) {
359 1.10 jdolecek int s;
360 1.10 jdolecek
361 1.1 jdolecek wd->sc_flags |= WDF_LOADED;
362 1.1 jdolecek
363 1.1 jdolecek /* Load the physical device parameters. */
364 1.10 jdolecek s = splbio();
365 1.10 jdolecek ed_get_params(wd, NULL);
366 1.10 jdolecek splx(s);
367 1.1 jdolecek
368 1.1 jdolecek /* Load the partition info if not already loaded. */
369 1.10 jdolecek edgetdisklabel(dev, wd);
370 1.1 jdolecek }
371 1.1 jdolecek }
372 1.1 jdolecek
373 1.1 jdolecek part = DISKPART(dev);
374 1.1 jdolecek
375 1.1 jdolecek /* Check that the partition exists. */
376 1.1 jdolecek if (part != RAW_PART &&
377 1.1 jdolecek (part >= wd->sc_dk.dk_label->d_npartitions ||
378 1.1 jdolecek wd->sc_dk.dk_label->d_partitions[part].p_fstype == FS_UNUSED)) {
379 1.1 jdolecek error = ENXIO;
380 1.1 jdolecek goto bad;
381 1.1 jdolecek }
382 1.8 sommerfe
383 1.1 jdolecek /* Insure only one open at a time. */
384 1.1 jdolecek switch (fmt) {
385 1.1 jdolecek case S_IFCHR:
386 1.1 jdolecek wd->sc_dk.dk_copenmask |= (1 << part);
387 1.1 jdolecek break;
388 1.1 jdolecek case S_IFBLK:
389 1.1 jdolecek wd->sc_dk.dk_bopenmask |= (1 << part);
390 1.1 jdolecek break;
391 1.1 jdolecek }
392 1.1 jdolecek wd->sc_dk.dk_openmask =
393 1.1 jdolecek wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
394 1.1 jdolecek
395 1.1 jdolecek ed_unlock(wd);
396 1.1 jdolecek return 0;
397 1.1 jdolecek
398 1.1 jdolecek bad:
399 1.1 jdolecek if (wd->sc_dk.dk_openmask == 0) {
400 1.1 jdolecek }
401 1.1 jdolecek
402 1.1 jdolecek bad3:
403 1.1 jdolecek ed_unlock(wd);
404 1.1 jdolecek bad4:
405 1.1 jdolecek return (error);
406 1.1 jdolecek }
407 1.1 jdolecek
408 1.1 jdolecek int
409 1.22.2.1 darrenr edmcaclose(dev, flag, fmt, l)
410 1.1 jdolecek dev_t dev;
411 1.1 jdolecek int flag, fmt;
412 1.22.2.1 darrenr struct lwp *l;
413 1.1 jdolecek {
414 1.1 jdolecek struct ed_softc *wd = device_lookup(&ed_cd, DISKUNIT(dev));
415 1.1 jdolecek int part = DISKPART(dev);
416 1.1 jdolecek int error;
417 1.8 sommerfe
418 1.22.2.2 skrll ATADEBUG_PRINT(("edmcaclose\n"), DEBUG_FUNCS);
419 1.1 jdolecek if ((error = ed_lock(wd)) != 0)
420 1.1 jdolecek return error;
421 1.1 jdolecek
422 1.1 jdolecek switch (fmt) {
423 1.1 jdolecek case S_IFCHR:
424 1.1 jdolecek wd->sc_dk.dk_copenmask &= ~(1 << part);
425 1.1 jdolecek break;
426 1.1 jdolecek case S_IFBLK:
427 1.1 jdolecek wd->sc_dk.dk_bopenmask &= ~(1 << part);
428 1.1 jdolecek break;
429 1.1 jdolecek }
430 1.1 jdolecek wd->sc_dk.dk_openmask =
431 1.1 jdolecek wd->sc_dk.dk_copenmask | wd->sc_dk.dk_bopenmask;
432 1.1 jdolecek
433 1.1 jdolecek if (wd->sc_dk.dk_openmask == 0) {
434 1.1 jdolecek #if 0
435 1.1 jdolecek wd_flushcache(wd, AT_WAIT);
436 1.1 jdolecek #endif
437 1.1 jdolecek /* XXXX Must wait for I/O to complete! */
438 1.1 jdolecek
439 1.1 jdolecek if (! (wd->sc_flags & WDF_KLABEL))
440 1.1 jdolecek wd->sc_flags &= ~WDF_LOADED;
441 1.1 jdolecek }
442 1.1 jdolecek
443 1.1 jdolecek ed_unlock(wd);
444 1.1 jdolecek
445 1.1 jdolecek return 0;
446 1.1 jdolecek }
447 1.1 jdolecek
448 1.1 jdolecek static void
449 1.10 jdolecek edgetdefaultlabel(ed, lp)
450 1.10 jdolecek struct ed_softc *ed;
451 1.1 jdolecek struct disklabel *lp;
452 1.1 jdolecek {
453 1.22.2.2 skrll ATADEBUG_PRINT(("edgetdefaultlabel\n"), DEBUG_FUNCS);
454 1.1 jdolecek memset(lp, 0, sizeof(struct disklabel));
455 1.1 jdolecek
456 1.1 jdolecek lp->d_secsize = DEV_BSIZE;
457 1.10 jdolecek lp->d_ntracks = ed->heads;
458 1.10 jdolecek lp->d_nsectors = ed->sectors;
459 1.10 jdolecek lp->d_ncylinders = ed->cyl;
460 1.1 jdolecek lp->d_secpercyl = lp->d_ntracks * lp->d_nsectors;
461 1.1 jdolecek
462 1.1 jdolecek lp->d_type = DTYPE_ESDI;
463 1.1 jdolecek
464 1.1 jdolecek strncpy(lp->d_typename, "ESDI", 16);
465 1.1 jdolecek strncpy(lp->d_packname, "fictitious", 16);
466 1.10 jdolecek lp->d_secperunit = ed->sc_capacity;
467 1.1 jdolecek lp->d_rpm = 3600;
468 1.1 jdolecek lp->d_interleave = 1;
469 1.1 jdolecek lp->d_flags = 0;
470 1.1 jdolecek
471 1.1 jdolecek lp->d_partitions[RAW_PART].p_offset = 0;
472 1.1 jdolecek lp->d_partitions[RAW_PART].p_size =
473 1.1 jdolecek lp->d_secperunit * (lp->d_secsize / DEV_BSIZE);
474 1.1 jdolecek lp->d_partitions[RAW_PART].p_fstype = FS_UNUSED;
475 1.1 jdolecek lp->d_npartitions = RAW_PART + 1;
476 1.1 jdolecek
477 1.1 jdolecek lp->d_magic = DISKMAGIC;
478 1.1 jdolecek lp->d_magic2 = DISKMAGIC;
479 1.1 jdolecek lp->d_checksum = dkcksum(lp);
480 1.1 jdolecek }
481 1.1 jdolecek
482 1.1 jdolecek /*
483 1.1 jdolecek * Fabricate a default disk label, and try to read the correct one.
484 1.1 jdolecek */
485 1.1 jdolecek static void
486 1.10 jdolecek edgetdisklabel(dev, ed)
487 1.10 jdolecek dev_t dev;
488 1.10 jdolecek struct ed_softc *ed;
489 1.1 jdolecek {
490 1.10 jdolecek struct disklabel *lp = ed->sc_dk.dk_label;
491 1.19 dsl const char *errstring;
492 1.1 jdolecek
493 1.22.2.2 skrll ATADEBUG_PRINT(("edgetdisklabel\n"), DEBUG_FUNCS);
494 1.1 jdolecek
495 1.10 jdolecek memset(ed->sc_dk.dk_cpulabel, 0, sizeof(struct cpu_disklabel));
496 1.1 jdolecek
497 1.10 jdolecek edgetdefaultlabel(ed, lp);
498 1.1 jdolecek
499 1.10 jdolecek errstring = readdisklabel(
500 1.10 jdolecek EDLABELDEV(dev), edmcastrategy, lp, ed->sc_dk.dk_cpulabel);
501 1.1 jdolecek if (errstring) {
502 1.1 jdolecek /*
503 1.1 jdolecek * This probably happened because the drive's default
504 1.1 jdolecek * geometry doesn't match the DOS geometry. We
505 1.1 jdolecek * assume the DOS geometry is now in the label and try
506 1.1 jdolecek * again. XXX This is a kluge.
507 1.1 jdolecek */
508 1.1 jdolecek #if 0
509 1.1 jdolecek if (wd->drvp->state > RECAL)
510 1.1 jdolecek wd->drvp->drive_flags |= DRIVE_RESET;
511 1.1 jdolecek #endif
512 1.10 jdolecek errstring = readdisklabel(EDLABELDEV(dev),
513 1.10 jdolecek edmcastrategy, lp, ed->sc_dk.dk_cpulabel);
514 1.1 jdolecek }
515 1.1 jdolecek if (errstring) {
516 1.10 jdolecek printf("%s: %s\n", ed->sc_dev.dv_xname, errstring);
517 1.1 jdolecek return;
518 1.1 jdolecek }
519 1.1 jdolecek }
520 1.1 jdolecek
521 1.1 jdolecek int
522 1.22.2.1 darrenr edmcaioctl(dev, xfer, addr, flag, l)
523 1.1 jdolecek dev_t dev;
524 1.1 jdolecek u_long xfer;
525 1.1 jdolecek caddr_t addr;
526 1.1 jdolecek int flag;
527 1.22.2.1 darrenr struct lwp *l;
528 1.1 jdolecek {
529 1.10 jdolecek struct ed_softc *ed = device_lookup(&ed_cd, DISKUNIT(dev));
530 1.1 jdolecek int error;
531 1.1 jdolecek
532 1.22.2.2 skrll ATADEBUG_PRINT(("edioctl\n"), DEBUG_FUNCS);
533 1.1 jdolecek
534 1.10 jdolecek if ((ed->sc_flags & WDF_LOADED) == 0)
535 1.1 jdolecek return EIO;
536 1.1 jdolecek
537 1.1 jdolecek switch (xfer) {
538 1.1 jdolecek case DIOCGDINFO:
539 1.10 jdolecek *(struct disklabel *)addr = *(ed->sc_dk.dk_label);
540 1.1 jdolecek return 0;
541 1.1 jdolecek
542 1.1 jdolecek case DIOCGPART:
543 1.10 jdolecek ((struct partinfo *)addr)->disklab = ed->sc_dk.dk_label;
544 1.1 jdolecek ((struct partinfo *)addr)->part =
545 1.10 jdolecek &ed->sc_dk.dk_label->d_partitions[DISKPART(dev)];
546 1.1 jdolecek return 0;
547 1.8 sommerfe
548 1.1 jdolecek case DIOCWDINFO:
549 1.1 jdolecek case DIOCSDINFO:
550 1.1 jdolecek {
551 1.1 jdolecek struct disklabel *lp;
552 1.1 jdolecek
553 1.1 jdolecek lp = (struct disklabel *)addr;
554 1.1 jdolecek
555 1.1 jdolecek if ((flag & FWRITE) == 0)
556 1.1 jdolecek return EBADF;
557 1.1 jdolecek
558 1.10 jdolecek if ((error = ed_lock(ed)) != 0)
559 1.1 jdolecek return error;
560 1.10 jdolecek ed->sc_flags |= WDF_LABELLING;
561 1.1 jdolecek
562 1.10 jdolecek error = setdisklabel(ed->sc_dk.dk_label,
563 1.1 jdolecek lp, /*wd->sc_dk.dk_openmask : */0,
564 1.10 jdolecek ed->sc_dk.dk_cpulabel);
565 1.1 jdolecek if (error == 0) {
566 1.1 jdolecek #if 0
567 1.1 jdolecek if (wd->drvp->state > RECAL)
568 1.1 jdolecek wd->drvp->drive_flags |= DRIVE_RESET;
569 1.1 jdolecek #endif
570 1.10 jdolecek if (xfer == DIOCWDINFO)
571 1.1 jdolecek error = writedisklabel(EDLABELDEV(dev),
572 1.10 jdolecek edmcastrategy, ed->sc_dk.dk_label,
573 1.10 jdolecek ed->sc_dk.dk_cpulabel);
574 1.1 jdolecek }
575 1.1 jdolecek
576 1.10 jdolecek ed->sc_flags &= ~WDF_LABELLING;
577 1.10 jdolecek ed_unlock(ed);
578 1.10 jdolecek return (error);
579 1.1 jdolecek }
580 1.1 jdolecek
581 1.1 jdolecek case DIOCKLABEL:
582 1.1 jdolecek if (*(int *)addr)
583 1.10 jdolecek ed->sc_flags |= WDF_KLABEL;
584 1.1 jdolecek else
585 1.10 jdolecek ed->sc_flags &= ~WDF_KLABEL;
586 1.1 jdolecek return 0;
587 1.8 sommerfe
588 1.1 jdolecek case DIOCWLABEL:
589 1.1 jdolecek if ((flag & FWRITE) == 0)
590 1.1 jdolecek return EBADF;
591 1.1 jdolecek if (*(int *)addr)
592 1.10 jdolecek ed->sc_flags |= WDF_WLABEL;
593 1.1 jdolecek else
594 1.10 jdolecek ed->sc_flags &= ~WDF_WLABEL;
595 1.1 jdolecek return 0;
596 1.1 jdolecek
597 1.1 jdolecek case DIOCGDEFLABEL:
598 1.10 jdolecek edgetdefaultlabel(ed, (struct disklabel *)addr);
599 1.1 jdolecek return 0;
600 1.1 jdolecek
601 1.10 jdolecek #if 0
602 1.1 jdolecek case DIOCWFORMAT:
603 1.1 jdolecek if ((flag & FWRITE) == 0)
604 1.1 jdolecek return EBADF;
605 1.1 jdolecek {
606 1.1 jdolecek register struct format_op *fop;
607 1.1 jdolecek struct iovec aiov;
608 1.1 jdolecek struct uio auio;
609 1.8 sommerfe
610 1.1 jdolecek fop = (struct format_op *)addr;
611 1.1 jdolecek aiov.iov_base = fop->df_buf;
612 1.1 jdolecek aiov.iov_len = fop->df_count;
613 1.1 jdolecek auio.uio_iov = &aiov;
614 1.1 jdolecek auio.uio_iovcnt = 1;
615 1.1 jdolecek auio.uio_resid = fop->df_count;
616 1.1 jdolecek auio.uio_segflg = 0;
617 1.1 jdolecek auio.uio_offset =
618 1.1 jdolecek fop->df_startblk * wd->sc_dk.dk_label->d_secsize;
619 1.22.2.1 darrenr auio.uio_lwp = l;
620 1.1 jdolecek error = physio(wdformat, NULL, dev, B_WRITE, minphys,
621 1.1 jdolecek &auio);
622 1.1 jdolecek fop->df_count -= auio.uio_resid;
623 1.1 jdolecek fop->df_reg[0] = wdc->sc_status;
624 1.1 jdolecek fop->df_reg[1] = wdc->sc_error;
625 1.1 jdolecek return error;
626 1.1 jdolecek }
627 1.1 jdolecek #endif
628 1.1 jdolecek
629 1.1 jdolecek default:
630 1.1 jdolecek return ENOTTY;
631 1.1 jdolecek }
632 1.1 jdolecek
633 1.1 jdolecek #ifdef DIAGNOSTIC
634 1.3 jdolecek panic("edioctl: impossible");
635 1.1 jdolecek #endif
636 1.1 jdolecek }
637 1.1 jdolecek
638 1.1 jdolecek int
639 1.1 jdolecek edmcasize(dev)
640 1.1 jdolecek dev_t dev;
641 1.1 jdolecek {
642 1.1 jdolecek struct ed_softc *wd;
643 1.1 jdolecek int part, omask;
644 1.1 jdolecek int size;
645 1.1 jdolecek
646 1.22.2.2 skrll ATADEBUG_PRINT(("edsize\n"), DEBUG_FUNCS);
647 1.1 jdolecek
648 1.1 jdolecek wd = device_lookup(&ed_cd, DISKUNIT(dev));
649 1.1 jdolecek if (wd == NULL)
650 1.1 jdolecek return (-1);
651 1.1 jdolecek
652 1.1 jdolecek part = DISKPART(dev);
653 1.1 jdolecek omask = wd->sc_dk.dk_openmask & (1 << part);
654 1.1 jdolecek
655 1.1 jdolecek if (omask == 0 && edmcaopen(dev, 0, S_IFBLK, NULL) != 0)
656 1.1 jdolecek return (-1);
657 1.1 jdolecek if (wd->sc_dk.dk_label->d_partitions[part].p_fstype != FS_SWAP)
658 1.1 jdolecek size = -1;
659 1.1 jdolecek else
660 1.1 jdolecek size = wd->sc_dk.dk_label->d_partitions[part].p_size *
661 1.1 jdolecek (wd->sc_dk.dk_label->d_secsize / DEV_BSIZE);
662 1.1 jdolecek if (omask == 0 && edmcaclose(dev, 0, S_IFBLK, NULL) != 0)
663 1.1 jdolecek return (-1);
664 1.1 jdolecek return (size);
665 1.1 jdolecek }
666 1.1 jdolecek
667 1.1 jdolecek /* #define WD_DUMP_NOT_TRUSTED if you just want to watch */
668 1.6 jdolecek static int eddoingadump = 0;
669 1.6 jdolecek static int eddumprecalibrated = 0;
670 1.6 jdolecek static int eddumpmulti = 1;
671 1.1 jdolecek
672 1.1 jdolecek /*
673 1.1 jdolecek * Dump core after a system crash.
674 1.1 jdolecek */
675 1.1 jdolecek int
676 1.1 jdolecek edmcadump(dev, blkno, va, size)
677 1.1 jdolecek dev_t dev;
678 1.1 jdolecek daddr_t blkno;
679 1.1 jdolecek caddr_t va;
680 1.1 jdolecek size_t size;
681 1.1 jdolecek {
682 1.6 jdolecek struct ed_softc *ed; /* disk unit to do the I/O */
683 1.1 jdolecek struct disklabel *lp; /* disk's disklabel */
684 1.7 jdolecek int part;
685 1.1 jdolecek int nblks; /* total number of sectors left to write */
686 1.10 jdolecek int error;
687 1.1 jdolecek
688 1.1 jdolecek /* Check if recursive dump; if so, punt. */
689 1.6 jdolecek if (eddoingadump)
690 1.1 jdolecek return EFAULT;
691 1.6 jdolecek eddoingadump = 1;
692 1.1 jdolecek
693 1.6 jdolecek ed = device_lookup(&ed_cd, DISKUNIT(dev));
694 1.6 jdolecek if (ed == NULL)
695 1.1 jdolecek return (ENXIO);
696 1.1 jdolecek
697 1.1 jdolecek part = DISKPART(dev);
698 1.1 jdolecek
699 1.1 jdolecek /* Make sure it was initialized. */
700 1.6 jdolecek if ((ed->sc_flags & EDF_INIT) == 0)
701 1.1 jdolecek return ENXIO;
702 1.1 jdolecek
703 1.1 jdolecek /* Convert to disk sectors. Request must be a multiple of size. */
704 1.6 jdolecek lp = ed->sc_dk.dk_label;
705 1.1 jdolecek if ((size % lp->d_secsize) != 0)
706 1.1 jdolecek return EFAULT;
707 1.1 jdolecek nblks = size / lp->d_secsize;
708 1.1 jdolecek blkno = blkno / (lp->d_secsize / DEV_BSIZE);
709 1.1 jdolecek
710 1.1 jdolecek /* Check transfer bounds against partition size. */
711 1.1 jdolecek if ((blkno < 0) || ((blkno + nblks) > lp->d_partitions[part].p_size))
712 1.8 sommerfe return EINVAL;
713 1.1 jdolecek
714 1.1 jdolecek /* Offset block number to start of partition. */
715 1.1 jdolecek blkno += lp->d_partitions[part].p_offset;
716 1.1 jdolecek
717 1.1 jdolecek /* Recalibrate, if first dump transfer. */
718 1.6 jdolecek if (eddumprecalibrated == 0) {
719 1.6 jdolecek eddumprecalibrated = 1;
720 1.6 jdolecek eddumpmulti = 8;
721 1.1 jdolecek #if 0
722 1.1 jdolecek wd->drvp->state = RESET;
723 1.1 jdolecek #endif
724 1.1 jdolecek }
725 1.8 sommerfe
726 1.1 jdolecek while (nblks > 0) {
727 1.10 jdolecek error = edc_bio(ed->edc_softc, ed, va, blkno,
728 1.10 jdolecek min(nblks, eddumpmulti) * lp->d_secsize, 0, 1);
729 1.10 jdolecek if (error)
730 1.10 jdolecek return (error);
731 1.1 jdolecek
732 1.1 jdolecek /* update block count */
733 1.6 jdolecek nblks -= min(nblks, eddumpmulti);
734 1.6 jdolecek blkno += min(nblks, eddumpmulti);
735 1.6 jdolecek va += min(nblks, eddumpmulti) * lp->d_secsize;
736 1.1 jdolecek }
737 1.1 jdolecek
738 1.6 jdolecek eddoingadump = 0;
739 1.6 jdolecek return (0);
740 1.1 jdolecek }
741 1.1 jdolecek
742 1.1 jdolecek static int
743 1.10 jdolecek ed_get_params(ed, drv_flags)
744 1.1 jdolecek struct ed_softc *ed;
745 1.10 jdolecek int *drv_flags;
746 1.1 jdolecek {
747 1.1 jdolecek u_int16_t cmd_args[2];
748 1.1 jdolecek
749 1.1 jdolecek /*
750 1.1 jdolecek * Get Device Configuration (09).
751 1.1 jdolecek */
752 1.5 jdolecek cmd_args[0] = 14; /* Options: 00s110, s: 0=Physical 1=Pseudo */
753 1.1 jdolecek cmd_args[1] = 0;
754 1.6 jdolecek if (edc_run_cmd(ed->edc_softc, CMD_GET_DEV_CONF, ed->sc_devno,
755 1.10 jdolecek cmd_args, 2, 1))
756 1.1 jdolecek return (1);
757 1.1 jdolecek
758 1.10 jdolecek ed->spares = ed->sense_data[1] >> 8;
759 1.10 jdolecek if (drv_flags)
760 1.10 jdolecek *drv_flags = ed->sense_data[1] & 0x1f;
761 1.10 jdolecek ed->rba = ed->sense_data[2] | (ed->sense_data[3] << 16);
762 1.1 jdolecek /* Instead of using:
763 1.10 jdolecek ed->cyl = ed->sense_data[4];
764 1.10 jdolecek ed->heads = ed->sense_data[5] & 0xff;
765 1.10 jdolecek ed->sectors = ed->sense_data[5] >> 8;
766 1.1 jdolecek * we fabricate the numbers from RBA count, so that
767 1.1 jdolecek * number of sectors is 32 and heads 64. This seems
768 1.1 jdolecek * to be necessary for integrated ESDI controller.
769 1.1 jdolecek */
770 1.1 jdolecek ed->sectors = 32;
771 1.1 jdolecek ed->heads = 64;
772 1.1 jdolecek ed->cyl = ed->rba / (ed->heads * ed->sectors);
773 1.1 jdolecek ed->sc_capacity = ed->rba;
774 1.1 jdolecek
775 1.1 jdolecek return (0);
776 1.1 jdolecek }
777