[PATCH] kvm: Fix gva_to_gpa()
[linux-2.6] / drivers / char / drm / sis_mm.c
1 /**************************************************************************
2  *
3  * Copyright 2006 Tungsten Graphics, Inc., Bismarck, ND., USA.
4  * All Rights Reserved.
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a
7  * copy of this software and associated documentation files (the
8  * "Software"), to deal in the Software without restriction, including
9  * without limitation the rights to use, copy, modify, merge, publish,
10  * distribute, sub license, and/or sell copies of the Software, and to
11  * permit persons to whom the Software is furnished to do so, subject to
12  * the following conditions:
13  *
14  * The above copyright notice and this permission notice (including the
15  * next paragraph) shall be included in all copies or substantial portions
16  * of the Software.
17  *
18  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
19  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
20  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
21  * THE COPYRIGHT HOLDERS, AUTHORS AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM,
22  * DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR
23  * OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE
24  * USE OR OTHER DEALINGS IN THE SOFTWARE.
25  *
26  *
27  **************************************************************************/
28
29 /*
30  * Authors:
31  *    Thomas Hellström <thomas-at-tungstengraphics-dot-com>
32  */
33
34 #include "drmP.h"
35 #include "sis_drm.h"
36 #include "sis_drv.h"
37
38 #include <video/sisfb.h>
39
40 #define VIDEO_TYPE 0
41 #define AGP_TYPE 1
42
43
44 #if defined(CONFIG_FB_SIS)
45 /* fb management via fb device */
46
47 #define SIS_MM_ALIGN_SHIFT 0
48 #define SIS_MM_ALIGN_MASK 0
49
50 static void *sis_sman_mm_allocate(void *private, unsigned long size,
51                                   unsigned alignment)
52 {
53         struct sis_memreq req;
54
55         req.size = size;
56         sis_malloc(&req);
57         if (req.size == 0)
58                 return NULL;
59         else
60                 return (void *)~req.offset;
61 }
62
63 static void sis_sman_mm_free(void *private, void *ref)
64 {
65         sis_free(~((unsigned long)ref));
66 }
67
68 static void sis_sman_mm_destroy(void *private)
69 {
70         ;
71 }
72
73 static unsigned long sis_sman_mm_offset(void *private, void *ref)
74 {
75         return ~((unsigned long)ref);
76 }
77
78 #else /* CONFIG_FB_SIS */
79
80 #define SIS_MM_ALIGN_SHIFT 4
81 #define SIS_MM_ALIGN_MASK ( (1 << SIS_MM_ALIGN_SHIFT) - 1)
82
83 #endif /* CONFIG_FB_SIS */
84
85 static int sis_fb_init(DRM_IOCTL_ARGS)
86 {
87         DRM_DEVICE;
88         drm_sis_private_t *dev_priv = dev->dev_private;
89         drm_sis_fb_t fb;
90         int ret;
91
92         DRM_COPY_FROM_USER_IOCTL(fb, (drm_sis_fb_t __user *) data, sizeof(fb));
93
94         mutex_lock(&dev->struct_mutex);
95 #if defined(CONFIG_FB_SIS)
96         {
97                 drm_sman_mm_t sman_mm;
98                 sman_mm.private = (void *)0xFFFFFFFF;
99                 sman_mm.allocate = sis_sman_mm_allocate;
100                 sman_mm.free = sis_sman_mm_free;
101                 sman_mm.destroy = sis_sman_mm_destroy;
102                 sman_mm.offset = sis_sman_mm_offset;
103                 ret =
104                     drm_sman_set_manager(&dev_priv->sman, VIDEO_TYPE, &sman_mm);
105         }
106 #else
107         ret = drm_sman_set_range(&dev_priv->sman, VIDEO_TYPE, 0,
108                                  fb.size >> SIS_MM_ALIGN_SHIFT);
109 #endif
110
111         if (ret) {
112                 DRM_ERROR("VRAM memory manager initialisation error\n");
113                 mutex_unlock(&dev->struct_mutex);
114                 return ret;
115         }
116
117         dev_priv->vram_initialized = 1;
118         dev_priv->vram_offset = fb.offset;
119
120         mutex_unlock(&dev->struct_mutex);
121         DRM_DEBUG("offset = %u, size = %u", fb.offset, fb.size);
122
123         return 0;
124 }
125
126 static int sis_drm_alloc(drm_device_t * dev, drm_file_t * priv,
127                          unsigned long data, int pool)
128 {
129         drm_sis_private_t *dev_priv = dev->dev_private;
130         drm_sis_mem_t __user *argp = (drm_sis_mem_t __user *) data;
131         drm_sis_mem_t mem;
132         int retval = 0;
133         drm_memblock_item_t *item;
134
135         DRM_COPY_FROM_USER_IOCTL(mem, argp, sizeof(mem));
136
137         mutex_lock(&dev->struct_mutex);
138
139         if (0 == ((pool == 0) ? dev_priv->vram_initialized :
140                       dev_priv->agp_initialized)) {
141                 DRM_ERROR
142                     ("Attempt to allocate from uninitialized memory manager.\n");
143                 return DRM_ERR(EINVAL);
144         }
145
146         mem.size = (mem.size + SIS_MM_ALIGN_MASK) >> SIS_MM_ALIGN_SHIFT;
147         item = drm_sman_alloc(&dev_priv->sman, pool, mem.size, 0,
148                               (unsigned long)priv);
149
150         mutex_unlock(&dev->struct_mutex);
151         if (item) {
152                 mem.offset = ((pool == 0) ?
153                               dev_priv->vram_offset : dev_priv->agp_offset) +
154                     (item->mm->
155                      offset(item->mm, item->mm_info) << SIS_MM_ALIGN_SHIFT);
156                 mem.free = item->user_hash.key;
157                 mem.size = mem.size << SIS_MM_ALIGN_SHIFT;
158         } else {
159                 mem.offset = 0;
160                 mem.size = 0;
161                 mem.free = 0;
162                 retval = DRM_ERR(ENOMEM);
163         }
164
165         DRM_COPY_TO_USER_IOCTL(argp, mem, sizeof(mem));
166
167         DRM_DEBUG("alloc %d, size = %d, offset = %d\n", pool, mem.size,
168                   mem.offset);
169
170         return retval;
171 }
172
173 static int sis_drm_free(DRM_IOCTL_ARGS)
174 {
175         DRM_DEVICE;
176         drm_sis_private_t *dev_priv = dev->dev_private;
177         drm_sis_mem_t mem;
178         int ret;
179
180         DRM_COPY_FROM_USER_IOCTL(mem, (drm_sis_mem_t __user *) data,
181                                  sizeof(mem));
182
183         mutex_lock(&dev->struct_mutex);
184         ret = drm_sman_free_key(&dev_priv->sman, mem.free);
185         mutex_unlock(&dev->struct_mutex);
186         DRM_DEBUG("free = 0x%lx\n", mem.free);
187
188         return ret;
189 }
190
191 static int sis_fb_alloc(DRM_IOCTL_ARGS)
192 {
193         DRM_DEVICE;
194         return sis_drm_alloc(dev, priv, data, VIDEO_TYPE);
195 }
196
197 static int sis_ioctl_agp_init(DRM_IOCTL_ARGS)
198 {
199         DRM_DEVICE;
200         drm_sis_private_t *dev_priv = dev->dev_private;
201         drm_sis_agp_t agp;
202         int ret;
203         dev_priv = dev->dev_private;
204
205         DRM_COPY_FROM_USER_IOCTL(agp, (drm_sis_agp_t __user *) data,
206                                  sizeof(agp));
207         mutex_lock(&dev->struct_mutex);
208         ret = drm_sman_set_range(&dev_priv->sman, AGP_TYPE, 0,
209                                  agp.size >> SIS_MM_ALIGN_SHIFT);
210
211         if (ret) {
212                 DRM_ERROR("AGP memory manager initialisation error\n");
213                 mutex_unlock(&dev->struct_mutex);
214                 return ret;
215         }
216
217         dev_priv->agp_initialized = 1;
218         dev_priv->agp_offset = agp.offset;
219         mutex_unlock(&dev->struct_mutex);
220
221         DRM_DEBUG("offset = %u, size = %u", agp.offset, agp.size);
222         return 0;
223 }
224
225 static int sis_ioctl_agp_alloc(DRM_IOCTL_ARGS)
226 {
227         DRM_DEVICE;
228
229         return sis_drm_alloc(dev, priv, data, AGP_TYPE);
230 }
231
232 static drm_local_map_t *sis_reg_init(drm_device_t *dev)
233 {
234         drm_map_list_t *entry;
235         drm_local_map_t *map;
236
237         list_for_each_entry(entry, &dev->maplist->head, head) {
238                 map = entry->map;
239                 if (!map)
240                         continue;
241                 if (map->type == _DRM_REGISTERS) {
242                         return map;
243                 }
244         }
245         return NULL;
246 }
247
248 int sis_idle(drm_device_t *dev)
249 {
250         drm_sis_private_t *dev_priv = dev->dev_private;
251         uint32_t idle_reg;
252         unsigned long end;
253         int i;
254
255         if (dev_priv->idle_fault)
256                 return 0;
257
258         if (dev_priv->mmio == NULL) {
259                 dev_priv->mmio = sis_reg_init(dev);
260                 if (dev_priv->mmio == NULL) {
261                         DRM_ERROR("Could not find register map.\n");
262                         return 0;
263                 }
264         }
265         
266         /*
267          * Implement a device switch here if needed
268          */
269
270         if (dev_priv->chipset != SIS_CHIP_315)
271                 return 0;
272
273         /*
274          * Timeout after 3 seconds. We cannot use DRM_WAIT_ON here
275          * because its polling frequency is too low.
276          */
277
278         end = jiffies + (DRM_HZ * 3);
279
280         for (i=0; i<4; ++i) {
281                 do {
282                         idle_reg = SIS_READ(0x85cc);
283                 } while ( !time_after_eq(jiffies, end) &&
284                           ((idle_reg & 0x80000000) != 0x80000000));
285         }
286
287         if (time_after_eq(jiffies, end)) {
288                 DRM_ERROR("Graphics engine idle timeout. "
289                           "Disabling idle check\n");
290                 dev_priv->idle_fault = 1;
291         }
292
293         /*
294          * The caller never sees an error code. It gets trapped
295          * in libdrm.
296          */
297
298         return 0;
299 }
300
301
302 void sis_lastclose(struct drm_device *dev)
303 {
304         drm_sis_private_t *dev_priv = dev->dev_private;
305
306         if (!dev_priv)
307                 return;
308
309         mutex_lock(&dev->struct_mutex);
310         drm_sman_cleanup(&dev_priv->sman);
311         dev_priv->vram_initialized = 0;
312         dev_priv->agp_initialized = 0;
313         dev_priv->mmio = NULL;
314         mutex_unlock(&dev->struct_mutex);
315 }
316
317 void sis_reclaim_buffers_locked(drm_device_t * dev, struct file *filp)
318 {
319         drm_sis_private_t *dev_priv = dev->dev_private;
320         drm_file_t *priv = filp->private_data;
321
322         mutex_lock(&dev->struct_mutex);
323         if (drm_sman_owner_clean(&dev_priv->sman, (unsigned long)priv)) {
324                 mutex_unlock(&dev->struct_mutex);
325                 return;
326         }
327
328         if (dev->driver->dma_quiescent) {
329                 dev->driver->dma_quiescent(dev);
330         }
331
332         drm_sman_owner_cleanup(&dev_priv->sman, (unsigned long)priv);
333         mutex_unlock(&dev->struct_mutex);
334         return;
335 }
336
337 drm_ioctl_desc_t sis_ioctls[] = {
338         [DRM_IOCTL_NR(DRM_SIS_FB_ALLOC)] = {sis_fb_alloc, DRM_AUTH},
339         [DRM_IOCTL_NR(DRM_SIS_FB_FREE)] = {sis_drm_free, DRM_AUTH},
340         [DRM_IOCTL_NR(DRM_SIS_AGP_INIT)] =
341             {sis_ioctl_agp_init, DRM_AUTH | DRM_MASTER | DRM_ROOT_ONLY},
342         [DRM_IOCTL_NR(DRM_SIS_AGP_ALLOC)] = {sis_ioctl_agp_alloc, DRM_AUTH},
343         [DRM_IOCTL_NR(DRM_SIS_AGP_FREE)] = {sis_drm_free, DRM_AUTH},
344         [DRM_IOCTL_NR(DRM_SIS_FB_INIT)] =
345             {sis_fb_init, DRM_AUTH | DRM_MASTER | DRM_ROOT_ONLY}
346 };
347
348 int sis_max_ioctl = DRM_ARRAY_SIZE(sis_ioctls);