FreeBSD/Linux Kernel Cross Reference
sys/pci/agp_sis.c
1 /*-
2 * Copyright (c) 2000 Doug Rabson
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, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 *
26 * $FreeBSD: releng/5.1/sys/pci/agp_sis.c 113506 2003-04-15 06:37:30Z mdodd $
27 */
28
29 #include "opt_bus.h"
30
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/malloc.h>
34 #include <sys/kernel.h>
35 #include <sys/bus.h>
36 #include <sys/lock.h>
37 #include <sys/lockmgr.h>
38 #include <sys/mutex.h>
39 #include <sys/proc.h>
40
41 #include <pci/pcivar.h>
42 #include <pci/pcireg.h>
43 #include <pci/agppriv.h>
44 #include <pci/agpreg.h>
45
46 #include <vm/vm.h>
47 #include <vm/vm_object.h>
48 #include <vm/pmap.h>
49
50 struct agp_sis_softc {
51 struct agp_softc agp;
52 u_int32_t initial_aperture; /* aperture size at startup */
53 struct agp_gatt *gatt;
54 };
55
56 static const char*
57 agp_sis_match(device_t dev)
58 {
59 if (pci_get_class(dev) != PCIC_BRIDGE
60 || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
61 return NULL;
62
63 if (agp_find_caps(dev) == 0)
64 return NULL;
65
66 switch (pci_get_devid(dev)) {
67 case 0x00011039:
68 return ("SiS 5591 host to AGP bridge");
69 case 0x06481039:
70 return ("SiS 648 host to AGP bridge");
71 };
72
73 if (pci_get_vendor(dev) == 0x1039)
74 return ("SIS Generic host to PCI bridge");
75
76 return NULL;
77 }
78
79 static int
80 agp_sis_probe(device_t dev)
81 {
82 const char *desc;
83
84 desc = agp_sis_match(dev);
85 if (desc) {
86 device_verbose(dev);
87 device_set_desc(dev, desc);
88 return 0;
89 }
90
91 return ENXIO;
92 }
93
94 static int
95 agp_sis_attach(device_t dev)
96 {
97 struct agp_sis_softc *sc = device_get_softc(dev);
98 struct agp_gatt *gatt;
99 int error;
100
101 error = agp_generic_attach(dev);
102 if (error)
103 return error;
104
105 sc->initial_aperture = AGP_GET_APERTURE(dev);
106
107 for (;;) {
108 gatt = agp_alloc_gatt(dev);
109 if (gatt)
110 break;
111
112 /*
113 * Probably contigmalloc failure. Try reducing the
114 * aperture so that the gatt size reduces.
115 */
116 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) {
117 agp_generic_detach(dev);
118 return ENOMEM;
119 }
120 }
121 sc->gatt = gatt;
122
123 /* Install the gatt. */
124 pci_write_config(dev, AGP_SIS_ATTBASE, gatt->ag_physical, 4);
125
126 /* Enable the aperture. */
127 pci_write_config(dev, AGP_SIS_WINCTRL,
128 pci_read_config(dev, AGP_SIS_WINCTRL, 1) | 3, 1);
129
130 /*
131 * Enable the TLB and make it automatically invalidate entries
132 * when the GATT is written.
133 */
134 pci_write_config(dev, AGP_SIS_TLBCTRL, 0x05, 1);
135
136 return 0;
137 }
138
139 static int
140 agp_sis_detach(device_t dev)
141 {
142 struct agp_sis_softc *sc = device_get_softc(dev);
143 int error;
144
145 error = agp_generic_detach(dev);
146 if (error)
147 return error;
148
149 /* Disable the aperture.. */
150 pci_write_config(dev, AGP_SIS_WINCTRL,
151 pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~3, 1);
152
153 /* and the TLB. */
154 pci_write_config(dev, AGP_SIS_TLBCTRL, 0, 1);
155
156 /* Put the aperture back the way it started. */
157 AGP_SET_APERTURE(dev, sc->initial_aperture);
158
159 agp_free_gatt(sc->gatt);
160 return 0;
161 }
162
163 static u_int32_t
164 agp_sis_get_aperture(device_t dev)
165 {
166 int gws;
167
168 /*
169 * The aperture size is equal to 4M<<gws.
170 */
171 gws = (pci_read_config(dev, AGP_SIS_WINCTRL, 1) & 0x70) >> 4;
172 return (4*1024*1024) << gws;
173 }
174
175 static int
176 agp_sis_set_aperture(device_t dev, u_int32_t aperture)
177 {
178 int gws;
179
180 /*
181 * Check for a power of two and make sure its within the
182 * programmable range.
183 */
184 if (aperture & (aperture - 1)
185 || aperture < 4*1024*1024
186 || aperture > 256*1024*1024)
187 return EINVAL;
188
189 gws = ffs(aperture / 4*1024*1024) - 1;
190
191 pci_write_config(dev, AGP_SIS_WINCTRL,
192 ((pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~0x70)
193 | gws << 4), 1);
194
195 return 0;
196 }
197
198 static int
199 agp_sis_bind_page(device_t dev, int offset, vm_offset_t physical)
200 {
201 struct agp_sis_softc *sc = device_get_softc(dev);
202
203 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
204 return EINVAL;
205
206 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical;
207 return 0;
208 }
209
210 static int
211 agp_sis_unbind_page(device_t dev, int offset)
212 {
213 struct agp_sis_softc *sc = device_get_softc(dev);
214
215 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
216 return EINVAL;
217
218 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
219 return 0;
220 }
221
222 static void
223 agp_sis_flush_tlb(device_t dev)
224 {
225 pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1);
226 }
227
228 static device_method_t agp_sis_methods[] = {
229 /* Device interface */
230 DEVMETHOD(device_probe, agp_sis_probe),
231 DEVMETHOD(device_attach, agp_sis_attach),
232 DEVMETHOD(device_detach, agp_sis_detach),
233 DEVMETHOD(device_shutdown, bus_generic_shutdown),
234 DEVMETHOD(device_suspend, bus_generic_suspend),
235 DEVMETHOD(device_resume, bus_generic_resume),
236
237 /* AGP interface */
238 DEVMETHOD(agp_get_aperture, agp_sis_get_aperture),
239 DEVMETHOD(agp_set_aperture, agp_sis_set_aperture),
240 DEVMETHOD(agp_bind_page, agp_sis_bind_page),
241 DEVMETHOD(agp_unbind_page, agp_sis_unbind_page),
242 DEVMETHOD(agp_flush_tlb, agp_sis_flush_tlb),
243 DEVMETHOD(agp_enable, agp_generic_enable),
244 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory),
245 DEVMETHOD(agp_free_memory, agp_generic_free_memory),
246 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory),
247 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory),
248
249 { 0, 0 }
250 };
251
252 static driver_t agp_sis_driver = {
253 "agp",
254 agp_sis_methods,
255 sizeof(struct agp_sis_softc),
256 };
257
258 static devclass_t agp_devclass;
259
260 DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0);
261 MODULE_DEPEND(agp_sis, agp, 1, 1, 1);
262 MODULE_DEPEND(agp_sis, pci, 1, 1, 1);
Cache object: 93bba9ae25be3b935a00c5d058495296
|