OSDN Git Service

VIA update:
[android-x86/external-libdrm.git] / shared-core / via_mm.c
1 /*
2  * Copyright 1998-2003 VIA Technologies, Inc. All Rights Reserved.
3  * Copyright 2001-2003 S3 Graphics, Inc. All Rights Reserved.
4  *
5  * Permission is hereby granted, free of charge, to any person obtaining a
6  * copy of this software and associated documentation files (the "Software"),
7  * to deal in the Software without restriction, including without limitation
8  * the rights to use, copy, modify, merge, publish, distribute, sub license,
9  * and/or sell copies of the Software, and to permit persons to whom the
10  * Software is furnished to do so, subject to the following conditions:
11  *
12  * The above copyright notice and this permission notice (including the
13  * next paragraph) shall be included in all copies or substantial portions
14  * of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT. IN NO EVENT SHALL
19  * VIA, S3 GRAPHICS, AND/OR ITS SUPPLIERS BE LIABLE FOR ANY CLAIM, DAMAGES OR
20  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
21  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
22  * DEALINGS IN THE SOFTWARE.
23  */
24 #include "drmP.h"
25 #include "via_drm.h"
26 #include "via_drv.h"
27 #include "via_ds.h"
28 #include "via_mm.h"
29
30 #define MAX_CONTEXT 100
31
32 unsigned int VIA_DEBUG = 1;
33
34 typedef struct {
35         int used;
36         int context;
37         set_t *sets[2];         /* 0 for frame buffer, 1 for AGP , 2 for System */
38 } via_context_t;
39
40 static via_context_t global_ppriv[MAX_CONTEXT];
41
42 static int add_alloc_set(int context, int type, unsigned int val)
43 {
44         int i, retval = 0;
45
46         for (i = 0; i < MAX_CONTEXT; i++) {
47                 if (global_ppriv[i].used && global_ppriv[i].context == context) {
48                         retval = via_setAdd(global_ppriv[i].sets[type], val);
49                         break;
50                 }
51         }
52
53         return retval;
54 }
55
56 static int del_alloc_set(int context, int type, unsigned int val)
57 {
58         int i, retval = 0;
59
60         for (i = 0; i < MAX_CONTEXT; i++)
61                 if (global_ppriv[i].used && global_ppriv[i].context == context) {
62                         retval = via_setDel(global_ppriv[i].sets[type], val);
63                         break;
64                 }
65
66         return retval;
67 }
68
69 /* agp memory management */
70 static memHeap_t *AgpHeap = NULL;
71
72 int via_agp_init(DRM_IOCTL_ARGS)
73 {
74         drm_via_agp_t agp;
75
76         DRM_COPY_FROM_USER_IOCTL(agp, (drm_via_agp_t *) data, sizeof(agp));
77
78         AgpHeap = via_mmInit(agp.offset, agp.size);
79
80         DRM_DEBUG("offset = %lu, size = %lu", (unsigned long)agp.offset, (unsigned long)agp.size);
81
82         return 0;
83 }
84
85 /* fb memory management */
86 static memHeap_t *FBHeap = NULL;
87
88 int via_fb_init(DRM_IOCTL_ARGS)
89 {
90         drm_via_fb_t fb;
91
92         DRM_COPY_FROM_USER_IOCTL(fb, (drm_via_fb_t *) data, sizeof(fb));
93
94         FBHeap = via_mmInit(fb.offset, fb.size);
95
96         DRM_DEBUG("offset = %lu, size = %lu", (unsigned long)fb.offset, (unsigned long)fb.size);
97
98         return 0;
99 }
100
101 int via_init_context(struct drm_device *dev, int context)
102 {
103         int i;
104
105         for (i = 0; i < MAX_CONTEXT; i++)
106                 if (global_ppriv[i].used &&
107                     (global_ppriv[i].context == context))
108                         break;
109
110         if (i >= MAX_CONTEXT) {
111                 for (i = 0; i < MAX_CONTEXT; i++) {
112                         if (!global_ppriv[i].used) {
113                                 global_ppriv[i].context = context;
114                                 global_ppriv[i].used = 1;
115                                 global_ppriv[i].sets[0] = via_setInit();
116                                 global_ppriv[i].sets[1] = via_setInit();
117                                 DRM_DEBUG("init allocation set, socket=%d,"
118                                           " context = %d\n", i, context);
119                                 break;
120                         }
121                 }
122
123                 if ((i >= MAX_CONTEXT) || (global_ppriv[i].sets[0] == NULL) ||
124                     (global_ppriv[i].sets[1] == NULL)) {
125                         return 0;
126                 }
127         }
128
129         return 1;
130 }
131
132 int via_final_context(struct drm_device *dev, int context)
133 {       
134         int i;
135         volatile int *lock;
136         drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
137         drm_via_sarea_t *sAPriv = dev_priv->sarea_priv;
138
139         for (i = 0; i < MAX_CONTEXT; i++)
140                 if (global_ppriv[i].used &&
141                     (global_ppriv[i].context == context))
142                         break;
143
144         if (i < MAX_CONTEXT) {
145                 set_t *set;
146                 unsigned int item;
147                 int retval;
148
149                 DRM_DEBUG("find socket %d, context = %d\n", i, context);
150
151                 /* Video Memory */
152                 set = global_ppriv[i].sets[0];
153                 retval = via_setFirst(set, &item);
154                 while (retval) {
155                         DRM_DEBUG("free video memory 0x%x\n", item);
156                         via_mmFreeMem((PMemBlock) item);
157                         retval = via_setNext(set, &item);
158                 }
159                 via_setDestroy(set);
160
161                 /* AGP Memory */
162                 set = global_ppriv[i].sets[1];
163                 retval = via_setFirst(set, &item);
164                 while (retval) {
165                         DRM_DEBUG("free agp memory 0x%x\n", item);
166                         via_mmFreeMem((PMemBlock) item);
167                         retval = via_setNext(set, &item);
168                 }
169                 via_setDestroy(set);
170
171                 global_ppriv[i].used = 0;
172         }
173         
174         /*
175          * Release futex locks.
176          */ 
177
178         for (i=0; i < VIA_NR_XVMC_LOCKS; ++i) {
179                 lock = XVMCLOCKPTR(sAPriv, i);
180                 if ( (_DRM_LOCKING_CONTEXT( *lock ) == i) && 
181                      (_DRM_LOCK_IS_HELD( *lock ))) {
182                         if ( *lock & _DRM_LOCK_CONT) {
183                                 DRM_WAKEUP( &(dev_priv->decoder_queue[i]));
184                         }
185                         *lock &= ~( _DRM_LOCK_HELD | _DRM_LOCK_CONT );
186                 }
187         }
188                         
189 #if defined(__linux__)
190         /* Linux specific until context tracking code gets ported to BSD */
191         /* Last context, perform cleanup */
192         if (dev->ctx_count == 1 && dev->dev_private) {
193                 DRM_DEBUG("Last Context\n");
194                 if (dev->irq)
195                         drm_irq_uninstall(dev);
196
197                 via_do_cleanup_map(dev);
198         }
199 #endif
200
201         return 1;
202 }
203
204 int via_mem_alloc(DRM_IOCTL_ARGS)
205 {
206         drm_via_mem_t mem;
207
208         DRM_COPY_FROM_USER_IOCTL(mem, (drm_via_mem_t *) data, sizeof(mem));
209         switch (mem.type) {
210         case VIDEO:
211                 if (via_fb_alloc(&mem) < 0)
212                         return -EFAULT;
213                 DRM_COPY_TO_USER_IOCTL((drm_via_mem_t *) data, mem,
214                                        sizeof(mem));
215                 return 0;
216         case AGP:
217                 if (via_agp_alloc(&mem) < 0)
218                         return -EFAULT;
219                 DRM_COPY_TO_USER_IOCTL((drm_via_mem_t *) data, mem,
220                                        sizeof(mem));
221                 return 0;
222         }
223
224         return -EFAULT;
225 }
226
227 int via_fb_alloc(drm_via_mem_t * mem)
228 {
229         drm_via_mm_t fb;
230         PMemBlock block;
231         int retval = 0;
232
233         if (!FBHeap)
234                 return -1;
235
236         fb.size = mem->size;
237         fb.context = mem->context;
238
239         block = via_mmAllocMem(FBHeap, fb.size, 5, 0);
240         if (block) {
241                 fb.offset = block->ofs;
242                 fb.free = (unsigned int)block;
243                 if (!add_alloc_set(fb.context, VIDEO, fb.free)) {
244                         DRM_DEBUG("adding to allocation set fails\n");
245                         via_mmFreeMem((PMemBlock) fb.free);
246                         retval = -1;
247                 }
248         } else {
249                 fb.offset = 0;
250                 fb.size = 0;
251                 fb.free = 0;
252                 retval = -1;
253         }
254
255         mem->offset = fb.offset;
256         mem->index = fb.free;
257
258         DRM_DEBUG("alloc fb, size = %d, offset = %d\n", fb.size,
259                   (int)fb.offset);
260
261         return retval;
262 }
263
264 int via_agp_alloc(drm_via_mem_t * mem)
265 {
266         drm_via_mm_t agp;
267         PMemBlock block;
268         int retval = 0;
269
270         if (!AgpHeap)
271                 return -1;
272
273         agp.size = mem->size;
274         agp.context = mem->context;
275
276         block = via_mmAllocMem(AgpHeap, agp.size, 5, 0);
277         if (block) {
278                 agp.offset = block->ofs;
279                 agp.free = (unsigned int)block;
280                 if (!add_alloc_set(agp.context, AGP, agp.free)) {
281                         DRM_DEBUG("adding to allocation set fails\n");
282                         via_mmFreeMem((PMemBlock) agp.free);
283                         retval = -1;
284                 }
285         } else {
286                 agp.offset = 0;
287                 agp.size = 0;
288                 agp.free = 0;
289         }
290
291         mem->offset = agp.offset;
292         mem->index = agp.free;
293
294         DRM_DEBUG("alloc agp, size = %d, offset = %d\n", agp.size,
295                   (unsigned int)agp.offset);
296         return retval;
297 }
298
299 int via_mem_free(DRM_IOCTL_ARGS)
300 {
301         drm_via_mem_t mem;
302
303         DRM_COPY_FROM_USER_IOCTL(mem, (drm_via_mem_t *) data, sizeof(mem));
304
305         switch (mem.type) {
306
307         case VIDEO:
308                 if (via_fb_free(&mem) == 0)
309                         return 0;
310                 break;
311         case AGP:
312                 if (via_agp_free(&mem) == 0)
313                         return 0;
314                 break;
315         }
316
317         return -EFAULT;
318 }
319
320 int via_fb_free(drm_via_mem_t * mem)
321 {
322         drm_via_mm_t fb;
323         int retval = 0;
324
325         if (!FBHeap) {
326                 return -1;
327         }
328
329         fb.free = mem->index;
330         fb.context = mem->context;
331
332         if (!fb.free) {
333                 return -1;
334
335         }
336
337         via_mmFreeMem((PMemBlock) fb.free);
338
339         if (!del_alloc_set(fb.context, VIDEO, fb.free)) {
340                 retval = -1;
341         }
342
343         DRM_DEBUG("free fb, free = %d\n", fb.free);
344
345         return retval;
346 }
347
348 int via_agp_free(drm_via_mem_t * mem)
349 {
350         drm_via_mm_t agp;
351
352         int retval = 0;
353
354         agp.free = mem->index;
355         agp.context = mem->context;
356
357         if (!agp.free)
358                 return -1;
359
360         via_mmFreeMem((PMemBlock) agp.free);
361
362         if (!del_alloc_set(agp.context, AGP, agp.free)) {
363                 retval = -1;
364         }
365
366         DRM_DEBUG("free agp, free = %d\n", agp.free);
367
368         return retval;
369 }