subr_disk.c revision 1.45 1 1.45 mrg /* $NetBSD: subr_disk.c,v 1.45 2002/11/01 11:32:01 mrg Exp $ */
2 1.22 thorpej
3 1.22 thorpej /*-
4 1.26 thorpej * Copyright (c) 1996, 1997, 1999, 2000 The NetBSD Foundation, Inc.
5 1.22 thorpej * All rights reserved.
6 1.22 thorpej *
7 1.22 thorpej * This code is derived from software contributed to The NetBSD Foundation
8 1.22 thorpej * by Jason R. Thorpe of the Numerical Aerospace Simulation Facility,
9 1.22 thorpej * NASA Ames Research Center.
10 1.22 thorpej *
11 1.22 thorpej * Redistribution and use in source and binary forms, with or without
12 1.22 thorpej * modification, are permitted provided that the following conditions
13 1.22 thorpej * are met:
14 1.22 thorpej * 1. Redistributions of source code must retain the above copyright
15 1.22 thorpej * notice, this list of conditions and the following disclaimer.
16 1.22 thorpej * 2. Redistributions in binary form must reproduce the above copyright
17 1.22 thorpej * notice, this list of conditions and the following disclaimer in the
18 1.22 thorpej * documentation and/or other materials provided with the distribution.
19 1.22 thorpej * 3. All advertising materials mentioning features or use of this software
20 1.22 thorpej * must display the following acknowledgement:
21 1.22 thorpej * This product includes software developed by the NetBSD
22 1.22 thorpej * Foundation, Inc. and its contributors.
23 1.22 thorpej * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.22 thorpej * contributors may be used to endorse or promote products derived
25 1.22 thorpej * from this software without specific prior written permission.
26 1.22 thorpej *
27 1.22 thorpej * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.22 thorpej * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.22 thorpej * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.22 thorpej * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.22 thorpej * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.22 thorpej * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.22 thorpej * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.22 thorpej * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.22 thorpej * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.22 thorpej * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.22 thorpej * POSSIBILITY OF SUCH DAMAGE.
38 1.22 thorpej */
39 1.12 cgd
40 1.11 mycroft /*
41 1.11 mycroft * Copyright (c) 1982, 1986, 1988, 1993
42 1.11 mycroft * The Regents of the University of California. All rights reserved.
43 1.11 mycroft * (c) UNIX System Laboratories, Inc.
44 1.11 mycroft * All or some portions of this file are derived from material licensed
45 1.11 mycroft * to the University of California by American Telephone and Telegraph
46 1.11 mycroft * Co. or Unix System Laboratories, Inc. and are reproduced herein with
47 1.11 mycroft * the permission of UNIX System Laboratories, Inc.
48 1.11 mycroft *
49 1.11 mycroft * Redistribution and use in source and binary forms, with or without
50 1.11 mycroft * modification, are permitted provided that the following conditions
51 1.11 mycroft * are met:
52 1.11 mycroft * 1. Redistributions of source code must retain the above copyright
53 1.11 mycroft * notice, this list of conditions and the following disclaimer.
54 1.11 mycroft * 2. Redistributions in binary form must reproduce the above copyright
55 1.11 mycroft * notice, this list of conditions and the following disclaimer in the
56 1.11 mycroft * documentation and/or other materials provided with the distribution.
57 1.11 mycroft * 3. All advertising materials mentioning features or use of this software
58 1.11 mycroft * must display the following acknowledgement:
59 1.11 mycroft * This product includes software developed by the University of
60 1.11 mycroft * California, Berkeley and its contributors.
61 1.11 mycroft * 4. Neither the name of the University nor the names of its contributors
62 1.11 mycroft * may be used to endorse or promote products derived from this software
63 1.11 mycroft * without specific prior written permission.
64 1.11 mycroft *
65 1.11 mycroft * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
66 1.11 mycroft * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
67 1.11 mycroft * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
68 1.11 mycroft * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
69 1.11 mycroft * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
70 1.11 mycroft * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
71 1.11 mycroft * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
72 1.11 mycroft * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
73 1.11 mycroft * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
74 1.11 mycroft * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
75 1.11 mycroft * SUCH DAMAGE.
76 1.11 mycroft *
77 1.12 cgd * @(#)ufs_disksubr.c 8.5 (Berkeley) 1/21/94
78 1.11 mycroft */
79 1.31 lukem
80 1.31 lukem #include <sys/cdefs.h>
81 1.45 mrg __KERNEL_RCSID(0, "$NetBSD: subr_disk.c,v 1.45 2002/11/01 11:32:01 mrg Exp $");
82 1.11 mycroft
83 1.11 mycroft #include <sys/param.h>
84 1.15 thorpej #include <sys/kernel.h>
85 1.15 thorpej #include <sys/malloc.h>
86 1.11 mycroft #include <sys/buf.h>
87 1.15 thorpej #include <sys/syslog.h>
88 1.11 mycroft #include <sys/disklabel.h>
89 1.15 thorpej #include <sys/disk.h>
90 1.33 simonb #include <sys/sysctl.h>
91 1.14 thorpej
92 1.14 thorpej /*
93 1.15 thorpej * A global list of all disks attached to the system. May grow or
94 1.15 thorpej * shrink over time.
95 1.15 thorpej */
96 1.15 thorpej struct disklist_head disklist; /* TAILQ_HEAD */
97 1.15 thorpej int disk_count; /* number of drives in global disklist */
98 1.33 simonb struct simplelock disklist_slock = SIMPLELOCK_INITIALIZER;
99 1.39 hannken
100 1.39 hannken /*
101 1.11 mycroft * Compute checksum for disk label.
102 1.11 mycroft */
103 1.11 mycroft u_int
104 1.30 simonb dkcksum(struct disklabel *lp)
105 1.11 mycroft {
106 1.29 augustss u_short *start, *end;
107 1.29 augustss u_short sum = 0;
108 1.11 mycroft
109 1.11 mycroft start = (u_short *)lp;
110 1.11 mycroft end = (u_short *)&lp->d_partitions[lp->d_npartitions];
111 1.11 mycroft while (start < end)
112 1.11 mycroft sum ^= *start++;
113 1.11 mycroft return (sum);
114 1.11 mycroft }
115 1.11 mycroft
116 1.11 mycroft /*
117 1.11 mycroft * Disk error is the preface to plaintive error messages
118 1.11 mycroft * about failing disk transfers. It prints messages of the form
119 1.11 mycroft
120 1.11 mycroft hp0g: hard error reading fsbn 12345 of 12344-12347 (hp0 bn %d cn %d tn %d sn %d)
121 1.11 mycroft
122 1.11 mycroft * if the offset of the error in the transfer and a disk label
123 1.11 mycroft * are both available. blkdone should be -1 if the position of the error
124 1.11 mycroft * is unknown; the disklabel pointer may be null from drivers that have not
125 1.20 christos * been converted to use them. The message is printed with printf
126 1.11 mycroft * if pri is LOG_PRINTF, otherwise it uses log at the specified priority.
127 1.20 christos * The message should be completed (with at least a newline) with printf
128 1.11 mycroft * or addlog, respectively. There is no trailing space.
129 1.11 mycroft */
130 1.11 mycroft void
131 1.38 yamt diskerr(const struct buf *bp, const char *dname, const char *what, int pri,
132 1.38 yamt int blkdone, const struct disklabel *lp)
133 1.11 mycroft {
134 1.25 drochner int unit = DISKUNIT(bp->b_dev), part = DISKPART(bp->b_dev);
135 1.30 simonb void (*pr)(const char *, ...);
136 1.11 mycroft char partname = 'a' + part;
137 1.11 mycroft int sn;
138 1.11 mycroft
139 1.11 mycroft if (pri != LOG_PRINTF) {
140 1.17 christos static const char fmt[] = "";
141 1.17 christos log(pri, fmt);
142 1.11 mycroft pr = addlog;
143 1.11 mycroft } else
144 1.20 christos pr = printf;
145 1.11 mycroft (*pr)("%s%d%c: %s %sing fsbn ", dname, unit, partname, what,
146 1.11 mycroft bp->b_flags & B_READ ? "read" : "writ");
147 1.11 mycroft sn = bp->b_blkno;
148 1.11 mycroft if (bp->b_bcount <= DEV_BSIZE)
149 1.11 mycroft (*pr)("%d", sn);
150 1.11 mycroft else {
151 1.11 mycroft if (blkdone >= 0) {
152 1.11 mycroft sn += blkdone;
153 1.11 mycroft (*pr)("%d of ", sn);
154 1.11 mycroft }
155 1.11 mycroft (*pr)("%d-%d", bp->b_blkno,
156 1.11 mycroft bp->b_blkno + (bp->b_bcount - 1) / DEV_BSIZE);
157 1.11 mycroft }
158 1.11 mycroft if (lp && (blkdone >= 0 || bp->b_bcount <= lp->d_secsize)) {
159 1.11 mycroft sn += lp->d_partitions[part].p_offset;
160 1.11 mycroft (*pr)(" (%s%d bn %d; cn %d", dname, unit, sn,
161 1.11 mycroft sn / lp->d_secpercyl);
162 1.11 mycroft sn %= lp->d_secpercyl;
163 1.36 enami (*pr)(" tn %d sn %d)", sn / lp->d_nsectors,
164 1.36 enami sn % lp->d_nsectors);
165 1.11 mycroft }
166 1.15 thorpej }
167 1.15 thorpej
168 1.15 thorpej /*
169 1.15 thorpej * Initialize the disklist. Called by main() before autoconfiguration.
170 1.15 thorpej */
171 1.15 thorpej void
172 1.30 simonb disk_init(void)
173 1.15 thorpej {
174 1.15 thorpej
175 1.15 thorpej TAILQ_INIT(&disklist);
176 1.15 thorpej disk_count = 0;
177 1.15 thorpej }
178 1.15 thorpej
179 1.15 thorpej /*
180 1.15 thorpej * Searches the disklist for the disk corresponding to the
181 1.15 thorpej * name provided.
182 1.15 thorpej */
183 1.15 thorpej struct disk *
184 1.30 simonb disk_find(char *name)
185 1.15 thorpej {
186 1.15 thorpej struct disk *diskp;
187 1.15 thorpej
188 1.15 thorpej if ((name == NULL) || (disk_count <= 0))
189 1.15 thorpej return (NULL);
190 1.15 thorpej
191 1.33 simonb simple_lock(&disklist_slock);
192 1.33 simonb for (diskp = TAILQ_FIRST(&disklist); diskp != NULL;
193 1.33 simonb diskp = TAILQ_NEXT(diskp, dk_link))
194 1.33 simonb if (strcmp(diskp->dk_name, name) == 0) {
195 1.33 simonb simple_unlock(&disklist_slock);
196 1.15 thorpej return (diskp);
197 1.33 simonb }
198 1.33 simonb simple_unlock(&disklist_slock);
199 1.15 thorpej
200 1.15 thorpej return (NULL);
201 1.15 thorpej }
202 1.15 thorpej
203 1.15 thorpej /*
204 1.15 thorpej * Attach a disk.
205 1.15 thorpej */
206 1.15 thorpej void
207 1.30 simonb disk_attach(struct disk *diskp)
208 1.15 thorpej {
209 1.15 thorpej int s;
210 1.15 thorpej
211 1.15 thorpej /*
212 1.15 thorpej * Allocate and initialize the disklabel structures. Note that
213 1.15 thorpej * it's not safe to sleep here, since we're probably going to be
214 1.15 thorpej * called during autoconfiguration.
215 1.15 thorpej */
216 1.15 thorpej diskp->dk_label = malloc(sizeof(struct disklabel), M_DEVBUF, M_NOWAIT);
217 1.15 thorpej diskp->dk_cpulabel = malloc(sizeof(struct cpu_disklabel), M_DEVBUF,
218 1.15 thorpej M_NOWAIT);
219 1.15 thorpej if ((diskp->dk_label == NULL) || (diskp->dk_cpulabel == NULL))
220 1.15 thorpej panic("disk_attach: can't allocate storage for disklabel");
221 1.15 thorpej
222 1.24 perry memset(diskp->dk_label, 0, sizeof(struct disklabel));
223 1.24 perry memset(diskp->dk_cpulabel, 0, sizeof(struct cpu_disklabel));
224 1.15 thorpej
225 1.15 thorpej /*
226 1.15 thorpej * Set the attached timestamp.
227 1.15 thorpej */
228 1.15 thorpej s = splclock();
229 1.15 thorpej diskp->dk_attachtime = mono_time;
230 1.15 thorpej splx(s);
231 1.15 thorpej
232 1.15 thorpej /*
233 1.15 thorpej * Link into the disklist.
234 1.15 thorpej */
235 1.33 simonb simple_lock(&disklist_slock);
236 1.15 thorpej TAILQ_INSERT_TAIL(&disklist, diskp, dk_link);
237 1.33 simonb simple_unlock(&disklist_slock);
238 1.15 thorpej ++disk_count;
239 1.15 thorpej }
240 1.15 thorpej
241 1.15 thorpej /*
242 1.16 christos * Detach a disk.
243 1.15 thorpej */
244 1.15 thorpej void
245 1.30 simonb disk_detach(struct disk *diskp)
246 1.15 thorpej {
247 1.15 thorpej
248 1.15 thorpej /*
249 1.23 thorpej * Remove from the disklist.
250 1.23 thorpej */
251 1.23 thorpej if (--disk_count < 0)
252 1.23 thorpej panic("disk_detach: disk_count < 0");
253 1.33 simonb simple_lock(&disklist_slock);
254 1.23 thorpej TAILQ_REMOVE(&disklist, diskp, dk_link);
255 1.33 simonb simple_unlock(&disklist_slock);
256 1.23 thorpej
257 1.23 thorpej /*
258 1.15 thorpej * Free the space used by the disklabel structures.
259 1.15 thorpej */
260 1.15 thorpej free(diskp->dk_label, M_DEVBUF);
261 1.15 thorpej free(diskp->dk_cpulabel, M_DEVBUF);
262 1.15 thorpej }
263 1.15 thorpej
264 1.15 thorpej /*
265 1.15 thorpej * Increment a disk's busy counter. If the counter is going from
266 1.15 thorpej * 0 to 1, set the timestamp.
267 1.15 thorpej */
268 1.15 thorpej void
269 1.30 simonb disk_busy(struct disk *diskp)
270 1.15 thorpej {
271 1.15 thorpej int s;
272 1.15 thorpej
273 1.15 thorpej /*
274 1.15 thorpej * XXX We'd like to use something as accurate as microtime(),
275 1.15 thorpej * but that doesn't depend on the system TOD clock.
276 1.15 thorpej */
277 1.15 thorpej if (diskp->dk_busy++ == 0) {
278 1.15 thorpej s = splclock();
279 1.15 thorpej diskp->dk_timestamp = mono_time;
280 1.15 thorpej splx(s);
281 1.15 thorpej }
282 1.15 thorpej }
283 1.15 thorpej
284 1.15 thorpej /*
285 1.15 thorpej * Decrement a disk's busy counter, increment the byte count, total busy
286 1.15 thorpej * time, and reset the timestamp.
287 1.15 thorpej */
288 1.15 thorpej void
289 1.45 mrg disk_unbusy(struct disk *diskp, long bcount, int read)
290 1.15 thorpej {
291 1.15 thorpej int s;
292 1.15 thorpej struct timeval dv_time, diff_time;
293 1.15 thorpej
294 1.23 thorpej if (diskp->dk_busy-- == 0) {
295 1.23 thorpej printf("%s: dk_busy < 0\n", diskp->dk_name);
296 1.23 thorpej panic("disk_unbusy");
297 1.23 thorpej }
298 1.15 thorpej
299 1.15 thorpej s = splclock();
300 1.15 thorpej dv_time = mono_time;
301 1.15 thorpej splx(s);
302 1.15 thorpej
303 1.15 thorpej timersub(&dv_time, &diskp->dk_timestamp, &diff_time);
304 1.15 thorpej timeradd(&diskp->dk_time, &diff_time, &diskp->dk_time);
305 1.15 thorpej
306 1.15 thorpej diskp->dk_timestamp = dv_time;
307 1.15 thorpej if (bcount > 0) {
308 1.45 mrg if (read) {
309 1.45 mrg diskp->dk_rbytes += bcount;
310 1.45 mrg diskp->dk_rxfer++;
311 1.45 mrg } else {
312 1.45 mrg diskp->dk_wbytes += bcount;
313 1.45 mrg diskp->dk_wxfer++;
314 1.45 mrg }
315 1.15 thorpej }
316 1.15 thorpej }
317 1.15 thorpej
318 1.15 thorpej /*
319 1.15 thorpej * Reset the metrics counters on the given disk. Note that we cannot
320 1.15 thorpej * reset the busy counter, as it may case a panic in disk_unbusy().
321 1.15 thorpej * We also must avoid playing with the timestamp information, as it
322 1.15 thorpej * may skew any pending transfer results.
323 1.15 thorpej */
324 1.15 thorpej void
325 1.30 simonb disk_resetstat(struct disk *diskp)
326 1.15 thorpej {
327 1.15 thorpej int s = splbio(), t;
328 1.15 thorpej
329 1.45 mrg diskp->dk_rxfer = 0;
330 1.45 mrg diskp->dk_rbytes = 0;
331 1.45 mrg diskp->dk_wxfer = 0;
332 1.45 mrg diskp->dk_wbytes = 0;
333 1.15 thorpej
334 1.15 thorpej t = splclock();
335 1.15 thorpej diskp->dk_attachtime = mono_time;
336 1.15 thorpej splx(t);
337 1.15 thorpej
338 1.15 thorpej timerclear(&diskp->dk_time);
339 1.15 thorpej
340 1.15 thorpej splx(s);
341 1.33 simonb }
342 1.33 simonb
343 1.33 simonb int
344 1.33 simonb sysctl_disknames(void *vwhere, size_t *sizep)
345 1.33 simonb {
346 1.33 simonb char buf[DK_DISKNAMELEN + 1];
347 1.33 simonb char *where = vwhere;
348 1.33 simonb struct disk *diskp;
349 1.33 simonb size_t needed, left, slen;
350 1.33 simonb int error, first;
351 1.33 simonb
352 1.33 simonb first = 1;
353 1.33 simonb error = 0;
354 1.33 simonb needed = 0;
355 1.33 simonb left = *sizep;
356 1.35 simonb
357 1.33 simonb simple_lock(&disklist_slock);
358 1.33 simonb for (diskp = TAILQ_FIRST(&disklist); diskp != NULL;
359 1.33 simonb diskp = TAILQ_NEXT(diskp, dk_link)) {
360 1.33 simonb if (where == NULL)
361 1.33 simonb needed += strlen(diskp->dk_name) + 1;
362 1.33 simonb else {
363 1.33 simonb memset(buf, 0, sizeof(buf));
364 1.33 simonb if (first) {
365 1.33 simonb strncpy(buf, diskp->dk_name, sizeof(buf));
366 1.33 simonb first = 0;
367 1.33 simonb } else {
368 1.33 simonb buf[0] = ' ';
369 1.36 enami strncpy(buf + 1, diskp->dk_name,
370 1.37 enami sizeof(buf) - 1);
371 1.33 simonb }
372 1.33 simonb buf[DK_DISKNAMELEN] = '\0';
373 1.33 simonb slen = strlen(buf);
374 1.33 simonb if (left < slen + 1)
375 1.33 simonb break;
376 1.33 simonb /* +1 to copy out the trailing NUL byte */
377 1.33 simonb error = copyout(buf, where, slen + 1);
378 1.33 simonb if (error)
379 1.33 simonb break;
380 1.33 simonb where += slen;
381 1.33 simonb needed += slen;
382 1.33 simonb left -= slen;
383 1.33 simonb }
384 1.33 simonb }
385 1.33 simonb simple_unlock(&disklist_slock);
386 1.33 simonb *sizep = needed;
387 1.33 simonb return (error);
388 1.33 simonb }
389 1.33 simonb
390 1.33 simonb int
391 1.33 simonb sysctl_diskstats(int *name, u_int namelen, void *vwhere, size_t *sizep)
392 1.33 simonb {
393 1.33 simonb struct disk_sysctl sdisk;
394 1.33 simonb struct disk *diskp;
395 1.33 simonb char *where = vwhere;
396 1.33 simonb size_t tocopy, left;
397 1.33 simonb int error;
398 1.33 simonb
399 1.33 simonb if (where == NULL) {
400 1.45 mrg *sizep = disk_count * sizeof(sdisk);
401 1.33 simonb return (0);
402 1.33 simonb }
403 1.33 simonb
404 1.33 simonb if (namelen == 0)
405 1.33 simonb tocopy = sizeof(sdisk);
406 1.33 simonb else
407 1.33 simonb tocopy = name[0];
408 1.33 simonb
409 1.33 simonb error = 0;
410 1.33 simonb left = *sizep;
411 1.33 simonb memset(&sdisk, 0, sizeof(sdisk));
412 1.35 simonb *sizep = 0;
413 1.33 simonb
414 1.33 simonb simple_lock(&disklist_slock);
415 1.34 simonb TAILQ_FOREACH(diskp, &disklist, dk_link) {
416 1.33 simonb if (left < sizeof(struct disk_sysctl))
417 1.33 simonb break;
418 1.36 enami strncpy(sdisk.dk_name, diskp->dk_name, sizeof(sdisk.dk_name));
419 1.45 mrg sdisk.dk_xfer = diskp->dk_rxfer + diskp->dk_wxfer;
420 1.45 mrg sdisk.dk_rxfer = diskp->dk_rxfer;
421 1.45 mrg sdisk.dk_wxfer = diskp->dk_wxfer;
422 1.33 simonb sdisk.dk_seek = diskp->dk_seek;
423 1.45 mrg sdisk.dk_bytes = diskp->dk_rbytes + diskp->dk_wbytes;
424 1.45 mrg sdisk.dk_rbytes = diskp->dk_rbytes;
425 1.45 mrg sdisk.dk_wbytes = diskp->dk_wbytes;
426 1.33 simonb sdisk.dk_attachtime_sec = diskp->dk_attachtime.tv_sec;
427 1.33 simonb sdisk.dk_attachtime_usec = diskp->dk_attachtime.tv_usec;
428 1.33 simonb sdisk.dk_timestamp_sec = diskp->dk_timestamp.tv_sec;
429 1.33 simonb sdisk.dk_timestamp_usec = diskp->dk_timestamp.tv_usec;
430 1.33 simonb sdisk.dk_time_sec = diskp->dk_time.tv_sec;
431 1.33 simonb sdisk.dk_time_usec = diskp->dk_time.tv_usec;
432 1.33 simonb sdisk.dk_busy = diskp->dk_busy;
433 1.35 simonb
434 1.33 simonb error = copyout(&sdisk, where, min(tocopy, sizeof(sdisk)));
435 1.33 simonb if (error)
436 1.33 simonb break;
437 1.33 simonb where += tocopy;
438 1.35 simonb *sizep += tocopy;
439 1.33 simonb left -= tocopy;
440 1.33 simonb }
441 1.33 simonb simple_unlock(&disklist_slock);
442 1.33 simonb return (error);
443 1.39 hannken }
444 1.39 hannken
445 1.39 hannken struct bufq_fcfs {
446 1.39 hannken TAILQ_HEAD(, buf) bq_head; /* actual list of buffers */
447 1.39 hannken };
448 1.39 hannken
449 1.39 hannken struct bufq_disksort {
450 1.39 hannken TAILQ_HEAD(, buf) bq_head; /* actual list of buffers */
451 1.39 hannken };
452 1.39 hannken
453 1.39 hannken #define PRIO_READ_BURST 48
454 1.39 hannken #define PRIO_WRITE_REQ 16
455 1.39 hannken
456 1.39 hannken struct bufq_prio {
457 1.39 hannken TAILQ_HEAD(, buf) bq_read, bq_write; /* actual list of buffers */
458 1.39 hannken struct buf *bq_write_next; /* next request in bq_write */
459 1.41 hannken struct buf *bq_next; /* current request */
460 1.39 hannken int bq_read_burst; /* # of consecutive reads */
461 1.39 hannken };
462 1.39 hannken
463 1.39 hannken
464 1.39 hannken /*
465 1.39 hannken * Check if two buf's are in ascending order.
466 1.39 hannken */
467 1.39 hannken static __inline int
468 1.39 hannken buf_inorder(struct buf *bp, struct buf *bq, int sortby)
469 1.39 hannken {
470 1.39 hannken int r;
471 1.39 hannken
472 1.39 hannken if (bp == NULL || bq == NULL)
473 1.43 enami return (bq == NULL);
474 1.39 hannken
475 1.39 hannken if (sortby == BUFQ_SORT_CYLINDER)
476 1.39 hannken r = bp->b_cylinder - bq->b_cylinder;
477 1.39 hannken else
478 1.39 hannken r = 0;
479 1.39 hannken
480 1.39 hannken if (r == 0)
481 1.39 hannken r = bp->b_rawblkno - bq->b_rawblkno;
482 1.39 hannken
483 1.43 enami return (r <= 0);
484 1.39 hannken }
485 1.39 hannken
486 1.39 hannken
487 1.39 hannken /*
488 1.39 hannken * First-come first-served sort for disks.
489 1.39 hannken *
490 1.39 hannken * Requests are appended to the queue without any reordering.
491 1.39 hannken */
492 1.39 hannken static void
493 1.39 hannken bufq_fcfs_put(struct bufq_state *bufq, struct buf *bp)
494 1.39 hannken {
495 1.39 hannken struct bufq_fcfs *fcfs = bufq->bq_private;
496 1.39 hannken
497 1.39 hannken TAILQ_INSERT_TAIL(&fcfs->bq_head, bp, b_actq);
498 1.39 hannken }
499 1.39 hannken
500 1.39 hannken static struct buf *
501 1.39 hannken bufq_fcfs_get(struct bufq_state *bufq, int remove)
502 1.39 hannken {
503 1.39 hannken struct bufq_fcfs *fcfs = bufq->bq_private;
504 1.39 hannken struct buf *bp;
505 1.39 hannken
506 1.39 hannken bp = TAILQ_FIRST(&fcfs->bq_head);
507 1.39 hannken
508 1.39 hannken if (bp != NULL && remove)
509 1.39 hannken TAILQ_REMOVE(&fcfs->bq_head, bp, b_actq);
510 1.39 hannken
511 1.43 enami return (bp);
512 1.39 hannken }
513 1.39 hannken
514 1.39 hannken
515 1.39 hannken /*
516 1.39 hannken * Seek sort for disks.
517 1.39 hannken *
518 1.39 hannken * There are actually two queues, sorted in ascendening order. The first
519 1.39 hannken * queue holds those requests which are positioned after the current block;
520 1.39 hannken * the second holds requests which came in after their position was passed.
521 1.39 hannken * Thus we implement a one-way scan, retracting after reaching the end of
522 1.39 hannken * the drive to the first request on the second queue, at which time it
523 1.39 hannken * becomes the first queue.
524 1.39 hannken *
525 1.39 hannken * A one-way scan is natural because of the way UNIX read-ahead blocks are
526 1.39 hannken * allocated.
527 1.39 hannken */
528 1.39 hannken static void
529 1.39 hannken bufq_disksort_put(struct bufq_state *bufq, struct buf *bp)
530 1.39 hannken {
531 1.39 hannken struct bufq_disksort *disksort = bufq->bq_private;
532 1.39 hannken struct buf *bq, *nbq;
533 1.39 hannken int sortby;
534 1.39 hannken
535 1.39 hannken sortby = bufq->bq_flags & BUFQ_SORT_MASK;
536 1.39 hannken
537 1.39 hannken bq = TAILQ_FIRST(&disksort->bq_head);
538 1.39 hannken
539 1.39 hannken /*
540 1.39 hannken * If the queue is empty it's easy; we just go on the end.
541 1.39 hannken */
542 1.39 hannken if (bq == NULL) {
543 1.39 hannken TAILQ_INSERT_TAIL(&disksort->bq_head, bp, b_actq);
544 1.39 hannken return;
545 1.39 hannken }
546 1.39 hannken
547 1.39 hannken /*
548 1.39 hannken * If we lie before the currently active request, then we
549 1.39 hannken * must locate the second request list and add ourselves to it.
550 1.39 hannken */
551 1.39 hannken if (buf_inorder(bp, bq, sortby)) {
552 1.39 hannken while ((nbq = TAILQ_NEXT(bq, b_actq)) != NULL) {
553 1.39 hannken /*
554 1.39 hannken * Check for an ``inversion'' in the normally ascending
555 1.39 hannken * block numbers, indicating the start of the second
556 1.39 hannken * request list.
557 1.39 hannken */
558 1.39 hannken if (buf_inorder(nbq, bq, sortby)) {
559 1.39 hannken /*
560 1.39 hannken * Search the second request list for the first
561 1.39 hannken * request at a larger block number. We go
562 1.39 hannken * after that; if there is no such request, we
563 1.39 hannken * go at the end.
564 1.39 hannken */
565 1.39 hannken do {
566 1.39 hannken if (buf_inorder(bp, nbq, sortby))
567 1.39 hannken goto insert;
568 1.39 hannken bq = nbq;
569 1.43 enami } while ((nbq =
570 1.43 enami TAILQ_NEXT(bq, b_actq)) != NULL);
571 1.39 hannken goto insert; /* after last */
572 1.39 hannken }
573 1.39 hannken bq = nbq;
574 1.39 hannken }
575 1.39 hannken /*
576 1.39 hannken * No inversions... we will go after the last, and
577 1.39 hannken * be the first request in the second request list.
578 1.39 hannken */
579 1.39 hannken goto insert;
580 1.39 hannken }
581 1.39 hannken /*
582 1.39 hannken * Request is at/after the current request...
583 1.39 hannken * sort in the first request list.
584 1.39 hannken */
585 1.39 hannken while ((nbq = TAILQ_NEXT(bq, b_actq)) != NULL) {
586 1.39 hannken /*
587 1.39 hannken * We want to go after the current request if there is an
588 1.39 hannken * inversion after it (i.e. it is the end of the first
589 1.39 hannken * request list), or if the next request is a larger cylinder
590 1.39 hannken * than our request.
591 1.39 hannken */
592 1.39 hannken if (buf_inorder(nbq, bq, sortby) ||
593 1.39 hannken buf_inorder(bp, nbq, sortby))
594 1.39 hannken goto insert;
595 1.39 hannken bq = nbq;
596 1.39 hannken }
597 1.39 hannken /*
598 1.39 hannken * Neither a second list nor a larger request... we go at the end of
599 1.39 hannken * the first list, which is the same as the end of the whole schebang.
600 1.39 hannken */
601 1.39 hannken insert: TAILQ_INSERT_AFTER(&disksort->bq_head, bq, bp, b_actq);
602 1.39 hannken }
603 1.39 hannken
604 1.39 hannken static struct buf *
605 1.39 hannken bufq_disksort_get(struct bufq_state *bufq, int remove)
606 1.39 hannken {
607 1.39 hannken struct bufq_disksort *disksort = bufq->bq_private;
608 1.39 hannken struct buf *bp;
609 1.39 hannken
610 1.39 hannken bp = TAILQ_FIRST(&disksort->bq_head);
611 1.39 hannken
612 1.39 hannken if (bp != NULL && remove)
613 1.39 hannken TAILQ_REMOVE(&disksort->bq_head, bp, b_actq);
614 1.39 hannken
615 1.43 enami return (bp);
616 1.39 hannken }
617 1.39 hannken
618 1.39 hannken
619 1.39 hannken /*
620 1.39 hannken * Seek sort for disks.
621 1.39 hannken *
622 1.39 hannken * There are two queues. The first queue holds read requests; the second
623 1.39 hannken * holds write requests. The read queue is first-come first-served; the
624 1.39 hannken * write queue is sorted in ascendening block order.
625 1.39 hannken * The read queue is processed first. After PRIO_READ_BURST consecutive
626 1.39 hannken * read requests with non-empty write queue PRIO_WRITE_REQ requests from
627 1.39 hannken * the write queue will be processed.
628 1.39 hannken */
629 1.39 hannken static void
630 1.39 hannken bufq_prio_put(struct bufq_state *bufq, struct buf *bp)
631 1.39 hannken {
632 1.39 hannken struct bufq_prio *prio = bufq->bq_private;
633 1.39 hannken struct buf *bq;
634 1.39 hannken int sortby;
635 1.39 hannken
636 1.39 hannken sortby = bufq->bq_flags & BUFQ_SORT_MASK;
637 1.39 hannken
638 1.39 hannken /*
639 1.39 hannken * If it's a read request append it to the list.
640 1.39 hannken */
641 1.39 hannken if ((bp->b_flags & B_READ) == B_READ) {
642 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_read, bp, b_actq);
643 1.39 hannken return;
644 1.39 hannken }
645 1.39 hannken
646 1.39 hannken bq = TAILQ_FIRST(&prio->bq_write);
647 1.39 hannken
648 1.39 hannken /*
649 1.39 hannken * If the write list is empty, simply append it to the list.
650 1.39 hannken */
651 1.39 hannken if (bq == NULL) {
652 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_write, bp, b_actq);
653 1.39 hannken prio->bq_write_next = bp;
654 1.39 hannken return;
655 1.39 hannken }
656 1.39 hannken
657 1.39 hannken /*
658 1.39 hannken * If we lie after the next request, insert after this request.
659 1.39 hannken */
660 1.39 hannken if (buf_inorder(prio->bq_write_next, bp, sortby))
661 1.39 hannken bq = prio->bq_write_next;
662 1.39 hannken
663 1.39 hannken /*
664 1.39 hannken * Search for the first request at a larger block number.
665 1.39 hannken * We go before this request if it exists.
666 1.39 hannken */
667 1.39 hannken while (bq != NULL && buf_inorder(bq, bp, sortby))
668 1.39 hannken bq = TAILQ_NEXT(bq, b_actq);
669 1.39 hannken
670 1.39 hannken if (bq != NULL)
671 1.39 hannken TAILQ_INSERT_BEFORE(bq, bp, b_actq);
672 1.39 hannken else
673 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_write, bp, b_actq);
674 1.39 hannken }
675 1.39 hannken
676 1.39 hannken static struct buf *
677 1.39 hannken bufq_prio_get(struct bufq_state *bufq, int remove)
678 1.39 hannken {
679 1.39 hannken struct bufq_prio *prio = bufq->bq_private;
680 1.39 hannken struct buf *bp;
681 1.39 hannken
682 1.39 hannken /*
683 1.41 hannken * If no current request, get next from the lists.
684 1.39 hannken */
685 1.41 hannken if (prio->bq_next == NULL) {
686 1.39 hannken /*
687 1.41 hannken * If at least one list is empty, select the other.
688 1.39 hannken */
689 1.41 hannken if (TAILQ_FIRST(&prio->bq_read) == NULL) {
690 1.41 hannken prio->bq_next = prio->bq_write_next;
691 1.41 hannken prio->bq_read_burst = 0;
692 1.41 hannken } else if (prio->bq_write_next == NULL) {
693 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
694 1.39 hannken prio->bq_read_burst = 0;
695 1.41 hannken } else {
696 1.41 hannken /*
697 1.41 hannken * Both list have requests. Select the read list up
698 1.41 hannken * to PRIO_READ_BURST times, then select the write
699 1.41 hannken * list PRIO_WRITE_REQ times.
700 1.41 hannken */
701 1.41 hannken if (prio->bq_read_burst++ < PRIO_READ_BURST)
702 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
703 1.41 hannken else if (prio->bq_read_burst <
704 1.43 enami PRIO_READ_BURST + PRIO_WRITE_REQ)
705 1.41 hannken prio->bq_next = prio->bq_write_next;
706 1.41 hannken else {
707 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
708 1.41 hannken prio->bq_read_burst = 0;
709 1.41 hannken }
710 1.39 hannken }
711 1.39 hannken }
712 1.39 hannken
713 1.41 hannken bp = prio->bq_next;
714 1.41 hannken
715 1.44 enami if (bp != NULL && remove) {
716 1.44 enami if ((bp->b_flags & B_READ) == B_READ)
717 1.44 enami TAILQ_REMOVE(&prio->bq_read, bp, b_actq);
718 1.39 hannken else {
719 1.39 hannken /*
720 1.44 enami * Advance the write pointer before removing
721 1.44 enami * bp since it is actually prio->bq_write_next.
722 1.39 hannken */
723 1.39 hannken prio->bq_write_next =
724 1.39 hannken TAILQ_NEXT(prio->bq_write_next, b_actq);
725 1.44 enami TAILQ_REMOVE(&prio->bq_write, bp, b_actq);
726 1.39 hannken if (prio->bq_write_next == NULL)
727 1.39 hannken prio->bq_write_next =
728 1.39 hannken TAILQ_FIRST(&prio->bq_write);
729 1.39 hannken }
730 1.41 hannken
731 1.41 hannken prio->bq_next = NULL;
732 1.39 hannken }
733 1.39 hannken
734 1.43 enami return (bp);
735 1.39 hannken }
736 1.39 hannken
737 1.40 hannken /*
738 1.40 hannken * Create a device buffer queue.
739 1.40 hannken */
740 1.39 hannken void
741 1.40 hannken bufq_alloc(struct bufq_state *bufq, int flags)
742 1.39 hannken {
743 1.39 hannken struct bufq_fcfs *fcfs;
744 1.39 hannken struct bufq_disksort *disksort;
745 1.39 hannken struct bufq_prio *prio;
746 1.39 hannken
747 1.39 hannken bufq->bq_flags = flags;
748 1.39 hannken
749 1.39 hannken switch (flags & BUFQ_SORT_MASK) {
750 1.39 hannken case BUFQ_SORT_RAWBLOCK:
751 1.39 hannken case BUFQ_SORT_CYLINDER:
752 1.39 hannken break;
753 1.39 hannken case 0:
754 1.39 hannken if ((flags & BUFQ_METHOD_MASK) == BUFQ_FCFS)
755 1.39 hannken break;
756 1.39 hannken /* FALLTHROUGH */
757 1.39 hannken default:
758 1.40 hannken panic("bufq_alloc: sort out of range");
759 1.39 hannken }
760 1.39 hannken
761 1.39 hannken switch (flags & BUFQ_METHOD_MASK) {
762 1.39 hannken case BUFQ_FCFS:
763 1.39 hannken bufq->bq_get = bufq_fcfs_get;
764 1.39 hannken bufq->bq_put = bufq_fcfs_put;
765 1.40 hannken MALLOC(bufq->bq_private, struct bufq_fcfs *,
766 1.40 hannken sizeof(struct bufq_fcfs), M_DEVBUF, M_ZERO);
767 1.39 hannken fcfs = (struct bufq_fcfs *)bufq->bq_private;
768 1.39 hannken TAILQ_INIT(&fcfs->bq_head);
769 1.39 hannken break;
770 1.39 hannken case BUFQ_DISKSORT:
771 1.39 hannken bufq->bq_get = bufq_disksort_get;
772 1.39 hannken bufq->bq_put = bufq_disksort_put;
773 1.40 hannken MALLOC(bufq->bq_private, struct bufq_disksort *,
774 1.40 hannken sizeof(struct bufq_disksort), M_DEVBUF, M_ZERO);
775 1.39 hannken disksort = (struct bufq_disksort *)bufq->bq_private;
776 1.39 hannken TAILQ_INIT(&disksort->bq_head);
777 1.39 hannken break;
778 1.39 hannken case BUFQ_READ_PRIO:
779 1.39 hannken bufq->bq_get = bufq_prio_get;
780 1.39 hannken bufq->bq_put = bufq_prio_put;
781 1.40 hannken MALLOC(bufq->bq_private, struct bufq_prio *,
782 1.40 hannken sizeof(struct bufq_prio), M_DEVBUF, M_ZERO);
783 1.39 hannken prio = (struct bufq_prio *)bufq->bq_private;
784 1.39 hannken TAILQ_INIT(&prio->bq_read);
785 1.39 hannken TAILQ_INIT(&prio->bq_write);
786 1.39 hannken break;
787 1.39 hannken default:
788 1.40 hannken panic("bufq_alloc: method out of range");
789 1.39 hannken }
790 1.40 hannken }
791 1.40 hannken
792 1.40 hannken /*
793 1.40 hannken * Destroy a device buffer queue.
794 1.40 hannken */
795 1.40 hannken void
796 1.40 hannken bufq_free(struct bufq_state *bufq)
797 1.40 hannken {
798 1.43 enami
799 1.40 hannken KASSERT(bufq->bq_private != NULL);
800 1.40 hannken KASSERT(BUFQ_PEEK(bufq) == NULL);
801 1.40 hannken
802 1.40 hannken FREE(bufq->bq_private, M_DEVBUF);
803 1.40 hannken bufq->bq_get = NULL;
804 1.40 hannken bufq->bq_put = NULL;
805 1.11 mycroft }
806