2 * Copyright (c) 2000 Doug Rabson
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
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.
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
26 * $FreeBSD: src/sys/dev/agp/agp_amd.c,v 1.25 2007/11/12 21:51:36 jhb Exp $
31 #include <sys/param.h>
32 #include <sys/systm.h>
33 #include <sys/malloc.h>
34 #include <sys/kernel.h>
39 #include <bus/pci/pcivar.h>
40 #include <bus/pci/pcireg.h>
45 #include <vm/vm_object.h>
48 MALLOC_DECLARE(M_AGP);
50 #define READ2(off) bus_space_read_2(sc->bst, sc->bsh, off)
51 #define READ4(off) bus_space_read_4(sc->bst, sc->bsh, off)
52 #define WRITE2(off,v) bus_space_write_2(sc->bst, sc->bsh, off, v)
53 #define WRITE4(off,v) bus_space_write_4(sc->bst, sc->bsh, off, v)
57 u_int32_t *ag_virtual; /* virtual address of gatt */
58 vm_offset_t ag_physical;
59 u_int32_t *ag_vdir; /* virtual address of page dir */
60 vm_offset_t ag_pdir; /* physical address of page dir */
63 struct agp_amd_softc {
65 struct resource *regs; /* memory mapped control registers */
66 bus_space_tag_t bst; /* bus_space tag */
67 bus_space_handle_t bsh; /* bus_space handle */
68 u_int32_t initial_aperture; /* aperture size at startup */
69 struct agp_amd_gatt *gatt;
72 static struct agp_amd_gatt *
73 agp_amd_alloc_gatt(device_t dev)
75 u_int32_t apsize = AGP_GET_APERTURE(dev);
76 u_int32_t entries = apsize >> AGP_PAGE_SHIFT;
77 struct agp_amd_gatt *gatt;
78 int i, npages, pdir_offset;
82 "allocating GATT for aperture of size %dM\n",
83 apsize / (1024*1024));
85 gatt = kmalloc(sizeof(struct agp_amd_gatt), M_AGP, M_INTWAIT);
88 * The AMD751 uses a page directory to map a non-contiguous
89 * gatt so we don't need to use contigmalloc.
90 * Malloc individual gatt pages and map them into the page
93 gatt->ag_entries = entries;
94 gatt->ag_virtual = kmalloc(entries * sizeof(u_int32_t),
95 M_AGP, M_INTWAIT | M_ZERO);
98 * Allocate the page directory.
100 gatt->ag_vdir = kmalloc(AGP_PAGE_SIZE, M_AGP, M_INTWAIT | M_ZERO);
102 gatt->ag_pdir = vtophys((vm_offset_t) gatt->ag_vdir);
104 device_printf(dev, "gatt -> ag_pdir %#lx\n",
105 (u_long)gatt->ag_pdir);
107 * Allocate the gatt pages
109 gatt->ag_entries = entries;
111 device_printf(dev, "allocating GATT for %d AGP page entries\n",
114 gatt->ag_physical = vtophys((vm_offset_t) gatt->ag_virtual);
117 * Map the pages of the GATT into the page directory.
119 * The GATT page addresses are mapped into the directory offset by
120 * an amount dependent on the base address of the aperture. This
121 * is and offset into the page directory, not an offset added to
122 * the addresses of the gatt pages.
125 pdir_offset = pci_read_config(dev, AGP_AMD751_APBASE, 4) >> 22;
127 npages = ((entries * sizeof(u_int32_t) + AGP_PAGE_SIZE - 1)
130 for (i = 0; i < npages; i++) {
134 va = ((vm_offset_t) gatt->ag_virtual) + i * AGP_PAGE_SIZE;
136 gatt->ag_vdir[i + pdir_offset] = pa | 1;
140 * Make sure the chipset can see everything.
148 agp_amd_free_gatt(struct agp_amd_gatt *gatt)
150 kfree(gatt->ag_virtual, M_AGP);
151 kfree(gatt->ag_vdir, M_AGP);
156 agp_amd_match(device_t dev)
158 if (pci_get_class(dev) != PCIC_BRIDGE
159 || pci_get_subclass(dev) != PCIS_BRIDGE_HOST)
162 if (agp_find_caps(dev) == 0)
165 switch (pci_get_devid(dev)) {
167 return ("AMD 751 host to AGP bridge");
169 return ("AMD 761 host to AGP bridge");
171 return ("AMD 762 host to AGP bridge");
178 agp_amd_probe(device_t dev)
182 if (resource_disabled("agp", device_get_unit(dev)))
184 desc = agp_amd_match(dev);
187 device_set_desc(dev, desc);
188 return BUS_PROBE_DEFAULT;
195 agp_amd_attach(device_t dev)
197 struct agp_amd_softc *sc = device_get_softc(dev);
198 struct agp_amd_gatt *gatt;
201 error = agp_generic_attach(dev);
205 rid = AGP_AMD751_REGISTERS;
206 sc->regs = bus_alloc_resource_any(dev, SYS_RES_MEMORY, &rid,
209 agp_generic_detach(dev);
213 sc->bst = rman_get_bustag(sc->regs);
214 sc->bsh = rman_get_bushandle(sc->regs);
216 sc->initial_aperture = AGP_GET_APERTURE(dev);
217 if (sc->initial_aperture == 0) {
218 device_printf(dev, "bad initial aperture size, disabling\n");
223 gatt = agp_amd_alloc_gatt(dev);
228 * Probably contigmalloc failure. Try reducing the
229 * aperture so that the gatt size reduces.
231 if (AGP_SET_APERTURE(dev, AGP_GET_APERTURE(dev) / 2))
236 /* Install the gatt. */
237 WRITE4(AGP_AMD751_ATTBASE, gatt->ag_pdir);
239 /* Enable synchronisation between host and agp. */
240 pci_write_config(dev,
242 AGP_AMD751_MODECTRL_SYNEN, 1);
244 /* Set indexing mode for two-level and enable page dir cache */
245 pci_write_config(dev,
246 AGP_AMD751_MODECTRL2,
247 AGP_AMD751_MODECTRL2_GPDCE, 1);
249 /* Enable the TLB and flush */
250 WRITE2(AGP_AMD751_STATUS,
251 READ2(AGP_AMD751_STATUS) | AGP_AMD751_STATUS_GCE);
258 agp_amd_detach(device_t dev)
260 struct agp_amd_softc *sc = device_get_softc(dev);
264 /* Disable the TLB.. */
265 WRITE2(AGP_AMD751_STATUS,
266 READ2(AGP_AMD751_STATUS) & ~AGP_AMD751_STATUS_GCE);
268 /* Disable host-agp sync */
269 pci_write_config(dev, AGP_AMD751_MODECTRL, 0x00, 1);
271 /* Clear the GATT base */
272 WRITE4(AGP_AMD751_ATTBASE, 0);
274 /* Put the aperture back the way it started. */
275 AGP_SET_APERTURE(dev, sc->initial_aperture);
277 agp_amd_free_gatt(sc->gatt);
280 bus_release_resource(dev, SYS_RES_MEMORY,
281 AGP_AMD751_REGISTERS, sc->regs);
287 agp_amd_get_aperture(device_t dev)
292 * The aperture size is equal to 32M<<vas.
294 vas = (pci_read_config(dev, AGP_AMD751_APCTRL, 1) & 0x06) >> 1;
295 return (32*1024*1024) << vas;
299 agp_amd_set_aperture(device_t dev, u_int32_t aperture)
304 * Check for a power of two and make sure its within the
305 * programmable range.
307 if (aperture & (aperture - 1)
308 || aperture < 32*1024*1024
309 || aperture > 2U*1024*1024*1024)
312 vas = ffs(aperture / 32*1024*1024) - 1;
315 * While the size register is bits 1-3 of APCTRL, bit 0 must be
316 * set for the size value to be 'valid'
318 pci_write_config(dev, AGP_AMD751_APCTRL,
319 (((pci_read_config(dev, AGP_AMD751_APCTRL, 1) & ~0x06)
320 | ((vas << 1) | 1))), 1);
326 agp_amd_bind_page(device_t dev, int offset, vm_offset_t physical)
328 struct agp_amd_softc *sc = device_get_softc(dev);
330 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
333 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = physical | 1;
335 /* invalidate the cache */
341 agp_amd_unbind_page(device_t dev, int offset)
343 struct agp_amd_softc *sc = device_get_softc(dev);
345 if (offset < 0 || offset >= (sc->gatt->ag_entries << AGP_PAGE_SHIFT))
348 sc->gatt->ag_virtual[offset >> AGP_PAGE_SHIFT] = 0;
353 agp_amd_flush_tlb(device_t dev)
355 struct agp_amd_softc *sc = device_get_softc(dev);
357 /* Set the cache invalidate bit and wait for the chipset to clear */
358 WRITE4(AGP_AMD751_TLBCTRL, 1);
361 } while (READ4(AGP_AMD751_TLBCTRL));
364 static device_method_t agp_amd_methods[] = {
365 /* Device interface */
366 DEVMETHOD(device_probe, agp_amd_probe),
367 DEVMETHOD(device_attach, agp_amd_attach),
368 DEVMETHOD(device_detach, agp_amd_detach),
369 DEVMETHOD(device_shutdown, bus_generic_shutdown),
370 DEVMETHOD(device_suspend, bus_generic_suspend),
371 DEVMETHOD(device_resume, bus_generic_resume),
374 DEVMETHOD(agp_get_aperture, agp_amd_get_aperture),
375 DEVMETHOD(agp_set_aperture, agp_amd_set_aperture),
376 DEVMETHOD(agp_bind_page, agp_amd_bind_page),
377 DEVMETHOD(agp_unbind_page, agp_amd_unbind_page),
378 DEVMETHOD(agp_flush_tlb, agp_amd_flush_tlb),
379 DEVMETHOD(agp_enable, agp_generic_enable),
380 DEVMETHOD(agp_alloc_memory, agp_generic_alloc_memory),
381 DEVMETHOD(agp_free_memory, agp_generic_free_memory),
382 DEVMETHOD(agp_bind_memory, agp_generic_bind_memory),
383 DEVMETHOD(agp_unbind_memory, agp_generic_unbind_memory),
388 static driver_t agp_amd_driver = {
391 sizeof(struct agp_amd_softc),
394 static devclass_t agp_devclass;
396 DRIVER_MODULE(agp_amd, pci, agp_amd_driver, agp_devclass, NULL, NULL);
397 MODULE_DEPEND(agp_amd, agp, 1, 1, 1);
398 MODULE_DEPEND(agp_amd, pci, 1, 1, 1);