cleanup patch from Adrian Bunk <bunk@stusta.de>
[platform/upstream/libdrm.git] / shared-core / via_map.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
28 static int via_do_init_map(drm_device_t * dev, drm_via_init_t * init)
29 {
30         drm_via_private_t *dev_priv;
31         unsigned int i;
32
33         DRM_DEBUG("%s\n", __FUNCTION__);
34
35         dev_priv = drm_alloc(sizeof(drm_via_private_t), DRM_MEM_DRIVER);
36         if (dev_priv == NULL)
37                 return -ENOMEM;
38
39         memset(dev_priv, 0, sizeof(drm_via_private_t));
40
41         DRM_GETSAREA();
42         if (!dev_priv->sarea) {
43                 DRM_ERROR("could not find sarea!\n");
44                 dev->dev_private = (void *)dev_priv;
45                 via_do_cleanup_map(dev);
46                 return -EINVAL;
47         }
48
49         dev_priv->fb = drm_core_findmap(dev, init->fb_offset);
50         if (!dev_priv->fb) {
51                 DRM_ERROR("could not find framebuffer!\n");
52                 dev->dev_private = (void *)dev_priv;
53                 via_do_cleanup_map(dev);
54                 return -EINVAL;
55         }
56         dev_priv->mmio = drm_core_findmap(dev, init->mmio_offset);
57         if (!dev_priv->mmio) {
58                 DRM_ERROR("could not find mmio region!\n");
59                 dev->dev_private = (void *)dev_priv;
60                 via_do_cleanup_map(dev);
61                 return -EINVAL;
62         }
63
64         dev_priv->sarea_priv =
65             (drm_via_sarea_t *) ((u8 *) dev_priv->sarea->handle +
66                                  init->sarea_priv_offset);
67
68         dev_priv->agpAddr = init->agpAddr;
69
70         for (i = 0; i < VIA_NR_XVMC_LOCKS; ++i)
71                 DRM_INIT_WAITQUEUE(&(dev_priv->decoder_queue[i]));
72
73         dev->dev_private = (void *)dev_priv;
74
75         return 0;
76 }
77
78 int via_do_cleanup_map(drm_device_t * dev)
79 {
80         if (dev->dev_private) {
81
82                 drm_via_private_t *dev_priv = dev->dev_private;
83
84                 via_dma_cleanup(dev);
85
86                 drm_free(dev_priv, sizeof(drm_via_private_t), DRM_MEM_DRIVER);
87                 dev->dev_private = NULL;
88         }
89
90         return 0;
91 }
92
93 int via_map_init(DRM_IOCTL_ARGS)
94 {
95         DRM_DEVICE;
96         drm_via_init_t init;
97
98         DRM_DEBUG("%s\n", __FUNCTION__);
99
100         DRM_COPY_FROM_USER_IOCTL(init, (drm_via_init_t *) data, sizeof(init));
101
102         switch (init.func) {
103         case VIA_INIT_MAP:
104                 return via_do_init_map(dev, &init);
105         case VIA_CLEANUP_MAP:
106                 return via_do_cleanup_map(dev);
107         }
108
109         return -EINVAL;
110 }
111
112 int via_decoder_futex(DRM_IOCTL_ARGS)
113 {
114         DRM_DEVICE;
115         drm_via_futex_t fx;
116         volatile int *lock;
117         drm_via_private_t *dev_priv = (drm_via_private_t *) dev->dev_private;
118         drm_via_sarea_t *sAPriv = dev_priv->sarea_priv;
119         int ret = 0;
120
121         DRM_COPY_FROM_USER_IOCTL(fx, (drm_via_futex_t *) data, sizeof(fx));
122
123         if (fx.lock > VIA_NR_XVMC_LOCKS)
124                 return -EFAULT;
125
126         lock = XVMCLOCKPTR(sAPriv, fx.lock);
127
128         switch (fx.func) {
129         case VIA_FUTEX_WAIT:
130                 DRM_WAIT_ON(ret, dev_priv->decoder_queue[fx.lock],
131                             (fx.ms / 10) * (DRM_HZ / 100), *lock != fx.val);
132                 return ret;
133         case VIA_FUTEX_WAKE:
134                 DRM_WAKEUP(&(dev_priv->decoder_queue[fx.lock]));
135                 return 0;
136         }
137         return 0;
138 }
139