Deleted Added
full compact
agp_sis.c (113506) agp_sis.c (116192)
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.
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: head/sys/dev/agp/agp_sis.c 113506 2003-04-15 06:37:30Z mdodd $
27 */
28
25 */
26
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/dev/agp/agp_sis.c 116192 2003-06-11 06:34:30Z obrien $");
29
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
50struct 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
56static const char*
57agp_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
79static int
80agp_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
94static int
95agp_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
139static int
140agp_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
163static u_int32_t
164agp_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
175static int
176agp_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
198static int
199agp_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
210static int
211agp_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
222static void
223agp_sis_flush_tlb(device_t dev)
224{
225 pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1);
226}
227
228static 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
252static driver_t agp_sis_driver = {
253 "agp",
254 agp_sis_methods,
255 sizeof(struct agp_sis_softc),
256};
257
258static devclass_t agp_devclass;
259
260DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0);
261MODULE_DEPEND(agp_sis, agp, 1, 1, 1);
262MODULE_DEPEND(agp_sis, pci, 1, 1, 1);
30#include "opt_bus.h"
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/malloc.h>
35#include <sys/kernel.h>
36#include <sys/bus.h>
37#include <sys/lock.h>
38#include <sys/lockmgr.h>
39#include <sys/mutex.h>
40#include <sys/proc.h>
41
42#include <pci/pcivar.h>
43#include <pci/pcireg.h>
44#include <pci/agppriv.h>
45#include <pci/agpreg.h>
46
47#include <vm/vm.h>
48#include <vm/vm_object.h>
49#include <vm/pmap.h>
50
51struct agp_sis_softc {
52 struct agp_softc agp;
53 u_int32_t initial_aperture; /* aperture size at startup */
54 struct agp_gatt *gatt;
55};
56
57static const char*
58agp_sis_match(device_t dev)
59{
60 if (pci_get_class(dev) != PCIC_BRIDGE
61 || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
62 return NULL;
63
64 if (agp_find_caps(dev) == 0)
65 return NULL;
66
67 switch (pci_get_devid(dev)) {
68 case 0x00011039:
69 return ("SiS 5591 host to AGP bridge");
70 case 0x06481039:
71 return ("SiS 648 host to AGP bridge");
72 };
73
74 if (pci_get_vendor(dev) == 0x1039)
75 return ("SIS Generic host to PCI bridge");
76
77 return NULL;
78}
79
80static int
81agp_sis_probe(device_t dev)
82{
83 const char *desc;
84
85 desc = agp_sis_match(dev);
86 if (desc) {
87 device_verbose(dev);
88 device_set_desc(dev, desc);
89 return 0;
90 }
91
92 return ENXIO;
93}
94
95static int
96agp_sis_attach(device_t dev)
97{
98 struct agp_sis_softc *sc = device_get_softc(dev);
99 struct agp_gatt *gatt;
100 int error;
101
102 error = agp_generic_attach(dev);
103 if (error)
104 return error;
105
106 sc->initial_aperture = AGP_GET_APERTURE(dev);
107
108 for (;;) {
109 gatt = agp_alloc_gatt(dev);
110 if (gatt)
111 break;
112
113 /*
114 * Probably contigmalloc failure. Try reducing the
115 * aperture so that the gatt size reduces.
116 */
117 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) {
118 agp_generic_detach(dev);
119 return ENOMEM;
120 }
121 }
122 sc->gatt = gatt;
123
124 /* Install the gatt. */
125 pci_write_config(dev, AGP_SIS_ATTBASE, gatt->ag_physical, 4);
126
127 /* Enable the aperture. */
128 pci_write_config(dev, AGP_SIS_WINCTRL,
129 pci_read_config(dev, AGP_SIS_WINCTRL, 1) | 3, 1);
130
131 /*
132 * Enable the TLB and make it automatically invalidate entries
133 * when the GATT is written.
134 */
135 pci_write_config(dev, AGP_SIS_TLBCTRL, 0x05, 1);
136
137 return 0;
138}
139
140static int
141agp_sis_detach(device_t dev)
142{
143 struct agp_sis_softc *sc = device_get_softc(dev);
144 int error;
145
146 error = agp_generic_detach(dev);
147 if (error)
148 return error;
149
150 /* Disable the aperture.. */
151 pci_write_config(dev, AGP_SIS_WINCTRL,
152 pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~3, 1);
153
154 /* and the TLB. */
155 pci_write_config(dev, AGP_SIS_TLBCTRL, 0, 1);
156
157 /* Put the aperture back the way it started. */
158 AGP_SET_APERTURE(dev, sc->initial_aperture);
159
160 agp_free_gatt(sc->gatt);
161 return 0;
162}
163
164static u_int32_t
165agp_sis_get_aperture(device_t dev)
166{
167 int gws;
168
169 /*
170 * The aperture size is equal to 4M<<gws.
171 */
172 gws = (pci_read_config(dev, AGP_SIS_WINCTRL, 1) & 0x70) >> 4;
173 return (4*1024*1024) << gws;
174}
175
176static int
177agp_sis_set_aperture(device_t dev, u_int32_t aperture)
178{
179 int gws;
180
181 /*
182 * Check for a power of two and make sure its within the
183 * programmable range.
184 */
185 if (aperture & (aperture - 1)
186 || aperture < 4*1024*1024
187 || aperture > 256*1024*1024)
188 return EINVAL;
189
190 gws = ffs(aperture / 4*1024*1024) - 1;
191
192 pci_write_config(dev, AGP_SIS_WINCTRL,
193 ((pci_read_config(dev, AGP_SIS_WINCTRL, 1) & ~0x70)
194 | gws << 4), 1);
195
196 return 0;
197}
198
199static int
200agp_sis_bind_page(device_t dev, int offset, vm_offset_t physical)
201{
202 struct agp_sis_softc *sc = device_get_softc(dev);
203
204 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
205 return EINVAL;
206
207 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical;
208 return 0;
209}
210
211static int
212agp_sis_unbind_page(device_t dev, int offset)
213{
214 struct agp_sis_softc *sc = device_get_softc(dev);
215
216 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
217 return EINVAL;
218
219 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
220 return 0;
221}
222
223static void
224agp_sis_flush_tlb(device_t dev)
225{
226 pci_write_config(dev, AGP_SIS_TLBFLUSH, 0x02, 1);
227}
228
229static device_method_t agp_sis_methods[] = {
230 /* Device interface */
231 DEVMETHOD(device_probe, agp_sis_probe),
232 DEVMETHOD(device_attach, agp_sis_attach),
233 DEVMETHOD(device_detach, agp_sis_detach),
234 DEVMETHOD(device_shutdown, bus_generic_shutdown),
235 DEVMETHOD(device_suspend, bus_generic_suspend),
236 DEVMETHOD(device_resume, bus_generic_resume),
237
238 /* AGP interface */
239 DEVMETHOD(agp_get_aperture, agp_sis_get_aperture),
240 DEVMETHOD(agp_set_aperture, agp_sis_set_aperture),
241 DEVMETHOD(agp_bind_page, agp_sis_bind_page),
242 DEVMETHOD(agp_unbind_page, agp_sis_unbind_page),
243 DEVMETHOD(agp_flush_tlb, agp_sis_flush_tlb),
244 DEVMETHOD(agp_enable, agp_generic_enable),
245 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory),
246 DEVMETHOD(agp_free_memory, agp_generic_free_memory),
247 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory),
248 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory),
249
250 { 0, 0 }
251};
252
253static driver_t agp_sis_driver = {
254 "agp",
255 agp_sis_methods,
256 sizeof(struct agp_sis_softc),
257};
258
259static devclass_t agp_devclass;
260
261DRIVER_MODULE(agp_sis, pci, agp_sis_driver, agp_devclass, 0, 0);
262MODULE_DEPEND(agp_sis, agp, 1, 1, 1);
263MODULE_DEPEND(agp_sis, pci, 1, 1, 1);