1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/pagemap.h>
15
16#include <drm/drm.h>
17#include <drm/drm_vma_manager.h>
18
19#include "gem.h"
20#include "psb_drv.h"
21
22static vm_fault_t psb_gem_fault(struct vm_fault *vmf);
23
24static void psb_gem_free_object(struct drm_gem_object *obj)
25{
26 struct gtt_range *gtt = container_of(obj, struct gtt_range, gem);
27
28
29 drm_gem_free_mmap_offset(obj);
30 drm_gem_object_release(obj);
31
32
33 psb_gtt_free_range(obj->dev, gtt);
34}
35
36static const struct vm_operations_struct psb_gem_vm_ops = {
37 .fault = psb_gem_fault,
38 .open = drm_gem_vm_open,
39 .close = drm_gem_vm_close,
40};
41
42const struct drm_gem_object_funcs psb_gem_object_funcs = {
43 .free = psb_gem_free_object,
44 .vm_ops = &psb_gem_vm_ops,
45};
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60int psb_gem_create(struct drm_file *file, struct drm_device *dev, u64 size,
61 u32 *handlep, int stolen, u32 align)
62{
63 struct gtt_range *r;
64 int ret;
65 u32 handle;
66
67 size = roundup(size, PAGE_SIZE);
68
69
70
71 r = psb_gtt_alloc_range(dev, size, "gem", 0, PAGE_SIZE);
72 if (r == NULL) {
73 dev_err(dev->dev, "no memory for %lld byte GEM object\n", size);
74 return -ENOSPC;
75 }
76 r->gem.funcs = &psb_gem_object_funcs;
77
78 if (drm_gem_object_init(dev, &r->gem, size) != 0) {
79 psb_gtt_free_range(dev, r);
80
81 dev_err(dev->dev, "GEM init failed for %lld\n", size);
82 return -ENOMEM;
83 }
84
85 mapping_set_gfp_mask(r->gem.filp->f_mapping, GFP_KERNEL | __GFP_DMA32);
86
87 ret = drm_gem_handle_create(file, &r->gem, &handle);
88 if (ret) {
89 dev_err(dev->dev, "GEM handle failed for %p, %lld\n",
90 &r->gem, size);
91 drm_gem_object_release(&r->gem);
92 psb_gtt_free_range(dev, r);
93 return ret;
94 }
95
96 drm_gem_object_put(&r->gem);
97 *handlep = handle;
98 return 0;
99}
100
101
102
103
104
105
106
107
108
109
110
111int psb_gem_dumb_create(struct drm_file *file, struct drm_device *dev,
112 struct drm_mode_create_dumb *args)
113{
114 args->pitch = ALIGN(args->width * ((args->bpp + 7) / 8), 64);
115 args->size = args->pitch * args->height;
116 return psb_gem_create(file, dev, args->size, &args->handle, 0,
117 PAGE_SIZE);
118}
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136static vm_fault_t psb_gem_fault(struct vm_fault *vmf)
137{
138 struct vm_area_struct *vma = vmf->vma;
139 struct drm_gem_object *obj;
140 struct gtt_range *r;
141 int err;
142 vm_fault_t ret;
143 unsigned long pfn;
144 pgoff_t page_offset;
145 struct drm_device *dev;
146 struct drm_psb_private *dev_priv;
147
148 obj = vma->vm_private_data;
149 dev = obj->dev;
150 dev_priv = dev->dev_private;
151
152 r = container_of(obj, struct gtt_range, gem);
153
154
155
156 mutex_lock(&dev_priv->mmap_mutex);
157
158
159
160 if (r->mmapping == 0) {
161 err = psb_gtt_pin(r);
162 if (err < 0) {
163 dev_err(dev->dev, "gma500: pin failed: %d\n", err);
164 ret = vmf_error(err);
165 goto fail;
166 }
167 r->mmapping = 1;
168 }
169
170
171
172 page_offset = (vmf->address - vma->vm_start) >> PAGE_SHIFT;
173
174
175 if (r->stolen)
176 pfn = (dev_priv->stolen_base + r->offset) >> PAGE_SHIFT;
177 else
178 pfn = page_to_pfn(r->pages[page_offset]);
179 ret = vmf_insert_pfn(vma, vmf->address, pfn);
180fail:
181 mutex_unlock(&dev_priv->mmap_mutex);
182
183 return ret;
184}
185