drm/radeon: Sync to Linux 3.11
[dragonfly.git] / sys / dev / drm / radeon / radeon_cs.c
1 /*
2  * Copyright 2008 Jerome Glisse.
3  * 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, sublicense,
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 next
13  * paragraph) shall be included in all copies or substantial portions of the
14  * 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 NONINFRINGEMENT.  IN NO EVENT SHALL
19  * PRECISION INSIGHT 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  * Authors:
25  *    Jerome Glisse <glisse@freedesktop.org>
26  *
27  * $FreeBSD: head/sys/dev/drm2/radeon/radeon_cs.c 254885 2013-08-25 19:37:15Z dumbbell $
28  */
29
30 #include <drm/drmP.h>
31 #include <uapi_drm/radeon_drm.h>
32 #include "radeon_reg.h"
33 #include "radeon.h"
34
35 static int radeon_cs_parser_relocs(struct radeon_cs_parser *p)
36 {
37         struct drm_device *ddev = p->rdev->ddev;
38         struct radeon_cs_chunk *chunk;
39         unsigned i, j;
40         bool duplicate;
41
42         if (p->chunk_relocs_idx == -1) {
43                 return 0;
44         }
45         chunk = &p->chunks[p->chunk_relocs_idx];
46         p->dma_reloc_idx = 0;
47         /* FIXME: we assume that each relocs use 4 dwords */
48         p->nrelocs = chunk->length_dw / 4;
49         p->relocs_ptr = kmalloc(p->nrelocs * sizeof(void *), M_DRM,
50                                 M_ZERO | M_WAITOK);
51         if (p->relocs_ptr == NULL) {
52                 return -ENOMEM;
53         }
54         p->relocs = kmalloc(p->nrelocs * sizeof(struct radeon_cs_reloc),
55                             M_DRM, M_ZERO | M_WAITOK);
56         if (p->relocs == NULL) {
57                 return -ENOMEM;
58         }
59         for (i = 0; i < p->nrelocs; i++) {
60                 struct drm_radeon_cs_reloc *r;
61
62                 duplicate = false;
63                 r = (struct drm_radeon_cs_reloc *)&chunk->kdata[i*4];
64                 for (j = 0; j < i; j++) {
65                         if (r->handle == p->relocs[j].handle) {
66                                 p->relocs_ptr[i] = &p->relocs[j];
67                                 duplicate = true;
68                                 break;
69                         }
70                 }
71                 if (duplicate) {
72                         p->relocs[i].handle = 0;
73                         continue;
74                 }
75
76                 p->relocs[i].gobj = drm_gem_object_lookup(ddev, p->filp,
77                                                           r->handle);
78                 if (p->relocs[i].gobj == NULL) {
79                         DRM_ERROR("gem object lookup failed 0x%x\n",
80                                   r->handle);
81                         return -ENOENT;
82                 }
83                 p->relocs_ptr[i] = &p->relocs[i];
84                 p->relocs[i].robj = gem_to_radeon_bo(p->relocs[i].gobj);
85                 p->relocs[i].lobj.bo = p->relocs[i].robj;
86                 p->relocs[i].lobj.written = !!r->write_domain;
87
88                 /* the first reloc of an UVD job is the
89                    msg and that must be in VRAM */
90                 if (p->ring == R600_RING_TYPE_UVD_INDEX && i == 0) {
91                         /* TODO: is this still needed for NI+ ? */
92                         p->relocs[i].lobj.domain =
93                                 RADEON_GEM_DOMAIN_VRAM;
94
95                         p->relocs[i].lobj.alt_domain =
96                                 RADEON_GEM_DOMAIN_VRAM;
97
98                 } else {
99                         uint32_t domain = r->write_domain ?
100                                 r->write_domain : r->read_domains;
101
102                         p->relocs[i].lobj.domain = domain;
103                         if (domain == RADEON_GEM_DOMAIN_VRAM)
104                                 domain |= RADEON_GEM_DOMAIN_GTT;
105                         p->relocs[i].lobj.alt_domain = domain;
106                 }
107
108                 p->relocs[i].lobj.tv.bo = &p->relocs[i].robj->tbo;
109                 p->relocs[i].handle = r->handle;
110
111                 radeon_bo_list_add_object(&p->relocs[i].lobj,
112                                           &p->validated);
113         }
114         return radeon_bo_list_validate(&p->validated, p->ring);
115 }
116
117 static int radeon_cs_get_ring(struct radeon_cs_parser *p, u32 ring, s32 priority)
118 {
119         p->priority = priority;
120
121         switch (ring) {
122         default:
123                 DRM_ERROR("unknown ring id: %d\n", ring);
124                 return -EINVAL;
125         case RADEON_CS_RING_GFX:
126                 p->ring = RADEON_RING_TYPE_GFX_INDEX;
127                 break;
128         case RADEON_CS_RING_COMPUTE:
129                 if (p->rdev->family >= CHIP_TAHITI) {
130                         if (p->priority > 0)
131                                 p->ring = CAYMAN_RING_TYPE_CP1_INDEX;
132                         else
133                                 p->ring = CAYMAN_RING_TYPE_CP2_INDEX;
134                 } else
135                         p->ring = RADEON_RING_TYPE_GFX_INDEX;
136                 break;
137         case RADEON_CS_RING_DMA:
138                 if (p->rdev->family >= CHIP_CAYMAN) {
139                         if (p->priority > 0)
140                                 p->ring = R600_RING_TYPE_DMA_INDEX;
141                         else
142                                 p->ring = CAYMAN_RING_TYPE_DMA1_INDEX;
143                 } else if (p->rdev->family >= CHIP_R600) {
144                         p->ring = R600_RING_TYPE_DMA_INDEX;
145                 } else {
146                         return -EINVAL;
147                 }
148                 break;
149         case RADEON_CS_RING_UVD:
150                 p->ring = R600_RING_TYPE_UVD_INDEX;
151                 break;
152         }
153         return 0;
154 }
155
156 static void radeon_cs_sync_rings(struct radeon_cs_parser *p)
157 {
158         int i;
159
160         for (i = 0; i < p->nrelocs; i++) {
161                 if (!p->relocs[i].robj)
162                         continue;
163
164                 radeon_ib_sync_to(&p->ib, p->relocs[i].robj->tbo.sync_obj);
165         }
166 }
167
168 /* XXX: note that this is called from the legacy UMS CS ioctl as well */
169 int radeon_cs_parser_init(struct radeon_cs_parser *p, void *data)
170 {
171         struct drm_radeon_cs *cs = data;
172         uint64_t *chunk_array_ptr;
173         unsigned size, i;
174         u32 ring = RADEON_CS_RING_GFX;
175         s32 priority = 0;
176
177         if (!cs->num_chunks) {
178                 return 0;
179         }
180         /* get chunks */
181         INIT_LIST_HEAD(&p->validated);
182         p->idx = 0;
183         p->ib.sa_bo = NULL;
184         p->ib.semaphore = NULL;
185         p->const_ib.sa_bo = NULL;
186         p->const_ib.semaphore = NULL;
187         p->chunk_ib_idx = -1;
188         p->chunk_relocs_idx = -1;
189         p->chunk_flags_idx = -1;
190         p->chunk_const_ib_idx = -1;
191         p->chunks_array = kmalloc(cs->num_chunks * sizeof(uint64_t),
192                                   M_DRM, M_ZERO | M_WAITOK);
193         if (p->chunks_array == NULL) {
194                 return -ENOMEM;
195         }
196         chunk_array_ptr = (uint64_t *)(unsigned long)(cs->chunks);
197         if (DRM_COPY_FROM_USER(p->chunks_array, chunk_array_ptr,
198                                sizeof(uint64_t)*cs->num_chunks)) {
199                 return -EFAULT;
200         }
201         p->cs_flags = 0;
202         p->nchunks = cs->num_chunks;
203         p->chunks = kmalloc(p->nchunks * sizeof(struct radeon_cs_chunk),
204                             M_DRM, M_ZERO | M_WAITOK);
205         if (p->chunks == NULL) {
206                 return -ENOMEM;
207         }
208         for (i = 0; i < p->nchunks; i++) {
209                 struct drm_radeon_cs_chunk __user **chunk_ptr = NULL;
210                 struct drm_radeon_cs_chunk user_chunk;
211                 uint32_t __user *cdata;
212
213                 chunk_ptr = (void __user*)(unsigned long)p->chunks_array[i];
214                 if (DRM_COPY_FROM_USER(&user_chunk, chunk_ptr,
215                                        sizeof(struct drm_radeon_cs_chunk))) {
216                         return -EFAULT;
217                 }
218                 p->chunks[i].length_dw = user_chunk.length_dw;
219                 p->chunks[i].kdata = NULL;
220                 p->chunks[i].chunk_id = user_chunk.chunk_id;
221                 p->chunks[i].user_ptr = (void __user *)(unsigned long)user_chunk.chunk_data;
222                 if (p->chunks[i].chunk_id == RADEON_CHUNK_ID_RELOCS) {
223                         p->chunk_relocs_idx = i;
224                 }
225                 if (p->chunks[i].chunk_id == RADEON_CHUNK_ID_IB) {
226                         p->chunk_ib_idx = i;
227                         /* zero length IB isn't useful */
228                         if (p->chunks[i].length_dw == 0)
229                                 return -EINVAL;
230                 }
231                 if (p->chunks[i].chunk_id == RADEON_CHUNK_ID_CONST_IB) {
232                         p->chunk_const_ib_idx = i;
233                         /* zero length CONST IB isn't useful */
234                         if (p->chunks[i].length_dw == 0)
235                                 return -EINVAL;
236                 }
237                 if (p->chunks[i].chunk_id == RADEON_CHUNK_ID_FLAGS) {
238                         p->chunk_flags_idx = i;
239                         /* zero length flags aren't useful */
240                         if (p->chunks[i].length_dw == 0)
241                                 return -EINVAL;
242                 }
243
244                 cdata = (uint32_t *)(unsigned long)user_chunk.chunk_data;
245                 if ((p->chunks[i].chunk_id == RADEON_CHUNK_ID_RELOCS) ||
246                     (p->chunks[i].chunk_id == RADEON_CHUNK_ID_FLAGS)) {
247                         size = p->chunks[i].length_dw * sizeof(uint32_t);
248                         p->chunks[i].kdata = kmalloc(size, M_DRM,
249                                                      M_WAITOK);
250                         if (p->chunks[i].kdata == NULL) {
251                                 return -ENOMEM;
252                         }
253                         if (DRM_COPY_FROM_USER(p->chunks[i].kdata,
254                                                p->chunks[i].user_ptr, size)) {
255                                 return -EFAULT;
256                         }
257                         if (p->chunks[i].chunk_id == RADEON_CHUNK_ID_FLAGS) {
258                                 p->cs_flags = p->chunks[i].kdata[0];
259                                 if (p->chunks[i].length_dw > 1)
260                                         ring = p->chunks[i].kdata[1];
261                                 if (p->chunks[i].length_dw > 2)
262                                         priority = (s32)p->chunks[i].kdata[2];
263                         }
264                 }
265         }
266
267         /* these are KMS only */
268         if (p->rdev) {
269                 if ((p->cs_flags & RADEON_CS_USE_VM) &&
270                     !p->rdev->vm_manager.enabled) {
271                         DRM_ERROR("VM not active on asic!\n");
272                         return -EINVAL;
273                 }
274
275                 if (radeon_cs_get_ring(p, ring, priority))
276                         return -EINVAL;
277
278                 /* we only support VM on some SI+ rings */
279                 if ((p->rdev->asic->ring[p->ring].cs_parse == NULL) &&
280                    ((p->cs_flags & RADEON_CS_USE_VM) == 0)) {
281                         DRM_ERROR("Ring %d requires VM!\n", p->ring);
282                         return -EINVAL;
283                 }
284         }
285
286         /* deal with non-vm */
287         if ((p->chunk_ib_idx != -1) &&
288             ((p->cs_flags & RADEON_CS_USE_VM) == 0) &&
289             (p->chunks[p->chunk_ib_idx].chunk_id == RADEON_CHUNK_ID_IB)) {
290                 if (p->chunks[p->chunk_ib_idx].length_dw > (16 * 1024)) {
291                         DRM_ERROR("cs IB too big: %d\n",
292                                   p->chunks[p->chunk_ib_idx].length_dw);
293                         return -EINVAL;
294                 }
295                 if (p->rdev && (p->rdev->flags & RADEON_IS_AGP)) {
296                         p->chunks[p->chunk_ib_idx].kpage[0] = kmalloc(PAGE_SIZE,
297                                                                       M_DRM,
298                                                                       M_WAITOK);
299                         p->chunks[p->chunk_ib_idx].kpage[1] = kmalloc(PAGE_SIZE,
300                                                                       M_DRM,
301                                                                       M_WAITOK);
302                         if (p->chunks[p->chunk_ib_idx].kpage[0] == NULL ||
303                             p->chunks[p->chunk_ib_idx].kpage[1] == NULL) {
304                                 drm_free(p->chunks[p->chunk_ib_idx].kpage[0],
305                                          M_DRM);
306                                 drm_free(p->chunks[p->chunk_ib_idx].kpage[1],
307                                          M_DRM);
308                                 p->chunks[p->chunk_ib_idx].kpage[0] = NULL;
309                                 p->chunks[p->chunk_ib_idx].kpage[1] = NULL;
310                                 return -ENOMEM;
311                         }
312                 }
313                 p->chunks[p->chunk_ib_idx].kpage_idx[0] = -1;
314                 p->chunks[p->chunk_ib_idx].kpage_idx[1] = -1;
315                 p->chunks[p->chunk_ib_idx].last_copied_page = -1;
316                 p->chunks[p->chunk_ib_idx].last_page_index =
317                         ((p->chunks[p->chunk_ib_idx].length_dw * 4) - 1) / PAGE_SIZE;
318         }
319
320         return 0;
321 }
322
323 /**
324  * cs_parser_fini() - clean parser states
325  * @parser:     parser structure holding parsing context.
326  * @error:      error number
327  *
328  * If error is set than unvalidate buffer, otherwise just free memory
329  * used by parsing context.
330  **/
331 static void radeon_cs_parser_fini(struct radeon_cs_parser *parser, int error)
332 {
333         unsigned i;
334
335         if (!error) {
336                 ttm_eu_fence_buffer_objects(&parser->validated,
337                                             parser->ib.fence);
338         } else {
339                 ttm_eu_backoff_reservation(&parser->validated);
340         }
341
342         if (parser->relocs != NULL) {
343                 for (i = 0; i < parser->nrelocs; i++) {
344                         if (parser->relocs[i].gobj)
345                                 drm_gem_object_unreference_unlocked(parser->relocs[i].gobj);
346                 }
347         }
348         drm_free(parser->track, M_DRM);
349         drm_free(parser->relocs, M_DRM);
350         drm_free(parser->relocs_ptr, M_DRM);
351         for (i = 0; i < parser->nchunks; i++) {
352                 drm_free(parser->chunks[i].kdata, M_DRM);
353                 if ((parser->rdev->flags & RADEON_IS_AGP)) {
354                         drm_free(parser->chunks[i].kpage[0], M_DRM);
355                         drm_free(parser->chunks[i].kpage[1], M_DRM);
356                 }
357         }
358         drm_free(parser->chunks, M_DRM);
359         drm_free(parser->chunks_array, M_DRM);
360         radeon_ib_free(parser->rdev, &parser->ib);
361         radeon_ib_free(parser->rdev, &parser->const_ib);
362 }
363
364 static int radeon_cs_ib_chunk(struct radeon_device *rdev,
365                               struct radeon_cs_parser *parser)
366 {
367         struct radeon_cs_chunk *ib_chunk;
368         int r;
369
370         if (parser->chunk_ib_idx == -1)
371                 return 0;
372
373         if (parser->cs_flags & RADEON_CS_USE_VM)
374                 return 0;
375
376         ib_chunk = &parser->chunks[parser->chunk_ib_idx];
377         /* Copy the packet into the IB, the parser will read from the
378          * input memory (cached) and write to the IB (which can be
379          * uncached).
380          */
381         r =  radeon_ib_get(rdev, parser->ring, &parser->ib,
382                            NULL, ib_chunk->length_dw * 4);
383         if (r) {
384                 DRM_ERROR("Failed to get ib !\n");
385                 return r;
386         }
387         parser->ib.length_dw = ib_chunk->length_dw;
388         r = radeon_cs_parse(rdev, parser->ring, parser);
389         if (r || parser->parser_error) {
390                 DRM_ERROR("Invalid command stream !\n");
391                 return r;
392         }
393         r = radeon_cs_finish_pages(parser);
394         if (r) {
395                 DRM_ERROR("Invalid command stream !\n");
396                 return r;
397         }
398         radeon_cs_sync_rings(parser);
399         r = radeon_ib_schedule(rdev, &parser->ib, NULL);
400         if (r) {
401                 DRM_ERROR("Failed to schedule IB !\n");
402         }
403         return r;
404 }
405
406 static int radeon_bo_vm_update_pte(struct radeon_cs_parser *parser,
407                                    struct radeon_vm *vm)
408 {
409         struct radeon_device *rdev = parser->rdev;
410         struct radeon_bo_list *lobj;
411         struct radeon_bo *bo;
412         int r;
413
414         r = radeon_vm_bo_update_pte(rdev, vm, rdev->ring_tmp_bo.bo, &rdev->ring_tmp_bo.bo->tbo.mem);
415         if (r) {
416                 return r;
417         }
418         list_for_each_entry(lobj, &parser->validated, tv.head) {
419                 bo = lobj->bo;
420                 r = radeon_vm_bo_update_pte(parser->rdev, vm, bo, &bo->tbo.mem);
421                 if (r) {
422                         return r;
423                 }
424         }
425         return 0;
426 }
427
428 static int radeon_cs_ib_vm_chunk(struct radeon_device *rdev,
429                                  struct radeon_cs_parser *parser)
430 {
431         struct radeon_cs_chunk *ib_chunk;
432         struct radeon_fpriv *fpriv = parser->filp->driver_priv;
433         struct radeon_vm *vm = &fpriv->vm;
434         int r;
435
436         if (parser->chunk_ib_idx == -1)
437                 return 0;
438         if ((parser->cs_flags & RADEON_CS_USE_VM) == 0)
439                 return 0;
440
441         if ((rdev->family >= CHIP_TAHITI) &&
442             (parser->chunk_const_ib_idx != -1)) {
443                 ib_chunk = &parser->chunks[parser->chunk_const_ib_idx];
444                 if (ib_chunk->length_dw > RADEON_IB_VM_MAX_SIZE) {
445                         DRM_ERROR("cs IB CONST too big: %d\n", ib_chunk->length_dw);
446                         return -EINVAL;
447                 }
448                 r =  radeon_ib_get(rdev, parser->ring, &parser->const_ib,
449                                    vm, ib_chunk->length_dw * 4);
450                 if (r) {
451                         DRM_ERROR("Failed to get const ib !\n");
452                         return r;
453                 }
454                 parser->const_ib.is_const_ib = true;
455                 parser->const_ib.length_dw = ib_chunk->length_dw;
456                 /* Copy the packet into the IB */
457                 if (DRM_COPY_FROM_USER(parser->const_ib.ptr, ib_chunk->user_ptr,
458                                        ib_chunk->length_dw * 4)) {
459                         return -EFAULT;
460                 }
461                 r = radeon_ring_ib_parse(rdev, parser->ring, &parser->const_ib);
462                 if (r) {
463                         return r;
464                 }
465         }
466
467         ib_chunk = &parser->chunks[parser->chunk_ib_idx];
468         if (ib_chunk->length_dw > RADEON_IB_VM_MAX_SIZE) {
469                 DRM_ERROR("cs IB too big: %d\n", ib_chunk->length_dw);
470                 return -EINVAL;
471         }
472         r =  radeon_ib_get(rdev, parser->ring, &parser->ib,
473                            vm, ib_chunk->length_dw * 4);
474         if (r) {
475                 DRM_ERROR("Failed to get ib !\n");
476                 return r;
477         }
478         parser->ib.length_dw = ib_chunk->length_dw;
479         /* Copy the packet into the IB */
480         if (DRM_COPY_FROM_USER(parser->ib.ptr, ib_chunk->user_ptr,
481                                ib_chunk->length_dw * 4)) {
482                 return -EFAULT;
483         }
484         r = radeon_ring_ib_parse(rdev, parser->ring, &parser->ib);
485         if (r) {
486                 return r;
487         }
488
489         lockmgr(&rdev->vm_manager.lock, LK_EXCLUSIVE);
490         lockmgr(&vm->mutex, LK_EXCLUSIVE);
491         r = radeon_vm_alloc_pt(rdev, vm);
492         if (r) {
493                 goto out;
494         }
495         r = radeon_bo_vm_update_pte(parser, vm);
496         if (r) {
497                 goto out;
498         }
499         radeon_cs_sync_rings(parser);
500         radeon_ib_sync_to(&parser->ib, vm->fence);
501         radeon_ib_sync_to(&parser->ib, radeon_vm_grab_id(
502                 rdev, vm, parser->ring));
503
504         if ((rdev->family >= CHIP_TAHITI) &&
505             (parser->chunk_const_ib_idx != -1)) {
506                 r = radeon_ib_schedule(rdev, &parser->ib, &parser->const_ib);
507         } else {
508                 r = radeon_ib_schedule(rdev, &parser->ib, NULL);
509         }
510
511         if (!r) {
512                 radeon_vm_fence(rdev, vm, parser->ib.fence);
513         }
514
515 out:
516         radeon_vm_add_to_lru(rdev, vm);
517         lockmgr(&vm->mutex, LK_RELEASE);
518         lockmgr(&rdev->vm_manager.lock, LK_RELEASE);
519         return r;
520 }
521
522 static int radeon_cs_handle_lockup(struct radeon_device *rdev, int r)
523 {
524         if (r == -EDEADLK) {
525                 r = radeon_gpu_reset(rdev);
526                 if (!r)
527                         r = -EAGAIN;
528         }
529         return r;
530 }
531
532 int radeon_cs_ioctl(struct drm_device *dev, void *data, struct drm_file *filp)
533 {
534         struct radeon_device *rdev = dev->dev_private;
535         struct radeon_cs_parser parser;
536         int r;
537
538         lockmgr(&rdev->exclusive_lock, LK_EXCLUSIVE);
539         if (!rdev->accel_working) {
540                 lockmgr(&rdev->exclusive_lock, LK_RELEASE);
541                 return -EBUSY;
542         }
543         /* initialize parser */
544         memset(&parser, 0, sizeof(struct radeon_cs_parser));
545         parser.filp = filp;
546         parser.rdev = rdev;
547         parser.dev = rdev->dev;
548         parser.family = rdev->family;
549         r = radeon_cs_parser_init(&parser, data);
550         if (r) {
551                 DRM_ERROR("Failed to initialize parser !\n");
552                 radeon_cs_parser_fini(&parser, r);
553                 lockmgr(&rdev->exclusive_lock, LK_RELEASE);
554                 r = radeon_cs_handle_lockup(rdev, r);
555                 return r;
556         }
557         r = radeon_cs_parser_relocs(&parser);
558         if (r) {
559                 if (r != -ERESTARTSYS)
560                         DRM_ERROR("Failed to parse relocation %d!\n", r);
561                 radeon_cs_parser_fini(&parser, r);
562                 lockmgr(&rdev->exclusive_lock, LK_RELEASE);
563                 r = radeon_cs_handle_lockup(rdev, r);
564                 return r;
565         }
566
567         /* XXX pick SD/HD/MVC */
568         if (parser.ring == R600_RING_TYPE_UVD_INDEX)
569                 radeon_uvd_note_usage(rdev);
570
571         r = radeon_cs_ib_chunk(rdev, &parser);
572         if (r) {
573                 goto out;
574         }
575         r = radeon_cs_ib_vm_chunk(rdev, &parser);
576         if (r) {
577                 goto out;
578         }
579 out:
580         radeon_cs_parser_fini(&parser, r);
581         lockmgr(&rdev->exclusive_lock, LK_RELEASE);
582         r = radeon_cs_handle_lockup(rdev, r);
583         return r;
584 }
585
586 int radeon_cs_finish_pages(struct radeon_cs_parser *p)
587 {
588         struct radeon_cs_chunk *ibc = &p->chunks[p->chunk_ib_idx];
589         int i;
590         int size = PAGE_SIZE;
591
592         for (i = ibc->last_copied_page + 1; i <= ibc->last_page_index; i++) {
593                 if (i == ibc->last_page_index) {
594                         size = (ibc->length_dw * 4) % PAGE_SIZE;
595                         if (size == 0)
596                                 size = PAGE_SIZE;
597                 }
598                 
599                 if (DRM_COPY_FROM_USER(p->ib.ptr + (i * (PAGE_SIZE/4)),
600                                        (char *)ibc->user_ptr + (i * PAGE_SIZE),
601                                        size))
602                         return -EFAULT;
603         }
604         return 0;
605 }
606
607 static int radeon_cs_update_pages(struct radeon_cs_parser *p, int pg_idx)
608 {
609         int new_page;
610         struct radeon_cs_chunk *ibc = &p->chunks[p->chunk_ib_idx];
611         int i;
612         int size = PAGE_SIZE;
613         bool copy1 = (p->rdev && (p->rdev->flags & RADEON_IS_AGP)) ?
614                 false : true;
615
616         for (i = ibc->last_copied_page + 1; i < pg_idx; i++) {
617                 if (DRM_COPY_FROM_USER(p->ib.ptr + (i * (PAGE_SIZE/4)),
618                                        (char *)ibc->user_ptr + (i * PAGE_SIZE),
619                                        PAGE_SIZE)) {
620                         p->parser_error = -EFAULT;
621                         return 0;
622                 }
623         }
624
625         if (pg_idx == ibc->last_page_index) {
626                 size = (ibc->length_dw * 4) % PAGE_SIZE;
627                 if (size == 0)
628                         size = PAGE_SIZE;
629         }
630
631         new_page = ibc->kpage_idx[0] < ibc->kpage_idx[1] ? 0 : 1;
632         if (copy1)
633                 ibc->kpage[new_page] = p->ib.ptr + (pg_idx * (PAGE_SIZE / 4));
634
635         if (DRM_COPY_FROM_USER(ibc->kpage[new_page],
636                                (char *)ibc->user_ptr + (pg_idx * PAGE_SIZE),
637                                size)) {
638                 p->parser_error = -EFAULT;
639                 return 0;
640         }
641
642         /* copy to IB for non single case */
643         if (!copy1)
644                 memcpy((void *)(p->ib.ptr+(pg_idx*(PAGE_SIZE/4))), ibc->kpage[new_page], size);
645
646         ibc->last_copied_page = pg_idx;
647         ibc->kpage_idx[new_page] = pg_idx;
648
649         return new_page;
650 }
651
652 u32 radeon_get_ib_value(struct radeon_cs_parser *p, int idx)
653 {
654         struct radeon_cs_chunk *ibc = &p->chunks[p->chunk_ib_idx];
655         u32 pg_idx, pg_offset;
656         u32 idx_value = 0;
657         int new_page;
658
659         pg_idx = (idx * 4) / PAGE_SIZE;
660         pg_offset = (idx * 4) % PAGE_SIZE;
661
662         if (ibc->kpage_idx[0] == pg_idx)
663                 return ibc->kpage[0][pg_offset/4];
664         if (ibc->kpage_idx[1] == pg_idx)
665                 return ibc->kpage[1][pg_offset/4];
666
667         new_page = radeon_cs_update_pages(p, pg_idx);
668         if (new_page < 0) {
669                 p->parser_error = new_page;
670                 return 0;
671         }
672
673         idx_value = ibc->kpage[new_page][pg_offset/4];
674         return idx_value;
675 }
676
677 /**
678  * radeon_cs_packet_parse() - parse cp packet and point ib index to next packet
679  * @parser:     parser structure holding parsing context.
680  * @pkt:        where to store packet information
681  *
682  * Assume that chunk_ib_index is properly set. Will return -EINVAL
683  * if packet is bigger than remaining ib size. or if packets is unknown.
684  **/
685 int radeon_cs_packet_parse(struct radeon_cs_parser *p,
686                            struct radeon_cs_packet *pkt,
687                            unsigned idx)
688 {
689         struct radeon_cs_chunk *ib_chunk = &p->chunks[p->chunk_ib_idx];
690         struct radeon_device *rdev = p->rdev;
691         uint32_t header;
692
693         if (idx >= ib_chunk->length_dw) {
694                 DRM_ERROR("Can not parse packet at %d after CS end %d !\n",
695                           idx, ib_chunk->length_dw);
696                 return -EINVAL;
697         }
698         header = radeon_get_ib_value(p, idx);
699         pkt->idx = idx;
700         pkt->type = RADEON_CP_PACKET_GET_TYPE(header);
701         pkt->count = RADEON_CP_PACKET_GET_COUNT(header);
702         pkt->one_reg_wr = 0;
703         switch (pkt->type) {
704         case RADEON_PACKET_TYPE0:
705                 if (rdev->family < CHIP_R600) {
706                         pkt->reg = R100_CP_PACKET0_GET_REG(header);
707                         pkt->one_reg_wr =
708                                 RADEON_CP_PACKET0_GET_ONE_REG_WR(header);
709                 } else
710                         pkt->reg = R600_CP_PACKET0_GET_REG(header);
711                 break;
712         case RADEON_PACKET_TYPE3:
713                 pkt->opcode = RADEON_CP_PACKET3_GET_OPCODE(header);
714                 break;
715         case RADEON_PACKET_TYPE2:
716                 pkt->count = -1;
717                 break;
718         default:
719                 DRM_ERROR("Unknown packet type %d at %d !\n", pkt->type, idx);
720                 return -EINVAL;
721         }
722         if ((pkt->count + 1 + pkt->idx) >= ib_chunk->length_dw) {
723                 DRM_ERROR("Packet (%d:%d:%d) end after CS buffer (%d) !\n",
724                           pkt->idx, pkt->type, pkt->count, ib_chunk->length_dw);
725                 return -EINVAL;
726         }
727         return 0;
728 }
729
730 /**
731  * radeon_cs_packet_next_is_pkt3_nop() - test if the next packet is P3 NOP
732  * @p:          structure holding the parser context.
733  *
734  * Check if the next packet is NOP relocation packet3.
735  **/
736 bool radeon_cs_packet_next_is_pkt3_nop(struct radeon_cs_parser *p)
737 {
738         struct radeon_cs_packet p3reloc;
739         int r;
740
741         r = radeon_cs_packet_parse(p, &p3reloc, p->idx);
742         if (r)
743                 return false;
744         if (p3reloc.type != RADEON_PACKET_TYPE3)
745                 return false;
746         if (p3reloc.opcode != RADEON_PACKET3_NOP)
747                 return false;
748         return true;
749 }
750
751 /**
752  * radeon_cs_dump_packet() - dump raw packet context
753  * @p:          structure holding the parser context.
754  * @pkt:        structure holding the packet.
755  *
756  * Used mostly for debugging and error reporting.
757  **/
758 void radeon_cs_dump_packet(struct radeon_cs_parser *p,
759                            struct radeon_cs_packet *pkt)
760 {
761         volatile uint32_t *ib;
762         unsigned i;
763         unsigned idx;
764
765         ib = p->ib.ptr;
766         idx = pkt->idx;
767         for (i = 0; i <= (pkt->count + 1); i++, idx++)
768                 DRM_INFO("ib[%d]=0x%08X\n", idx, ib[idx]);
769 }
770
771 /**
772  * radeon_cs_packet_next_reloc() - parse next (should be reloc) packet
773  * @parser:             parser structure holding parsing context.
774  * @data:               pointer to relocation data
775  * @offset_start:       starting offset
776  * @offset_mask:        offset mask (to align start offset on)
777  * @reloc:              reloc informations
778  *
779  * Check if next packet is relocation packet3, do bo validation and compute
780  * GPU offset using the provided start.
781  **/
782 int radeon_cs_packet_next_reloc(struct radeon_cs_parser *p,
783                                 struct radeon_cs_reloc **cs_reloc,
784                                 int nomm)
785 {
786         struct radeon_cs_chunk *relocs_chunk;
787         struct radeon_cs_packet p3reloc;
788         unsigned idx;
789         int r;
790
791         if (p->chunk_relocs_idx == -1) {
792                 DRM_ERROR("No relocation chunk !\n");
793                 return -EINVAL;
794         }
795         *cs_reloc = NULL;
796         relocs_chunk = &p->chunks[p->chunk_relocs_idx];
797         r = radeon_cs_packet_parse(p, &p3reloc, p->idx);
798         if (r)
799                 return r;
800         p->idx += p3reloc.count + 2;
801         if (p3reloc.type != RADEON_PACKET_TYPE3 ||
802             p3reloc.opcode != RADEON_PACKET3_NOP) {
803                 DRM_ERROR("No packet3 for relocation for packet at %d.\n",
804                           p3reloc.idx);
805                 radeon_cs_dump_packet(p, &p3reloc);
806                 return -EINVAL;
807         }
808         idx = radeon_get_ib_value(p, p3reloc.idx + 1);
809         if (idx >= relocs_chunk->length_dw) {
810                 DRM_ERROR("Relocs at %d after relocations chunk end %d !\n",
811                           idx, relocs_chunk->length_dw);
812                 radeon_cs_dump_packet(p, &p3reloc);
813                 return -EINVAL;
814         }
815         /* FIXME: we assume reloc size is 4 dwords */
816         if (nomm) {
817                 *cs_reloc = p->relocs;
818                 (*cs_reloc)->lobj.gpu_offset =
819                         (u64)relocs_chunk->kdata[idx + 3] << 32;
820                 (*cs_reloc)->lobj.gpu_offset |= relocs_chunk->kdata[idx + 0];
821         } else
822                 *cs_reloc = p->relocs_ptr[(idx / 4)];
823         return 0;
824 }