Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / gpu / drm / nouveau / nouveau_usif.c
1 /*
2  * Copyright 2014 Red Hat Inc.
3  *
4  * Permission is hereby granted, free of charge, to any person obtaining a
5  * copy of this software and associated documentation files (the "Software"),
6  * to deal in the Software without restriction, including without limitation
7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
8  * and/or sell copies of the Software, and to permit persons to whom the
9  * Software is furnished to do so, subject to the following conditions:
10  *
11  * The above copyright notice and this permission notice shall be included in
12  * all copies or substantial portions of the Software.
13  *
14  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
15  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
16  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
17  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
18  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
19  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
20  * OTHER DEALINGS IN THE SOFTWARE.
21  *
22  * Authors: Ben Skeggs <bskeggs@redhat.com>
23  */
24
25 #include "nouveau_drm.h"
26 #include "nouveau_usif.h"
27
28 #include <nvif/notify.h>
29 #include <nvif/unpack.h>
30 #include <nvif/client.h>
31 #include <nvif/event.h>
32 #include <nvif/ioctl.h>
33
34 struct usif_notify_p {
35         struct drm_pending_event base;
36         struct {
37                 struct drm_event base;
38                 u8 data[];
39         } e;
40 };
41
42 struct usif_notify {
43         struct list_head head;
44         atomic_t enabled;
45         u32 handle;
46         u16 reply;
47         u8  route;
48         u64 token;
49         struct usif_notify_p *p;
50 };
51
52 static inline struct usif_notify *
53 usif_notify_find(struct drm_file *filp, u32 handle)
54 {
55         struct nouveau_cli *cli = nouveau_cli(filp);
56         struct usif_notify *ntfy;
57         list_for_each_entry(ntfy, &cli->notifys, head) {
58                 if (ntfy->handle == handle)
59                         return ntfy;
60         }
61         return NULL;
62 }
63
64 static inline void
65 usif_notify_dtor(struct usif_notify *ntfy)
66 {
67         list_del(&ntfy->head);
68         kfree(ntfy);
69 }
70
71 int
72 usif_notify(const void *header, u32 length, const void *data, u32 size)
73 {
74         struct usif_notify *ntfy = NULL;
75         const union {
76                 struct nvif_notify_rep_v0 v0;
77         } *rep = header;
78         struct drm_device *dev;
79         struct drm_file *filp;
80         unsigned long flags;
81
82         if (length == sizeof(rep->v0) && rep->v0.version == 0) {
83                 if (WARN_ON(!(ntfy = (void *)(unsigned long)rep->v0.token)))
84                         return NVIF_NOTIFY_DROP;
85                 BUG_ON(rep->v0.route != NVDRM_NOTIFY_USIF);
86         } else
87         if (WARN_ON(1))
88                 return NVIF_NOTIFY_DROP;
89
90         if (WARN_ON(!ntfy->p || ntfy->reply != (length + size)))
91                 return NVIF_NOTIFY_DROP;
92         filp = ntfy->p->base.file_priv;
93         dev = filp->minor->dev;
94
95         memcpy(&ntfy->p->e.data[0], header, length);
96         memcpy(&ntfy->p->e.data[length], data, size);
97         switch (rep->v0.version) {
98         case 0: {
99                 struct nvif_notify_rep_v0 *rep = (void *)ntfy->p->e.data;
100                 rep->route = ntfy->route;
101                 rep->token = ntfy->token;
102         }
103                 break;
104         default:
105                 BUG_ON(1);
106                 break;
107         }
108
109         spin_lock_irqsave(&dev->event_lock, flags);
110         if (!WARN_ON(filp->event_space < ntfy->p->e.base.length)) {
111                 list_add_tail(&ntfy->p->base.link, &filp->event_list);
112                 filp->event_space -= ntfy->p->e.base.length;
113         }
114         wake_up_interruptible(&filp->event_wait);
115         spin_unlock_irqrestore(&dev->event_lock, flags);
116         atomic_set(&ntfy->enabled, 0);
117         return NVIF_NOTIFY_DROP;
118 }
119
120 static int
121 usif_notify_new(struct drm_file *f, void *data, u32 size, void *argv, u32 argc)
122 {
123         struct nouveau_cli *cli = nouveau_cli(f);
124         struct nvif_client *client = &cli->base;
125         union {
126                 struct nvif_ioctl_ntfy_new_v0 v0;
127         } *args = data;
128         union {
129                 struct nvif_notify_req_v0 v0;
130         } *req;
131         struct usif_notify *ntfy;
132         int ret;
133
134         if (nvif_unpack(args->v0, 0, 0, true)) {
135                 if (usif_notify_find(f, args->v0.index))
136                         return -EEXIST;
137         } else
138                 return ret;
139         req = data;
140
141         if (!(ntfy = kmalloc(sizeof(*ntfy), GFP_KERNEL)))
142                 return -ENOMEM;
143         atomic_set(&ntfy->enabled, 0);
144
145         if (nvif_unpack(req->v0, 0, 0, true)) {
146                 ntfy->reply = sizeof(struct nvif_notify_rep_v0) + req->v0.reply;
147                 ntfy->route = req->v0.route;
148                 ntfy->token = req->v0.token;
149                 req->v0.route = NVDRM_NOTIFY_USIF;
150                 req->v0.token = (unsigned long)(void *)ntfy;
151                 ret = nvif_client_ioctl(client, argv, argc);
152                 req->v0.token = ntfy->token;
153                 req->v0.route = ntfy->route;
154                 ntfy->handle = args->v0.index;
155         }
156
157         if (ret == 0)
158                 list_add(&ntfy->head, &cli->notifys);
159         if (ret)
160                 kfree(ntfy);
161         return ret;
162 }
163
164 static int
165 usif_notify_del(struct drm_file *f, void *data, u32 size, void *argv, u32 argc)
166 {
167         struct nouveau_cli *cli = nouveau_cli(f);
168         struct nvif_client *client = &cli->base;
169         union {
170                 struct nvif_ioctl_ntfy_del_v0 v0;
171         } *args = data;
172         struct usif_notify *ntfy;
173         int ret;
174
175         if (nvif_unpack(args->v0, 0, 0, true)) {
176                 if (!(ntfy = usif_notify_find(f, args->v0.index)))
177                         return -ENOENT;
178         } else
179                 return ret;
180
181         ret = nvif_client_ioctl(client, argv, argc);
182         if (ret == 0)
183                 usif_notify_dtor(ntfy);
184         return ret;
185 }
186
187 static int
188 usif_notify_get(struct drm_file *f, void *data, u32 size, void *argv, u32 argc)
189 {
190         struct nouveau_cli *cli = nouveau_cli(f);
191         struct nvif_client *client = &cli->base;
192         union {
193                 struct nvif_ioctl_ntfy_del_v0 v0;
194         } *args = data;
195         struct usif_notify *ntfy;
196         int ret;
197
198         if (nvif_unpack(args->v0, 0, 0, true)) {
199                 if (!(ntfy = usif_notify_find(f, args->v0.index)))
200                         return -ENOENT;
201         } else
202                 return ret;
203
204         if (atomic_xchg(&ntfy->enabled, 1))
205                 return 0;
206
207         ntfy->p = kmalloc(sizeof(*ntfy->p) + ntfy->reply, GFP_KERNEL);
208         if (ret = -ENOMEM, !ntfy->p)
209                 goto done;
210         ntfy->p->base.event = &ntfy->p->e.base;
211         ntfy->p->base.file_priv = f;
212         ntfy->p->base.pid = current->pid;
213         ntfy->p->base.destroy =(void(*)(struct drm_pending_event *))kfree;
214         ntfy->p->e.base.type = DRM_NOUVEAU_EVENT_NVIF;
215         ntfy->p->e.base.length = sizeof(ntfy->p->e.base) + ntfy->reply;
216
217         ret = nvif_client_ioctl(client, argv, argc);
218 done:
219         if (ret) {
220                 atomic_set(&ntfy->enabled, 0);
221                 kfree(ntfy->p);
222         }
223         return ret;
224 }
225
226 static int
227 usif_notify_put(struct drm_file *f, void *data, u32 size, void *argv, u32 argc)
228 {
229         struct nouveau_cli *cli = nouveau_cli(f);
230         struct nvif_client *client = &cli->base;
231         union {
232                 struct nvif_ioctl_ntfy_put_v0 v0;
233         } *args = data;
234         struct usif_notify *ntfy;
235         int ret;
236
237         if (nvif_unpack(args->v0, 0, 0, true)) {
238                 if (!(ntfy = usif_notify_find(f, args->v0.index)))
239                         return -ENOENT;
240         } else
241                 return ret;
242
243         ret = nvif_client_ioctl(client, argv, argc);
244         if (ret == 0 && atomic_xchg(&ntfy->enabled, 0))
245                 kfree(ntfy->p);
246         return ret;
247 }
248
249 struct usif_object {
250         struct list_head head;
251         struct list_head ntfy;
252         u8  route;
253         u64 token;
254 };
255
256 static void
257 usif_object_dtor(struct usif_object *object)
258 {
259         list_del(&object->head);
260         kfree(object);
261 }
262
263 static int
264 usif_object_new(struct drm_file *f, void *data, u32 size, void *argv, u32 argc)
265 {
266         struct nouveau_cli *cli = nouveau_cli(f);
267         struct nvif_client *client = &cli->base;
268         union {
269                 struct nvif_ioctl_new_v0 v0;
270         } *args = data;
271         struct usif_object *object;
272         int ret;
273
274         if (!(object = kmalloc(sizeof(*object), GFP_KERNEL)))
275                 return -ENOMEM;
276         list_add(&object->head, &cli->objects);
277
278         if (nvif_unpack(args->v0, 0, 0, true)) {
279                 object->route = args->v0.route;
280                 object->token = args->v0.token;
281                 args->v0.route = NVDRM_OBJECT_USIF;
282                 args->v0.token = (unsigned long)(void *)object;
283                 ret = nvif_client_ioctl(client, argv, argc);
284                 args->v0.token = object->token;
285                 args->v0.route = object->route;
286         }
287
288         if (ret)
289                 usif_object_dtor(object);
290         return ret;
291 }
292
293 int
294 usif_ioctl(struct drm_file *filp, void __user *user, u32 argc)
295 {
296         struct nouveau_cli *cli = nouveau_cli(filp);
297         struct nvif_client *client = &cli->base;
298         void *data = kmalloc(argc, GFP_KERNEL);
299         u32   size = argc;
300         union {
301                 struct nvif_ioctl_v0 v0;
302         } *argv = data;
303         struct usif_object *object;
304         u8 owner;
305         int ret;
306
307         if (ret = -ENOMEM, !argv)
308                 goto done;
309         if (ret = -EFAULT, copy_from_user(argv, user, size))
310                 goto done;
311
312         if (nvif_unpack(argv->v0, 0, 0, true)) {
313                 /* block access to objects not created via this interface */
314                 owner = argv->v0.owner;
315                 argv->v0.owner = NVDRM_OBJECT_USIF;
316         } else
317                 goto done;
318
319         mutex_lock(&cli->mutex);
320         switch (argv->v0.type) {
321         case NVIF_IOCTL_V0_NEW:
322                 /* ... except if we're creating children */
323                 argv->v0.owner = NVIF_IOCTL_V0_OWNER_ANY;
324                 ret = usif_object_new(filp, data, size, argv, argc);
325                 break;
326         case NVIF_IOCTL_V0_NTFY_NEW:
327                 ret = usif_notify_new(filp, data, size, argv, argc);
328                 break;
329         case NVIF_IOCTL_V0_NTFY_DEL:
330                 ret = usif_notify_del(filp, data, size, argv, argc);
331                 break;
332         case NVIF_IOCTL_V0_NTFY_GET:
333                 ret = usif_notify_get(filp, data, size, argv, argc);
334                 break;
335         case NVIF_IOCTL_V0_NTFY_PUT:
336                 ret = usif_notify_put(filp, data, size, argv, argc);
337                 break;
338         default:
339                 ret = nvif_client_ioctl(client, argv, argc);
340                 break;
341         }
342         if (argv->v0.route == NVDRM_OBJECT_USIF) {
343                 object = (void *)(unsigned long)argv->v0.token;
344                 argv->v0.route = object->route;
345                 argv->v0.token = object->token;
346                 if (ret == 0 && argv->v0.type == NVIF_IOCTL_V0_DEL) {
347                         list_del(&object->head);
348                         kfree(object);
349                 }
350         } else {
351                 argv->v0.route = NVIF_IOCTL_V0_ROUTE_HIDDEN;
352                 argv->v0.token = 0;
353         }
354         argv->v0.owner = owner;
355         mutex_unlock(&cli->mutex);
356
357         if (copy_to_user(user, argv, argc))
358                 ret = -EFAULT;
359 done:
360         kfree(argv);
361         return ret;
362 }
363
364 void
365 usif_client_fini(struct nouveau_cli *cli)
366 {
367         struct usif_object *object, *otemp;
368         struct usif_notify *notify, *ntemp;
369
370         list_for_each_entry_safe(notify, ntemp, &cli->notifys, head) {
371                 usif_notify_dtor(notify);
372         }
373
374         list_for_each_entry_safe(object, otemp, &cli->objects, head) {
375                 usif_object_dtor(object);
376         }
377 }
378
379 void
380 usif_client_init(struct nouveau_cli *cli)
381 {
382         INIT_LIST_HEAD(&cli->objects);
383         INIT_LIST_HEAD(&cli->notifys);
384 }