1 #include <linux/module.h>
2 #include <linux/pci.h>
3 #include <linux/init.h>
4 #include <linux/agp_backend.h>
5 #include <linux/mm.h>
6 #include <linux/slab.h>
7
8 #include <asm/machvec.h>
9 #include <asm/agp_backend.h>
10 #include "../../../arch/alpha/kernel/pci_impl.h"
11
12 #include "agp.h"
13
alpha_core_agp_vm_fault(struct vm_fault * vmf)14 static vm_fault_t alpha_core_agp_vm_fault(struct vm_fault *vmf)
15 {
16 alpha_agp_info *agp = agp_bridge->dev_private_data;
17 dma_addr_t dma_addr;
18 unsigned long pa;
19 struct page *page;
20
21 dma_addr = vmf->address - vmf->vma->vm_start + agp->aperture.bus_base;
22 pa = agp->ops->translate(agp, dma_addr);
23
24 if (pa == (unsigned long)-EINVAL)
25 return VM_FAULT_SIGBUS; /* no translation */
26
27 /*
28 * Get the page, inc the use count, and return it
29 */
30 page = virt_to_page(__va(pa));
31 get_page(page);
32 vmf->page = page;
33 return 0;
34 }
35
36 static struct aper_size_info_fixed alpha_core_agp_sizes[] =
37 {
38 { 0, 0, 0 }, /* filled in by alpha_core_agp_setup */
39 };
40
41 static const struct vm_operations_struct alpha_core_agp_vm_ops = {
42 .fault = alpha_core_agp_vm_fault,
43 };
44
45
alpha_core_agp_fetch_size(void)46 static int alpha_core_agp_fetch_size(void)
47 {
48 return alpha_core_agp_sizes[0].size;
49 }
50
alpha_core_agp_configure(void)51 static int alpha_core_agp_configure(void)
52 {
53 alpha_agp_info *agp = agp_bridge->dev_private_data;
54 agp_bridge->gart_bus_addr = agp->aperture.bus_base;
55 return 0;
56 }
57
alpha_core_agp_cleanup(void)58 static void alpha_core_agp_cleanup(void)
59 {
60 alpha_agp_info *agp = agp_bridge->dev_private_data;
61
62 agp->ops->cleanup(agp);
63 }
64
alpha_core_agp_tlbflush(struct agp_memory * mem)65 static void alpha_core_agp_tlbflush(struct agp_memory *mem)
66 {
67 alpha_agp_info *agp = agp_bridge->dev_private_data;
68 alpha_mv.mv_pci_tbi(agp->hose, 0, -1);
69 }
70
alpha_core_agp_enable(struct agp_bridge_data * bridge,u32 mode)71 static void alpha_core_agp_enable(struct agp_bridge_data *bridge, u32 mode)
72 {
73 alpha_agp_info *agp = bridge->dev_private_data;
74
75 agp->mode.lw = agp_collect_device_status(bridge, mode,
76 agp->capability.lw);
77
78 agp->mode.bits.enable = 1;
79 agp->ops->configure(agp);
80
81 agp_device_command(agp->mode.lw, false);
82 }
83
alpha_core_agp_insert_memory(struct agp_memory * mem,off_t pg_start,int type)84 static int alpha_core_agp_insert_memory(struct agp_memory *mem, off_t pg_start,
85 int type)
86 {
87 alpha_agp_info *agp = agp_bridge->dev_private_data;
88 int num_entries, status;
89 void *temp;
90
91 if (type >= AGP_USER_TYPES || mem->type >= AGP_USER_TYPES)
92 return -EINVAL;
93
94 temp = agp_bridge->current_size;
95 num_entries = A_SIZE_FIX(temp)->num_entries;
96 if ((pg_start + mem->page_count) > num_entries)
97 return -EINVAL;
98
99 status = agp->ops->bind(agp, pg_start, mem);
100 mb();
101 alpha_core_agp_tlbflush(mem);
102
103 return status;
104 }
105
alpha_core_agp_remove_memory(struct agp_memory * mem,off_t pg_start,int type)106 static int alpha_core_agp_remove_memory(struct agp_memory *mem, off_t pg_start,
107 int type)
108 {
109 alpha_agp_info *agp = agp_bridge->dev_private_data;
110 int status;
111
112 status = agp->ops->unbind(agp, pg_start, mem);
113 alpha_core_agp_tlbflush(mem);
114 return status;
115 }
116
alpha_core_agp_create_free_gatt_table(struct agp_bridge_data * a)117 static int alpha_core_agp_create_free_gatt_table(struct agp_bridge_data *a)
118 {
119 return 0;
120 }
121
122 struct agp_bridge_driver alpha_core_agp_driver = {
123 .owner = THIS_MODULE,
124 .aperture_sizes = alpha_core_agp_sizes,
125 .num_aperture_sizes = 1,
126 .size_type = FIXED_APER_SIZE,
127 .cant_use_aperture = true,
128 .masks = NULL,
129
130 .fetch_size = alpha_core_agp_fetch_size,
131 .configure = alpha_core_agp_configure,
132 .agp_enable = alpha_core_agp_enable,
133 .cleanup = alpha_core_agp_cleanup,
134 .tlb_flush = alpha_core_agp_tlbflush,
135 .mask_memory = agp_generic_mask_memory,
136 .cache_flush = global_cache_flush,
137 .create_gatt_table = alpha_core_agp_create_free_gatt_table,
138 .free_gatt_table = alpha_core_agp_create_free_gatt_table,
139 .insert_memory = alpha_core_agp_insert_memory,
140 .remove_memory = alpha_core_agp_remove_memory,
141 .alloc_by_type = agp_generic_alloc_by_type,
142 .free_by_type = agp_generic_free_by_type,
143 .agp_alloc_page = agp_generic_alloc_page,
144 .agp_alloc_pages = agp_generic_alloc_pages,
145 .agp_destroy_page = agp_generic_destroy_page,
146 .agp_destroy_pages = agp_generic_destroy_pages,
147 .agp_type_to_mask_type = agp_generic_type_to_mask_type,
148 };
149
150 struct agp_bridge_data *alpha_bridge;
151
152 int __init
alpha_core_agp_setup(void)153 alpha_core_agp_setup(void)
154 {
155 alpha_agp_info *agp = alpha_mv.agp_info();
156 struct pci_dev *pdev; /* faked */
157 struct aper_size_info_fixed *aper_size;
158
159 if (!agp)
160 return -ENODEV;
161 if (agp->ops->setup(agp))
162 return -ENODEV;
163
164 /*
165 * Build the aperture size descriptor
166 */
167 aper_size = alpha_core_agp_sizes;
168 aper_size->size = agp->aperture.size / (1024 * 1024);
169 aper_size->num_entries = agp->aperture.size / PAGE_SIZE;
170 aper_size->page_order = __ffs(aper_size->num_entries / 1024);
171
172 /*
173 * Build a fake pci_dev struct
174 */
175 pdev = pci_alloc_dev(NULL);
176 if (!pdev)
177 return -ENOMEM;
178 pdev->vendor = 0xffff;
179 pdev->device = 0xffff;
180 pdev->sysdata = agp->hose;
181
182 alpha_bridge = agp_alloc_bridge();
183 if (!alpha_bridge)
184 goto fail;
185
186 alpha_bridge->driver = &alpha_core_agp_driver;
187 alpha_bridge->vm_ops = &alpha_core_agp_vm_ops;
188 alpha_bridge->current_size = aper_size; /* only 1 size */
189 alpha_bridge->dev_private_data = agp;
190 alpha_bridge->dev = pdev;
191 alpha_bridge->mode = agp->capability.lw;
192
193 printk(KERN_INFO PFX "Detected AGP on hose %d\n", agp->hose->index);
194 return agp_add_bridge(alpha_bridge);
195
196 fail:
197 kfree(pdev);
198 return -ENOMEM;
199 }
200
agp_alpha_core_init(void)201 static int __init agp_alpha_core_init(void)
202 {
203 if (agp_off)
204 return -EINVAL;
205 if (alpha_mv.agp_info)
206 return alpha_core_agp_setup();
207 return -ENODEV;
208 }
209
agp_alpha_core_cleanup(void)210 static void __exit agp_alpha_core_cleanup(void)
211 {
212 agp_remove_bridge(alpha_bridge);
213 agp_put_bridge(alpha_bridge);
214 }
215
216 module_init(agp_alpha_core_init);
217 module_exit(agp_alpha_core_cleanup);
218
219 MODULE_AUTHOR("Jeff Wiedemeier <Jeff.Wiedemeier@hp.com>");
220 MODULE_LICENSE("GPL and additional rights");
221