1
2
3
4
5
6
7#include <linux/dma-mapping.h>
8#include <linux/seq_file.h>
9#include <linux/shmem_fs.h>
10#include <linux/spinlock.h>
11#include <linux/pfn_t.h>
12
13#include <drm/drm_prime.h>
14#include <drm/drm_vma_manager.h>
15
16#include "omap_drv.h"
17#include "omap_dmm_tiler.h"
18
19
20
21
22
23
24#define OMAP_BO_MEM_DMA_API 0x01000000
25#define OMAP_BO_MEM_SHMEM 0x02000000
26#define OMAP_BO_MEM_DMABUF 0x08000000
27
28struct omap_gem_object {
29 struct drm_gem_object base;
30
31 struct list_head mm_list;
32
33 u32 flags;
34
35
36 u16 width, height;
37
38
39 u32 roll;
40
41
42 struct mutex lock;
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65 dma_addr_t dma_addr;
66
67
68
69
70 refcount_t dma_addr_cnt;
71
72
73
74
75
76 struct sg_table *sgt;
77
78
79
80
81 struct tiler_block *block;
82
83
84
85
86
87 struct page **pages;
88
89
90 dma_addr_t *dma_addrs;
91
92
93
94
95 void *vaddr;
96};
97
98#define to_omap_bo(x) container_of(x, struct omap_gem_object, base)
99
100
101
102
103
104
105
106
107
108
109
110
111#define NUM_USERGART_ENTRIES 2
112struct omap_drm_usergart_entry {
113 struct tiler_block *block;
114 dma_addr_t dma_addr;
115 struct drm_gem_object *obj;
116 pgoff_t obj_pgoff;
117
118};
119
120struct omap_drm_usergart {
121 struct omap_drm_usergart_entry entry[NUM_USERGART_ENTRIES];
122 int height;
123 int height_shift;
124 int slot_shift;
125 int stride_pfn;
126 int last;
127};
128
129
130
131
132
133
134u64 omap_gem_mmap_offset(struct drm_gem_object *obj)
135{
136 struct drm_device *dev = obj->dev;
137 int ret;
138 size_t size;
139
140
141 size = omap_gem_mmap_size(obj);
142 ret = drm_gem_create_mmap_offset_size(obj, size);
143 if (ret) {
144 dev_err(dev->dev, "could not allocate mmap offset\n");
145 return 0;
146 }
147
148 return drm_vma_node_offset_addr(&obj->vma_node);
149}
150
151static bool omap_gem_is_contiguous(struct omap_gem_object *omap_obj)
152{
153 if (omap_obj->flags & OMAP_BO_MEM_DMA_API)
154 return true;
155
156 if ((omap_obj->flags & OMAP_BO_MEM_DMABUF) && omap_obj->sgt->nents == 1)
157 return true;
158
159 return false;
160}
161
162
163
164
165
166static void omap_gem_evict_entry(struct drm_gem_object *obj,
167 enum tiler_fmt fmt, struct omap_drm_usergart_entry *entry)
168{
169 struct omap_gem_object *omap_obj = to_omap_bo(obj);
170 struct omap_drm_private *priv = obj->dev->dev_private;
171 int n = priv->usergart[fmt].height;
172 size_t size = PAGE_SIZE * n;
173 loff_t off = omap_gem_mmap_offset(obj) +
174 (entry->obj_pgoff << PAGE_SHIFT);
175 const int m = DIV_ROUND_UP(omap_obj->width << fmt, PAGE_SIZE);
176
177 if (m > 1) {
178 int i;
179
180 for (i = n; i > 0; i--) {
181 unmap_mapping_range(obj->dev->anon_inode->i_mapping,
182 off, PAGE_SIZE, 1);
183 off += PAGE_SIZE * m;
184 }
185 } else {
186 unmap_mapping_range(obj->dev->anon_inode->i_mapping,
187 off, size, 1);
188 }
189
190 entry->obj = NULL;
191}
192
193
194static void omap_gem_evict(struct drm_gem_object *obj)
195{
196 struct omap_gem_object *omap_obj = to_omap_bo(obj);
197 struct omap_drm_private *priv = obj->dev->dev_private;
198
199 if (omap_obj->flags & OMAP_BO_TILED_MASK) {
200 enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
201 int i;
202
203 for (i = 0; i < NUM_USERGART_ENTRIES; i++) {
204 struct omap_drm_usergart_entry *entry =
205 &priv->usergart[fmt].entry[i];
206
207 if (entry->obj == obj)
208 omap_gem_evict_entry(obj, fmt, entry);
209 }
210 }
211}
212
213
214
215
216
217
218
219
220
221static int omap_gem_attach_pages(struct drm_gem_object *obj)
222{
223 struct drm_device *dev = obj->dev;
224 struct omap_gem_object *omap_obj = to_omap_bo(obj);
225 struct page **pages;
226 int npages = obj->size >> PAGE_SHIFT;
227 int i, ret;
228 dma_addr_t *addrs;
229
230 lockdep_assert_held(&omap_obj->lock);
231
232
233
234
235
236 if (!(omap_obj->flags & OMAP_BO_MEM_SHMEM) || omap_obj->pages)
237 return 0;
238
239 pages = drm_gem_get_pages(obj);
240 if (IS_ERR(pages)) {
241 dev_err(obj->dev->dev, "could not get pages: %ld\n", PTR_ERR(pages));
242 return PTR_ERR(pages);
243 }
244
245
246
247
248 if (omap_obj->flags & (OMAP_BO_WC|OMAP_BO_UNCACHED)) {
249 addrs = kmalloc_array(npages, sizeof(*addrs), GFP_KERNEL);
250 if (!addrs) {
251 ret = -ENOMEM;
252 goto free_pages;
253 }
254
255 for (i = 0; i < npages; i++) {
256 addrs[i] = dma_map_page(dev->dev, pages[i],
257 0, PAGE_SIZE, DMA_TO_DEVICE);
258
259 if (dma_mapping_error(dev->dev, addrs[i])) {
260 dev_warn(dev->dev,
261 "%s: failed to map page\n", __func__);
262
263 for (i = i - 1; i >= 0; --i) {
264 dma_unmap_page(dev->dev, addrs[i],
265 PAGE_SIZE, DMA_TO_DEVICE);
266 }
267
268 ret = -ENOMEM;
269 goto free_addrs;
270 }
271 }
272 } else {
273 addrs = kcalloc(npages, sizeof(*addrs), GFP_KERNEL);
274 if (!addrs) {
275 ret = -ENOMEM;
276 goto free_pages;
277 }
278 }
279
280 omap_obj->dma_addrs = addrs;
281 omap_obj->pages = pages;
282
283 return 0;
284
285free_addrs:
286 kfree(addrs);
287free_pages:
288 drm_gem_put_pages(obj, pages, true, false);
289
290 return ret;
291}
292
293
294static void omap_gem_detach_pages(struct drm_gem_object *obj)
295{
296 struct omap_gem_object *omap_obj = to_omap_bo(obj);
297 unsigned int npages = obj->size >> PAGE_SHIFT;
298 unsigned int i;
299
300 lockdep_assert_held(&omap_obj->lock);
301
302 for (i = 0; i < npages; i++) {
303 if (omap_obj->dma_addrs[i])
304 dma_unmap_page(obj->dev->dev, omap_obj->dma_addrs[i],
305 PAGE_SIZE, DMA_TO_DEVICE);
306 }
307
308 kfree(omap_obj->dma_addrs);
309 omap_obj->dma_addrs = NULL;
310
311 drm_gem_put_pages(obj, omap_obj->pages, true, false);
312 omap_obj->pages = NULL;
313}
314
315
316u32 omap_gem_flags(struct drm_gem_object *obj)
317{
318 return to_omap_bo(obj)->flags;
319}
320
321
322size_t omap_gem_mmap_size(struct drm_gem_object *obj)
323{
324 struct omap_gem_object *omap_obj = to_omap_bo(obj);
325 size_t size = obj->size;
326
327 if (omap_obj->flags & OMAP_BO_TILED_MASK) {
328
329
330
331
332
333
334 size = tiler_vsize(gem2fmt(omap_obj->flags),
335 omap_obj->width, omap_obj->height);
336 }
337
338 return size;
339}
340
341
342
343
344
345
346static vm_fault_t omap_gem_fault_1d(struct drm_gem_object *obj,
347 struct vm_area_struct *vma, struct vm_fault *vmf)
348{
349 struct omap_gem_object *omap_obj = to_omap_bo(obj);
350 unsigned long pfn;
351 pgoff_t pgoff;
352
353
354 pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
355
356 if (omap_obj->pages) {
357 omap_gem_cpu_sync_page(obj, pgoff);
358 pfn = page_to_pfn(omap_obj->pages[pgoff]);
359 } else {
360 BUG_ON(!omap_gem_is_contiguous(omap_obj));
361 pfn = (omap_obj->dma_addr >> PAGE_SHIFT) + pgoff;
362 }
363
364 VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
365 pfn, pfn << PAGE_SHIFT);
366
367 return vmf_insert_mixed(vma, vmf->address,
368 __pfn_to_pfn_t(pfn, PFN_DEV));
369}
370
371
372static vm_fault_t omap_gem_fault_2d(struct drm_gem_object *obj,
373 struct vm_area_struct *vma, struct vm_fault *vmf)
374{
375 struct omap_gem_object *omap_obj = to_omap_bo(obj);
376 struct omap_drm_private *priv = obj->dev->dev_private;
377 struct omap_drm_usergart_entry *entry;
378 enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
379 struct page *pages[64];
380 unsigned long pfn;
381 pgoff_t pgoff, base_pgoff;
382 unsigned long vaddr;
383 int i, err, slots;
384 vm_fault_t ret = VM_FAULT_NOPAGE;
385
386
387
388
389
390
391 const int n = priv->usergart[fmt].height;
392 const int n_shift = priv->usergart[fmt].height_shift;
393
394
395
396
397
398
399
400 const int m = DIV_ROUND_UP(omap_obj->width << fmt, PAGE_SIZE);
401
402
403 pgoff = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
404
405
406
407
408
409 base_pgoff = round_down(pgoff, m << n_shift);
410
411
412 slots = omap_obj->width >> priv->usergart[fmt].slot_shift;
413
414 vaddr = vmf->address - ((pgoff - base_pgoff) << PAGE_SHIFT);
415
416 entry = &priv->usergart[fmt].entry[priv->usergart[fmt].last];
417
418
419 if (entry->obj)
420 omap_gem_evict_entry(entry->obj, fmt, entry);
421
422 entry->obj = obj;
423 entry->obj_pgoff = base_pgoff;
424
425
426 base_pgoff = (base_pgoff >> n_shift) * slots;
427
428
429 if (m > 1) {
430 int off = pgoff % m;
431 entry->obj_pgoff += off;
432 base_pgoff /= m;
433 slots = min(slots - (off << n_shift), n);
434 base_pgoff += off << n_shift;
435 vaddr += off << PAGE_SHIFT;
436 }
437
438
439
440
441
442
443
444
445 memcpy(pages, &omap_obj->pages[base_pgoff],
446 sizeof(struct page *) * slots);
447 memset(pages + slots, 0,
448 sizeof(struct page *) * (n - slots));
449
450 err = tiler_pin(entry->block, pages, ARRAY_SIZE(pages), 0, true);
451 if (err) {
452 ret = vmf_error(err);
453 dev_err(obj->dev->dev, "failed to pin: %d\n", err);
454 return ret;
455 }
456
457 pfn = entry->dma_addr >> PAGE_SHIFT;
458
459 VERB("Inserting %p pfn %lx, pa %lx", (void *)vmf->address,
460 pfn, pfn << PAGE_SHIFT);
461
462 for (i = n; i > 0; i--) {
463 ret = vmf_insert_mixed(vma,
464 vaddr, __pfn_to_pfn_t(pfn, PFN_DEV));
465 if (ret & VM_FAULT_ERROR)
466 break;
467 pfn += priv->usergart[fmt].stride_pfn;
468 vaddr += PAGE_SIZE * m;
469 }
470
471
472 priv->usergart[fmt].last = (priv->usergart[fmt].last + 1)
473 % NUM_USERGART_ENTRIES;
474
475 return ret;
476}
477
478
479
480
481
482
483
484
485
486
487
488
489
490vm_fault_t omap_gem_fault(struct vm_fault *vmf)
491{
492 struct vm_area_struct *vma = vmf->vma;
493 struct drm_gem_object *obj = vma->vm_private_data;
494 struct omap_gem_object *omap_obj = to_omap_bo(obj);
495 int err;
496 vm_fault_t ret;
497
498
499
500
501 mutex_lock(&omap_obj->lock);
502
503
504 err = omap_gem_attach_pages(obj);
505 if (err) {
506 ret = vmf_error(err);
507 goto fail;
508 }
509
510
511
512
513
514
515
516 if (omap_obj->flags & OMAP_BO_TILED_MASK)
517 ret = omap_gem_fault_2d(obj, vma, vmf);
518 else
519 ret = omap_gem_fault_1d(obj, vma, vmf);
520
521
522fail:
523 mutex_unlock(&omap_obj->lock);
524 return ret;
525}
526
527
528int omap_gem_mmap(struct file *filp, struct vm_area_struct *vma)
529{
530 int ret;
531
532 ret = drm_gem_mmap(filp, vma);
533 if (ret) {
534 DBG("mmap failed: %d", ret);
535 return ret;
536 }
537
538 return omap_gem_mmap_obj(vma->vm_private_data, vma);
539}
540
541int omap_gem_mmap_obj(struct drm_gem_object *obj,
542 struct vm_area_struct *vma)
543{
544 struct omap_gem_object *omap_obj = to_omap_bo(obj);
545
546 vma->vm_flags &= ~VM_PFNMAP;
547 vma->vm_flags |= VM_MIXEDMAP;
548
549 if (omap_obj->flags & OMAP_BO_WC) {
550 vma->vm_page_prot = pgprot_writecombine(vm_get_page_prot(vma->vm_flags));
551 } else if (omap_obj->flags & OMAP_BO_UNCACHED) {
552 vma->vm_page_prot = pgprot_noncached(vm_get_page_prot(vma->vm_flags));
553 } else {
554
555
556
557
558
559 if (WARN_ON(!obj->filp))
560 return -EINVAL;
561
562
563
564
565
566
567 fput(vma->vm_file);
568 vma->vm_pgoff = 0;
569 vma->vm_file = get_file(obj->filp);
570
571 vma->vm_page_prot = vm_get_page_prot(vma->vm_flags);
572 }
573
574 return 0;
575}
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
591int omap_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
592 struct drm_mode_create_dumb *args)
593{
594 union omap_gem_size gsize;
595
596 args->pitch = DIV_ROUND_UP(args->width * args->bpp, 8);
597
598 args->size = PAGE_ALIGN(args->pitch * args->height);
599
600 gsize = (union omap_gem_size){
601 .bytes = args->size,
602 };
603
604 return omap_gem_new_handle(dev, file, gsize,
605 OMAP_BO_SCANOUT | OMAP_BO_WC, &args->handle);
606}
607
608
609
610
611
612
613
614
615
616
617int omap_gem_dumb_map_offset(struct drm_file *file, struct drm_device *dev,
618 u32 handle, u64 *offset)
619{
620 struct drm_gem_object *obj;
621 int ret = 0;
622
623
624 obj = drm_gem_object_lookup(file, handle);
625 if (obj == NULL) {
626 ret = -ENOENT;
627 goto fail;
628 }
629
630 *offset = omap_gem_mmap_offset(obj);
631
632 drm_gem_object_put(obj);
633
634fail:
635 return ret;
636}
637
638#ifdef CONFIG_DRM_FBDEV_EMULATION
639
640
641
642
643
644int omap_gem_roll(struct drm_gem_object *obj, u32 roll)
645{
646 struct omap_gem_object *omap_obj = to_omap_bo(obj);
647 u32 npages = obj->size >> PAGE_SHIFT;
648 int ret = 0;
649
650 if (roll > npages) {
651 dev_err(obj->dev->dev, "invalid roll: %d\n", roll);
652 return -EINVAL;
653 }
654
655 omap_obj->roll = roll;
656
657 mutex_lock(&omap_obj->lock);
658
659
660 if (omap_obj->block) {
661 ret = omap_gem_attach_pages(obj);
662 if (ret)
663 goto fail;
664
665 ret = tiler_pin(omap_obj->block, omap_obj->pages, npages,
666 roll, true);
667 if (ret)
668 dev_err(obj->dev->dev, "could not repin: %d\n", ret);
669 }
670
671fail:
672 mutex_unlock(&omap_obj->lock);
673
674 return ret;
675}
676#endif
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691static inline bool omap_gem_is_cached_coherent(struct drm_gem_object *obj)
692{
693 struct omap_gem_object *omap_obj = to_omap_bo(obj);
694
695 return !((omap_obj->flags & OMAP_BO_MEM_SHMEM) &&
696 ((omap_obj->flags & OMAP_BO_CACHE_MASK) == OMAP_BO_CACHED));
697}
698
699
700
701
702void omap_gem_cpu_sync_page(struct drm_gem_object *obj, int pgoff)
703{
704 struct drm_device *dev = obj->dev;
705 struct omap_gem_object *omap_obj = to_omap_bo(obj);
706
707 if (omap_gem_is_cached_coherent(obj))
708 return;
709
710 if (omap_obj->dma_addrs[pgoff]) {
711 dma_unmap_page(dev->dev, omap_obj->dma_addrs[pgoff],
712 PAGE_SIZE, DMA_TO_DEVICE);
713 omap_obj->dma_addrs[pgoff] = 0;
714 }
715}
716
717
718void omap_gem_dma_sync_buffer(struct drm_gem_object *obj,
719 enum dma_data_direction dir)
720{
721 struct drm_device *dev = obj->dev;
722 struct omap_gem_object *omap_obj = to_omap_bo(obj);
723 int i, npages = obj->size >> PAGE_SHIFT;
724 struct page **pages = omap_obj->pages;
725 bool dirty = false;
726
727 if (omap_gem_is_cached_coherent(obj))
728 return;
729
730 for (i = 0; i < npages; i++) {
731 if (!omap_obj->dma_addrs[i]) {
732 dma_addr_t addr;
733
734 addr = dma_map_page(dev->dev, pages[i], 0,
735 PAGE_SIZE, dir);
736 if (dma_mapping_error(dev->dev, addr)) {
737 dev_warn(dev->dev, "%s: failed to map page\n",
738 __func__);
739 break;
740 }
741
742 dirty = true;
743 omap_obj->dma_addrs[i] = addr;
744 }
745 }
746
747 if (dirty) {
748 unmap_mapping_range(obj->filp->f_mapping, 0,
749 omap_gem_mmap_size(obj), 1);
750 }
751}
752
753
754
755
756
757
758
759
760
761
762
763
764
765
766
767int omap_gem_pin(struct drm_gem_object *obj, dma_addr_t *dma_addr)
768{
769 struct omap_drm_private *priv = obj->dev->dev_private;
770 struct omap_gem_object *omap_obj = to_omap_bo(obj);
771 int ret = 0;
772
773 mutex_lock(&omap_obj->lock);
774
775 if (!omap_gem_is_contiguous(omap_obj) && priv->has_dmm) {
776 if (refcount_read(&omap_obj->dma_addr_cnt) == 0) {
777 u32 npages = obj->size >> PAGE_SHIFT;
778 enum tiler_fmt fmt = gem2fmt(omap_obj->flags);
779 struct tiler_block *block;
780
781 BUG_ON(omap_obj->block);
782
783 refcount_set(&omap_obj->dma_addr_cnt, 1);
784
785 ret = omap_gem_attach_pages(obj);
786 if (ret)
787 goto fail;
788
789 if (omap_obj->flags & OMAP_BO_TILED_MASK) {
790 block = tiler_reserve_2d(fmt,
791 omap_obj->width,
792 omap_obj->height, 0);
793 } else {
794 block = tiler_reserve_1d(obj->size);
795 }
796
797 if (IS_ERR(block)) {
798 ret = PTR_ERR(block);
799 dev_err(obj->dev->dev,
800 "could not remap: %d (%d)\n", ret, fmt);
801 goto fail;
802 }
803
804
805 ret = tiler_pin(block, omap_obj->pages, npages,
806 omap_obj->roll, true);
807 if (ret) {
808 tiler_release(block);
809 dev_err(obj->dev->dev,
810 "could not pin: %d\n", ret);
811 goto fail;
812 }
813
814 omap_obj->dma_addr = tiler_ssptr(block);
815 omap_obj->block = block;
816
817 DBG("got dma address: %pad", &omap_obj->dma_addr);
818 } else {
819 refcount_inc(&omap_obj->dma_addr_cnt);
820 }
821
822 if (dma_addr)
823 *dma_addr = omap_obj->dma_addr;
824 } else if (omap_gem_is_contiguous(omap_obj)) {
825 if (dma_addr)
826 *dma_addr = omap_obj->dma_addr;
827 } else {
828 ret = -EINVAL;
829 goto fail;
830 }
831
832fail:
833 mutex_unlock(&omap_obj->lock);
834
835 return ret;
836}
837
838
839
840
841
842
843
844static void omap_gem_unpin_locked(struct drm_gem_object *obj)
845{
846 struct omap_drm_private *priv = obj->dev->dev_private;
847 struct omap_gem_object *omap_obj = to_omap_bo(obj);
848 int ret;
849
850 if (omap_gem_is_contiguous(omap_obj) || !priv->has_dmm)
851 return;
852
853 if (refcount_dec_and_test(&omap_obj->dma_addr_cnt)) {
854 ret = tiler_unpin(omap_obj->block);
855 if (ret) {
856 dev_err(obj->dev->dev,
857 "could not unpin pages: %d\n", ret);
858 }
859 ret = tiler_release(omap_obj->block);
860 if (ret) {
861 dev_err(obj->dev->dev,
862 "could not release unmap: %d\n", ret);
863 }
864 omap_obj->dma_addr = 0;
865 omap_obj->block = NULL;
866 }
867}
868
869
870
871
872
873
874
875
876
877void omap_gem_unpin(struct drm_gem_object *obj)
878{
879 struct omap_gem_object *omap_obj = to_omap_bo(obj);
880
881 mutex_lock(&omap_obj->lock);
882 omap_gem_unpin_locked(obj);
883 mutex_unlock(&omap_obj->lock);
884}
885
886
887
888
889
890int omap_gem_rotated_dma_addr(struct drm_gem_object *obj, u32 orient,
891 int x, int y, dma_addr_t *dma_addr)
892{
893 struct omap_gem_object *omap_obj = to_omap_bo(obj);
894 int ret = -EINVAL;
895
896 mutex_lock(&omap_obj->lock);
897
898 if ((refcount_read(&omap_obj->dma_addr_cnt) > 0) && omap_obj->block &&
899 (omap_obj->flags & OMAP_BO_TILED_MASK)) {
900 *dma_addr = tiler_tsptr(omap_obj->block, orient, x, y);
901 ret = 0;
902 }
903
904 mutex_unlock(&omap_obj->lock);
905
906 return ret;
907}
908
909
910int omap_gem_tiled_stride(struct drm_gem_object *obj, u32 orient)
911{
912 struct omap_gem_object *omap_obj = to_omap_bo(obj);
913 int ret = -EINVAL;
914 if (omap_obj->flags & OMAP_BO_TILED_MASK)
915 ret = tiler_stride(gem2fmt(omap_obj->flags), orient);
916 return ret;
917}
918
919
920
921
922
923
924
925
926
927
928
929int omap_gem_get_pages(struct drm_gem_object *obj, struct page ***pages,
930 bool remap)
931{
932 struct omap_gem_object *omap_obj = to_omap_bo(obj);
933 int ret = 0;
934
935 mutex_lock(&omap_obj->lock);
936
937 if (remap) {
938 ret = omap_gem_attach_pages(obj);
939 if (ret)
940 goto unlock;
941 }
942
943 if (!omap_obj->pages) {
944 ret = -ENOMEM;
945 goto unlock;
946 }
947
948 *pages = omap_obj->pages;
949
950unlock:
951 mutex_unlock(&omap_obj->lock);
952
953 return ret;
954}
955
956
957int omap_gem_put_pages(struct drm_gem_object *obj)
958{
959
960
961
962
963 return 0;
964}
965
966#ifdef CONFIG_DRM_FBDEV_EMULATION
967
968
969
970
971void *omap_gem_vaddr(struct drm_gem_object *obj)
972{
973 struct omap_gem_object *omap_obj = to_omap_bo(obj);
974 void *vaddr;
975 int ret;
976
977 mutex_lock(&omap_obj->lock);
978
979 if (!omap_obj->vaddr) {
980 ret = omap_gem_attach_pages(obj);
981 if (ret) {
982 vaddr = ERR_PTR(ret);
983 goto unlock;
984 }
985
986 omap_obj->vaddr = vmap(omap_obj->pages, obj->size >> PAGE_SHIFT,
987 VM_MAP, pgprot_writecombine(PAGE_KERNEL));
988 }
989
990 vaddr = omap_obj->vaddr;
991
992unlock:
993 mutex_unlock(&omap_obj->lock);
994 return vaddr;
995}
996#endif
997
998
999
1000
1001
1002#ifdef CONFIG_PM
1003
1004int omap_gem_resume(struct drm_device *dev)
1005{
1006 struct omap_drm_private *priv = dev->dev_private;
1007 struct omap_gem_object *omap_obj;
1008 int ret = 0;
1009
1010 mutex_lock(&priv->list_lock);
1011 list_for_each_entry(omap_obj, &priv->obj_list, mm_list) {
1012 if (omap_obj->block) {
1013 struct drm_gem_object *obj = &omap_obj->base;
1014 u32 npages = obj->size >> PAGE_SHIFT;
1015
1016 WARN_ON(!omap_obj->pages);
1017 ret = tiler_pin(omap_obj->block,
1018 omap_obj->pages, npages,
1019 omap_obj->roll, true);
1020 if (ret) {
1021 dev_err(dev->dev, "could not repin: %d\n", ret);
1022 goto done;
1023 }
1024 }
1025 }
1026
1027done:
1028 mutex_unlock(&priv->list_lock);
1029 return ret;
1030}
1031#endif
1032
1033
1034
1035
1036
1037#ifdef CONFIG_DEBUG_FS
1038void omap_gem_describe(struct drm_gem_object *obj, struct seq_file *m)
1039{
1040 struct omap_gem_object *omap_obj = to_omap_bo(obj);
1041 u64 off;
1042
1043 off = drm_vma_node_start(&obj->vma_node);
1044
1045 mutex_lock(&omap_obj->lock);
1046
1047 seq_printf(m, "%08x: %2d (%2d) %08llx %pad (%2d) %p %4d",
1048 omap_obj->flags, obj->name, kref_read(&obj->refcount),
1049 off, &omap_obj->dma_addr,
1050 refcount_read(&omap_obj->dma_addr_cnt),
1051 omap_obj->vaddr, omap_obj->roll);
1052
1053 if (omap_obj->flags & OMAP_BO_TILED_MASK) {
1054 seq_printf(m, " %dx%d", omap_obj->width, omap_obj->height);
1055 if (omap_obj->block) {
1056 struct tcm_area *area = &omap_obj->block->area;
1057 seq_printf(m, " (%dx%d, %dx%d)",
1058 area->p0.x, area->p0.y,
1059 area->p1.x, area->p1.y);
1060 }
1061 } else {
1062 seq_printf(m, " %zu", obj->size);
1063 }
1064
1065 mutex_unlock(&omap_obj->lock);
1066
1067 seq_printf(m, "\n");
1068}
1069
1070void omap_gem_describe_objects(struct list_head *list, struct seq_file *m)
1071{
1072 struct omap_gem_object *omap_obj;
1073 int count = 0;
1074 size_t size = 0;
1075
1076 list_for_each_entry(omap_obj, list, mm_list) {
1077 struct drm_gem_object *obj = &omap_obj->base;
1078 seq_printf(m, " ");
1079 omap_gem_describe(obj, m);
1080 count++;
1081 size += obj->size;
1082 }
1083
1084 seq_printf(m, "Total %d objects, %zu bytes\n", count, size);
1085}
1086#endif
1087
1088
1089
1090
1091
1092void omap_gem_free_object(struct drm_gem_object *obj)
1093{
1094 struct drm_device *dev = obj->dev;
1095 struct omap_drm_private *priv = dev->dev_private;
1096 struct omap_gem_object *omap_obj = to_omap_bo(obj);
1097
1098 omap_gem_evict(obj);
1099
1100 mutex_lock(&priv->list_lock);
1101 list_del(&omap_obj->mm_list);
1102 mutex_unlock(&priv->list_lock);
1103
1104
1105
1106
1107
1108
1109
1110 mutex_lock(&omap_obj->lock);
1111
1112
1113 WARN_ON(refcount_read(&omap_obj->dma_addr_cnt) > 0);
1114
1115 if (omap_obj->pages) {
1116 if (omap_obj->flags & OMAP_BO_MEM_DMABUF)
1117 kfree(omap_obj->pages);
1118 else
1119 omap_gem_detach_pages(obj);
1120 }
1121
1122 if (omap_obj->flags & OMAP_BO_MEM_DMA_API) {
1123 dma_free_wc(dev->dev, obj->size, omap_obj->vaddr,
1124 omap_obj->dma_addr);
1125 } else if (omap_obj->vaddr) {
1126 vunmap(omap_obj->vaddr);
1127 } else if (obj->import_attach) {
1128 drm_prime_gem_destroy(obj, omap_obj->sgt);
1129 }
1130
1131 mutex_unlock(&omap_obj->lock);
1132
1133 drm_gem_object_release(obj);
1134
1135 mutex_destroy(&omap_obj->lock);
1136
1137 kfree(omap_obj);
1138}
1139
1140static bool omap_gem_validate_flags(struct drm_device *dev, u32 flags)
1141{
1142 struct omap_drm_private *priv = dev->dev_private;
1143
1144 switch (flags & OMAP_BO_CACHE_MASK) {
1145 case OMAP_BO_CACHED:
1146 case OMAP_BO_WC:
1147 case OMAP_BO_CACHE_MASK:
1148 break;
1149
1150 default:
1151 return false;
1152 }
1153
1154 if (flags & OMAP_BO_TILED_MASK) {
1155 if (!priv->usergart)
1156 return false;
1157
1158 switch (flags & OMAP_BO_TILED_MASK) {
1159 case OMAP_BO_TILED_8:
1160 case OMAP_BO_TILED_16:
1161 case OMAP_BO_TILED_32:
1162 break;
1163
1164 default:
1165 return false;
1166 }
1167 }
1168
1169 return true;
1170}
1171
1172
1173struct drm_gem_object *omap_gem_new(struct drm_device *dev,
1174 union omap_gem_size gsize, u32 flags)
1175{
1176 struct omap_drm_private *priv = dev->dev_private;
1177 struct omap_gem_object *omap_obj;
1178 struct drm_gem_object *obj;
1179 struct address_space *mapping;
1180 size_t size;
1181 int ret;
1182
1183 if (!omap_gem_validate_flags(dev, flags))
1184 return NULL;
1185
1186
1187 if (flags & OMAP_BO_TILED_MASK) {
1188
1189
1190
1191
1192 flags |= OMAP_BO_MEM_SHMEM;
1193
1194
1195
1196
1197
1198 flags &= ~(OMAP_BO_CACHED|OMAP_BO_WC|OMAP_BO_UNCACHED);
1199 flags |= tiler_get_cpu_cache_flags();
1200 } else if ((flags & OMAP_BO_SCANOUT) && !priv->has_dmm) {
1201
1202
1203
1204
1205 flags |= OMAP_BO_MEM_DMA_API;
1206 } else if (!(flags & OMAP_BO_MEM_DMABUF)) {
1207
1208
1209
1210 flags |= OMAP_BO_MEM_SHMEM;
1211 }
1212
1213
1214 omap_obj = kzalloc(sizeof(*omap_obj), GFP_KERNEL);
1215 if (!omap_obj)
1216 return NULL;
1217
1218 obj = &omap_obj->base;
1219 omap_obj->flags = flags;
1220 mutex_init(&omap_obj->lock);
1221
1222 if (flags & OMAP_BO_TILED_MASK) {
1223
1224
1225
1226
1227 tiler_align(gem2fmt(flags), &gsize.tiled.width,
1228 &gsize.tiled.height);
1229
1230 size = tiler_size(gem2fmt(flags), gsize.tiled.width,
1231 gsize.tiled.height);
1232
1233 omap_obj->width = gsize.tiled.width;
1234 omap_obj->height = gsize.tiled.height;
1235 } else {
1236 size = PAGE_ALIGN(gsize.bytes);
1237 }
1238
1239
1240 if (!(flags & OMAP_BO_MEM_SHMEM)) {
1241 drm_gem_private_object_init(dev, obj, size);
1242 } else {
1243 ret = drm_gem_object_init(dev, obj, size);
1244 if (ret)
1245 goto err_free;
1246
1247 mapping = obj->filp->f_mapping;
1248 mapping_set_gfp_mask(mapping, GFP_USER | __GFP_DMA32);
1249 }
1250
1251
1252 if (flags & OMAP_BO_MEM_DMA_API) {
1253 omap_obj->vaddr = dma_alloc_wc(dev->dev, size,
1254 &omap_obj->dma_addr,
1255 GFP_KERNEL);
1256 if (!omap_obj->vaddr)
1257 goto err_release;
1258 }
1259
1260 mutex_lock(&priv->list_lock);
1261 list_add(&omap_obj->mm_list, &priv->obj_list);
1262 mutex_unlock(&priv->list_lock);
1263
1264 return obj;
1265
1266err_release:
1267 drm_gem_object_release(obj);
1268err_free:
1269 kfree(omap_obj);
1270 return NULL;
1271}
1272
1273struct drm_gem_object *omap_gem_new_dmabuf(struct drm_device *dev, size_t size,
1274 struct sg_table *sgt)
1275{
1276 struct omap_drm_private *priv = dev->dev_private;
1277 struct omap_gem_object *omap_obj;
1278 struct drm_gem_object *obj;
1279 union omap_gem_size gsize;
1280
1281
1282 if (sgt->orig_nents != 1 && !priv->has_dmm)
1283 return ERR_PTR(-EINVAL);
1284
1285 gsize.bytes = PAGE_ALIGN(size);
1286 obj = omap_gem_new(dev, gsize, OMAP_BO_MEM_DMABUF | OMAP_BO_WC);
1287 if (!obj)
1288 return ERR_PTR(-ENOMEM);
1289
1290 omap_obj = to_omap_bo(obj);
1291
1292 mutex_lock(&omap_obj->lock);
1293
1294 omap_obj->sgt = sgt;
1295
1296 if (sgt->orig_nents == 1) {
1297 omap_obj->dma_addr = sg_dma_address(sgt->sgl);
1298 } else {
1299
1300 struct sg_page_iter iter;
1301 struct page **pages;
1302 unsigned int npages;
1303 unsigned int i = 0;
1304
1305 npages = DIV_ROUND_UP(size, PAGE_SIZE);
1306 pages = kcalloc(npages, sizeof(*pages), GFP_KERNEL);
1307 if (!pages) {
1308 omap_gem_free_object(obj);
1309 obj = ERR_PTR(-ENOMEM);
1310 goto done;
1311 }
1312
1313 omap_obj->pages = pages;
1314
1315 for_each_sg_page(sgt->sgl, &iter, sgt->orig_nents, 0) {
1316 pages[i++] = sg_page_iter_page(&iter);
1317 if (i > npages)
1318 break;
1319 }
1320
1321 if (WARN_ON(i != npages)) {
1322 omap_gem_free_object(obj);
1323 obj = ERR_PTR(-ENOMEM);
1324 goto done;
1325 }
1326 }
1327
1328done:
1329 mutex_unlock(&omap_obj->lock);
1330 return obj;
1331}
1332
1333
1334int omap_gem_new_handle(struct drm_device *dev, struct drm_file *file,
1335 union omap_gem_size gsize, u32 flags, u32 *handle)
1336{
1337 struct drm_gem_object *obj;
1338 int ret;
1339
1340 obj = omap_gem_new(dev, gsize, flags);
1341 if (!obj)
1342 return -ENOMEM;
1343
1344 ret = drm_gem_handle_create(file, obj, handle);
1345 if (ret) {
1346 omap_gem_free_object(obj);
1347 return ret;
1348 }
1349
1350
1351 drm_gem_object_put(obj);
1352
1353 return 0;
1354}
1355
1356
1357
1358
1359
1360
1361void omap_gem_init(struct drm_device *dev)
1362{
1363 struct omap_drm_private *priv = dev->dev_private;
1364 struct omap_drm_usergart *usergart;
1365 const enum tiler_fmt fmts[] = {
1366 TILFMT_8BIT, TILFMT_16BIT, TILFMT_32BIT
1367 };
1368 int i, j;
1369
1370 if (!dmm_is_available()) {
1371
1372 dev_warn(dev->dev, "DMM not available, disable DMM support\n");
1373 return;
1374 }
1375
1376 usergart = kcalloc(3, sizeof(*usergart), GFP_KERNEL);
1377 if (!usergart)
1378 return;
1379
1380
1381 for (i = 0; i < ARRAY_SIZE(fmts); i++) {
1382 u16 h = 1, w = PAGE_SIZE >> i;
1383
1384 tiler_align(fmts[i], &w, &h);
1385
1386
1387
1388
1389 usergart[i].height = h;
1390 usergart[i].height_shift = ilog2(h);
1391 usergart[i].stride_pfn = tiler_stride(fmts[i], 0) >> PAGE_SHIFT;
1392 usergart[i].slot_shift = ilog2((PAGE_SIZE / h) >> i);
1393 for (j = 0; j < NUM_USERGART_ENTRIES; j++) {
1394 struct omap_drm_usergart_entry *entry;
1395 struct tiler_block *block;
1396
1397 entry = &usergart[i].entry[j];
1398 block = tiler_reserve_2d(fmts[i], w, h, PAGE_SIZE);
1399 if (IS_ERR(block)) {
1400 dev_err(dev->dev,
1401 "reserve failed: %d, %d, %ld\n",
1402 i, j, PTR_ERR(block));
1403 return;
1404 }
1405 entry->dma_addr = tiler_ssptr(block);
1406 entry->block = block;
1407
1408 DBG("%d:%d: %dx%d: dma_addr=%pad stride=%d", i, j, w, h,
1409 &entry->dma_addr,
1410 usergart[i].stride_pfn << PAGE_SHIFT);
1411 }
1412 }
1413
1414 priv->usergart = usergart;
1415 priv->has_dmm = true;
1416}
1417
1418void omap_gem_deinit(struct drm_device *dev)
1419{
1420 struct omap_drm_private *priv = dev->dev_private;
1421
1422
1423
1424
1425 kfree(priv->usergart);
1426}
1427