Merge from vendor branch OPENSSH:
[dragonfly.git] / sys / dev / agp / agp_via.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: src/sys/pci/agp_via.c,v 1.1.2.2 2001/10/04 09:53:04 ru Exp $
27  *      $DragonFly: src/sys/dev/agp/agp_via.c,v 1.5 2004/07/04 00:24:52 dillon Exp $
28  */
29
30 #include "opt_bus.h"
31 #include "opt_pci.h"
32
33 #include <sys/param.h>
34 #include <sys/systm.h>
35 #include <sys/malloc.h>
36 #include <sys/kernel.h>
37 #include <sys/bus.h>
38 #include <sys/lock.h>
39
40 #include <bus/pci/pcivar.h>
41 #include <bus/pci/pcireg.h>
42 #include "agppriv.h"
43 #include "agpreg.h"
44
45 #include <vm/vm.h>
46 #include <vm/vm_object.h>
47 #include <vm/pmap.h>
48
49 #define         REG_GARTCTRL    0
50 #define         REG_APSIZE      1
51 #define         REG_ATTBASE     2
52
53 struct agp_via_softc {
54         struct agp_softc agp;
55         u_int32_t       initial_aperture; /* aperture size at startup */
56         struct agp_gatt *gatt;
57         int             *regs;
58 };
59
60 static int via_v2_regs[] = { AGP_VIA_GARTCTRL, AGP_VIA_APSIZE,
61                             AGP_VIA_ATTBASE };
62 static int via_v3_regs[] = { AGP3_VIA_GARTCTRL, AGP3_VIA_APSIZE,
63                             AGP3_VIA_ATTBASE };
64
65 static const char*
66 agp_via_match(device_t dev)
67 {
68         if (pci_get_class(dev) != PCIC_BRIDGE
69             || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
70                 return NULL;
71
72         if (agp_find_caps(dev) == 0)
73                 return NULL;
74
75         switch (pci_get_devid(dev)) {
76         case 0x03051106:
77                 return ("VIA 82C8363 (Apollo KT133A) host to PCI bridge");
78         case 0x05011106:
79                 return ("VIA 8501 (Apollo MVP4) host to PCI bridge");
80         case 0x05971106:
81                 return ("VIA 82C597 (Apollo VP3) host to PCI bridge");
82         case 0x05981106:
83                 return ("VIA 82C598 (Apollo MVP3) host to PCI bridge");
84         case 0x06051106:
85                 return ("VIA 82C694X (Apollo Pro 133A) host to PCI bridge");
86         case 0x06911106:
87                 return ("VIA 82C691 (Apollo Pro) host to PCI bridge");
88         case 0x31881106:
89                 return ("VIA 8385 host to PCI bridge");
90         };
91
92         if (pci_get_vendor(dev) == 0x1106)
93                 return ("VIA Generic host to PCI bridge");
94
95         return NULL;
96 }
97
98 static int
99 agp_via_probe(device_t dev)
100 {
101         const char *desc;
102
103         desc = agp_via_match(dev);
104         if (desc) {
105                 device_verbose(dev);
106                 device_set_desc(dev, desc);
107                 return 0;
108         }
109
110         return ENXIO;
111 }
112
113 static int
114 agp_via_attach(device_t dev)
115 {
116         struct agp_via_softc *sc = device_get_softc(dev);
117         struct agp_gatt *gatt;
118         int error;
119
120         switch (pci_get_devid(dev)) {
121         case 0x31881106:
122                 sc->regs = via_v3_regs;
123                 break;
124         default:
125                 sc->regs = via_v2_regs;
126                 break;
127         }
128
129         error = agp_generic_attach(dev);
130         if (error)
131                 return error;
132
133         sc->initial_aperture = AGP_GET_APERTURE(dev);
134
135         for (;;) {
136                 gatt = agp_alloc_gatt(dev);
137                 if (gatt)
138                         break;
139
140                 /*
141                  * Probably contigmalloc failure. Try reducing the
142                  * aperture so that the gatt size reduces.
143                  */
144                 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2)) {
145                         agp_generic_detach(dev);
146                         return ENOMEM;
147                 }
148         }
149         sc->gatt = gatt;
150
151         /* Install the gatt. */
152         pci_write_config(dev, sc->regs[REG_ATTBASE], gatt->ag_physical | 3, 4);
153         
154         /* Enable the aperture. */
155         pci_write_config(dev, sc->regs[REG_GARTCTRL], 0x0f, 4);
156
157         return 0;
158 }
159
160 static int
161 agp_via_detach(device_t dev)
162 {
163         struct agp_via_softc *sc = device_get_softc(dev);
164         int error;
165
166         error = agp_generic_detach(dev);
167         if (error)
168                 return error;
169
170         pci_write_config(dev, sc->regs[REG_GARTCTRL], 0, 4);
171         pci_write_config(dev, sc->regs[REG_ATTBASE], 0, 4);
172         AGP_SET_APERTURE(dev, sc->initial_aperture);
173         agp_free_gatt(sc->gatt);
174
175         return 0;
176 }
177
178 static u_int32_t
179 agp_via_get_aperture(device_t dev)
180 {
181         struct agp_via_softc *sc = device_get_softc(dev);
182         u_int32_t apsize;
183
184         apsize = pci_read_config(dev, sc->regs[REG_APSIZE], 1) & 0x1f;
185
186         /*
187          * The size is determined by the number of low bits of
188          * register APBASE which are forced to zero. The low 20 bits
189          * are always forced to zero and each zero bit in the apsize
190          * field just read forces the corresponding bit in the 27:20
191          * to be zero. We calculate the aperture size accordingly.
192          */
193         return (((apsize ^ 0xff) << 20) | ((1 << 20) - 1)) + 1;
194 }
195
196 static int
197 agp_via_set_aperture(device_t dev, u_int32_t aperture)
198 {
199         struct agp_via_softc *sc = device_get_softc(dev);
200         u_int32_t apsize;
201
202         /*
203          * Reverse the magic from get_aperture.
204          */
205         apsize = ((aperture - 1) >> 20) ^ 0xff;
206
207         /*
208          * Double check for sanity.
209          */
210         if ((((apsize ^ 0xff) << 20) | ((1 << 20) - 1)) + 1 != aperture)
211                 return EINVAL;
212
213         pci_write_config(dev, sc->regs[REG_APSIZE], apsize, 1);
214
215         return 0;
216 }
217
218 static int
219 agp_via_bind_page(device_t dev, int offset, vm_offset_t physical)
220 {
221         struct agp_via_softc *sc = device_get_softc(dev);
222
223         if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
224                 return EINVAL;
225
226         sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical;
227         return 0;
228 }
229
230 static int
231 agp_via_unbind_page(device_t dev, int offset)
232 {
233         struct agp_via_softc *sc = device_get_softc(dev);
234
235         if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
236                 return EINVAL;
237
238         sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
239         return 0;
240 }
241
242 static void
243 agp_via_flush_tlb(device_t dev)
244 {
245         struct agp_via_softc *sc = device_get_softc(dev);
246
247         pci_write_config(dev, sc->regs[REG_GARTCTRL], 0x8f, 4);
248         pci_write_config(dev, sc->regs[REG_GARTCTRL], 0x0f, 4);
249 }
250
251 static device_method_t agp_via_methods[] = {
252         /* Device interface */
253         DEVMETHOD(device_probe,         agp_via_probe),
254         DEVMETHOD(device_attach,        agp_via_attach),
255         DEVMETHOD(device_detach,        agp_via_detach),
256         DEVMETHOD(device_shutdown,      bus_generic_shutdown),
257         DEVMETHOD(device_suspend,       bus_generic_suspend),
258         DEVMETHOD(device_resume,        bus_generic_resume),
259
260         /* AGP interface */
261         DEVMETHOD(agp_get_aperture,     agp_via_get_aperture),
262         DEVMETHOD(agp_set_aperture,     agp_via_set_aperture),
263         DEVMETHOD(agp_bind_page,        agp_via_bind_page),
264         DEVMETHOD(agp_unbind_page,      agp_via_unbind_page),
265         DEVMETHOD(agp_flush_tlb,        agp_via_flush_tlb),
266         DEVMETHOD(agp_enable,           agp_generic_enable),
267         DEVMETHOD(agp_alloc_memory,     agp_generic_alloc_memory),
268         DEVMETHOD(agp_free_memory,      agp_generic_free_memory),
269         DEVMETHOD(agp_bind_memory,      agp_generic_bind_memory),
270         DEVMETHOD(agp_unbind_memory,    agp_generic_unbind_memory),
271
272         { 0, 0 }
273 };
274
275 static driver_t agp_via_driver = {
276         "agp",
277         agp_via_methods,
278         sizeof(struct agp_via_softc),
279 };
280
281 static devclass_t agp_devclass;
282
283 DRIVER_MODULE(agp_via, pci, agp_via_driver, agp_devclass, 0, 0);
284 MODULE_DEPEND(agp_via, agp, 1, 1, 1);
285 MODULE_DEPEND(agp_via, pci, 1, 1, 1);