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
26
27
28
29
30
31
32
33
34#include <video/sisfb.h>
35
36#include <drm/drm_device.h>
37#include <drm/drm_file.h>
38#include <drm/sis_drm.h>
39
40#include "sis_drv.h"
41
42
43#define VIDEO_TYPE 0
44#define AGP_TYPE 1
45
46
47struct sis_memblock {
48 struct drm_mm_node mm_node;
49 struct sis_memreq req;
50 struct list_head owner_list;
51};
52
53#if defined(CONFIG_FB_SIS) || defined(CONFIG_FB_SIS_MODULE)
54
55
56#define SIS_MM_ALIGN_SHIFT 0
57#define SIS_MM_ALIGN_MASK 0
58
59#else
60
61#define SIS_MM_ALIGN_SHIFT 4
62#define SIS_MM_ALIGN_MASK ((1 << SIS_MM_ALIGN_SHIFT) - 1)
63
64#endif
65
66static int sis_fb_init(struct drm_device *dev, void *data, struct drm_file *file_priv)
67{
68 drm_sis_private_t *dev_priv = dev->dev_private;
69 drm_sis_fb_t *fb = data;
70
71 mutex_lock(&dev->struct_mutex);
72
73
74 drm_mm_init(&dev_priv->vram_mm, 0, fb->size >> SIS_MM_ALIGN_SHIFT);
75
76 dev_priv->vram_initialized = 1;
77 dev_priv->vram_offset = fb->offset;
78
79 mutex_unlock(&dev->struct_mutex);
80 DRM_DEBUG("offset = %lu, size = %lu\n", fb->offset, fb->size);
81
82 return 0;
83}
84
85static int sis_drm_alloc(struct drm_device *dev, struct drm_file *file,
86 void *data, int pool)
87{
88 drm_sis_private_t *dev_priv = dev->dev_private;
89 drm_sis_mem_t *mem = data;
90 int retval = 0, user_key;
91 struct sis_memblock *item;
92 struct sis_file_private *file_priv = file->driver_priv;
93 unsigned long offset;
94
95 mutex_lock(&dev->struct_mutex);
96
97 if (0 == ((pool == 0) ? dev_priv->vram_initialized :
98 dev_priv->agp_initialized)) {
99 DRM_ERROR
100 ("Attempt to allocate from uninitialized memory manager.\n");
101 mutex_unlock(&dev->struct_mutex);
102 return -EINVAL;
103 }
104
105 item = kzalloc(sizeof(*item), GFP_KERNEL);
106 if (!item) {
107 retval = -ENOMEM;
108 goto fail_alloc;
109 }
110
111 mem->size = (mem->size + SIS_MM_ALIGN_MASK) >> SIS_MM_ALIGN_SHIFT;
112 if (pool == AGP_TYPE) {
113 retval = drm_mm_insert_node(&dev_priv->agp_mm,
114 &item->mm_node,
115 mem->size);
116 offset = item->mm_node.start;
117 } else {
118#if defined(CONFIG_FB_SIS) || defined(CONFIG_FB_SIS_MODULE)
119 item->req.size = mem->size;
120 sis_malloc(&item->req);
121 if (item->req.size == 0)
122 retval = -ENOMEM;
123 offset = item->req.offset;
124#else
125 retval = drm_mm_insert_node(&dev_priv->vram_mm,
126 &item->mm_node,
127 mem->size);
128 offset = item->mm_node.start;
129#endif
130 }
131 if (retval)
132 goto fail_alloc;
133
134 retval = idr_alloc(&dev_priv->object_idr, item, 1, 0, GFP_KERNEL);
135 if (retval < 0)
136 goto fail_idr;
137 user_key = retval;
138
139 list_add(&item->owner_list, &file_priv->obj_list);
140 mutex_unlock(&dev->struct_mutex);
141
142 mem->offset = ((pool == 0) ?
143 dev_priv->vram_offset : dev_priv->agp_offset) +
144 (offset << SIS_MM_ALIGN_SHIFT);
145 mem->free = user_key;
146 mem->size = mem->size << SIS_MM_ALIGN_SHIFT;
147
148 return 0;
149
150fail_idr:
151 drm_mm_remove_node(&item->mm_node);
152fail_alloc:
153 kfree(item);
154 mutex_unlock(&dev->struct_mutex);
155
156 mem->offset = 0;
157 mem->size = 0;
158 mem->free = 0;
159
160 DRM_DEBUG("alloc %d, size = %ld, offset = %ld\n", pool, mem->size,
161 mem->offset);
162
163 return retval;
164}
165
166static int sis_drm_free(struct drm_device *dev, void *data, struct drm_file *file_priv)
167{
168 drm_sis_private_t *dev_priv = dev->dev_private;
169 drm_sis_mem_t *mem = data;
170 struct sis_memblock *obj;
171
172 mutex_lock(&dev->struct_mutex);
173 obj = idr_find(&dev_priv->object_idr, mem->free);
174 if (obj == NULL) {
175 mutex_unlock(&dev->struct_mutex);
176 return -EINVAL;
177 }
178
179 idr_remove(&dev_priv->object_idr, mem->free);
180 list_del(&obj->owner_list);
181 if (drm_mm_node_allocated(&obj->mm_node))
182 drm_mm_remove_node(&obj->mm_node);
183#if defined(CONFIG_FB_SIS) || defined(CONFIG_FB_SIS_MODULE)
184 else
185 sis_free(obj->req.offset);
186#endif
187 kfree(obj);
188 mutex_unlock(&dev->struct_mutex);
189 DRM_DEBUG("free = 0x%lx\n", mem->free);
190
191 return 0;
192}
193
194static int sis_fb_alloc(struct drm_device *dev, void *data,
195 struct drm_file *file_priv)
196{
197 return sis_drm_alloc(dev, file_priv, data, VIDEO_TYPE);
198}
199
200static int sis_ioctl_agp_init(struct drm_device *dev, void *data,
201 struct drm_file *file_priv)
202{
203 drm_sis_private_t *dev_priv = dev->dev_private;
204 drm_sis_agp_t *agp = data;
205 dev_priv = dev->dev_private;
206
207 mutex_lock(&dev->struct_mutex);
208 drm_mm_init(&dev_priv->agp_mm, 0, agp->size >> SIS_MM_ALIGN_SHIFT);
209
210 dev_priv->agp_initialized = 1;
211 dev_priv->agp_offset = agp->offset;
212 mutex_unlock(&dev->struct_mutex);
213
214 DRM_DEBUG("offset = %lu, size = %lu\n", agp->offset, agp->size);
215 return 0;
216}
217
218static int sis_ioctl_agp_alloc(struct drm_device *dev, void *data,
219 struct drm_file *file_priv)
220{
221
222 return sis_drm_alloc(dev, file_priv, data, AGP_TYPE);
223}
224
225static drm_local_map_t *sis_reg_init(struct drm_device *dev)
226{
227 struct drm_map_list *entry;
228 drm_local_map_t *map;
229
230 list_for_each_entry(entry, &dev->maplist, head) {
231 map = entry->map;
232 if (!map)
233 continue;
234 if (map->type == _DRM_REGISTERS)
235 return map;
236 }
237 return NULL;
238}
239
240int sis_idle(struct drm_device *dev)
241{
242 drm_sis_private_t *dev_priv = dev->dev_private;
243 uint32_t idle_reg;
244 unsigned long end;
245 int i;
246
247 if (dev_priv->idle_fault)
248 return 0;
249
250 if (dev_priv->mmio == NULL) {
251 dev_priv->mmio = sis_reg_init(dev);
252 if (dev_priv->mmio == NULL) {
253 DRM_ERROR("Could not find register map.\n");
254 return 0;
255 }
256 }
257
258
259
260
261
262 if (dev_priv->chipset != SIS_CHIP_315)
263 return 0;
264
265
266
267
268
269
270 end = jiffies + (HZ * 3);
271
272 for (i = 0; i < 4; ++i) {
273 do {
274 idle_reg = SIS_READ(0x85cc);
275 } while (!time_after_eq(jiffies, end) &&
276 ((idle_reg & 0x80000000) != 0x80000000));
277 }
278
279 if (time_after_eq(jiffies, end)) {
280 DRM_ERROR("Graphics engine idle timeout. "
281 "Disabling idle check\n");
282 dev_priv->idle_fault = 1;
283 }
284
285
286
287
288
289
290 return 0;
291}
292
293
294void sis_lastclose(struct drm_device *dev)
295{
296 drm_sis_private_t *dev_priv = dev->dev_private;
297
298 if (!dev_priv)
299 return;
300
301 mutex_lock(&dev->struct_mutex);
302 if (dev_priv->vram_initialized) {
303 drm_mm_takedown(&dev_priv->vram_mm);
304 dev_priv->vram_initialized = 0;
305 }
306 if (dev_priv->agp_initialized) {
307 drm_mm_takedown(&dev_priv->agp_mm);
308 dev_priv->agp_initialized = 0;
309 }
310 dev_priv->mmio = NULL;
311 mutex_unlock(&dev->struct_mutex);
312}
313
314void sis_reclaim_buffers_locked(struct drm_device *dev,
315 struct drm_file *file)
316{
317 struct sis_file_private *file_priv = file->driver_priv;
318 struct sis_memblock *entry, *next;
319
320 if (!(dev->master && file->master->lock.hw_lock))
321 return;
322
323 drm_legacy_idlelock_take(&file->master->lock);
324
325 mutex_lock(&dev->struct_mutex);
326 if (list_empty(&file_priv->obj_list)) {
327 mutex_unlock(&dev->struct_mutex);
328 drm_legacy_idlelock_release(&file->master->lock);
329
330 return;
331 }
332
333 sis_idle(dev);
334
335
336 list_for_each_entry_safe(entry, next, &file_priv->obj_list,
337 owner_list) {
338 list_del(&entry->owner_list);
339 if (drm_mm_node_allocated(&entry->mm_node))
340 drm_mm_remove_node(&entry->mm_node);
341#if defined(CONFIG_FB_SIS) || defined(CONFIG_FB_SIS_MODULE)
342 else
343 sis_free(entry->req.offset);
344#endif
345 kfree(entry);
346 }
347 mutex_unlock(&dev->struct_mutex);
348
349 drm_legacy_idlelock_release(&file->master->lock);
350
351 return;
352}
353
354const struct drm_ioctl_desc sis_ioctls[] = {
355 DRM_IOCTL_DEF_DRV(SIS_FB_ALLOC, sis_fb_alloc, DRM_AUTH),
356 DRM_IOCTL_DEF_DRV(SIS_FB_FREE, sis_drm_free, DRM_AUTH),
357 DRM_IOCTL_DEF_DRV(SIS_AGP_INIT, sis_ioctl_agp_init, DRM_AUTH | DRM_MASTER | DRM_ROOT_ONLY),
358 DRM_IOCTL_DEF_DRV(SIS_AGP_ALLOC, sis_ioctl_agp_alloc, DRM_AUTH),
359 DRM_IOCTL_DEF_DRV(SIS_AGP_FREE, sis_drm_free, DRM_AUTH),
360 DRM_IOCTL_DEF_DRV(SIS_FB_INIT, sis_fb_init, DRM_AUTH | DRM_MASTER | DRM_ROOT_ONLY),
361};
362
363int sis_max_ioctl = ARRAY_SIZE(sis_ioctls);
364