2 * ATi AGPGART routines.
5 #include <linux/types.h>
6 #include <linux/module.h>
8 #include <linux/init.h>
9 #include <linux/string.h>
10 #include <linux/slab.h>
11 #include <linux/agp_backend.h>
15 #define ATI_GART_MMBASE_ADDR 0x14
16 #define ATI_RS100_APSIZE 0xac
17 #define ATI_RS100_IG_AGPMODE 0xb0
18 #define ATI_RS300_APSIZE 0xf8
19 #define ATI_RS300_IG_AGPMODE 0xfc
20 #define ATI_GART_FEATURE_ID 0x00
21 #define ATI_GART_BASE 0x04
22 #define ATI_GART_CACHE_SZBASE 0x08
23 #define ATI_GART_CACHE_CNTRL 0x0c
24 #define ATI_GART_CACHE_ENTRY_CNTRL 0x10
27 static struct aper_size_info_lvl2 ati_generic_sizes
[7] =
29 {2048, 524288, 0x0000000c},
30 {1024, 262144, 0x0000000a},
31 {512, 131072, 0x00000008},
32 {256, 65536, 0x00000006},
33 {128, 32768, 0x00000004},
34 {64, 16384, 0x00000002},
35 {32, 8192, 0x00000000}
38 static struct gatt_mask ati_generic_masks
[] =
40 { .mask
= 1, .type
= 0}
44 typedef struct _ati_page_map
{
46 unsigned long __iomem
*remapped
;
49 static struct _ati_generic_private
{
50 volatile u8 __iomem
*registers
;
51 ati_page_map
**gatt_pages
;
53 } ati_generic_private
;
55 static int ati_create_page_map(ati_page_map
*page_map
)
59 page_map
->real
= (unsigned long *) __get_free_page(GFP_KERNEL
);
60 if (page_map
->real
== NULL
)
63 SetPageReserved(virt_to_page(page_map
->real
));
64 err
= map_page_into_agp(virt_to_page(page_map
->real
));
65 page_map
->remapped
= ioremap_nocache(virt_to_gart(page_map
->real
),
67 if (page_map
->remapped
== NULL
|| err
) {
68 ClearPageReserved(virt_to_page(page_map
->real
));
69 free_page((unsigned long) page_map
->real
);
70 page_map
->real
= NULL
;
76 for (i
= 0; i
< PAGE_SIZE
/ sizeof(unsigned long); i
++) {
77 writel(agp_bridge
->scratch_page
, page_map
->remapped
+i
);
78 readl(page_map
->remapped
+i
); /* PCI Posting. */
85 static void ati_free_page_map(ati_page_map
*page_map
)
87 unmap_page_from_agp(virt_to_page(page_map
->real
));
88 iounmap(page_map
->remapped
);
89 ClearPageReserved(virt_to_page(page_map
->real
));
90 free_page((unsigned long) page_map
->real
);
94 static void ati_free_gatt_pages(void)
97 ati_page_map
**tables
;
100 tables
= ati_generic_private
.gatt_pages
;
101 for (i
= 0; i
< ati_generic_private
.num_tables
; i
++) {
104 if (entry
->real
!= NULL
)
105 ati_free_page_map(entry
);
113 static int ati_create_gatt_pages(int nr_tables
)
115 ati_page_map
**tables
;
120 tables
= kzalloc((nr_tables
+ 1) * sizeof(ati_page_map
*),GFP_KERNEL
);
124 for (i
= 0; i
< nr_tables
; i
++) {
125 entry
= kzalloc(sizeof(ati_page_map
), GFP_KERNEL
);
137 retval
= ati_create_page_map(entry
);
138 if (retval
!= 0) break;
140 ati_generic_private
.num_tables
= nr_tables
;
141 ati_generic_private
.gatt_pages
= tables
;
144 ati_free_gatt_pages();
149 static int is_r200(void)
151 if ((agp_bridge
->dev
->device
== PCI_DEVICE_ID_ATI_RS100
) ||
152 (agp_bridge
->dev
->device
== PCI_DEVICE_ID_ATI_RS200
) ||
153 (agp_bridge
->dev
->device
== PCI_DEVICE_ID_ATI_RS200_B
) ||
154 (agp_bridge
->dev
->device
== PCI_DEVICE_ID_ATI_RS250
))
159 static int ati_fetch_size(void)
163 struct aper_size_info_lvl2
*values
;
166 pci_read_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, &temp
);
168 pci_read_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, &temp
);
170 temp
= (temp
& 0x0000000e);
171 values
= A_SIZE_LVL2(agp_bridge
->driver
->aperture_sizes
);
172 for (i
= 0; i
< agp_bridge
->driver
->num_aperture_sizes
; i
++) {
173 if (temp
== values
[i
].size_value
) {
174 agp_bridge
->previous_size
=
175 agp_bridge
->current_size
= (void *) (values
+ i
);
177 agp_bridge
->aperture_size_idx
= i
;
178 return values
[i
].size
;
185 static void ati_tlbflush(struct agp_memory
* mem
)
187 writel(1, ati_generic_private
.registers
+ATI_GART_CACHE_CNTRL
);
188 readl(ati_generic_private
.registers
+ATI_GART_CACHE_CNTRL
); /* PCI Posting. */
191 static void ati_cleanup(void)
193 struct aper_size_info_lvl2
*previous_size
;
196 previous_size
= A_SIZE_LVL2(agp_bridge
->previous_size
);
198 /* Write back the previous size and disable gart translation */
200 pci_read_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, &temp
);
201 temp
= ((temp
& ~(0x0000000f)) | previous_size
->size_value
);
202 pci_write_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, temp
);
204 pci_read_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, &temp
);
205 temp
= ((temp
& ~(0x0000000f)) | previous_size
->size_value
);
206 pci_write_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, temp
);
208 iounmap((volatile u8 __iomem
*)ati_generic_private
.registers
);
212 static int ati_configure(void)
216 /* Get the memory mapped registers */
217 pci_read_config_dword(agp_bridge
->dev
, ATI_GART_MMBASE_ADDR
, &temp
);
218 temp
= (temp
& 0xfffff000);
219 ati_generic_private
.registers
= (volatile u8 __iomem
*) ioremap(temp
, 4096);
222 pci_write_config_dword(agp_bridge
->dev
, ATI_RS100_IG_AGPMODE
, 0x20000);
224 pci_write_config_dword(agp_bridge
->dev
, ATI_RS300_IG_AGPMODE
, 0x20000);
226 /* address to map too */
228 pci_read_config_dword(agp_bridge.dev, AGP_APBASE, &temp);
229 agp_bridge.gart_bus_addr = (temp & PCI_BASE_ADDRESS_MEM_MASK);
230 printk(KERN_INFO PFX "IGP320 gart_bus_addr: %x\n", agp_bridge.gart_bus_addr);
232 writel(0x60000, ati_generic_private
.registers
+ATI_GART_FEATURE_ID
);
233 readl(ati_generic_private
.registers
+ATI_GART_FEATURE_ID
); /* PCI Posting.*/
235 /* SIGNALED_SYSTEM_ERROR @ NB_STATUS */
236 pci_read_config_dword(agp_bridge
->dev
, 4, &temp
);
237 pci_write_config_dword(agp_bridge
->dev
, 4, temp
| (1<<14));
239 /* Write out the address of the gatt table */
240 writel(agp_bridge
->gatt_bus_addr
, ati_generic_private
.registers
+ATI_GART_BASE
);
241 readl(ati_generic_private
.registers
+ATI_GART_BASE
); /* PCI Posting. */
248 static int agp_ati_suspend(struct pci_dev
*dev
, pm_message_t state
)
251 pci_set_power_state(dev
, 3);
256 static int agp_ati_resume(struct pci_dev
*dev
)
258 pci_set_power_state(dev
, 0);
259 pci_restore_state(dev
);
261 return ati_configure();
266 *Since we don't need contiguous memory we just try
267 * to get the gatt table once
270 #define GET_PAGE_DIR_OFF(addr) (addr >> 22)
271 #define GET_PAGE_DIR_IDX(addr) (GET_PAGE_DIR_OFF(addr) - \
272 GET_PAGE_DIR_OFF(agp_bridge->gart_bus_addr))
273 #define GET_GATT_OFF(addr) ((addr & 0x003ff000) >> 12)
275 #define GET_GATT(addr) (ati_generic_private.gatt_pages[\
276 GET_PAGE_DIR_IDX(addr)]->remapped)
278 static int ati_insert_memory(struct agp_memory
* mem
,
279 off_t pg_start
, int type
)
281 int i
, j
, num_entries
;
282 unsigned long __iomem
*cur_gatt
;
285 num_entries
= A_SIZE_LVL2(agp_bridge
->current_size
)->num_entries
;
287 if (type
!= 0 || mem
->type
!= 0)
290 if ((pg_start
+ mem
->page_count
) > num_entries
)
294 while (j
< (pg_start
+ mem
->page_count
)) {
295 addr
= (j
* PAGE_SIZE
) + agp_bridge
->gart_bus_addr
;
296 cur_gatt
= GET_GATT(addr
);
297 if (!PGE_EMPTY(agp_bridge
,readl(cur_gatt
+GET_GATT_OFF(addr
))))
302 if (mem
->is_flushed
== FALSE
) {
304 global_cache_flush();
305 mem
->is_flushed
= TRUE
;
308 for (i
= 0, j
= pg_start
; i
< mem
->page_count
; i
++, j
++) {
309 addr
= (j
* PAGE_SIZE
) + agp_bridge
->gart_bus_addr
;
310 cur_gatt
= GET_GATT(addr
);
311 writel(agp_bridge
->driver
->mask_memory(agp_bridge
,
312 mem
->memory
[i
], mem
->type
), cur_gatt
+GET_GATT_OFF(addr
));
313 readl(cur_gatt
+GET_GATT_OFF(addr
)); /* PCI Posting. */
315 agp_bridge
->driver
->tlb_flush(mem
);
319 static int ati_remove_memory(struct agp_memory
* mem
, off_t pg_start
,
323 unsigned long __iomem
*cur_gatt
;
326 if (type
!= 0 || mem
->type
!= 0)
329 for (i
= pg_start
; i
< (mem
->page_count
+ pg_start
); i
++) {
330 addr
= (i
* PAGE_SIZE
) + agp_bridge
->gart_bus_addr
;
331 cur_gatt
= GET_GATT(addr
);
332 writel(agp_bridge
->scratch_page
, cur_gatt
+GET_GATT_OFF(addr
));
333 readl(cur_gatt
+GET_GATT_OFF(addr
)); /* PCI Posting. */
336 agp_bridge
->driver
->tlb_flush(mem
);
340 static int ati_create_gatt_table(struct agp_bridge_data
*bridge
)
342 struct aper_size_info_lvl2
*value
;
343 ati_page_map page_dir
;
348 struct aper_size_info_lvl2
*current_size
;
350 value
= A_SIZE_LVL2(agp_bridge
->current_size
);
351 retval
= ati_create_page_map(&page_dir
);
355 retval
= ati_create_gatt_pages(value
->num_entries
/ 1024);
357 ati_free_page_map(&page_dir
);
361 agp_bridge
->gatt_table_real
= (u32
*)page_dir
.real
;
362 agp_bridge
->gatt_table
= (u32 __iomem
*) page_dir
.remapped
;
363 agp_bridge
->gatt_bus_addr
= virt_to_gart(page_dir
.real
);
365 /* Write out the size register */
366 current_size
= A_SIZE_LVL2(agp_bridge
->current_size
);
369 pci_read_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, &temp
);
370 temp
= (((temp
& ~(0x0000000e)) | current_size
->size_value
)
372 pci_write_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, temp
);
373 pci_read_config_dword(agp_bridge
->dev
, ATI_RS100_APSIZE
, &temp
);
375 pci_read_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, &temp
);
376 temp
= (((temp
& ~(0x0000000e)) | current_size
->size_value
)
378 pci_write_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, temp
);
379 pci_read_config_dword(agp_bridge
->dev
, ATI_RS300_APSIZE
, &temp
);
383 * Get the address for the gart region.
384 * This is a bus address even on the alpha, b/c its
385 * used to program the agp master not the cpu
387 pci_read_config_dword(agp_bridge
->dev
, AGP_APBASE
, &temp
);
388 addr
= (temp
& PCI_BASE_ADDRESS_MEM_MASK
);
389 agp_bridge
->gart_bus_addr
= addr
;
391 /* Calculate the agp offset */
392 for (i
= 0; i
< value
->num_entries
/ 1024; i
++, addr
+= 0x00400000) {
393 writel(virt_to_gart(ati_generic_private
.gatt_pages
[i
]->real
) | 1,
394 page_dir
.remapped
+GET_PAGE_DIR_OFF(addr
));
395 readl(page_dir
.remapped
+GET_PAGE_DIR_OFF(addr
)); /* PCI Posting. */
401 static int ati_free_gatt_table(struct agp_bridge_data
*bridge
)
403 ati_page_map page_dir
;
405 page_dir
.real
= (unsigned long *)agp_bridge
->gatt_table_real
;
406 page_dir
.remapped
= (unsigned long __iomem
*)agp_bridge
->gatt_table
;
408 ati_free_gatt_pages();
409 ati_free_page_map(&page_dir
);
413 static struct agp_bridge_driver ati_generic_bridge
= {
414 .owner
= THIS_MODULE
,
415 .aperture_sizes
= ati_generic_sizes
,
416 .size_type
= LVL2_APER_SIZE
,
417 .num_aperture_sizes
= 7,
418 .configure
= ati_configure
,
419 .fetch_size
= ati_fetch_size
,
420 .cleanup
= ati_cleanup
,
421 .tlb_flush
= ati_tlbflush
,
422 .mask_memory
= agp_generic_mask_memory
,
423 .masks
= ati_generic_masks
,
424 .agp_enable
= agp_generic_enable
,
425 .cache_flush
= global_cache_flush
,
426 .create_gatt_table
= ati_create_gatt_table
,
427 .free_gatt_table
= ati_free_gatt_table
,
428 .insert_memory
= ati_insert_memory
,
429 .remove_memory
= ati_remove_memory
,
430 .alloc_by_type
= agp_generic_alloc_by_type
,
431 .free_by_type
= agp_generic_free_by_type
,
432 .agp_alloc_page
= agp_generic_alloc_page
,
433 .agp_destroy_page
= agp_generic_destroy_page
,
437 static struct agp_device_ids ati_agp_device_ids
[] __devinitdata
=
440 .device_id
= PCI_DEVICE_ID_ATI_RS100
,
441 .chipset_name
= "IGP320/M",
444 .device_id
= PCI_DEVICE_ID_ATI_RS200
,
445 .chipset_name
= "IGP330/340/345/350/M",
448 .device_id
= PCI_DEVICE_ID_ATI_RS200_B
,
449 .chipset_name
= "IGP345M",
452 .device_id
= PCI_DEVICE_ID_ATI_RS250
,
453 .chipset_name
= "IGP7000/M",
456 .device_id
= PCI_DEVICE_ID_ATI_RS300_100
,
457 .chipset_name
= "IGP9100/M",
460 .device_id
= PCI_DEVICE_ID_ATI_RS300_133
,
461 .chipset_name
= "IGP9100/M",
464 .device_id
= PCI_DEVICE_ID_ATI_RS300_166
,
465 .chipset_name
= "IGP9100/M",
468 .device_id
= PCI_DEVICE_ID_ATI_RS300_200
,
469 .chipset_name
= "IGP9100/M",
472 .device_id
= PCI_DEVICE_ID_ATI_RS350_200
,
473 .chipset_name
= "IGP9100/M",
475 { }, /* dummy final entry, always present */
478 static int __devinit
agp_ati_probe(struct pci_dev
*pdev
,
479 const struct pci_device_id
*ent
)
481 struct agp_device_ids
*devs
= ati_agp_device_ids
;
482 struct agp_bridge_data
*bridge
;
486 cap_ptr
= pci_find_capability(pdev
, PCI_CAP_ID_AGP
);
490 /* probe for known chipsets */
491 for (j
= 0; devs
[j
].chipset_name
; j
++) {
492 if (pdev
->device
== devs
[j
].device_id
)
497 "Unsupported Ati chipset (device id: %04x)\n", pdev
->device
);
501 bridge
= agp_alloc_bridge();
506 bridge
->capndx
= cap_ptr
;
508 bridge
->driver
= &ati_generic_bridge
;
510 printk(KERN_INFO PFX
"Detected Ati %s chipset\n",
511 devs
[j
].chipset_name
);
513 /* Fill in the mode register */
514 pci_read_config_dword(pdev
,
515 bridge
->capndx
+PCI_AGP_STATUS
,
518 pci_set_drvdata(pdev
, bridge
);
519 return agp_add_bridge(bridge
);
522 static void __devexit
agp_ati_remove(struct pci_dev
*pdev
)
524 struct agp_bridge_data
*bridge
= pci_get_drvdata(pdev
);
526 agp_remove_bridge(bridge
);
527 agp_put_bridge(bridge
);
530 static struct pci_device_id agp_ati_pci_table
[] = {
532 .class = (PCI_CLASS_BRIDGE_HOST
<< 8),
534 .vendor
= PCI_VENDOR_ID_ATI
,
535 .device
= PCI_ANY_ID
,
536 .subvendor
= PCI_ANY_ID
,
537 .subdevice
= PCI_ANY_ID
,
542 MODULE_DEVICE_TABLE(pci
, agp_ati_pci_table
);
544 static struct pci_driver agp_ati_pci_driver
= {
545 .name
= "agpgart-ati",
546 .id_table
= agp_ati_pci_table
,
547 .probe
= agp_ati_probe
,
548 .remove
= agp_ati_remove
,
550 .suspend
= agp_ati_suspend
,
551 .resume
= agp_ati_resume
,
555 static int __init
agp_ati_init(void)
559 return pci_register_driver(&agp_ati_pci_driver
);
562 static void __exit
agp_ati_cleanup(void)
564 pci_unregister_driver(&agp_ati_pci_driver
);
567 module_init(agp_ati_init
);
568 module_exit(agp_ati_cleanup
);
570 MODULE_AUTHOR("Dave Jones <davej@codemonkey.org.uk>");
571 MODULE_LICENSE("GPL and additional rights");