xref: /netbsd-src/sys/dev/pci/agp_i810.c (revision 46f5119e40af2e51998f686b2fdcc76b5488f7f3)
1 /*	$NetBSD: agp_i810.c,v 1.73 2011/04/04 20:37:56 dyoung Exp $	*/
2 
3 /*-
4  * Copyright (c) 2000 Doug Rabson
5  * Copyright (c) 2000 Ruslan Ermilov
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  *
29  *	$FreeBSD: src/sys/pci/agp_i810.c,v 1.4 2001/07/05 21:28:47 jhb Exp $
30  */
31 
32 #include <sys/cdefs.h>
33 __KERNEL_RCSID(0, "$NetBSD: agp_i810.c,v 1.73 2011/04/04 20:37:56 dyoung Exp $");
34 
35 #include <sys/param.h>
36 #include <sys/systm.h>
37 #include <sys/malloc.h>
38 #include <sys/kernel.h>
39 #include <sys/proc.h>
40 #include <sys/device.h>
41 #include <sys/conf.h>
42 
43 #include <dev/pci/pcivar.h>
44 #include <dev/pci/pcireg.h>
45 #include <dev/pci/pcidevs.h>
46 #include <dev/pci/agpvar.h>
47 #include <dev/pci/agpreg.h>
48 
49 #include <sys/agpio.h>
50 
51 #include <sys/bus.h>
52 
53 #include "agp_intel.h"
54 
55 #define READ1(off)	bus_space_read_1(isc->bst, isc->bsh, off)
56 #define READ4(off)	bus_space_read_4(isc->bst, isc->bsh, off)
57 #define WRITE4(off,v)	bus_space_write_4(isc->bst, isc->bsh, off, v)
58 
59 #define CHIP_I810 0	/* i810/i815 */
60 #define CHIP_I830 1	/* 830M/845G */
61 #define CHIP_I855 2	/* 852GM/855GM/865G */
62 #define CHIP_I915 3	/* 915G/915GM/945G/945GM/945GME */
63 #define CHIP_I965 4	/* 965Q/965PM */
64 #define CHIP_G33  5	/* G33/Q33/Q35 */
65 #define CHIP_G4X  6	/* G45/Q45 */
66 
67 struct agp_i810_softc {
68 	u_int32_t initial_aperture;	/* aperture size at startup */
69 	struct agp_gatt *gatt;
70 	int chiptype;			/* i810-like or i830 */
71 	u_int32_t dcache_size;		/* i810 only */
72 	u_int32_t stolen;		/* number of i830/845 gtt entries
73 					   for stolen memory */
74 	bus_space_tag_t bst;		/* register bus_space tag */
75 	bus_space_handle_t bsh;		/* register bus_space handle */
76 	bus_space_tag_t gtt_bst;	/* GTT bus_space tag */
77 	bus_space_handle_t gtt_bsh;	/* GTT bus_space handle */
78 	struct pci_attach_args vga_pa;
79 
80 	u_int32_t pgtblctl;
81 };
82 
83 /* XXX hack, see below */
84 static bus_addr_t agp_i810_vga_regbase;
85 static bus_space_handle_t agp_i810_vga_bsh;
86 
87 static u_int32_t agp_i810_get_aperture(struct agp_softc *);
88 static int agp_i810_set_aperture(struct agp_softc *, u_int32_t);
89 static int agp_i810_bind_page(struct agp_softc *, off_t, bus_addr_t);
90 static int agp_i810_unbind_page(struct agp_softc *, off_t);
91 static void agp_i810_flush_tlb(struct agp_softc *);
92 static int agp_i810_enable(struct agp_softc *, u_int32_t mode);
93 static struct agp_memory *agp_i810_alloc_memory(struct agp_softc *, int,
94 						vsize_t);
95 static int agp_i810_free_memory(struct agp_softc *, struct agp_memory *);
96 static int agp_i810_bind_memory(struct agp_softc *, struct agp_memory *, off_t);
97 static int agp_i810_unbind_memory(struct agp_softc *, struct agp_memory *);
98 
99 static bool agp_i810_resume(device_t, const pmf_qual_t *);
100 static int agp_i810_init(struct agp_softc *);
101 
102 static int agp_i810_init(struct agp_softc *);
103 static int agp_i810_write_gtt_entry(struct agp_i810_softc *, off_t,
104 				    bus_addr_t);
105 
106 static struct agp_methods agp_i810_methods = {
107 	agp_i810_get_aperture,
108 	agp_i810_set_aperture,
109 	agp_i810_bind_page,
110 	agp_i810_unbind_page,
111 	agp_i810_flush_tlb,
112 	agp_i810_enable,
113 	agp_i810_alloc_memory,
114 	agp_i810_free_memory,
115 	agp_i810_bind_memory,
116 	agp_i810_unbind_memory,
117 };
118 
119 static int
120 agp_i810_write_gtt_entry(struct agp_i810_softc *isc, off_t off, bus_addr_t v)
121 {
122 	u_int32_t pte;
123 	bus_size_t base_off, wroff;
124 
125 	/* Bits 11:4 (physical start address extension) should be zero. */
126 	if ((v & 0xff0) != 0)
127 		return EINVAL;
128 
129 	pte = (u_int32_t)v;
130 	/*
131 	 * We need to massage the pte if bus_addr_t is wider than 32 bits.
132 	 * The compiler isn't smart enough, hence the casts to uintmax_t.
133 	 */
134 	if (sizeof(bus_addr_t) > sizeof(u_int32_t)) {
135 		/* 965+ can do 36-bit addressing, add in the extra bits. */
136 		if (isc->chiptype == CHIP_I965 ||
137 		    isc->chiptype == CHIP_G33 ||
138 		    isc->chiptype == CHIP_G4X) {
139 			if (((uintmax_t)v >> 36) != 0)
140 				return EINVAL;
141 			pte |= (v >> 28) & 0xf0;
142 		} else {
143 			if (((uintmax_t)v >> 32) != 0)
144 				return EINVAL;
145 		}
146 	}
147 
148 	base_off = 0;
149 	wroff = (off >> AGP_PAGE_SHIFT) * 4;
150 
151 	switch (isc->chiptype) {
152 	case CHIP_I810:
153 	case CHIP_I830:
154 	case CHIP_I855:
155 		base_off = AGP_I810_GTT;
156 		break;
157 	case CHIP_I965:
158 		base_off = AGP_I965_GTT;
159 		break;
160 	case CHIP_G4X:
161 		base_off = AGP_G4X_GTT;
162 		break;
163 	case CHIP_I915:
164 	case CHIP_G33:
165 		bus_space_write_4(isc->gtt_bst, isc->gtt_bsh, wroff, pte);
166 		return 0;
167 	}
168 
169 	WRITE4(base_off + wroff, pte);
170 	return 0;
171 }
172 
173 /* XXXthorpej -- duplicated code (see arch/x86/pci/pchb.c) */
174 static int
175 agp_i810_vgamatch(const struct pci_attach_args *pa)
176 {
177 
178 	if (PCI_CLASS(pa->pa_class) != PCI_CLASS_DISPLAY ||
179 	    PCI_SUBCLASS(pa->pa_class) != PCI_SUBCLASS_DISPLAY_VGA)
180 		return (0);
181 
182 	switch (PCI_PRODUCT(pa->pa_id)) {
183 	case PCI_PRODUCT_INTEL_82810_GC:
184 	case PCI_PRODUCT_INTEL_82810_DC100_GC:
185 	case PCI_PRODUCT_INTEL_82810E_GC:
186 	case PCI_PRODUCT_INTEL_82815_FULL_GRAPH:
187 	case PCI_PRODUCT_INTEL_82830MP_IV:
188 	case PCI_PRODUCT_INTEL_82845G_IGD:
189 	case PCI_PRODUCT_INTEL_82855GM_IGD:
190 	case PCI_PRODUCT_INTEL_82865_IGD:
191 	case PCI_PRODUCT_INTEL_82915G_IGD:
192 	case PCI_PRODUCT_INTEL_82915GM_IGD:
193 	case PCI_PRODUCT_INTEL_82945P_IGD:
194 	case PCI_PRODUCT_INTEL_82945GM_IGD:
195 	case PCI_PRODUCT_INTEL_82945GM_IGD_1:
196 	case PCI_PRODUCT_INTEL_82945GME_IGD:
197 	case PCI_PRODUCT_INTEL_E7221_IGD:
198 	case PCI_PRODUCT_INTEL_82965Q_IGD:
199 	case PCI_PRODUCT_INTEL_82965Q_IGD_1:
200 	case PCI_PRODUCT_INTEL_82965PM_IGD:
201 	case PCI_PRODUCT_INTEL_82965PM_IGD_1:
202 	case PCI_PRODUCT_INTEL_82G33_IGD:
203 	case PCI_PRODUCT_INTEL_82G33_IGD_1:
204 	case PCI_PRODUCT_INTEL_82965G_IGD:
205 	case PCI_PRODUCT_INTEL_82965G_IGD_1:
206 	case PCI_PRODUCT_INTEL_82965GME_IGD:
207 	case PCI_PRODUCT_INTEL_82Q35_IGD:
208 	case PCI_PRODUCT_INTEL_82Q35_IGD_1:
209 	case PCI_PRODUCT_INTEL_82Q33_IGD:
210 	case PCI_PRODUCT_INTEL_82Q33_IGD_1:
211 	case PCI_PRODUCT_INTEL_82G35_IGD:
212 	case PCI_PRODUCT_INTEL_82G35_IGD_1:
213 	case PCI_PRODUCT_INTEL_82946GZ_IGD:
214 	case PCI_PRODUCT_INTEL_82GM45_IGD:
215 	case PCI_PRODUCT_INTEL_82GM45_IGD_1:
216 	case PCI_PRODUCT_INTEL_82IGD_E_IGD:
217 	case PCI_PRODUCT_INTEL_82Q45_IGD:
218 	case PCI_PRODUCT_INTEL_82G45_IGD:
219 	case PCI_PRODUCT_INTEL_82G41_IGD:
220 	case PCI_PRODUCT_INTEL_82B43_IGD:
221 	case PCI_PRODUCT_INTEL_IRONLAKE_D_IGD:
222 	case PCI_PRODUCT_INTEL_IRONLAKE_M_IGD:
223 	case PCI_PRODUCT_INTEL_PINEVIEW_IGD:
224 	case PCI_PRODUCT_INTEL_PINEVIEW_M_IGD:
225 		return (1);
226 	}
227 
228 	return (0);
229 }
230 
231 static int
232 agp_i965_map_aperture(struct pci_attach_args *pa, struct agp_softc *sc, int reg)
233 {
234         /*
235          * Find the aperture. Don't map it (yet), this would
236          * eat KVA.
237          */
238         if (pci_mapreg_info(pa->pa_pc, pa->pa_tag, reg,
239             PCI_MAPREG_TYPE_MEM|PCI_MAPREG_MEM_TYPE_64BIT, &sc->as_apaddr, &sc->as_apsize,
240             &sc->as_apflags) != 0)
241                 return ENXIO;
242 
243         sc->as_apt = pa->pa_memt;
244 
245         return 0;
246 }
247 
248 int
249 agp_i810_attach(device_t parent, device_t self, void *aux)
250 {
251 	struct agp_softc *sc = device_private(self);
252 	struct agp_i810_softc *isc;
253 	struct agp_gatt *gatt;
254 	int error, apbase;
255 	bus_addr_t mmadr;
256 	bus_size_t mmadrsize;
257 
258 	isc = malloc(sizeof *isc, M_AGP, M_NOWAIT|M_ZERO);
259 	if (isc == NULL) {
260 		aprint_error(": can't allocate chipset-specific softc\n");
261 		return ENOMEM;
262 	}
263 	sc->as_chipc = isc;
264 	sc->as_methods = &agp_i810_methods;
265 
266 	if (pci_find_device(&isc->vga_pa, agp_i810_vgamatch) == 0) {
267 #if NAGP_INTEL > 0
268 		const struct pci_attach_args *pa = aux;
269 
270 		switch (PCI_PRODUCT(pa->pa_id)) {
271 		case PCI_PRODUCT_INTEL_82840_HB:
272 		case PCI_PRODUCT_INTEL_82865_HB:
273 		case PCI_PRODUCT_INTEL_82845G_DRAM:
274 		case PCI_PRODUCT_INTEL_82815_FULL_HUB:
275 		case PCI_PRODUCT_INTEL_82855GM_MCH:
276 			return agp_intel_attach(parent, self, aux);
277 		}
278 #endif
279 		aprint_error(": can't find internal VGA device config space\n");
280 		free(isc, M_AGP);
281 		return ENOENT;
282 	}
283 
284 	/* XXXfvdl */
285 	sc->as_dmat = isc->vga_pa.pa_dmat;
286 
287 	switch (PCI_PRODUCT(isc->vga_pa.pa_id)) {
288 	case PCI_PRODUCT_INTEL_82810_GC:
289 	case PCI_PRODUCT_INTEL_82810_DC100_GC:
290 	case PCI_PRODUCT_INTEL_82810E_GC:
291 	case PCI_PRODUCT_INTEL_82815_FULL_GRAPH:
292 		isc->chiptype = CHIP_I810;
293 		break;
294 	case PCI_PRODUCT_INTEL_82830MP_IV:
295 	case PCI_PRODUCT_INTEL_82845G_IGD:
296 		isc->chiptype = CHIP_I830;
297 		break;
298 	case PCI_PRODUCT_INTEL_82855GM_IGD:
299 	case PCI_PRODUCT_INTEL_82865_IGD:
300 		isc->chiptype = CHIP_I855;
301 		break;
302 	case PCI_PRODUCT_INTEL_82915G_IGD:
303 	case PCI_PRODUCT_INTEL_82915GM_IGD:
304 	case PCI_PRODUCT_INTEL_82945P_IGD:
305 	case PCI_PRODUCT_INTEL_82945GM_IGD:
306 	case PCI_PRODUCT_INTEL_82945GM_IGD_1:
307 	case PCI_PRODUCT_INTEL_82945GME_IGD:
308 	case PCI_PRODUCT_INTEL_E7221_IGD:
309 	case PCI_PRODUCT_INTEL_PINEVIEW_IGD:
310 	case PCI_PRODUCT_INTEL_PINEVIEW_M_IGD:
311 		isc->chiptype = CHIP_I915;
312 		break;
313 	case PCI_PRODUCT_INTEL_82965Q_IGD:
314 	case PCI_PRODUCT_INTEL_82965Q_IGD_1:
315 	case PCI_PRODUCT_INTEL_82965PM_IGD:
316 	case PCI_PRODUCT_INTEL_82965PM_IGD_1:
317 	case PCI_PRODUCT_INTEL_82965G_IGD:
318 	case PCI_PRODUCT_INTEL_82965G_IGD_1:
319 	case PCI_PRODUCT_INTEL_82965GME_IGD:
320 	case PCI_PRODUCT_INTEL_82946GZ_IGD:
321 	case PCI_PRODUCT_INTEL_82G35_IGD:
322 	case PCI_PRODUCT_INTEL_82G35_IGD_1:
323 		isc->chiptype = CHIP_I965;
324 		break;
325 	case PCI_PRODUCT_INTEL_82Q35_IGD:
326 	case PCI_PRODUCT_INTEL_82Q35_IGD_1:
327 	case PCI_PRODUCT_INTEL_82G33_IGD:
328 	case PCI_PRODUCT_INTEL_82G33_IGD_1:
329 	case PCI_PRODUCT_INTEL_82Q33_IGD:
330 	case PCI_PRODUCT_INTEL_82Q33_IGD_1:
331 		isc->chiptype = CHIP_G33;
332 		break;
333 	case PCI_PRODUCT_INTEL_82GM45_IGD:
334 	case PCI_PRODUCT_INTEL_82GM45_IGD_1:
335 	case PCI_PRODUCT_INTEL_82IGD_E_IGD:
336 	case PCI_PRODUCT_INTEL_82Q45_IGD:
337 	case PCI_PRODUCT_INTEL_82G45_IGD:
338 	case PCI_PRODUCT_INTEL_82G41_IGD:
339 	case PCI_PRODUCT_INTEL_82B43_IGD:
340 	case PCI_PRODUCT_INTEL_IRONLAKE_D_IGD:
341 	case PCI_PRODUCT_INTEL_IRONLAKE_M_IGD:
342 		isc->chiptype = CHIP_G4X;
343 		break;
344 	}
345 
346 	switch (isc->chiptype) {
347 	case CHIP_I915:
348 	case CHIP_G33:
349 		apbase = AGP_I915_GMADR;
350 		break;
351 	case CHIP_I965:
352 	case CHIP_G4X:
353 		apbase = AGP_I965_GMADR;
354 		break;
355 	default:
356 		apbase = AGP_I810_GMADR;
357 		break;
358 	}
359 
360 	if (isc->chiptype == CHIP_I965 || isc->chiptype == CHIP_G4X) {
361 		error = agp_i965_map_aperture(&isc->vga_pa, sc, apbase);
362 	} else {
363 		error = agp_map_aperture(&isc->vga_pa, sc, apbase);
364 	}
365 	if (error != 0) {
366 		aprint_error(": can't map aperture\n");
367 		free(isc, M_AGP);
368 		return error;
369 	}
370 
371 	if (isc->chiptype == CHIP_I915 || isc->chiptype == CHIP_G33) {
372 		error = pci_mapreg_map(&isc->vga_pa, AGP_I915_MMADR,
373 		    PCI_MAPREG_TYPE_MEM, 0, &isc->bst, &isc->bsh,
374 		    &mmadr, &mmadrsize);
375 		if (error != 0) {
376 			aprint_error(": can't map mmadr registers\n");
377 			agp_generic_detach(sc);
378 			return error;
379 		}
380 		error = pci_mapreg_map(&isc->vga_pa, AGP_I915_GTTADR,
381 		    PCI_MAPREG_TYPE_MEM, 0, &isc->gtt_bst, &isc->gtt_bsh,
382 		    NULL, NULL);
383 		if (error != 0) {
384 			aprint_error(": can't map gttadr registers\n");
385 			/* XXX we should release mmadr here */
386 			agp_generic_detach(sc);
387 			return error;
388 		}
389 	} else if (isc->chiptype == CHIP_I965 || isc->chiptype == CHIP_G4X) {
390 		error = pci_mapreg_map(&isc->vga_pa, AGP_I965_MMADR,
391 		    PCI_MAPREG_TYPE_MEM, 0, &isc->bst, &isc->bsh,
392 		    &mmadr, &mmadrsize);
393 		if (error != 0) {
394 			aprint_error(": can't map mmadr registers\n");
395 			agp_generic_detach(sc);
396 			return error;
397 		}
398 	} else {
399 		error = pci_mapreg_map(&isc->vga_pa, AGP_I810_MMADR,
400 		    PCI_MAPREG_TYPE_MEM, 0, &isc->bst, &isc->bsh,
401 		    &mmadr, &mmadrsize);
402 		if (error != 0) {
403 			aprint_error(": can't map mmadr registers\n");
404 			agp_generic_detach(sc);
405 			return error;
406 		}
407 	}
408 
409 	isc->initial_aperture = AGP_GET_APERTURE(sc);
410 
411 	gatt = malloc(sizeof(struct agp_gatt), M_AGP, M_NOWAIT);
412 	if (!gatt) {
413  		agp_generic_detach(sc);
414  		return ENOMEM;
415 	}
416 	isc->gatt = gatt;
417 
418 	gatt->ag_entries = AGP_GET_APERTURE(sc) >> AGP_PAGE_SHIFT;
419 
420 	if (!pmf_device_register(self, NULL, agp_i810_resume))
421 		aprint_error_dev(self, "couldn't establish power handler\n");
422 
423 	/*
424 	 * XXX horrible hack to allow drm code to use our mapping
425 	 * of VGA chip registers
426 	 */
427 	agp_i810_vga_regbase = mmadr;
428 	agp_i810_vga_bsh = isc->bsh;
429 
430 	return agp_i810_init(sc);
431 }
432 
433 /*
434  * XXX horrible hack to allow drm code to use our mapping
435  * of VGA chip registers
436  */
437 int
438 agp_i810_borrow(bus_addr_t base, bus_space_handle_t *hdlp)
439 {
440 
441 	if (!agp_i810_vga_regbase || base != agp_i810_vga_regbase)
442 		return 0;
443 	*hdlp = agp_i810_vga_bsh;
444 	return 1;
445 }
446 
447 static int agp_i810_init(struct agp_softc *sc)
448 {
449 	struct agp_i810_softc *isc;
450 	struct agp_gatt *gatt;
451 
452 	isc = sc->as_chipc;
453 	gatt = isc->gatt;
454 
455 	if (isc->chiptype == CHIP_I810) {
456 		void *virtual;
457 		int dummyseg;
458 
459 		/* Some i810s have on-chip memory called dcache */
460 		if (READ1(AGP_I810_DRT) & AGP_I810_DRT_POPULATED)
461 			isc->dcache_size = 4 * 1024 * 1024;
462 		else
463 			isc->dcache_size = 0;
464 
465 		/* According to the specs the gatt on the i810 must be 64k */
466 		if (agp_alloc_dmamem(sc->as_dmat, 64 * 1024,
467 		    0, &gatt->ag_dmamap, &virtual, &gatt->ag_physical,
468 		    &gatt->ag_dmaseg, 1, &dummyseg) != 0) {
469 			free(gatt, M_AGP);
470 			agp_generic_detach(sc);
471 			return ENOMEM;
472 		}
473 		gatt->ag_virtual = (uint32_t *)virtual;
474 		gatt->ag_size = gatt->ag_entries * sizeof(u_int32_t);
475 		memset(gatt->ag_virtual, 0, gatt->ag_size);
476 
477 		agp_flush_cache();
478 		/* Install the GATT. */
479 		WRITE4(AGP_I810_PGTBL_CTL, gatt->ag_physical | 1);
480 	} else if (isc->chiptype == CHIP_I830) {
481 		/* The i830 automatically initializes the 128k gatt on boot. */
482 		pcireg_t reg;
483 		u_int32_t pgtblctl;
484 		u_int16_t gcc1;
485 
486 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I830_GCC0);
487 		gcc1 = (u_int16_t)(reg >> 16);
488 		switch (gcc1 & AGP_I830_GCC1_GMS) {
489 		case AGP_I830_GCC1_GMS_STOLEN_512:
490 			isc->stolen = (512 - 132) * 1024 / 4096;
491 			break;
492 		case AGP_I830_GCC1_GMS_STOLEN_1024:
493 			isc->stolen = (1024 - 132) * 1024 / 4096;
494 			break;
495 		case AGP_I830_GCC1_GMS_STOLEN_8192:
496 			isc->stolen = (8192 - 132) * 1024 / 4096;
497 			break;
498 		default:
499 			isc->stolen = 0;
500 			aprint_error(
501 			    ": unknown memory configuration, disabling\n");
502 			agp_generic_detach(sc);
503 			return EINVAL;
504 		}
505 
506 		if (isc->stolen > 0) {
507 			aprint_normal(": detected %dk stolen memory\n%s",
508 			    isc->stolen * 4, device_xname(sc->as_dev));
509 		}
510 
511 		/* GATT address is already in there, make sure it's enabled */
512 		pgtblctl = READ4(AGP_I810_PGTBL_CTL);
513 		pgtblctl |= 1;
514 		WRITE4(AGP_I810_PGTBL_CTL, pgtblctl);
515 
516 		gatt->ag_physical = pgtblctl & ~1;
517 	} else if (isc->chiptype == CHIP_I855 || isc->chiptype == CHIP_I915 ||
518 		   isc->chiptype == CHIP_I965 || isc->chiptype == CHIP_G33 ||
519 		   isc->chiptype == CHIP_G4X) {
520 		pcireg_t reg;
521 		u_int32_t pgtblctl, gtt_size, stolen;
522 		u_int16_t gcc1;
523 
524 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I855_GCC1);
525 		gcc1 = (u_int16_t)(reg >> 16);
526 
527 		pgtblctl = READ4(AGP_I810_PGTBL_CTL);
528 
529 		/* Stolen memory is set up at the beginning of the aperture by
530                  * the BIOS, consisting of the GATT followed by 4kb for the
531 		 * BIOS display.
532                  */
533                 switch (isc->chiptype) {
534 		case CHIP_I855:
535 			gtt_size = 128;
536 			break;
537                 case CHIP_I915:
538 			gtt_size = 256;
539 			break;
540 		case CHIP_I965:
541 			switch (pgtblctl & AGP_I810_PGTBL_SIZE_MASK) {
542 			case AGP_I810_PGTBL_SIZE_128KB:
543 			case AGP_I810_PGTBL_SIZE_512KB:
544 				gtt_size = 512;
545 				break;
546 			case AGP_I965_PGTBL_SIZE_1MB:
547 				gtt_size = 1024;
548 				break;
549 			case AGP_I965_PGTBL_SIZE_2MB:
550 				gtt_size = 2048;
551 				break;
552 			case AGP_I965_PGTBL_SIZE_1_5MB:
553 				gtt_size = 1024 + 512;
554 				break;
555 			default:
556 				aprint_error("Bad PGTBL size\n");
557 				agp_generic_detach(sc);
558 				return EINVAL;
559 			}
560 			break;
561 		case CHIP_G33:
562 			switch (gcc1 & AGP_G33_PGTBL_SIZE_MASK) {
563 			case AGP_G33_PGTBL_SIZE_1M:
564 				gtt_size = 1024;
565 				break;
566 			case AGP_G33_PGTBL_SIZE_2M:
567 				gtt_size = 2048;
568 				break;
569 			default:
570 				aprint_error(": Bad PGTBL size\n");
571 				agp_generic_detach(sc);
572 				return EINVAL;
573 			}
574 			break;
575 		case CHIP_G4X:
576 			gtt_size = 0;
577 			break;
578 		default:
579 			aprint_error(": bad chiptype\n");
580 			agp_generic_detach(sc);
581 			return EINVAL;
582 		}
583 
584 		switch (gcc1 & AGP_I855_GCC1_GMS) {
585 		case AGP_I855_GCC1_GMS_STOLEN_1M:
586 			stolen = 1024;
587 			break;
588 		case AGP_I855_GCC1_GMS_STOLEN_4M:
589 			stolen = 4 * 1024;
590 			break;
591 		case AGP_I855_GCC1_GMS_STOLEN_8M:
592 			stolen = 8 * 1024;
593 			break;
594 		case AGP_I855_GCC1_GMS_STOLEN_16M:
595 			stolen = 16 * 1024;
596 			break;
597 		case AGP_I855_GCC1_GMS_STOLEN_32M:
598 			stolen = 32 * 1024;
599 			break;
600 		case AGP_I915_GCC1_GMS_STOLEN_48M:
601 			stolen = 48 * 1024;
602 			break;
603 		case AGP_I915_GCC1_GMS_STOLEN_64M:
604 			stolen = 64 * 1024;
605 			break;
606 		case AGP_G33_GCC1_GMS_STOLEN_128M:
607 			stolen = 128 * 1024;
608 			break;
609 		case AGP_G33_GCC1_GMS_STOLEN_256M:
610 			stolen = 256 * 1024;
611 			break;
612 		case AGP_G4X_GCC1_GMS_STOLEN_96M:
613 			stolen = 96 * 1024;
614 			break;
615 		case AGP_G4X_GCC1_GMS_STOLEN_160M:
616 			stolen = 160 * 1024;
617 			break;
618 		case AGP_G4X_GCC1_GMS_STOLEN_224M:
619 			stolen = 224 * 1024;
620 			break;
621 		case AGP_G4X_GCC1_GMS_STOLEN_352M:
622 			stolen = 352 * 1024;
623 			break;
624 		default:
625 			aprint_error(
626 			    ": unknown memory configuration, disabling\n");
627 			agp_generic_detach(sc);
628 			return EINVAL;
629 		}
630 
631 		switch (gcc1 & AGP_I855_GCC1_GMS) {
632 		case AGP_I915_GCC1_GMS_STOLEN_48M:
633 		case AGP_I915_GCC1_GMS_STOLEN_64M:
634 			if (isc->chiptype != CHIP_I915 &&
635 			    isc->chiptype != CHIP_I965 &&
636 			    isc->chiptype != CHIP_G33 &&
637 			    isc->chiptype != CHIP_G4X)
638 				stolen = 0;
639 			break;
640 		case AGP_G33_GCC1_GMS_STOLEN_128M:
641 		case AGP_G33_GCC1_GMS_STOLEN_256M:
642 			if (isc->chiptype != CHIP_I965 &&
643 			    isc->chiptype != CHIP_G33 &&
644 			    isc->chiptype != CHIP_G4X)
645 				stolen = 0;
646 			break;
647 		case AGP_G4X_GCC1_GMS_STOLEN_96M:
648 		case AGP_G4X_GCC1_GMS_STOLEN_160M:
649 		case AGP_G4X_GCC1_GMS_STOLEN_224M:
650 		case AGP_G4X_GCC1_GMS_STOLEN_352M:
651 			if (isc->chiptype != CHIP_I965 &&
652 			    isc->chiptype != CHIP_G4X)
653 				stolen = 0;
654 			break;
655 		}
656 
657 		/* BIOS space */
658 		gtt_size += 4;
659 
660 		isc->stolen = (stolen - gtt_size) * 1024 / 4096;
661 
662 		if (isc->stolen > 0) {
663 			aprint_normal(": detected %dk stolen memory\n%s",
664 			    isc->stolen * 4, device_xname(sc->as_dev));
665 		}
666 
667 		/* GATT address is already in there, make sure it's enabled */
668 		pgtblctl |= 1;
669 		WRITE4(AGP_I810_PGTBL_CTL, pgtblctl);
670 
671 		gatt->ag_physical = pgtblctl & ~1;
672 	}
673 
674 	/*
675 	 * Make sure the chipset can see everything.
676 	 */
677 	agp_flush_cache();
678 
679 	return 0;
680 }
681 
682 #if 0
683 static int
684 agp_i810_detach(struct agp_softc *sc)
685 {
686 	int error;
687 	struct agp_i810_softc *isc = sc->as_chipc;
688 
689 	error = agp_generic_detach(sc);
690 	if (error)
691 		return error;
692 
693 	/* Clear the GATT base. */
694 	if (sc->chiptype == CHIP_I810) {
695 		WRITE4(AGP_I810_PGTBL_CTL, 0);
696 	} else {
697 		unsigned int pgtblctl;
698 		pgtblctl = READ4(AGP_I810_PGTBL_CTL);
699 		pgtblctl &= ~1;
700 		WRITE4(AGP_I810_PGTBL_CTL, pgtblctl);
701 	}
702 
703 	/* Put the aperture back the way it started. */
704 	AGP_SET_APERTURE(sc, isc->initial_aperture);
705 
706 	if (sc->chiptype == CHIP_I810) {
707 		agp_free_dmamem(sc->as_dmat, gatt->ag_size, gatt->ag_dmamap,
708 		    (void *)gatt->ag_virtual, &gatt->ag_dmaseg, 1);
709 	}
710 	free(sc->gatt, M_AGP);
711 
712 	return 0;
713 }
714 #endif
715 
716 static u_int32_t
717 agp_i810_get_aperture(struct agp_softc *sc)
718 {
719 	struct agp_i810_softc *isc = sc->as_chipc;
720 	pcireg_t reg;
721 	u_int32_t size;
722 	u_int16_t miscc, gcc1, msac;
723 
724 	size = 0;
725 
726 	switch (isc->chiptype) {
727 	case CHIP_I810:
728 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I810_SMRAM);
729 		miscc = (u_int16_t)(reg >> 16);
730 		if ((miscc & AGP_I810_MISCC_WINSIZE) ==
731 		    AGP_I810_MISCC_WINSIZE_32)
732 			size = 32 * 1024 * 1024;
733 		else
734 			size = 64 * 1024 * 1024;
735 		break;
736 	case CHIP_I830:
737 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I830_GCC0);
738 		gcc1 = (u_int16_t)(reg >> 16);
739 		if ((gcc1 & AGP_I830_GCC1_GMASIZE) == AGP_I830_GCC1_GMASIZE_64)
740 			size = 64 * 1024 * 1024;
741 		else
742 			size = 128 * 1024 * 1024;
743 		break;
744 	case CHIP_I855:
745 		size = 128 * 1024 * 1024;
746 		break;
747 	case CHIP_I915:
748 	case CHIP_G33:
749 	case CHIP_G4X:
750 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I915_MSAC);
751 		msac = (u_int16_t)(reg >> 16);
752 		if (msac & AGP_I915_MSAC_APER_128M)
753 			size = 128 * 1024 * 1024;
754 		else
755 			size = 256 * 1024 * 1024;
756 		break;
757 	case CHIP_I965:
758 		size = 512 * 1024 * 1024;
759 		break;
760 	default:
761 		aprint_error(": Unknown chipset\n");
762 	}
763 
764 	return size;
765 }
766 
767 static int
768 agp_i810_set_aperture(struct agp_softc *sc, u_int32_t aperture)
769 {
770 	struct agp_i810_softc *isc = sc->as_chipc;
771 	pcireg_t reg;
772 	u_int16_t miscc, gcc1;
773 
774 	switch (isc->chiptype) {
775 	case CHIP_I810:
776 		/*
777 		 * Double check for sanity.
778 		 */
779 		if (aperture != (32 * 1024 * 1024) &&
780 		    aperture != (64 * 1024 * 1024)) {
781 			aprint_error_dev(sc->as_dev, "bad aperture size %d\n",
782 			    aperture);
783 			return EINVAL;
784 		}
785 
786 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I810_SMRAM);
787 		miscc = (u_int16_t)(reg >> 16);
788 		miscc &= ~AGP_I810_MISCC_WINSIZE;
789 		if (aperture == 32 * 1024 * 1024)
790 			miscc |= AGP_I810_MISCC_WINSIZE_32;
791 		else
792 			miscc |= AGP_I810_MISCC_WINSIZE_64;
793 
794 		reg &= 0x0000ffff;
795 		reg |= ((pcireg_t)miscc) << 16;
796 		pci_conf_write(sc->as_pc, sc->as_tag, AGP_I810_SMRAM, reg);
797 		break;
798 	case CHIP_I830:
799 		if (aperture != (64 * 1024 * 1024) &&
800 		    aperture != (128 * 1024 * 1024)) {
801 			aprint_error_dev(sc->as_dev, "bad aperture size %d\n",
802 			    aperture);
803 			return EINVAL;
804 		}
805 		reg = pci_conf_read(sc->as_pc, sc->as_tag, AGP_I830_GCC0);
806 		gcc1 = (u_int16_t)(reg >> 16);
807 		gcc1 &= ~AGP_I830_GCC1_GMASIZE;
808 		if (aperture == 64 * 1024 * 1024)
809 			gcc1 |= AGP_I830_GCC1_GMASIZE_64;
810 		else
811 			gcc1 |= AGP_I830_GCC1_GMASIZE_128;
812 
813 		reg &= 0x0000ffff;
814 		reg |= ((pcireg_t)gcc1) << 16;
815 		pci_conf_write(sc->as_pc, sc->as_tag, AGP_I830_GCC0, reg);
816 		break;
817 	case CHIP_I855:
818 	case CHIP_I915:
819 		if (aperture != agp_i810_get_aperture(sc)) {
820 			aprint_error_dev(sc->as_dev, "bad aperture size %d\n",
821 			    aperture);
822 			return EINVAL;
823 		}
824 		break;
825 	case CHIP_I965:
826 		if (aperture != 512 * 1024 * 1024) {
827 			aprint_error_dev(sc->as_dev, "bad aperture size %d\n",
828 			    aperture);
829 			return EINVAL;
830 		}
831 		break;
832 	}
833 
834 	return 0;
835 }
836 
837 static int
838 agp_i810_bind_page(struct agp_softc *sc, off_t offset, bus_addr_t physical)
839 {
840 	struct agp_i810_softc *isc = sc->as_chipc;
841 
842 	if (offset < 0 || offset >= (isc->gatt->ag_entries << AGP_PAGE_SHIFT)) {
843 #ifdef AGP_DEBUG
844 		printf("%s: failed: offset 0x%08x, shift %d, entries %d\n",
845 		    device_xname(sc->as_dev), (int)offset, AGP_PAGE_SHIFT,
846 		    isc->gatt->ag_entries);
847 #endif
848 		return EINVAL;
849 	}
850 
851 	if (isc->chiptype != CHIP_I810) {
852 		if ((offset >> AGP_PAGE_SHIFT) < isc->stolen) {
853 #ifdef AGP_DEBUG
854 			printf("%s: trying to bind into stolen memory\n",
855 			    device_xname(sc->as_dev));
856 #endif
857 			return EINVAL;
858 		}
859 	}
860 
861 	return agp_i810_write_gtt_entry(isc, offset, physical | 1);
862 }
863 
864 static int
865 agp_i810_unbind_page(struct agp_softc *sc, off_t offset)
866 {
867 	struct agp_i810_softc *isc = sc->as_chipc;
868 
869 	if (offset < 0 || offset >= (isc->gatt->ag_entries << AGP_PAGE_SHIFT))
870 		return EINVAL;
871 
872 	if (isc->chiptype != CHIP_I810 ) {
873 		if ((offset >> AGP_PAGE_SHIFT) < isc->stolen) {
874 #ifdef AGP_DEBUG
875 			printf("%s: trying to unbind from stolen memory\n",
876 			    device_xname(sc->as_dev));
877 #endif
878 			return EINVAL;
879 		}
880 	}
881 
882 	return agp_i810_write_gtt_entry(isc, offset, 0);
883 }
884 
885 /*
886  * Writing via memory mapped registers already flushes all TLBs.
887  */
888 static void
889 agp_i810_flush_tlb(struct agp_softc *sc)
890 {
891 }
892 
893 static int
894 agp_i810_enable(struct agp_softc *sc, u_int32_t mode)
895 {
896 
897 	return 0;
898 }
899 
900 static struct agp_memory *
901 agp_i810_alloc_memory(struct agp_softc *sc, int type, vsize_t size)
902 {
903 	struct agp_i810_softc *isc = sc->as_chipc;
904 	struct agp_memory *mem;
905 
906 #ifdef AGP_DEBUG
907 	printf("AGP: alloc(%d, 0x%x)\n", type, (int) size);
908 #endif
909 
910 	if ((size & (AGP_PAGE_SIZE - 1)) != 0)
911 		return 0;
912 
913 	if (sc->as_allocated + size > sc->as_maxmem)
914 		return 0;
915 
916 	if (type == 1) {
917 		/*
918 		 * Mapping local DRAM into GATT.
919 		 */
920 		if (isc->chiptype != CHIP_I810 )
921 			return 0;
922 		if (size != isc->dcache_size)
923 			return 0;
924 	} else if (type == 2) {
925 		/*
926 		 * Bogus mapping for the hardware cursor.
927 		 */
928 		if (size != AGP_PAGE_SIZE && size != 4 * AGP_PAGE_SIZE)
929 			return 0;
930 	}
931 
932 	mem = malloc(sizeof *mem, M_AGP, M_WAITOK|M_ZERO);
933 	if (mem == NULL)
934 		return NULL;
935 	mem->am_id = sc->as_nextid++;
936 	mem->am_size = size;
937 	mem->am_type = type;
938 
939 	if (type == 2) {
940 		/*
941 		 * Allocate and wire down the memory now so that we can
942 		 * get its physical address.
943 		 */
944 		mem->am_dmaseg = malloc(sizeof *mem->am_dmaseg, M_AGP,
945 		    M_WAITOK);
946 		if (mem->am_dmaseg == NULL) {
947 			free(mem, M_AGP);
948 			return NULL;
949 		}
950 		if (agp_alloc_dmamem(sc->as_dmat, size, 0,
951 		    &mem->am_dmamap, &mem->am_virtual, &mem->am_physical,
952 		    mem->am_dmaseg, 1, &mem->am_nseg) != 0) {
953 			free(mem->am_dmaseg, M_AGP);
954 			free(mem, M_AGP);
955 			return NULL;
956 		}
957 		memset(mem->am_virtual, 0, size);
958 	} else if (type != 1) {
959 		if (bus_dmamap_create(sc->as_dmat, size, size / PAGE_SIZE + 1,
960 				      size, 0, BUS_DMA_NOWAIT,
961 				      &mem->am_dmamap) != 0) {
962 			free(mem, M_AGP);
963 			return NULL;
964 		}
965 	}
966 
967 	TAILQ_INSERT_TAIL(&sc->as_memory, mem, am_link);
968 	sc->as_allocated += size;
969 
970 	return mem;
971 }
972 
973 static int
974 agp_i810_free_memory(struct agp_softc *sc, struct agp_memory *mem)
975 {
976 	if (mem->am_is_bound)
977 		return EBUSY;
978 
979 	if (mem->am_type == 2) {
980 		agp_free_dmamem(sc->as_dmat, mem->am_size, mem->am_dmamap,
981 		    mem->am_virtual, mem->am_dmaseg, mem->am_nseg);
982 		free(mem->am_dmaseg, M_AGP);
983 	}
984 
985 	sc->as_allocated -= mem->am_size;
986 	TAILQ_REMOVE(&sc->as_memory, mem, am_link);
987 	free(mem, M_AGP);
988 	return 0;
989 }
990 
991 static int
992 agp_i810_bind_memory(struct agp_softc *sc, struct agp_memory *mem,
993 		     off_t offset)
994 {
995 	struct agp_i810_softc *isc = sc->as_chipc;
996 	u_int32_t regval, i;
997 
998 	if (mem->am_is_bound != 0)
999 		return EINVAL;
1000 
1001 	/*
1002 	 * XXX evil hack: the PGTBL_CTL appearently gets overwritten by the
1003 	 * X server for mysterious reasons which leads to crashes if we write
1004 	 * to the GTT through the MMIO window.
1005 	 * Until the issue is solved, simply restore it.
1006 	 */
1007 	regval = bus_space_read_4(isc->bst, isc->bsh, AGP_I810_PGTBL_CTL);
1008 	if (regval != (isc->gatt->ag_physical | 1)) {
1009 		printf("agp_i810_bind_memory: PGTBL_CTL is 0x%x - fixing\n",
1010 		       regval);
1011 		bus_space_write_4(isc->bst, isc->bsh, AGP_I810_PGTBL_CTL,
1012 				  isc->gatt->ag_physical | 1);
1013 	}
1014 
1015 	if (mem->am_type == 2) {
1016 		for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE)
1017 			agp_i810_bind_page(sc, offset + i,
1018 			    mem->am_physical + i);
1019 		mem->am_offset = offset;
1020 		mem->am_is_bound = 1;
1021 		return 0;
1022 	}
1023 
1024 	if (mem->am_type != 1)
1025 		return agp_generic_bind_memory(sc, mem, offset);
1026 
1027 	if (isc->chiptype != CHIP_I810)
1028 		return EINVAL;
1029 
1030 	for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE)
1031 		agp_i810_write_gtt_entry(isc, i, i | 3);
1032 	mem->am_is_bound = 1;
1033 	return 0;
1034 }
1035 
1036 static int
1037 agp_i810_unbind_memory(struct agp_softc *sc, struct agp_memory *mem)
1038 {
1039 	struct agp_i810_softc *isc = sc->as_chipc;
1040 	u_int32_t i;
1041 
1042 	if (mem->am_is_bound == 0)
1043 		return EINVAL;
1044 
1045 	if (mem->am_type == 2) {
1046 		for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE)
1047 			agp_i810_unbind_page(sc, mem->am_offset + i);
1048 		mem->am_offset = 0;
1049 		mem->am_is_bound = 0;
1050 		return 0;
1051 	}
1052 
1053 	if (mem->am_type != 1)
1054 		return agp_generic_unbind_memory(sc, mem);
1055 
1056 	if (isc->chiptype != CHIP_I810)
1057 		return EINVAL;
1058 
1059 	for (i = 0; i < mem->am_size; i += AGP_PAGE_SIZE)
1060 		agp_i810_write_gtt_entry(isc, i, 0);
1061 	mem->am_is_bound = 0;
1062 	return 0;
1063 }
1064 
1065 static bool
1066 agp_i810_resume(device_t dv, const pmf_qual_t *qual)
1067 {
1068 	struct agp_softc *sc = device_private(dv);
1069 	struct agp_i810_softc *isc = sc->as_chipc;
1070 
1071 	isc->pgtblctl = READ4(AGP_I810_PGTBL_CTL);
1072 	agp_flush_cache();
1073 
1074 	return true;
1075 }
1076