Add NetGear FA-511 support
[dragonfly.git] / sys / kern / kern_physio.c
CommitLineData
984263bc
MD
1/*
2 * Copyright (c) 1994 John S. Dyson
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice immediately at the beginning of the file, without modification,
10 * this list of conditions, and the following disclaimer.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * 3. Absolutely no warranty of function or purpose is made by the author
15 * John S. Dyson.
16 * 4. Modifications may be freely made to this file if the above conditions
17 * are met.
18 *
f366cb61 19 * $FreeBSD: src/sys/kern/kern_physio.c,v 1.46.2.4 2003/11/14 09:51:47 simokawa Exp $
a8f169e2 20 * $DragonFly: src/sys/kern/kern_physio.c,v 1.17 2006/04/28 16:34:01 dillon Exp $
984263bc
MD
21 */
22
23#include <sys/param.h>
24#include <sys/systm.h>
25#include <sys/buf.h>
26#include <sys/conf.h>
27#include <sys/proc.h>
28#include <sys/uio.h>
335dda38 29#include <sys/device.h>
54048233 30#include <sys/thread2.h>
984263bc
MD
31
32#include <vm/vm.h>
33#include <vm/vm_extern.h>
34
35static void
81b5c339 36physwakeup(struct bio *bio)
984263bc 37{
81b5c339 38 wakeup(bio);
984263bc
MD
39}
40
41int
42physio(dev_t dev, struct uio *uio, int ioflag)
43{
44 int i;
45 int error;
f366cb61 46 int chk_blockno;
a8f169e2 47 int saflags;
984263bc 48 caddr_t sa;
984263bc
MD
49 u_int iolen;
50 struct buf *bp;
51
984263bc
MD
52 bp = getpbuf(NULL);
53 sa = bp->b_data;
a8f169e2 54 saflags = bp->b_flags;
984263bc
MD
55 error = 0;
56
57 /* XXX: sanity check */
58 if(dev->si_iosize_max < PAGE_SIZE) {
59 printf("WARNING: %s si_iosize_max=%d, using DFLTPHYS.\n",
60 devtoname(dev), dev->si_iosize_max);
61 dev->si_iosize_max = DFLTPHYS;
62 }
63
f366cb61 64 /* Don't check block number overflow for D_MEM */
978d73e7 65 if ((dev_dflags(dev) & D_TYPEMASK) == D_MEM)
f366cb61
HP
66 chk_blockno = 0;
67 else
68 chk_blockno = 1;
69
984263bc
MD
70 for (i = 0; i < uio->uio_iovcnt; i++) {
71 while (uio->uio_iov[i].iov_len) {
72 if (uio->uio_rw == UIO_READ)
a8f169e2 73 bp->b_flags = saflags | B_READ;
984263bc 74 else
a8f169e2 75 bp->b_flags = saflags | B_WRITE;
984263bc
MD
76 bp->b_data = uio->uio_iov[i].iov_base;
77 bp->b_bcount = uio->uio_iov[i].iov_len;
984263bc
MD
78 bp->b_saveaddr = sa;
79
81b5c339
MD
80 reinitbufbio(bp); /* clear translation cache */
81 bp->b_bio1.bio_offset = uio->uio_offset;
82 bp->b_bio1.bio_done = physwakeup;
83
984263bc
MD
84 /* Don't exceed drivers iosize limit */
85 if (bp->b_bcount > dev->si_iosize_max)
86 bp->b_bcount = dev->si_iosize_max;
87
88 /*
89 * Make sure the pbuf can map the request
90 * XXX: The pbuf has kvasize = MAXPHYS so a request
91 * XXX: larger than MAXPHYS - PAGE_SIZE must be
92 * XXX: page aligned or it will be fragmented.
93 */
94 iolen = ((vm_offset_t) bp->b_data) & PAGE_MASK;
95 if ((bp->b_bcount + iolen) > bp->b_kvasize) {
96 bp->b_bcount = bp->b_kvasize;
97 if (iolen != 0)
98 bp->b_bcount -= PAGE_SIZE;
99 }
100 bp->b_bufsize = bp->b_bcount;
101
81b5c339 102 if (uio->uio_segflg == UIO_USERSPACE) {
984263bc
MD
103 if (vmapbuf(bp) < 0) {
104 error = EFAULT;
105 goto doerror;
106 }
81b5c339
MD
107 }
108 dev_dstrategy(dev, &bp->b_bio1);
e43a034f 109 crit_enter();
984263bc 110 while ((bp->b_flags & B_DONE) == 0)
81b5c339 111 tsleep(&bp->b_bio1, 0, "physstr", 0);
e43a034f 112 crit_exit();
984263bc
MD
113
114 if (uio->uio_segflg == UIO_USERSPACE)
115 vunmapbuf(bp);
116 iolen = bp->b_bcount - bp->b_resid;
117 if (iolen == 0 && !(bp->b_flags & B_ERROR))
118 goto doerror; /* EOF */
119 uio->uio_iov[i].iov_len -= iolen;
120 uio->uio_iov[i].iov_base += iolen;
121 uio->uio_resid -= iolen;
122 uio->uio_offset += iolen;
123 if( bp->b_flags & B_ERROR) {
124 error = bp->b_error;
125 goto doerror;
126 }
127 }
128 }
129doerror:
d094eee8 130 bp->b_data = sa;
984263bc 131 relpbuf(bp, NULL);
984263bc
MD
132 return (error);
133}