1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <linux/config.h>
26#include "savage.h"
27#include "drmP.h"
28#include "savage_drv.h"
29
30#define DRIVER_AUTHOR "John Zhao, S3 Graphics Inc."
31
32#define DRIVER_NAME "savage"
33#define DRIVER_DESC "Savage4 Family"
34#define DRIVER_DATE "20011023"
35
36#define DRIVER_MAJOR 1
37#define DRIVER_MINOR 0
38#define DRIVER_PATCHLEVEL 0
39
40
41
42
43
44#define DRIVER_IOCTLS \
45 [DRM_IOCTL_NR(DRM_IOCTL_SAVAGE_ALLOC_CONTINUOUS_MEM)] \
46 = {savage_alloc_continuous_mem,1,0},\
47 [DRM_IOCTL_NR( DRM_IOCTL_SAVAGE_GET_PHYSICS_ADDRESS)] \
48 = {savage_get_physics_address,1,0},\
49 [DRM_IOCTL_NR(DRM_IOCTL_SAVAGE_FREE_CONTINUOUS_MEM)] \
50 = {savage_free_cont_mem,1,0}
51
52int savage_alloc_continuous_mem(struct inode *inode, struct file *filp,
53 unsigned int cmd, unsigned long arg)
54{
55 drm_savage_alloc_cont_mem_t cont_mem;
56 unsigned long size, addr;
57 void *ret;
58 int i;
59 mem_map_t *p;
60 pgprot_t flags;
61
62
63 drm_file_t *priv = filp->private_data;
64 drm_device_t *dev = priv->dev;
65 drm_map_t *map;
66 drm_map_list_t *list;
67
68 dma_addr_t pa;
69
70 if (copy_from_user(&cont_mem, (drm_savage_alloc_cont_mem_t *) arg, sizeof(cont_mem)))
71 return -EFAULT;
72
73
74 if (cont_mem.size <= 0)
75 return -EINVAL;
76 if( 0xFFFFFFFFUL / cont_mem.size < cont_mem.type )
77 return -EINVAL;
78
79 map = DRM(alloc) (sizeof(*map), DRM_MEM_MAPS);
80 if (!map)
81 return -ENOMEM;
82
83 size = cont_mem.type * cont_mem.size;
84
85 ret = pci_alloc_consistent(NULL, size, &pa);
86 if (ret == NULL)
87 return -ENOMEM;
88
89
90 for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
91 SetPageReserved(p);
92
93 cont_mem.phyaddress = pa;
94 cont_mem.location = DRM_SAVAGE_MEM_LOCATION_PCI;
95
96
97 down_write(¤t->mm->mmap_sem);
98 addr = do_mmap(NULL, 0, size, PROT_READ | PROT_WRITE, MAP_PRIVATE, cont_mem.phyaddress);
99 if ((unsigned long)addr > -1024UL)
100 {
101 up_write(¤t->mm->mmap_sem);
102 return -EINVAL;
103 }
104 pgprot_val(flags) = _PAGE_PRESENT | _PAGE_RW | _PAGE_USER;
105 if (remap_page_range(addr, cont_mem.phyaddress, size, flags))
106 {
107 up_write(¤t->mm->mmap_sem);
108 return -EINVAL;
109 }
110 up_write(¤t->mm->mmap_sem);
111
112 for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
113 ClearPageReserved(p);
114
115 cont_mem.linear = addr;
116
117
118 map->handle = ret;
119 map->offset = cont_mem.phyaddress;
120 map->size = size;
121 map->mtrr = -1;
122
123
124 list = DRM(alloc) (sizeof(*list), DRM_MEM_MAPS);
125 if (!list) {
126 DRM(free) (map, sizeof(*map), DRM_MEM_MAPS);
127 return -EINVAL;
128 }
129 memset(list, 0, sizeof(*list));
130 list->map = map;
131
132 down(&dev->struct_sem);
133 list_add(&list->head, &dev->maplist->head);
134 up(&dev->struct_sem);
135
136 if (copy_to_user((drm_savage_alloc_cont_mem_t *) arg, &cont_mem, sizeof(cont_mem)))
137 return -EFAULT;
138
139#warning "Race at the very least"
140 for (i = 0, p = virt_to_page(ret); i < size / PAGE_SIZE; i++, p++)
141 atomic_set(&p->count, 1);
142
143 return 1;
144}
145
146int savage_get_physics_address(struct inode *inode, struct file *filp,
147 unsigned int cmd, unsigned long arg)
148{
149
150 drm_savage_get_physcis_address_t req;
151 unsigned long buf;
152 pgd_t *pgd;
153 pmd_t *pmd;
154 pte_t *pte;
155 struct mm_struct *mm;
156
157 if (copy_from_user(&req, (drm_savage_get_physcis_address_t *) arg, sizeof(req)))
158 return -EFAULT;
159 buf = req.v_address;
160
161#warning "FIXME: need to redo logic for this"
162
163 if (buf >= (unsigned long) high_memory)
164 mm = &init_mm;
165 else
166 mm = current->mm;
167
168 spin_lock(&mm->page_table_lock);
169
170 pgd = pgd_offset(mm, buf);
171 pmd = pmd_offset(pgd, buf);
172 pte = pte_offset(pmd, buf);
173
174 if (!pte_present(*pte))
175 {
176 spin_unlock(&mm->page_table_lock);
177 return -EINVAL;
178 }
179 req.p_address = ((pte_val(*pte) & PAGE_MASK) | (buf & (PAGE_SIZE - 1)));
180 spin_unlock(&mm->page_table_lock);
181
182 if (copy_to_user((drm_savage_get_physcis_address_t *) arg, &req, sizeof(req)))
183 return -EFAULT;
184 return 1;
185}
186
187
188int savage_free_cont_mem(struct inode *inode, struct file *filp,
189 unsigned int cmd, unsigned long arg)
190{
191 drm_savage_alloc_cont_mem_t cont_mem;
192 unsigned long size;
193
194
195 drm_file_t *priv = filp->private_data;
196 drm_device_t *dev = priv->dev;
197 drm_map_t *map;
198 struct list_head *list;
199 drm_map_list_t *r_list = NULL;
200
201 if (copy_from_user(&cont_mem, (drm_savage_alloc_cont_mem_t *) arg, sizeof(cont_mem)))
202 return -EFAULT;
203#warning "fix size overflow check"
204 size = cont_mem.type * cont_mem.size;
205 if (size <= 0)
206 return -EINVAL;
207
208
209 list_for_each(list, &dev->maplist->head) {
210 r_list = (drm_map_list_t *) list;
211
212 if (r_list->map && r_list->map->offset == cont_mem.phyaddress)
213 break;
214 }
215
216 if (list == (&dev->maplist->head)) {
217 up(&dev->struct_sem);
218 return -EINVAL;
219 }
220 map = r_list->map;
221 list_del(list);
222 DRM(free) (list, sizeof(*list), DRM_MEM_MAPS);
223
224
225 if (do_munmap(current->mm, cont_mem.linear, size) != 0)
226 return -EFAULT;
227
228 pci_free_consistent(NULL, size, map->handle, cont_mem.phyaddress);
229
230 return 1;
231}
232
233
234#include "drm_agpsupport.h"
235#include "drm_auth.h"
236#include "drm_bufs.h"
237#include "drm_context.h"
238#include "drm_dma.h"
239#include "drm_drawable.h"
240#include "drm_drv.h"
241#include "drm_fops.h"
242#include "drm_init.h"
243#include "drm_ioctl.h"
244#include "drm_lock.h"
245#include "drm_memory.h"
246#include "drm_proc.h"
247#include "drm_vm.h"
248#include "drm_stub.h"
249