subr_disk.c revision 1.43 1 1.43 enami /* $NetBSD: subr_disk.c,v 1.43 2002/11/01 03:32:21 enami 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.43 enami __KERNEL_RCSID(0, "$NetBSD: subr_disk.c,v 1.43 2002/11/01 03:32:21 enami 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.30 simonb disk_unbusy(struct disk *diskp, long bcount)
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.15 thorpej diskp->dk_bytes += bcount;
309 1.15 thorpej diskp->dk_xfer++;
310 1.15 thorpej }
311 1.15 thorpej }
312 1.15 thorpej
313 1.15 thorpej /*
314 1.15 thorpej * Reset the metrics counters on the given disk. Note that we cannot
315 1.15 thorpej * reset the busy counter, as it may case a panic in disk_unbusy().
316 1.15 thorpej * We also must avoid playing with the timestamp information, as it
317 1.15 thorpej * may skew any pending transfer results.
318 1.15 thorpej */
319 1.15 thorpej void
320 1.30 simonb disk_resetstat(struct disk *diskp)
321 1.15 thorpej {
322 1.15 thorpej int s = splbio(), t;
323 1.15 thorpej
324 1.15 thorpej diskp->dk_xfer = 0;
325 1.15 thorpej diskp->dk_bytes = 0;
326 1.15 thorpej
327 1.15 thorpej t = splclock();
328 1.15 thorpej diskp->dk_attachtime = mono_time;
329 1.15 thorpej splx(t);
330 1.15 thorpej
331 1.15 thorpej timerclear(&diskp->dk_time);
332 1.15 thorpej
333 1.15 thorpej splx(s);
334 1.33 simonb }
335 1.33 simonb
336 1.33 simonb int
337 1.33 simonb sysctl_disknames(void *vwhere, size_t *sizep)
338 1.33 simonb {
339 1.33 simonb char buf[DK_DISKNAMELEN + 1];
340 1.33 simonb char *where = vwhere;
341 1.33 simonb struct disk *diskp;
342 1.33 simonb size_t needed, left, slen;
343 1.33 simonb int error, first;
344 1.33 simonb
345 1.33 simonb first = 1;
346 1.33 simonb error = 0;
347 1.33 simonb needed = 0;
348 1.33 simonb left = *sizep;
349 1.35 simonb
350 1.33 simonb simple_lock(&disklist_slock);
351 1.33 simonb for (diskp = TAILQ_FIRST(&disklist); diskp != NULL;
352 1.33 simonb diskp = TAILQ_NEXT(diskp, dk_link)) {
353 1.33 simonb if (where == NULL)
354 1.33 simonb needed += strlen(diskp->dk_name) + 1;
355 1.33 simonb else {
356 1.33 simonb memset(buf, 0, sizeof(buf));
357 1.33 simonb if (first) {
358 1.33 simonb strncpy(buf, diskp->dk_name, sizeof(buf));
359 1.33 simonb first = 0;
360 1.33 simonb } else {
361 1.33 simonb buf[0] = ' ';
362 1.36 enami strncpy(buf + 1, diskp->dk_name,
363 1.37 enami sizeof(buf) - 1);
364 1.33 simonb }
365 1.33 simonb buf[DK_DISKNAMELEN] = '\0';
366 1.33 simonb slen = strlen(buf);
367 1.33 simonb if (left < slen + 1)
368 1.33 simonb break;
369 1.33 simonb /* +1 to copy out the trailing NUL byte */
370 1.33 simonb error = copyout(buf, where, slen + 1);
371 1.33 simonb if (error)
372 1.33 simonb break;
373 1.33 simonb where += slen;
374 1.33 simonb needed += slen;
375 1.33 simonb left -= slen;
376 1.33 simonb }
377 1.33 simonb }
378 1.33 simonb simple_unlock(&disklist_slock);
379 1.33 simonb *sizep = needed;
380 1.33 simonb return (error);
381 1.33 simonb }
382 1.33 simonb
383 1.33 simonb int
384 1.33 simonb sysctl_diskstats(int *name, u_int namelen, void *vwhere, size_t *sizep)
385 1.33 simonb {
386 1.33 simonb struct disk_sysctl sdisk;
387 1.33 simonb struct disk *diskp;
388 1.33 simonb char *where = vwhere;
389 1.33 simonb size_t tocopy, left;
390 1.33 simonb int error;
391 1.33 simonb
392 1.33 simonb if (where == NULL) {
393 1.33 simonb *sizep = disk_count * sizeof(struct disk_sysctl);
394 1.33 simonb return (0);
395 1.33 simonb }
396 1.33 simonb
397 1.33 simonb if (namelen == 0)
398 1.33 simonb tocopy = sizeof(sdisk);
399 1.33 simonb else
400 1.33 simonb tocopy = name[0];
401 1.33 simonb
402 1.33 simonb error = 0;
403 1.33 simonb left = *sizep;
404 1.33 simonb memset(&sdisk, 0, sizeof(sdisk));
405 1.35 simonb *sizep = 0;
406 1.33 simonb
407 1.33 simonb simple_lock(&disklist_slock);
408 1.34 simonb TAILQ_FOREACH(diskp, &disklist, dk_link) {
409 1.33 simonb if (left < sizeof(struct disk_sysctl))
410 1.33 simonb break;
411 1.36 enami strncpy(sdisk.dk_name, diskp->dk_name, sizeof(sdisk.dk_name));
412 1.33 simonb sdisk.dk_xfer = diskp->dk_xfer;
413 1.33 simonb sdisk.dk_seek = diskp->dk_seek;
414 1.33 simonb sdisk.dk_bytes = diskp->dk_bytes;
415 1.33 simonb sdisk.dk_attachtime_sec = diskp->dk_attachtime.tv_sec;
416 1.33 simonb sdisk.dk_attachtime_usec = diskp->dk_attachtime.tv_usec;
417 1.33 simonb sdisk.dk_timestamp_sec = diskp->dk_timestamp.tv_sec;
418 1.33 simonb sdisk.dk_timestamp_usec = diskp->dk_timestamp.tv_usec;
419 1.33 simonb sdisk.dk_time_sec = diskp->dk_time.tv_sec;
420 1.33 simonb sdisk.dk_time_usec = diskp->dk_time.tv_usec;
421 1.33 simonb sdisk.dk_busy = diskp->dk_busy;
422 1.35 simonb
423 1.33 simonb error = copyout(&sdisk, where, min(tocopy, sizeof(sdisk)));
424 1.33 simonb if (error)
425 1.33 simonb break;
426 1.33 simonb where += tocopy;
427 1.35 simonb *sizep += tocopy;
428 1.33 simonb left -= tocopy;
429 1.33 simonb }
430 1.33 simonb simple_unlock(&disklist_slock);
431 1.33 simonb return (error);
432 1.39 hannken }
433 1.39 hannken
434 1.39 hannken
435 1.39 hannken struct bufq_fcfs {
436 1.39 hannken TAILQ_HEAD(, buf) bq_head; /* actual list of buffers */
437 1.39 hannken };
438 1.39 hannken
439 1.39 hannken struct bufq_disksort {
440 1.39 hannken TAILQ_HEAD(, buf) bq_head; /* actual list of buffers */
441 1.39 hannken };
442 1.39 hannken
443 1.39 hannken #define PRIO_READ_BURST 48
444 1.39 hannken #define PRIO_WRITE_REQ 16
445 1.39 hannken
446 1.39 hannken struct bufq_prio {
447 1.39 hannken TAILQ_HEAD(, buf) bq_read, bq_write; /* actual list of buffers */
448 1.39 hannken struct buf *bq_write_next; /* next request in bq_write */
449 1.41 hannken struct buf *bq_next; /* current request */
450 1.39 hannken int bq_read_burst; /* # of consecutive reads */
451 1.39 hannken };
452 1.39 hannken
453 1.39 hannken
454 1.39 hannken /*
455 1.39 hannken * Check if two buf's are in ascending order.
456 1.39 hannken */
457 1.39 hannken static __inline int
458 1.39 hannken buf_inorder(struct buf *bp, struct buf *bq, int sortby)
459 1.39 hannken {
460 1.39 hannken int r;
461 1.39 hannken
462 1.39 hannken if (bp == NULL || bq == NULL)
463 1.43 enami return (bq == NULL);
464 1.39 hannken
465 1.39 hannken if (sortby == BUFQ_SORT_CYLINDER)
466 1.39 hannken r = bp->b_cylinder - bq->b_cylinder;
467 1.39 hannken else
468 1.39 hannken r = 0;
469 1.39 hannken
470 1.39 hannken if (r == 0)
471 1.39 hannken r = bp->b_rawblkno - bq->b_rawblkno;
472 1.39 hannken
473 1.43 enami return (r <= 0);
474 1.39 hannken }
475 1.39 hannken
476 1.39 hannken
477 1.39 hannken /*
478 1.39 hannken * First-come first-served sort for disks.
479 1.39 hannken *
480 1.39 hannken * Requests are appended to the queue without any reordering.
481 1.39 hannken */
482 1.39 hannken static void
483 1.39 hannken bufq_fcfs_put(struct bufq_state *bufq, struct buf *bp)
484 1.39 hannken {
485 1.39 hannken struct bufq_fcfs *fcfs = bufq->bq_private;
486 1.39 hannken
487 1.39 hannken TAILQ_INSERT_TAIL(&fcfs->bq_head, bp, b_actq);
488 1.39 hannken }
489 1.39 hannken
490 1.39 hannken static struct buf *
491 1.39 hannken bufq_fcfs_get(struct bufq_state *bufq, int remove)
492 1.39 hannken {
493 1.39 hannken struct bufq_fcfs *fcfs = bufq->bq_private;
494 1.39 hannken struct buf *bp;
495 1.39 hannken
496 1.39 hannken bp = TAILQ_FIRST(&fcfs->bq_head);
497 1.39 hannken
498 1.39 hannken if (bp != NULL && remove)
499 1.39 hannken TAILQ_REMOVE(&fcfs->bq_head, bp, b_actq);
500 1.39 hannken
501 1.43 enami return (bp);
502 1.39 hannken }
503 1.39 hannken
504 1.39 hannken
505 1.39 hannken /*
506 1.39 hannken * Seek sort for disks.
507 1.39 hannken *
508 1.39 hannken * There are actually two queues, sorted in ascendening order. The first
509 1.39 hannken * queue holds those requests which are positioned after the current block;
510 1.39 hannken * the second holds requests which came in after their position was passed.
511 1.39 hannken * Thus we implement a one-way scan, retracting after reaching the end of
512 1.39 hannken * the drive to the first request on the second queue, at which time it
513 1.39 hannken * becomes the first queue.
514 1.39 hannken *
515 1.39 hannken * A one-way scan is natural because of the way UNIX read-ahead blocks are
516 1.39 hannken * allocated.
517 1.39 hannken */
518 1.39 hannken static void
519 1.39 hannken bufq_disksort_put(struct bufq_state *bufq, struct buf *bp)
520 1.39 hannken {
521 1.39 hannken struct bufq_disksort *disksort = bufq->bq_private;
522 1.39 hannken struct buf *bq, *nbq;
523 1.39 hannken int sortby;
524 1.39 hannken
525 1.39 hannken sortby = bufq->bq_flags & BUFQ_SORT_MASK;
526 1.39 hannken
527 1.39 hannken bq = TAILQ_FIRST(&disksort->bq_head);
528 1.39 hannken
529 1.39 hannken /*
530 1.39 hannken * If the queue is empty it's easy; we just go on the end.
531 1.39 hannken */
532 1.39 hannken if (bq == NULL) {
533 1.39 hannken TAILQ_INSERT_TAIL(&disksort->bq_head, bp, b_actq);
534 1.39 hannken return;
535 1.39 hannken }
536 1.39 hannken
537 1.39 hannken /*
538 1.39 hannken * If we lie before the currently active request, then we
539 1.39 hannken * must locate the second request list and add ourselves to it.
540 1.39 hannken */
541 1.39 hannken if (buf_inorder(bp, bq, sortby)) {
542 1.39 hannken while ((nbq = TAILQ_NEXT(bq, b_actq)) != NULL) {
543 1.39 hannken /*
544 1.39 hannken * Check for an ``inversion'' in the normally ascending
545 1.39 hannken * block numbers, indicating the start of the second
546 1.39 hannken * request list.
547 1.39 hannken */
548 1.39 hannken if (buf_inorder(nbq, bq, sortby)) {
549 1.39 hannken /*
550 1.39 hannken * Search the second request list for the first
551 1.39 hannken * request at a larger block number. We go
552 1.39 hannken * after that; if there is no such request, we
553 1.39 hannken * go at the end.
554 1.39 hannken */
555 1.39 hannken do {
556 1.39 hannken if (buf_inorder(bp, nbq, sortby))
557 1.39 hannken goto insert;
558 1.39 hannken bq = nbq;
559 1.43 enami } while ((nbq =
560 1.43 enami TAILQ_NEXT(bq, b_actq)) != NULL);
561 1.39 hannken goto insert; /* after last */
562 1.39 hannken }
563 1.39 hannken bq = nbq;
564 1.39 hannken }
565 1.39 hannken /*
566 1.39 hannken * No inversions... we will go after the last, and
567 1.39 hannken * be the first request in the second request list.
568 1.39 hannken */
569 1.39 hannken goto insert;
570 1.39 hannken }
571 1.39 hannken /*
572 1.39 hannken * Request is at/after the current request...
573 1.39 hannken * sort in the first request list.
574 1.39 hannken */
575 1.39 hannken while ((nbq = TAILQ_NEXT(bq, b_actq)) != NULL) {
576 1.39 hannken /*
577 1.39 hannken * We want to go after the current request if there is an
578 1.39 hannken * inversion after it (i.e. it is the end of the first
579 1.39 hannken * request list), or if the next request is a larger cylinder
580 1.39 hannken * than our request.
581 1.39 hannken */
582 1.39 hannken if (buf_inorder(nbq, bq, sortby) ||
583 1.39 hannken buf_inorder(bp, nbq, sortby))
584 1.39 hannken goto insert;
585 1.39 hannken bq = nbq;
586 1.39 hannken }
587 1.39 hannken /*
588 1.39 hannken * Neither a second list nor a larger request... we go at the end of
589 1.39 hannken * the first list, which is the same as the end of the whole schebang.
590 1.39 hannken */
591 1.39 hannken insert: TAILQ_INSERT_AFTER(&disksort->bq_head, bq, bp, b_actq);
592 1.39 hannken }
593 1.39 hannken
594 1.39 hannken static struct buf *
595 1.39 hannken bufq_disksort_get(struct bufq_state *bufq, int remove)
596 1.39 hannken {
597 1.39 hannken struct bufq_disksort *disksort = bufq->bq_private;
598 1.39 hannken struct buf *bp;
599 1.39 hannken
600 1.39 hannken bp = TAILQ_FIRST(&disksort->bq_head);
601 1.39 hannken
602 1.39 hannken if (bp != NULL && remove)
603 1.39 hannken TAILQ_REMOVE(&disksort->bq_head, bp, b_actq);
604 1.39 hannken
605 1.43 enami return (bp);
606 1.39 hannken }
607 1.39 hannken
608 1.39 hannken
609 1.39 hannken /*
610 1.39 hannken * Seek sort for disks.
611 1.39 hannken *
612 1.39 hannken * There are two queues. The first queue holds read requests; the second
613 1.39 hannken * holds write requests. The read queue is first-come first-served; the
614 1.39 hannken * write queue is sorted in ascendening block order.
615 1.39 hannken * The read queue is processed first. After PRIO_READ_BURST consecutive
616 1.39 hannken * read requests with non-empty write queue PRIO_WRITE_REQ requests from
617 1.39 hannken * the write queue will be processed.
618 1.39 hannken */
619 1.39 hannken static void
620 1.39 hannken bufq_prio_put(struct bufq_state *bufq, struct buf *bp)
621 1.39 hannken {
622 1.39 hannken struct bufq_prio *prio = bufq->bq_private;
623 1.39 hannken struct buf *bq;
624 1.39 hannken int sortby;
625 1.39 hannken
626 1.39 hannken sortby = bufq->bq_flags & BUFQ_SORT_MASK;
627 1.39 hannken
628 1.39 hannken /*
629 1.39 hannken * If it's a read request append it to the list.
630 1.39 hannken */
631 1.39 hannken if ((bp->b_flags & B_READ) == B_READ) {
632 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_read, bp, b_actq);
633 1.39 hannken return;
634 1.39 hannken }
635 1.39 hannken
636 1.39 hannken bq = TAILQ_FIRST(&prio->bq_write);
637 1.39 hannken
638 1.39 hannken /*
639 1.39 hannken * If the write list is empty, simply append it to the list.
640 1.39 hannken */
641 1.39 hannken if (bq == NULL) {
642 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_write, bp, b_actq);
643 1.39 hannken prio->bq_write_next = bp;
644 1.39 hannken return;
645 1.39 hannken }
646 1.39 hannken
647 1.39 hannken /*
648 1.39 hannken * If we lie after the next request, insert after this request.
649 1.39 hannken */
650 1.39 hannken if (buf_inorder(prio->bq_write_next, bp, sortby))
651 1.39 hannken bq = prio->bq_write_next;
652 1.39 hannken
653 1.39 hannken /*
654 1.39 hannken * Search for the first request at a larger block number.
655 1.39 hannken * We go before this request if it exists.
656 1.39 hannken */
657 1.39 hannken while (bq != NULL && buf_inorder(bq, bp, sortby))
658 1.39 hannken bq = TAILQ_NEXT(bq, b_actq);
659 1.39 hannken
660 1.39 hannken if (bq != NULL)
661 1.39 hannken TAILQ_INSERT_BEFORE(bq, bp, b_actq);
662 1.39 hannken else
663 1.39 hannken TAILQ_INSERT_TAIL(&prio->bq_write, bp, b_actq);
664 1.39 hannken }
665 1.39 hannken
666 1.39 hannken static struct buf *
667 1.39 hannken bufq_prio_get(struct bufq_state *bufq, int remove)
668 1.39 hannken {
669 1.39 hannken struct bufq_prio *prio = bufq->bq_private;
670 1.39 hannken struct buf *bp;
671 1.39 hannken
672 1.39 hannken /*
673 1.41 hannken * If no current request, get next from the lists.
674 1.39 hannken */
675 1.41 hannken if (prio->bq_next == NULL) {
676 1.39 hannken /*
677 1.41 hannken * If at least one list is empty, select the other.
678 1.39 hannken */
679 1.41 hannken if (TAILQ_FIRST(&prio->bq_read) == NULL) {
680 1.41 hannken prio->bq_next = prio->bq_write_next;
681 1.41 hannken prio->bq_read_burst = 0;
682 1.41 hannken } else if (prio->bq_write_next == NULL) {
683 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
684 1.39 hannken prio->bq_read_burst = 0;
685 1.41 hannken } else {
686 1.41 hannken /*
687 1.41 hannken * Both list have requests. Select the read list up
688 1.41 hannken * to PRIO_READ_BURST times, then select the write
689 1.41 hannken * list PRIO_WRITE_REQ times.
690 1.41 hannken */
691 1.41 hannken if (prio->bq_read_burst++ < PRIO_READ_BURST)
692 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
693 1.41 hannken else if (prio->bq_read_burst <
694 1.43 enami PRIO_READ_BURST + PRIO_WRITE_REQ)
695 1.41 hannken prio->bq_next = prio->bq_write_next;
696 1.41 hannken else {
697 1.41 hannken prio->bq_next = TAILQ_FIRST(&prio->bq_read);
698 1.41 hannken prio->bq_read_burst = 0;
699 1.41 hannken }
700 1.39 hannken }
701 1.39 hannken }
702 1.39 hannken
703 1.41 hannken bp = prio->bq_next;
704 1.41 hannken
705 1.41 hannken if (prio->bq_next != NULL && remove) {
706 1.41 hannken if ((prio->bq_next->b_flags & B_READ) == B_READ)
707 1.41 hannken TAILQ_REMOVE(&prio->bq_read, prio->bq_next, b_actq);
708 1.39 hannken else {
709 1.41 hannken TAILQ_REMOVE(&prio->bq_write, prio->bq_next, b_actq);
710 1.39 hannken /*
711 1.39 hannken * Advance the write pointer.
712 1.39 hannken */
713 1.39 hannken prio->bq_write_next =
714 1.39 hannken TAILQ_NEXT(prio->bq_write_next, b_actq);
715 1.39 hannken if (prio->bq_write_next == NULL)
716 1.39 hannken prio->bq_write_next =
717 1.39 hannken TAILQ_FIRST(&prio->bq_write);
718 1.39 hannken }
719 1.41 hannken
720 1.41 hannken prio->bq_next = NULL;
721 1.39 hannken }
722 1.39 hannken
723 1.43 enami return (bp);
724 1.39 hannken }
725 1.39 hannken
726 1.40 hannken /*
727 1.40 hannken * Create a device buffer queue.
728 1.40 hannken */
729 1.39 hannken void
730 1.40 hannken bufq_alloc(struct bufq_state *bufq, int flags)
731 1.39 hannken {
732 1.39 hannken struct bufq_fcfs *fcfs;
733 1.39 hannken struct bufq_disksort *disksort;
734 1.39 hannken struct bufq_prio *prio;
735 1.39 hannken
736 1.39 hannken bufq->bq_flags = flags;
737 1.39 hannken
738 1.39 hannken switch (flags & BUFQ_SORT_MASK) {
739 1.39 hannken case BUFQ_SORT_RAWBLOCK:
740 1.39 hannken case BUFQ_SORT_CYLINDER:
741 1.39 hannken break;
742 1.39 hannken case 0:
743 1.39 hannken if ((flags & BUFQ_METHOD_MASK) == BUFQ_FCFS)
744 1.39 hannken break;
745 1.39 hannken /* FALLTHROUGH */
746 1.39 hannken default:
747 1.40 hannken panic("bufq_alloc: sort out of range");
748 1.39 hannken }
749 1.39 hannken
750 1.39 hannken switch (flags & BUFQ_METHOD_MASK) {
751 1.39 hannken case BUFQ_FCFS:
752 1.39 hannken bufq->bq_get = bufq_fcfs_get;
753 1.39 hannken bufq->bq_put = bufq_fcfs_put;
754 1.40 hannken MALLOC(bufq->bq_private, struct bufq_fcfs *,
755 1.40 hannken sizeof(struct bufq_fcfs), M_DEVBUF, M_ZERO);
756 1.39 hannken fcfs = (struct bufq_fcfs *)bufq->bq_private;
757 1.39 hannken TAILQ_INIT(&fcfs->bq_head);
758 1.39 hannken break;
759 1.39 hannken case BUFQ_DISKSORT:
760 1.39 hannken bufq->bq_get = bufq_disksort_get;
761 1.39 hannken bufq->bq_put = bufq_disksort_put;
762 1.40 hannken MALLOC(bufq->bq_private, struct bufq_disksort *,
763 1.40 hannken sizeof(struct bufq_disksort), M_DEVBUF, M_ZERO);
764 1.39 hannken disksort = (struct bufq_disksort *)bufq->bq_private;
765 1.39 hannken TAILQ_INIT(&disksort->bq_head);
766 1.39 hannken break;
767 1.39 hannken case BUFQ_READ_PRIO:
768 1.39 hannken bufq->bq_get = bufq_prio_get;
769 1.39 hannken bufq->bq_put = bufq_prio_put;
770 1.40 hannken MALLOC(bufq->bq_private, struct bufq_prio *,
771 1.40 hannken sizeof(struct bufq_prio), M_DEVBUF, M_ZERO);
772 1.39 hannken prio = (struct bufq_prio *)bufq->bq_private;
773 1.39 hannken TAILQ_INIT(&prio->bq_read);
774 1.39 hannken TAILQ_INIT(&prio->bq_write);
775 1.39 hannken break;
776 1.39 hannken default:
777 1.40 hannken panic("bufq_alloc: method out of range");
778 1.39 hannken }
779 1.40 hannken }
780 1.40 hannken
781 1.40 hannken /*
782 1.40 hannken * Destroy a device buffer queue.
783 1.40 hannken */
784 1.40 hannken void
785 1.40 hannken bufq_free(struct bufq_state *bufq)
786 1.40 hannken {
787 1.43 enami
788 1.40 hannken KASSERT(bufq->bq_private != NULL);
789 1.40 hannken KASSERT(BUFQ_PEEK(bufq) == NULL);
790 1.40 hannken
791 1.40 hannken FREE(bufq->bq_private, M_DEVBUF);
792 1.40 hannken bufq->bq_get = NULL;
793 1.40 hannken bufq->bq_put = NULL;
794 1.11 mycroft }
795