1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * Copyright (C) 2017 Samsung Electronics Co.Ltd
3*4882a593Smuzhiyun * Authors:
4*4882a593Smuzhiyun * Marek Szyprowski <m.szyprowski@samsung.com>
5*4882a593Smuzhiyun *
6*4882a593Smuzhiyun * Exynos DRM Image Post Processing (IPP) related functions
7*4882a593Smuzhiyun *
8*4882a593Smuzhiyun * Permission is hereby granted, free of charge, to any person obtaining a
9*4882a593Smuzhiyun * copy of this software and associated documentation files (the "Software"),
10*4882a593Smuzhiyun * to deal in the Software without restriction, including without limitation
11*4882a593Smuzhiyun * the rights to use, copy, modify, merge, publish, distribute, sublicense,
12*4882a593Smuzhiyun * and/or sell copies of the Software, and to permit persons to whom the
13*4882a593Smuzhiyun * Software is furnished to do so, subject to the following conditions:
14*4882a593Smuzhiyun *
15*4882a593Smuzhiyun * The above copyright notice and this permission notice shall be included in
16*4882a593Smuzhiyun * all copies or substantial portions of the Software.
17*4882a593Smuzhiyun */
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include <linux/uaccess.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #include <drm/drm_file.h>
22*4882a593Smuzhiyun #include <drm/drm_fourcc.h>
23*4882a593Smuzhiyun #include <drm/drm_mode.h>
24*4882a593Smuzhiyun #include <drm/exynos_drm.h>
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun #include "exynos_drm_drv.h"
27*4882a593Smuzhiyun #include "exynos_drm_gem.h"
28*4882a593Smuzhiyun #include "exynos_drm_ipp.h"
29*4882a593Smuzhiyun
30*4882a593Smuzhiyun static int num_ipp;
31*4882a593Smuzhiyun static LIST_HEAD(ipp_list);
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun /**
34*4882a593Smuzhiyun * exynos_drm_ipp_register - Register a new picture processor hardware module
35*4882a593Smuzhiyun * @dev: DRM device
36*4882a593Smuzhiyun * @ipp: ipp module to init
37*4882a593Smuzhiyun * @funcs: callbacks for the new ipp object
38*4882a593Smuzhiyun * @caps: bitmask of ipp capabilities (%DRM_EXYNOS_IPP_CAP_*)
39*4882a593Smuzhiyun * @formats: array of supported formats
40*4882a593Smuzhiyun * @num_formats: size of the supported formats array
41*4882a593Smuzhiyun * @name: name (for debugging purposes)
42*4882a593Smuzhiyun *
43*4882a593Smuzhiyun * Initializes a ipp module.
44*4882a593Smuzhiyun *
45*4882a593Smuzhiyun * Returns:
46*4882a593Smuzhiyun * Zero on success, error code on failure.
47*4882a593Smuzhiyun */
exynos_drm_ipp_register(struct device * dev,struct exynos_drm_ipp * ipp,const struct exynos_drm_ipp_funcs * funcs,unsigned int caps,const struct exynos_drm_ipp_formats * formats,unsigned int num_formats,const char * name)48*4882a593Smuzhiyun int exynos_drm_ipp_register(struct device *dev, struct exynos_drm_ipp *ipp,
49*4882a593Smuzhiyun const struct exynos_drm_ipp_funcs *funcs, unsigned int caps,
50*4882a593Smuzhiyun const struct exynos_drm_ipp_formats *formats,
51*4882a593Smuzhiyun unsigned int num_formats, const char *name)
52*4882a593Smuzhiyun {
53*4882a593Smuzhiyun WARN_ON(!ipp);
54*4882a593Smuzhiyun WARN_ON(!funcs);
55*4882a593Smuzhiyun WARN_ON(!formats);
56*4882a593Smuzhiyun WARN_ON(!num_formats);
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun spin_lock_init(&ipp->lock);
59*4882a593Smuzhiyun INIT_LIST_HEAD(&ipp->todo_list);
60*4882a593Smuzhiyun init_waitqueue_head(&ipp->done_wq);
61*4882a593Smuzhiyun ipp->dev = dev;
62*4882a593Smuzhiyun ipp->funcs = funcs;
63*4882a593Smuzhiyun ipp->capabilities = caps;
64*4882a593Smuzhiyun ipp->name = name;
65*4882a593Smuzhiyun ipp->formats = formats;
66*4882a593Smuzhiyun ipp->num_formats = num_formats;
67*4882a593Smuzhiyun
68*4882a593Smuzhiyun /* ipp_list modification is serialized by component framework */
69*4882a593Smuzhiyun list_add_tail(&ipp->head, &ipp_list);
70*4882a593Smuzhiyun ipp->id = num_ipp++;
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(dev, "Registered ipp %d\n", ipp->id);
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun return 0;
75*4882a593Smuzhiyun }
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun /**
78*4882a593Smuzhiyun * exynos_drm_ipp_unregister - Unregister the picture processor module
79*4882a593Smuzhiyun * @dev: DRM device
80*4882a593Smuzhiyun * @ipp: ipp module
81*4882a593Smuzhiyun */
exynos_drm_ipp_unregister(struct device * dev,struct exynos_drm_ipp * ipp)82*4882a593Smuzhiyun void exynos_drm_ipp_unregister(struct device *dev,
83*4882a593Smuzhiyun struct exynos_drm_ipp *ipp)
84*4882a593Smuzhiyun {
85*4882a593Smuzhiyun WARN_ON(ipp->task);
86*4882a593Smuzhiyun WARN_ON(!list_empty(&ipp->todo_list));
87*4882a593Smuzhiyun list_del(&ipp->head);
88*4882a593Smuzhiyun }
89*4882a593Smuzhiyun
90*4882a593Smuzhiyun /**
91*4882a593Smuzhiyun * exynos_drm_ipp_ioctl_get_res_ioctl - enumerate all ipp modules
92*4882a593Smuzhiyun * @dev: DRM device
93*4882a593Smuzhiyun * @data: ioctl data
94*4882a593Smuzhiyun * @file_priv: DRM file info
95*4882a593Smuzhiyun *
96*4882a593Smuzhiyun * Construct a list of ipp ids.
97*4882a593Smuzhiyun *
98*4882a593Smuzhiyun * Called by the user via ioctl.
99*4882a593Smuzhiyun *
100*4882a593Smuzhiyun * Returns:
101*4882a593Smuzhiyun * Zero on success, negative errno on failure.
102*4882a593Smuzhiyun */
exynos_drm_ipp_get_res_ioctl(struct drm_device * dev,void * data,struct drm_file * file_priv)103*4882a593Smuzhiyun int exynos_drm_ipp_get_res_ioctl(struct drm_device *dev, void *data,
104*4882a593Smuzhiyun struct drm_file *file_priv)
105*4882a593Smuzhiyun {
106*4882a593Smuzhiyun struct drm_exynos_ioctl_ipp_get_res *resp = data;
107*4882a593Smuzhiyun struct exynos_drm_ipp *ipp;
108*4882a593Smuzhiyun uint32_t __user *ipp_ptr = (uint32_t __user *)
109*4882a593Smuzhiyun (unsigned long)resp->ipp_id_ptr;
110*4882a593Smuzhiyun unsigned int count = num_ipp, copied = 0;
111*4882a593Smuzhiyun
112*4882a593Smuzhiyun /*
113*4882a593Smuzhiyun * This ioctl is called twice, once to determine how much space is
114*4882a593Smuzhiyun * needed, and the 2nd time to fill it.
115*4882a593Smuzhiyun */
116*4882a593Smuzhiyun if (count && resp->count_ipps >= count) {
117*4882a593Smuzhiyun list_for_each_entry(ipp, &ipp_list, head) {
118*4882a593Smuzhiyun if (put_user(ipp->id, ipp_ptr + copied))
119*4882a593Smuzhiyun return -EFAULT;
120*4882a593Smuzhiyun copied++;
121*4882a593Smuzhiyun }
122*4882a593Smuzhiyun }
123*4882a593Smuzhiyun resp->count_ipps = count;
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun return 0;
126*4882a593Smuzhiyun }
127*4882a593Smuzhiyun
__ipp_get(uint32_t id)128*4882a593Smuzhiyun static inline struct exynos_drm_ipp *__ipp_get(uint32_t id)
129*4882a593Smuzhiyun {
130*4882a593Smuzhiyun struct exynos_drm_ipp *ipp;
131*4882a593Smuzhiyun
132*4882a593Smuzhiyun list_for_each_entry(ipp, &ipp_list, head)
133*4882a593Smuzhiyun if (ipp->id == id)
134*4882a593Smuzhiyun return ipp;
135*4882a593Smuzhiyun return NULL;
136*4882a593Smuzhiyun }
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun /**
139*4882a593Smuzhiyun * exynos_drm_ipp_ioctl_get_caps - get ipp module capabilities and formats
140*4882a593Smuzhiyun * @dev: DRM device
141*4882a593Smuzhiyun * @data: ioctl data
142*4882a593Smuzhiyun * @file_priv: DRM file info
143*4882a593Smuzhiyun *
144*4882a593Smuzhiyun * Construct a structure describing ipp module capabilities.
145*4882a593Smuzhiyun *
146*4882a593Smuzhiyun * Called by the user via ioctl.
147*4882a593Smuzhiyun *
148*4882a593Smuzhiyun * Returns:
149*4882a593Smuzhiyun * Zero on success, negative errno on failure.
150*4882a593Smuzhiyun */
exynos_drm_ipp_get_caps_ioctl(struct drm_device * dev,void * data,struct drm_file * file_priv)151*4882a593Smuzhiyun int exynos_drm_ipp_get_caps_ioctl(struct drm_device *dev, void *data,
152*4882a593Smuzhiyun struct drm_file *file_priv)
153*4882a593Smuzhiyun {
154*4882a593Smuzhiyun struct drm_exynos_ioctl_ipp_get_caps *resp = data;
155*4882a593Smuzhiyun void __user *ptr = (void __user *)(unsigned long)resp->formats_ptr;
156*4882a593Smuzhiyun struct exynos_drm_ipp *ipp;
157*4882a593Smuzhiyun int i;
158*4882a593Smuzhiyun
159*4882a593Smuzhiyun ipp = __ipp_get(resp->ipp_id);
160*4882a593Smuzhiyun if (!ipp)
161*4882a593Smuzhiyun return -ENOENT;
162*4882a593Smuzhiyun
163*4882a593Smuzhiyun resp->ipp_id = ipp->id;
164*4882a593Smuzhiyun resp->capabilities = ipp->capabilities;
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun /*
167*4882a593Smuzhiyun * This ioctl is called twice, once to determine how much space is
168*4882a593Smuzhiyun * needed, and the 2nd time to fill it.
169*4882a593Smuzhiyun */
170*4882a593Smuzhiyun if (resp->formats_count >= ipp->num_formats) {
171*4882a593Smuzhiyun for (i = 0; i < ipp->num_formats; i++) {
172*4882a593Smuzhiyun struct drm_exynos_ipp_format tmp = {
173*4882a593Smuzhiyun .fourcc = ipp->formats[i].fourcc,
174*4882a593Smuzhiyun .type = ipp->formats[i].type,
175*4882a593Smuzhiyun .modifier = ipp->formats[i].modifier,
176*4882a593Smuzhiyun };
177*4882a593Smuzhiyun
178*4882a593Smuzhiyun if (copy_to_user(ptr, &tmp, sizeof(tmp)))
179*4882a593Smuzhiyun return -EFAULT;
180*4882a593Smuzhiyun ptr += sizeof(tmp);
181*4882a593Smuzhiyun }
182*4882a593Smuzhiyun }
183*4882a593Smuzhiyun resp->formats_count = ipp->num_formats;
184*4882a593Smuzhiyun
185*4882a593Smuzhiyun return 0;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun
__ipp_format_get(struct exynos_drm_ipp * ipp,uint32_t fourcc,uint64_t mod,unsigned int type)188*4882a593Smuzhiyun static inline const struct exynos_drm_ipp_formats *__ipp_format_get(
189*4882a593Smuzhiyun struct exynos_drm_ipp *ipp, uint32_t fourcc,
190*4882a593Smuzhiyun uint64_t mod, unsigned int type)
191*4882a593Smuzhiyun {
192*4882a593Smuzhiyun int i;
193*4882a593Smuzhiyun
194*4882a593Smuzhiyun for (i = 0; i < ipp->num_formats; i++) {
195*4882a593Smuzhiyun if ((ipp->formats[i].type & type) &&
196*4882a593Smuzhiyun ipp->formats[i].fourcc == fourcc &&
197*4882a593Smuzhiyun ipp->formats[i].modifier == mod)
198*4882a593Smuzhiyun return &ipp->formats[i];
199*4882a593Smuzhiyun }
200*4882a593Smuzhiyun return NULL;
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun
203*4882a593Smuzhiyun /**
204*4882a593Smuzhiyun * exynos_drm_ipp_get_limits_ioctl - get ipp module limits
205*4882a593Smuzhiyun * @dev: DRM device
206*4882a593Smuzhiyun * @data: ioctl data
207*4882a593Smuzhiyun * @file_priv: DRM file info
208*4882a593Smuzhiyun *
209*4882a593Smuzhiyun * Construct a structure describing ipp module limitations for provided
210*4882a593Smuzhiyun * picture format.
211*4882a593Smuzhiyun *
212*4882a593Smuzhiyun * Called by the user via ioctl.
213*4882a593Smuzhiyun *
214*4882a593Smuzhiyun * Returns:
215*4882a593Smuzhiyun * Zero on success, negative errno on failure.
216*4882a593Smuzhiyun */
exynos_drm_ipp_get_limits_ioctl(struct drm_device * dev,void * data,struct drm_file * file_priv)217*4882a593Smuzhiyun int exynos_drm_ipp_get_limits_ioctl(struct drm_device *dev, void *data,
218*4882a593Smuzhiyun struct drm_file *file_priv)
219*4882a593Smuzhiyun {
220*4882a593Smuzhiyun struct drm_exynos_ioctl_ipp_get_limits *resp = data;
221*4882a593Smuzhiyun void __user *ptr = (void __user *)(unsigned long)resp->limits_ptr;
222*4882a593Smuzhiyun const struct exynos_drm_ipp_formats *format;
223*4882a593Smuzhiyun struct exynos_drm_ipp *ipp;
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun if (resp->type != DRM_EXYNOS_IPP_FORMAT_SOURCE &&
226*4882a593Smuzhiyun resp->type != DRM_EXYNOS_IPP_FORMAT_DESTINATION)
227*4882a593Smuzhiyun return -EINVAL;
228*4882a593Smuzhiyun
229*4882a593Smuzhiyun ipp = __ipp_get(resp->ipp_id);
230*4882a593Smuzhiyun if (!ipp)
231*4882a593Smuzhiyun return -ENOENT;
232*4882a593Smuzhiyun
233*4882a593Smuzhiyun format = __ipp_format_get(ipp, resp->fourcc, resp->modifier,
234*4882a593Smuzhiyun resp->type);
235*4882a593Smuzhiyun if (!format)
236*4882a593Smuzhiyun return -EINVAL;
237*4882a593Smuzhiyun
238*4882a593Smuzhiyun /*
239*4882a593Smuzhiyun * This ioctl is called twice, once to determine how much space is
240*4882a593Smuzhiyun * needed, and the 2nd time to fill it.
241*4882a593Smuzhiyun */
242*4882a593Smuzhiyun if (format->num_limits && resp->limits_count >= format->num_limits)
243*4882a593Smuzhiyun if (copy_to_user((void __user *)ptr, format->limits,
244*4882a593Smuzhiyun sizeof(*format->limits) * format->num_limits))
245*4882a593Smuzhiyun return -EFAULT;
246*4882a593Smuzhiyun resp->limits_count = format->num_limits;
247*4882a593Smuzhiyun
248*4882a593Smuzhiyun return 0;
249*4882a593Smuzhiyun }
250*4882a593Smuzhiyun
251*4882a593Smuzhiyun struct drm_pending_exynos_ipp_event {
252*4882a593Smuzhiyun struct drm_pending_event base;
253*4882a593Smuzhiyun struct drm_exynos_ipp_event event;
254*4882a593Smuzhiyun };
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun static inline struct exynos_drm_ipp_task *
exynos_drm_ipp_task_alloc(struct exynos_drm_ipp * ipp)257*4882a593Smuzhiyun exynos_drm_ipp_task_alloc(struct exynos_drm_ipp *ipp)
258*4882a593Smuzhiyun {
259*4882a593Smuzhiyun struct exynos_drm_ipp_task *task;
260*4882a593Smuzhiyun
261*4882a593Smuzhiyun task = kzalloc(sizeof(*task), GFP_KERNEL);
262*4882a593Smuzhiyun if (!task)
263*4882a593Smuzhiyun return NULL;
264*4882a593Smuzhiyun
265*4882a593Smuzhiyun task->dev = ipp->dev;
266*4882a593Smuzhiyun task->ipp = ipp;
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun /* some defaults */
269*4882a593Smuzhiyun task->src.rect.w = task->dst.rect.w = UINT_MAX;
270*4882a593Smuzhiyun task->src.rect.h = task->dst.rect.h = UINT_MAX;
271*4882a593Smuzhiyun task->transform.rotation = DRM_MODE_ROTATE_0;
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Allocated task %pK\n", task);
274*4882a593Smuzhiyun
275*4882a593Smuzhiyun return task;
276*4882a593Smuzhiyun }
277*4882a593Smuzhiyun
278*4882a593Smuzhiyun static const struct exynos_drm_param_map {
279*4882a593Smuzhiyun unsigned int id;
280*4882a593Smuzhiyun unsigned int size;
281*4882a593Smuzhiyun unsigned int offset;
282*4882a593Smuzhiyun } exynos_drm_ipp_params_maps[] = {
283*4882a593Smuzhiyun {
284*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_BUFFER | DRM_EXYNOS_IPP_TASK_TYPE_SOURCE,
285*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_buffer),
286*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, src.buf),
287*4882a593Smuzhiyun }, {
288*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_BUFFER |
289*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_TYPE_DESTINATION,
290*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_buffer),
291*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, dst.buf),
292*4882a593Smuzhiyun }, {
293*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_RECTANGLE | DRM_EXYNOS_IPP_TASK_TYPE_SOURCE,
294*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_rect),
295*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, src.rect),
296*4882a593Smuzhiyun }, {
297*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_RECTANGLE |
298*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_TYPE_DESTINATION,
299*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_rect),
300*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, dst.rect),
301*4882a593Smuzhiyun }, {
302*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_TRANSFORM,
303*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_transform),
304*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, transform),
305*4882a593Smuzhiyun }, {
306*4882a593Smuzhiyun DRM_EXYNOS_IPP_TASK_ALPHA,
307*4882a593Smuzhiyun sizeof(struct drm_exynos_ipp_task_alpha),
308*4882a593Smuzhiyun offsetof(struct exynos_drm_ipp_task, alpha),
309*4882a593Smuzhiyun },
310*4882a593Smuzhiyun };
311*4882a593Smuzhiyun
exynos_drm_ipp_task_set(struct exynos_drm_ipp_task * task,struct drm_exynos_ioctl_ipp_commit * arg)312*4882a593Smuzhiyun static int exynos_drm_ipp_task_set(struct exynos_drm_ipp_task *task,
313*4882a593Smuzhiyun struct drm_exynos_ioctl_ipp_commit *arg)
314*4882a593Smuzhiyun {
315*4882a593Smuzhiyun const struct exynos_drm_param_map *map = exynos_drm_ipp_params_maps;
316*4882a593Smuzhiyun void __user *params = (void __user *)(unsigned long)arg->params_ptr;
317*4882a593Smuzhiyun unsigned int size = arg->params_size;
318*4882a593Smuzhiyun uint32_t id;
319*4882a593Smuzhiyun int i;
320*4882a593Smuzhiyun
321*4882a593Smuzhiyun while (size) {
322*4882a593Smuzhiyun if (get_user(id, (uint32_t __user *)params))
323*4882a593Smuzhiyun return -EFAULT;
324*4882a593Smuzhiyun
325*4882a593Smuzhiyun for (i = 0; i < ARRAY_SIZE(exynos_drm_ipp_params_maps); i++)
326*4882a593Smuzhiyun if (map[i].id == id)
327*4882a593Smuzhiyun break;
328*4882a593Smuzhiyun if (i == ARRAY_SIZE(exynos_drm_ipp_params_maps) ||
329*4882a593Smuzhiyun map[i].size > size)
330*4882a593Smuzhiyun return -EINVAL;
331*4882a593Smuzhiyun
332*4882a593Smuzhiyun if (copy_from_user((void *)task + map[i].offset, params,
333*4882a593Smuzhiyun map[i].size))
334*4882a593Smuzhiyun return -EFAULT;
335*4882a593Smuzhiyun
336*4882a593Smuzhiyun params += map[i].size;
337*4882a593Smuzhiyun size -= map[i].size;
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun
340*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev,
341*4882a593Smuzhiyun "Got task %pK configuration from userspace\n",
342*4882a593Smuzhiyun task);
343*4882a593Smuzhiyun return 0;
344*4882a593Smuzhiyun }
345*4882a593Smuzhiyun
exynos_drm_ipp_task_setup_buffer(struct exynos_drm_ipp_buffer * buf,struct drm_file * filp)346*4882a593Smuzhiyun static int exynos_drm_ipp_task_setup_buffer(struct exynos_drm_ipp_buffer *buf,
347*4882a593Smuzhiyun struct drm_file *filp)
348*4882a593Smuzhiyun {
349*4882a593Smuzhiyun int ret = 0;
350*4882a593Smuzhiyun int i;
351*4882a593Smuzhiyun
352*4882a593Smuzhiyun /* get GEM buffers and check their size */
353*4882a593Smuzhiyun for (i = 0; i < buf->format->num_planes; i++) {
354*4882a593Smuzhiyun unsigned int height = (i == 0) ? buf->buf.height :
355*4882a593Smuzhiyun DIV_ROUND_UP(buf->buf.height, buf->format->vsub);
356*4882a593Smuzhiyun unsigned long size = height * buf->buf.pitch[i];
357*4882a593Smuzhiyun struct exynos_drm_gem *gem = exynos_drm_gem_get(filp,
358*4882a593Smuzhiyun buf->buf.gem_id[i]);
359*4882a593Smuzhiyun if (!gem) {
360*4882a593Smuzhiyun ret = -ENOENT;
361*4882a593Smuzhiyun goto gem_free;
362*4882a593Smuzhiyun }
363*4882a593Smuzhiyun buf->exynos_gem[i] = gem;
364*4882a593Smuzhiyun
365*4882a593Smuzhiyun if (size + buf->buf.offset[i] > buf->exynos_gem[i]->size) {
366*4882a593Smuzhiyun i++;
367*4882a593Smuzhiyun ret = -EINVAL;
368*4882a593Smuzhiyun goto gem_free;
369*4882a593Smuzhiyun }
370*4882a593Smuzhiyun buf->dma_addr[i] = buf->exynos_gem[i]->dma_addr +
371*4882a593Smuzhiyun buf->buf.offset[i];
372*4882a593Smuzhiyun }
373*4882a593Smuzhiyun
374*4882a593Smuzhiyun return 0;
375*4882a593Smuzhiyun gem_free:
376*4882a593Smuzhiyun while (i--) {
377*4882a593Smuzhiyun exynos_drm_gem_put(buf->exynos_gem[i]);
378*4882a593Smuzhiyun buf->exynos_gem[i] = NULL;
379*4882a593Smuzhiyun }
380*4882a593Smuzhiyun return ret;
381*4882a593Smuzhiyun }
382*4882a593Smuzhiyun
exynos_drm_ipp_task_release_buf(struct exynos_drm_ipp_buffer * buf)383*4882a593Smuzhiyun static void exynos_drm_ipp_task_release_buf(struct exynos_drm_ipp_buffer *buf)
384*4882a593Smuzhiyun {
385*4882a593Smuzhiyun int i;
386*4882a593Smuzhiyun
387*4882a593Smuzhiyun if (!buf->exynos_gem[0])
388*4882a593Smuzhiyun return;
389*4882a593Smuzhiyun for (i = 0; i < buf->format->num_planes; i++)
390*4882a593Smuzhiyun exynos_drm_gem_put(buf->exynos_gem[i]);
391*4882a593Smuzhiyun }
392*4882a593Smuzhiyun
exynos_drm_ipp_task_free(struct exynos_drm_ipp * ipp,struct exynos_drm_ipp_task * task)393*4882a593Smuzhiyun static void exynos_drm_ipp_task_free(struct exynos_drm_ipp *ipp,
394*4882a593Smuzhiyun struct exynos_drm_ipp_task *task)
395*4882a593Smuzhiyun {
396*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Freeing task %pK\n", task);
397*4882a593Smuzhiyun
398*4882a593Smuzhiyun exynos_drm_ipp_task_release_buf(&task->src);
399*4882a593Smuzhiyun exynos_drm_ipp_task_release_buf(&task->dst);
400*4882a593Smuzhiyun if (task->event)
401*4882a593Smuzhiyun drm_event_cancel_free(ipp->drm_dev, &task->event->base);
402*4882a593Smuzhiyun kfree(task);
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun
405*4882a593Smuzhiyun struct drm_ipp_limit {
406*4882a593Smuzhiyun struct drm_exynos_ipp_limit_val h;
407*4882a593Smuzhiyun struct drm_exynos_ipp_limit_val v;
408*4882a593Smuzhiyun };
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun enum drm_ipp_size_id {
411*4882a593Smuzhiyun IPP_LIMIT_BUFFER, IPP_LIMIT_AREA, IPP_LIMIT_ROTATED, IPP_LIMIT_MAX
412*4882a593Smuzhiyun };
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun static const enum drm_exynos_ipp_limit_type limit_id_fallback[IPP_LIMIT_MAX][4] = {
415*4882a593Smuzhiyun [IPP_LIMIT_BUFFER] = { DRM_EXYNOS_IPP_LIMIT_SIZE_BUFFER },
416*4882a593Smuzhiyun [IPP_LIMIT_AREA] = { DRM_EXYNOS_IPP_LIMIT_SIZE_AREA,
417*4882a593Smuzhiyun DRM_EXYNOS_IPP_LIMIT_SIZE_BUFFER },
418*4882a593Smuzhiyun [IPP_LIMIT_ROTATED] = { DRM_EXYNOS_IPP_LIMIT_SIZE_ROTATED,
419*4882a593Smuzhiyun DRM_EXYNOS_IPP_LIMIT_SIZE_AREA,
420*4882a593Smuzhiyun DRM_EXYNOS_IPP_LIMIT_SIZE_BUFFER },
421*4882a593Smuzhiyun };
422*4882a593Smuzhiyun
__limit_set_val(unsigned int * ptr,unsigned int val)423*4882a593Smuzhiyun static inline void __limit_set_val(unsigned int *ptr, unsigned int val)
424*4882a593Smuzhiyun {
425*4882a593Smuzhiyun if (!*ptr)
426*4882a593Smuzhiyun *ptr = val;
427*4882a593Smuzhiyun }
428*4882a593Smuzhiyun
__get_size_limit(const struct drm_exynos_ipp_limit * limits,unsigned int num_limits,enum drm_ipp_size_id id,struct drm_ipp_limit * res)429*4882a593Smuzhiyun static void __get_size_limit(const struct drm_exynos_ipp_limit *limits,
430*4882a593Smuzhiyun unsigned int num_limits, enum drm_ipp_size_id id,
431*4882a593Smuzhiyun struct drm_ipp_limit *res)
432*4882a593Smuzhiyun {
433*4882a593Smuzhiyun const struct drm_exynos_ipp_limit *l = limits;
434*4882a593Smuzhiyun int i = 0;
435*4882a593Smuzhiyun
436*4882a593Smuzhiyun memset(res, 0, sizeof(*res));
437*4882a593Smuzhiyun for (i = 0; limit_id_fallback[id][i]; i++)
438*4882a593Smuzhiyun for (l = limits; l - limits < num_limits; l++) {
439*4882a593Smuzhiyun if (((l->type & DRM_EXYNOS_IPP_LIMIT_TYPE_MASK) !=
440*4882a593Smuzhiyun DRM_EXYNOS_IPP_LIMIT_TYPE_SIZE) ||
441*4882a593Smuzhiyun ((l->type & DRM_EXYNOS_IPP_LIMIT_SIZE_MASK) !=
442*4882a593Smuzhiyun limit_id_fallback[id][i]))
443*4882a593Smuzhiyun continue;
444*4882a593Smuzhiyun __limit_set_val(&res->h.min, l->h.min);
445*4882a593Smuzhiyun __limit_set_val(&res->h.max, l->h.max);
446*4882a593Smuzhiyun __limit_set_val(&res->h.align, l->h.align);
447*4882a593Smuzhiyun __limit_set_val(&res->v.min, l->v.min);
448*4882a593Smuzhiyun __limit_set_val(&res->v.max, l->v.max);
449*4882a593Smuzhiyun __limit_set_val(&res->v.align, l->v.align);
450*4882a593Smuzhiyun }
451*4882a593Smuzhiyun }
452*4882a593Smuzhiyun
__align_check(unsigned int val,unsigned int align)453*4882a593Smuzhiyun static inline bool __align_check(unsigned int val, unsigned int align)
454*4882a593Smuzhiyun {
455*4882a593Smuzhiyun if (align && (val & (align - 1))) {
456*4882a593Smuzhiyun DRM_DEBUG_DRIVER("Value %d exceeds HW limits (align %d)\n",
457*4882a593Smuzhiyun val, align);
458*4882a593Smuzhiyun return false;
459*4882a593Smuzhiyun }
460*4882a593Smuzhiyun return true;
461*4882a593Smuzhiyun }
462*4882a593Smuzhiyun
__size_limit_check(unsigned int val,struct drm_exynos_ipp_limit_val * l)463*4882a593Smuzhiyun static inline bool __size_limit_check(unsigned int val,
464*4882a593Smuzhiyun struct drm_exynos_ipp_limit_val *l)
465*4882a593Smuzhiyun {
466*4882a593Smuzhiyun if ((l->min && val < l->min) || (l->max && val > l->max)) {
467*4882a593Smuzhiyun DRM_DEBUG_DRIVER("Value %d exceeds HW limits (min %d, max %d)\n",
468*4882a593Smuzhiyun val, l->min, l->max);
469*4882a593Smuzhiyun return false;
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun return __align_check(val, l->align);
472*4882a593Smuzhiyun }
473*4882a593Smuzhiyun
exynos_drm_ipp_check_size_limits(struct exynos_drm_ipp_buffer * buf,const struct drm_exynos_ipp_limit * limits,unsigned int num_limits,bool rotate,bool swap)474*4882a593Smuzhiyun static int exynos_drm_ipp_check_size_limits(struct exynos_drm_ipp_buffer *buf,
475*4882a593Smuzhiyun const struct drm_exynos_ipp_limit *limits, unsigned int num_limits,
476*4882a593Smuzhiyun bool rotate, bool swap)
477*4882a593Smuzhiyun {
478*4882a593Smuzhiyun enum drm_ipp_size_id id = rotate ? IPP_LIMIT_ROTATED : IPP_LIMIT_AREA;
479*4882a593Smuzhiyun struct drm_ipp_limit l;
480*4882a593Smuzhiyun struct drm_exynos_ipp_limit_val *lh = &l.h, *lv = &l.v;
481*4882a593Smuzhiyun int real_width = buf->buf.pitch[0] / buf->format->cpp[0];
482*4882a593Smuzhiyun
483*4882a593Smuzhiyun if (!limits)
484*4882a593Smuzhiyun return 0;
485*4882a593Smuzhiyun
486*4882a593Smuzhiyun __get_size_limit(limits, num_limits, IPP_LIMIT_BUFFER, &l);
487*4882a593Smuzhiyun if (!__size_limit_check(real_width, &l.h) ||
488*4882a593Smuzhiyun !__size_limit_check(buf->buf.height, &l.v))
489*4882a593Smuzhiyun return -EINVAL;
490*4882a593Smuzhiyun
491*4882a593Smuzhiyun if (swap) {
492*4882a593Smuzhiyun lv = &l.h;
493*4882a593Smuzhiyun lh = &l.v;
494*4882a593Smuzhiyun }
495*4882a593Smuzhiyun __get_size_limit(limits, num_limits, id, &l);
496*4882a593Smuzhiyun if (!__size_limit_check(buf->rect.w, lh) ||
497*4882a593Smuzhiyun !__align_check(buf->rect.x, lh->align) ||
498*4882a593Smuzhiyun !__size_limit_check(buf->rect.h, lv) ||
499*4882a593Smuzhiyun !__align_check(buf->rect.y, lv->align))
500*4882a593Smuzhiyun return -EINVAL;
501*4882a593Smuzhiyun
502*4882a593Smuzhiyun return 0;
503*4882a593Smuzhiyun }
504*4882a593Smuzhiyun
__scale_limit_check(unsigned int src,unsigned int dst,unsigned int min,unsigned int max)505*4882a593Smuzhiyun static inline bool __scale_limit_check(unsigned int src, unsigned int dst,
506*4882a593Smuzhiyun unsigned int min, unsigned int max)
507*4882a593Smuzhiyun {
508*4882a593Smuzhiyun if ((max && (dst << 16) > src * max) ||
509*4882a593Smuzhiyun (min && (dst << 16) < src * min)) {
510*4882a593Smuzhiyun DRM_DEBUG_DRIVER("Scale from %d to %d exceeds HW limits (ratio min %d.%05d, max %d.%05d)\n",
511*4882a593Smuzhiyun src, dst,
512*4882a593Smuzhiyun min >> 16, 100000 * (min & 0xffff) / (1 << 16),
513*4882a593Smuzhiyun max >> 16, 100000 * (max & 0xffff) / (1 << 16));
514*4882a593Smuzhiyun return false;
515*4882a593Smuzhiyun }
516*4882a593Smuzhiyun return true;
517*4882a593Smuzhiyun }
518*4882a593Smuzhiyun
exynos_drm_ipp_check_scale_limits(struct drm_exynos_ipp_task_rect * src,struct drm_exynos_ipp_task_rect * dst,const struct drm_exynos_ipp_limit * limits,unsigned int num_limits,bool swap)519*4882a593Smuzhiyun static int exynos_drm_ipp_check_scale_limits(
520*4882a593Smuzhiyun struct drm_exynos_ipp_task_rect *src,
521*4882a593Smuzhiyun struct drm_exynos_ipp_task_rect *dst,
522*4882a593Smuzhiyun const struct drm_exynos_ipp_limit *limits,
523*4882a593Smuzhiyun unsigned int num_limits, bool swap)
524*4882a593Smuzhiyun {
525*4882a593Smuzhiyun const struct drm_exynos_ipp_limit_val *lh, *lv;
526*4882a593Smuzhiyun int dw, dh;
527*4882a593Smuzhiyun
528*4882a593Smuzhiyun for (; num_limits; limits++, num_limits--)
529*4882a593Smuzhiyun if ((limits->type & DRM_EXYNOS_IPP_LIMIT_TYPE_MASK) ==
530*4882a593Smuzhiyun DRM_EXYNOS_IPP_LIMIT_TYPE_SCALE)
531*4882a593Smuzhiyun break;
532*4882a593Smuzhiyun if (!num_limits)
533*4882a593Smuzhiyun return 0;
534*4882a593Smuzhiyun
535*4882a593Smuzhiyun lh = (!swap) ? &limits->h : &limits->v;
536*4882a593Smuzhiyun lv = (!swap) ? &limits->v : &limits->h;
537*4882a593Smuzhiyun dw = (!swap) ? dst->w : dst->h;
538*4882a593Smuzhiyun dh = (!swap) ? dst->h : dst->w;
539*4882a593Smuzhiyun
540*4882a593Smuzhiyun if (!__scale_limit_check(src->w, dw, lh->min, lh->max) ||
541*4882a593Smuzhiyun !__scale_limit_check(src->h, dh, lv->min, lv->max))
542*4882a593Smuzhiyun return -EINVAL;
543*4882a593Smuzhiyun
544*4882a593Smuzhiyun return 0;
545*4882a593Smuzhiyun }
546*4882a593Smuzhiyun
exynos_drm_ipp_check_format(struct exynos_drm_ipp_task * task,struct exynos_drm_ipp_buffer * buf,struct exynos_drm_ipp_buffer * src,struct exynos_drm_ipp_buffer * dst,bool rotate,bool swap)547*4882a593Smuzhiyun static int exynos_drm_ipp_check_format(struct exynos_drm_ipp_task *task,
548*4882a593Smuzhiyun struct exynos_drm_ipp_buffer *buf,
549*4882a593Smuzhiyun struct exynos_drm_ipp_buffer *src,
550*4882a593Smuzhiyun struct exynos_drm_ipp_buffer *dst,
551*4882a593Smuzhiyun bool rotate, bool swap)
552*4882a593Smuzhiyun {
553*4882a593Smuzhiyun const struct exynos_drm_ipp_formats *fmt;
554*4882a593Smuzhiyun int ret, i;
555*4882a593Smuzhiyun
556*4882a593Smuzhiyun fmt = __ipp_format_get(task->ipp, buf->buf.fourcc, buf->buf.modifier,
557*4882a593Smuzhiyun buf == src ? DRM_EXYNOS_IPP_FORMAT_SOURCE :
558*4882a593Smuzhiyun DRM_EXYNOS_IPP_FORMAT_DESTINATION);
559*4882a593Smuzhiyun if (!fmt) {
560*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev,
561*4882a593Smuzhiyun "Task %pK: %s format not supported\n",
562*4882a593Smuzhiyun task, buf == src ? "src" : "dst");
563*4882a593Smuzhiyun return -EINVAL;
564*4882a593Smuzhiyun }
565*4882a593Smuzhiyun
566*4882a593Smuzhiyun /* basic checks */
567*4882a593Smuzhiyun if (buf->buf.width == 0 || buf->buf.height == 0)
568*4882a593Smuzhiyun return -EINVAL;
569*4882a593Smuzhiyun
570*4882a593Smuzhiyun buf->format = drm_format_info(buf->buf.fourcc);
571*4882a593Smuzhiyun for (i = 0; i < buf->format->num_planes; i++) {
572*4882a593Smuzhiyun unsigned int width = (i == 0) ? buf->buf.width :
573*4882a593Smuzhiyun DIV_ROUND_UP(buf->buf.width, buf->format->hsub);
574*4882a593Smuzhiyun
575*4882a593Smuzhiyun if (buf->buf.pitch[i] == 0)
576*4882a593Smuzhiyun buf->buf.pitch[i] = width * buf->format->cpp[i];
577*4882a593Smuzhiyun if (buf->buf.pitch[i] < width * buf->format->cpp[i])
578*4882a593Smuzhiyun return -EINVAL;
579*4882a593Smuzhiyun if (!buf->buf.gem_id[i])
580*4882a593Smuzhiyun return -ENOENT;
581*4882a593Smuzhiyun }
582*4882a593Smuzhiyun
583*4882a593Smuzhiyun /* pitch for additional planes must match */
584*4882a593Smuzhiyun if (buf->format->num_planes > 2 &&
585*4882a593Smuzhiyun buf->buf.pitch[1] != buf->buf.pitch[2])
586*4882a593Smuzhiyun return -EINVAL;
587*4882a593Smuzhiyun
588*4882a593Smuzhiyun /* check driver limits */
589*4882a593Smuzhiyun ret = exynos_drm_ipp_check_size_limits(buf, fmt->limits,
590*4882a593Smuzhiyun fmt->num_limits,
591*4882a593Smuzhiyun rotate,
592*4882a593Smuzhiyun buf == dst ? swap : false);
593*4882a593Smuzhiyun if (ret)
594*4882a593Smuzhiyun return ret;
595*4882a593Smuzhiyun ret = exynos_drm_ipp_check_scale_limits(&src->rect, &dst->rect,
596*4882a593Smuzhiyun fmt->limits,
597*4882a593Smuzhiyun fmt->num_limits, swap);
598*4882a593Smuzhiyun return ret;
599*4882a593Smuzhiyun }
600*4882a593Smuzhiyun
exynos_drm_ipp_task_check(struct exynos_drm_ipp_task * task)601*4882a593Smuzhiyun static int exynos_drm_ipp_task_check(struct exynos_drm_ipp_task *task)
602*4882a593Smuzhiyun {
603*4882a593Smuzhiyun struct exynos_drm_ipp *ipp = task->ipp;
604*4882a593Smuzhiyun struct exynos_drm_ipp_buffer *src = &task->src, *dst = &task->dst;
605*4882a593Smuzhiyun unsigned int rotation = task->transform.rotation;
606*4882a593Smuzhiyun int ret = 0;
607*4882a593Smuzhiyun bool swap = drm_rotation_90_or_270(rotation);
608*4882a593Smuzhiyun bool rotate = (rotation != DRM_MODE_ROTATE_0);
609*4882a593Smuzhiyun bool scale = false;
610*4882a593Smuzhiyun
611*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Checking task %pK\n", task);
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun if (src->rect.w == UINT_MAX)
614*4882a593Smuzhiyun src->rect.w = src->buf.width;
615*4882a593Smuzhiyun if (src->rect.h == UINT_MAX)
616*4882a593Smuzhiyun src->rect.h = src->buf.height;
617*4882a593Smuzhiyun if (dst->rect.w == UINT_MAX)
618*4882a593Smuzhiyun dst->rect.w = dst->buf.width;
619*4882a593Smuzhiyun if (dst->rect.h == UINT_MAX)
620*4882a593Smuzhiyun dst->rect.h = dst->buf.height;
621*4882a593Smuzhiyun
622*4882a593Smuzhiyun if (src->rect.x + src->rect.w > (src->buf.width) ||
623*4882a593Smuzhiyun src->rect.y + src->rect.h > (src->buf.height) ||
624*4882a593Smuzhiyun dst->rect.x + dst->rect.w > (dst->buf.width) ||
625*4882a593Smuzhiyun dst->rect.y + dst->rect.h > (dst->buf.height)) {
626*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev,
627*4882a593Smuzhiyun "Task %pK: defined area is outside provided buffers\n",
628*4882a593Smuzhiyun task);
629*4882a593Smuzhiyun return -EINVAL;
630*4882a593Smuzhiyun }
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun if ((!swap && (src->rect.w != dst->rect.w ||
633*4882a593Smuzhiyun src->rect.h != dst->rect.h)) ||
634*4882a593Smuzhiyun (swap && (src->rect.w != dst->rect.h ||
635*4882a593Smuzhiyun src->rect.h != dst->rect.w)))
636*4882a593Smuzhiyun scale = true;
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun if ((!(ipp->capabilities & DRM_EXYNOS_IPP_CAP_CROP) &&
639*4882a593Smuzhiyun (src->rect.x || src->rect.y || dst->rect.x || dst->rect.y)) ||
640*4882a593Smuzhiyun (!(ipp->capabilities & DRM_EXYNOS_IPP_CAP_ROTATE) && rotate) ||
641*4882a593Smuzhiyun (!(ipp->capabilities & DRM_EXYNOS_IPP_CAP_SCALE) && scale) ||
642*4882a593Smuzhiyun (!(ipp->capabilities & DRM_EXYNOS_IPP_CAP_CONVERT) &&
643*4882a593Smuzhiyun src->buf.fourcc != dst->buf.fourcc)) {
644*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Task %pK: hw capabilities exceeded\n",
645*4882a593Smuzhiyun task);
646*4882a593Smuzhiyun return -EINVAL;
647*4882a593Smuzhiyun }
648*4882a593Smuzhiyun
649*4882a593Smuzhiyun ret = exynos_drm_ipp_check_format(task, src, src, dst, rotate, swap);
650*4882a593Smuzhiyun if (ret)
651*4882a593Smuzhiyun return ret;
652*4882a593Smuzhiyun
653*4882a593Smuzhiyun ret = exynos_drm_ipp_check_format(task, dst, src, dst, false, swap);
654*4882a593Smuzhiyun if (ret)
655*4882a593Smuzhiyun return ret;
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(ipp->dev, "Task %pK: all checks done.\n",
658*4882a593Smuzhiyun task);
659*4882a593Smuzhiyun
660*4882a593Smuzhiyun return ret;
661*4882a593Smuzhiyun }
662*4882a593Smuzhiyun
exynos_drm_ipp_task_setup_buffers(struct exynos_drm_ipp_task * task,struct drm_file * filp)663*4882a593Smuzhiyun static int exynos_drm_ipp_task_setup_buffers(struct exynos_drm_ipp_task *task,
664*4882a593Smuzhiyun struct drm_file *filp)
665*4882a593Smuzhiyun {
666*4882a593Smuzhiyun struct exynos_drm_ipp_buffer *src = &task->src, *dst = &task->dst;
667*4882a593Smuzhiyun int ret = 0;
668*4882a593Smuzhiyun
669*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Setting buffer for task %pK\n",
670*4882a593Smuzhiyun task);
671*4882a593Smuzhiyun
672*4882a593Smuzhiyun ret = exynos_drm_ipp_task_setup_buffer(src, filp);
673*4882a593Smuzhiyun if (ret) {
674*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev,
675*4882a593Smuzhiyun "Task %pK: src buffer setup failed\n",
676*4882a593Smuzhiyun task);
677*4882a593Smuzhiyun return ret;
678*4882a593Smuzhiyun }
679*4882a593Smuzhiyun ret = exynos_drm_ipp_task_setup_buffer(dst, filp);
680*4882a593Smuzhiyun if (ret) {
681*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev,
682*4882a593Smuzhiyun "Task %pK: dst buffer setup failed\n",
683*4882a593Smuzhiyun task);
684*4882a593Smuzhiyun return ret;
685*4882a593Smuzhiyun }
686*4882a593Smuzhiyun
687*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "Task %pK: buffers prepared.\n",
688*4882a593Smuzhiyun task);
689*4882a593Smuzhiyun
690*4882a593Smuzhiyun return ret;
691*4882a593Smuzhiyun }
692*4882a593Smuzhiyun
693*4882a593Smuzhiyun
exynos_drm_ipp_event_create(struct exynos_drm_ipp_task * task,struct drm_file * file_priv,uint64_t user_data)694*4882a593Smuzhiyun static int exynos_drm_ipp_event_create(struct exynos_drm_ipp_task *task,
695*4882a593Smuzhiyun struct drm_file *file_priv, uint64_t user_data)
696*4882a593Smuzhiyun {
697*4882a593Smuzhiyun struct drm_pending_exynos_ipp_event *e = NULL;
698*4882a593Smuzhiyun int ret;
699*4882a593Smuzhiyun
700*4882a593Smuzhiyun e = kzalloc(sizeof(*e), GFP_KERNEL);
701*4882a593Smuzhiyun if (!e)
702*4882a593Smuzhiyun return -ENOMEM;
703*4882a593Smuzhiyun
704*4882a593Smuzhiyun e->event.base.type = DRM_EXYNOS_IPP_EVENT;
705*4882a593Smuzhiyun e->event.base.length = sizeof(e->event);
706*4882a593Smuzhiyun e->event.user_data = user_data;
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun ret = drm_event_reserve_init(task->ipp->drm_dev, file_priv, &e->base,
709*4882a593Smuzhiyun &e->event.base);
710*4882a593Smuzhiyun if (ret)
711*4882a593Smuzhiyun goto free;
712*4882a593Smuzhiyun
713*4882a593Smuzhiyun task->event = e;
714*4882a593Smuzhiyun return 0;
715*4882a593Smuzhiyun free:
716*4882a593Smuzhiyun kfree(e);
717*4882a593Smuzhiyun return ret;
718*4882a593Smuzhiyun }
719*4882a593Smuzhiyun
exynos_drm_ipp_event_send(struct exynos_drm_ipp_task * task)720*4882a593Smuzhiyun static void exynos_drm_ipp_event_send(struct exynos_drm_ipp_task *task)
721*4882a593Smuzhiyun {
722*4882a593Smuzhiyun struct timespec64 now;
723*4882a593Smuzhiyun
724*4882a593Smuzhiyun ktime_get_ts64(&now);
725*4882a593Smuzhiyun task->event->event.tv_sec = now.tv_sec;
726*4882a593Smuzhiyun task->event->event.tv_usec = now.tv_nsec / NSEC_PER_USEC;
727*4882a593Smuzhiyun task->event->event.sequence = atomic_inc_return(&task->ipp->sequence);
728*4882a593Smuzhiyun
729*4882a593Smuzhiyun drm_send_event(task->ipp->drm_dev, &task->event->base);
730*4882a593Smuzhiyun }
731*4882a593Smuzhiyun
exynos_drm_ipp_task_cleanup(struct exynos_drm_ipp_task * task)732*4882a593Smuzhiyun static int exynos_drm_ipp_task_cleanup(struct exynos_drm_ipp_task *task)
733*4882a593Smuzhiyun {
734*4882a593Smuzhiyun int ret = task->ret;
735*4882a593Smuzhiyun
736*4882a593Smuzhiyun if (ret == 0 && task->event) {
737*4882a593Smuzhiyun exynos_drm_ipp_event_send(task);
738*4882a593Smuzhiyun /* ensure event won't be canceled on task free */
739*4882a593Smuzhiyun task->event = NULL;
740*4882a593Smuzhiyun }
741*4882a593Smuzhiyun
742*4882a593Smuzhiyun exynos_drm_ipp_task_free(task->ipp, task);
743*4882a593Smuzhiyun return ret;
744*4882a593Smuzhiyun }
745*4882a593Smuzhiyun
exynos_drm_ipp_cleanup_work(struct work_struct * work)746*4882a593Smuzhiyun static void exynos_drm_ipp_cleanup_work(struct work_struct *work)
747*4882a593Smuzhiyun {
748*4882a593Smuzhiyun struct exynos_drm_ipp_task *task = container_of(work,
749*4882a593Smuzhiyun struct exynos_drm_ipp_task, cleanup_work);
750*4882a593Smuzhiyun
751*4882a593Smuzhiyun exynos_drm_ipp_task_cleanup(task);
752*4882a593Smuzhiyun }
753*4882a593Smuzhiyun
754*4882a593Smuzhiyun static void exynos_drm_ipp_next_task(struct exynos_drm_ipp *ipp);
755*4882a593Smuzhiyun
756*4882a593Smuzhiyun /**
757*4882a593Smuzhiyun * exynos_drm_ipp_task_done - finish given task and set return code
758*4882a593Smuzhiyun * @task: ipp task to finish
759*4882a593Smuzhiyun * @ret: error code or 0 if operation has been performed successfully
760*4882a593Smuzhiyun */
exynos_drm_ipp_task_done(struct exynos_drm_ipp_task * task,int ret)761*4882a593Smuzhiyun void exynos_drm_ipp_task_done(struct exynos_drm_ipp_task *task, int ret)
762*4882a593Smuzhiyun {
763*4882a593Smuzhiyun struct exynos_drm_ipp *ipp = task->ipp;
764*4882a593Smuzhiyun unsigned long flags;
765*4882a593Smuzhiyun
766*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(task->dev, "ipp: %d, task %pK done: %d\n",
767*4882a593Smuzhiyun ipp->id, task, ret);
768*4882a593Smuzhiyun
769*4882a593Smuzhiyun spin_lock_irqsave(&ipp->lock, flags);
770*4882a593Smuzhiyun if (ipp->task == task)
771*4882a593Smuzhiyun ipp->task = NULL;
772*4882a593Smuzhiyun task->flags |= DRM_EXYNOS_IPP_TASK_DONE;
773*4882a593Smuzhiyun task->ret = ret;
774*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
775*4882a593Smuzhiyun
776*4882a593Smuzhiyun exynos_drm_ipp_next_task(ipp);
777*4882a593Smuzhiyun wake_up(&ipp->done_wq);
778*4882a593Smuzhiyun
779*4882a593Smuzhiyun if (task->flags & DRM_EXYNOS_IPP_TASK_ASYNC) {
780*4882a593Smuzhiyun INIT_WORK(&task->cleanup_work, exynos_drm_ipp_cleanup_work);
781*4882a593Smuzhiyun schedule_work(&task->cleanup_work);
782*4882a593Smuzhiyun }
783*4882a593Smuzhiyun }
784*4882a593Smuzhiyun
exynos_drm_ipp_next_task(struct exynos_drm_ipp * ipp)785*4882a593Smuzhiyun static void exynos_drm_ipp_next_task(struct exynos_drm_ipp *ipp)
786*4882a593Smuzhiyun {
787*4882a593Smuzhiyun struct exynos_drm_ipp_task *task;
788*4882a593Smuzhiyun unsigned long flags;
789*4882a593Smuzhiyun int ret;
790*4882a593Smuzhiyun
791*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(ipp->dev, "ipp: %d, try to run new task\n",
792*4882a593Smuzhiyun ipp->id);
793*4882a593Smuzhiyun
794*4882a593Smuzhiyun spin_lock_irqsave(&ipp->lock, flags);
795*4882a593Smuzhiyun
796*4882a593Smuzhiyun if (ipp->task || list_empty(&ipp->todo_list)) {
797*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
798*4882a593Smuzhiyun return;
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun
801*4882a593Smuzhiyun task = list_first_entry(&ipp->todo_list, struct exynos_drm_ipp_task,
802*4882a593Smuzhiyun head);
803*4882a593Smuzhiyun list_del_init(&task->head);
804*4882a593Smuzhiyun ipp->task = task;
805*4882a593Smuzhiyun
806*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
807*4882a593Smuzhiyun
808*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(ipp->dev,
809*4882a593Smuzhiyun "ipp: %d, selected task %pK to run\n", ipp->id,
810*4882a593Smuzhiyun task);
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun ret = ipp->funcs->commit(ipp, task);
813*4882a593Smuzhiyun if (ret)
814*4882a593Smuzhiyun exynos_drm_ipp_task_done(task, ret);
815*4882a593Smuzhiyun }
816*4882a593Smuzhiyun
exynos_drm_ipp_schedule_task(struct exynos_drm_ipp * ipp,struct exynos_drm_ipp_task * task)817*4882a593Smuzhiyun static void exynos_drm_ipp_schedule_task(struct exynos_drm_ipp *ipp,
818*4882a593Smuzhiyun struct exynos_drm_ipp_task *task)
819*4882a593Smuzhiyun {
820*4882a593Smuzhiyun unsigned long flags;
821*4882a593Smuzhiyun
822*4882a593Smuzhiyun spin_lock_irqsave(&ipp->lock, flags);
823*4882a593Smuzhiyun list_add(&task->head, &ipp->todo_list);
824*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
825*4882a593Smuzhiyun
826*4882a593Smuzhiyun exynos_drm_ipp_next_task(ipp);
827*4882a593Smuzhiyun }
828*4882a593Smuzhiyun
exynos_drm_ipp_task_abort(struct exynos_drm_ipp * ipp,struct exynos_drm_ipp_task * task)829*4882a593Smuzhiyun static void exynos_drm_ipp_task_abort(struct exynos_drm_ipp *ipp,
830*4882a593Smuzhiyun struct exynos_drm_ipp_task *task)
831*4882a593Smuzhiyun {
832*4882a593Smuzhiyun unsigned long flags;
833*4882a593Smuzhiyun
834*4882a593Smuzhiyun spin_lock_irqsave(&ipp->lock, flags);
835*4882a593Smuzhiyun if (task->flags & DRM_EXYNOS_IPP_TASK_DONE) {
836*4882a593Smuzhiyun /* already completed task */
837*4882a593Smuzhiyun exynos_drm_ipp_task_cleanup(task);
838*4882a593Smuzhiyun } else if (ipp->task != task) {
839*4882a593Smuzhiyun /* task has not been scheduled for execution yet */
840*4882a593Smuzhiyun list_del_init(&task->head);
841*4882a593Smuzhiyun exynos_drm_ipp_task_cleanup(task);
842*4882a593Smuzhiyun } else {
843*4882a593Smuzhiyun /*
844*4882a593Smuzhiyun * currently processed task, call abort() and perform
845*4882a593Smuzhiyun * cleanup with async worker
846*4882a593Smuzhiyun */
847*4882a593Smuzhiyun task->flags |= DRM_EXYNOS_IPP_TASK_ASYNC;
848*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
849*4882a593Smuzhiyun if (ipp->funcs->abort)
850*4882a593Smuzhiyun ipp->funcs->abort(ipp, task);
851*4882a593Smuzhiyun return;
852*4882a593Smuzhiyun }
853*4882a593Smuzhiyun spin_unlock_irqrestore(&ipp->lock, flags);
854*4882a593Smuzhiyun }
855*4882a593Smuzhiyun
856*4882a593Smuzhiyun /**
857*4882a593Smuzhiyun * exynos_drm_ipp_commit_ioctl - perform image processing operation
858*4882a593Smuzhiyun * @dev: DRM device
859*4882a593Smuzhiyun * @data: ioctl data
860*4882a593Smuzhiyun * @file_priv: DRM file info
861*4882a593Smuzhiyun *
862*4882a593Smuzhiyun * Construct a ipp task from the set of properties provided from the user
863*4882a593Smuzhiyun * and try to schedule it to framebuffer processor hardware.
864*4882a593Smuzhiyun *
865*4882a593Smuzhiyun * Called by the user via ioctl.
866*4882a593Smuzhiyun *
867*4882a593Smuzhiyun * Returns:
868*4882a593Smuzhiyun * Zero on success, negative errno on failure.
869*4882a593Smuzhiyun */
exynos_drm_ipp_commit_ioctl(struct drm_device * dev,void * data,struct drm_file * file_priv)870*4882a593Smuzhiyun int exynos_drm_ipp_commit_ioctl(struct drm_device *dev, void *data,
871*4882a593Smuzhiyun struct drm_file *file_priv)
872*4882a593Smuzhiyun {
873*4882a593Smuzhiyun struct drm_exynos_ioctl_ipp_commit *arg = data;
874*4882a593Smuzhiyun struct exynos_drm_ipp *ipp;
875*4882a593Smuzhiyun struct exynos_drm_ipp_task *task;
876*4882a593Smuzhiyun int ret = 0;
877*4882a593Smuzhiyun
878*4882a593Smuzhiyun if ((arg->flags & ~DRM_EXYNOS_IPP_FLAGS) || arg->reserved)
879*4882a593Smuzhiyun return -EINVAL;
880*4882a593Smuzhiyun
881*4882a593Smuzhiyun /* can't test and expect an event at the same time */
882*4882a593Smuzhiyun if ((arg->flags & DRM_EXYNOS_IPP_FLAG_TEST_ONLY) &&
883*4882a593Smuzhiyun (arg->flags & DRM_EXYNOS_IPP_FLAG_EVENT))
884*4882a593Smuzhiyun return -EINVAL;
885*4882a593Smuzhiyun
886*4882a593Smuzhiyun ipp = __ipp_get(arg->ipp_id);
887*4882a593Smuzhiyun if (!ipp)
888*4882a593Smuzhiyun return -ENOENT;
889*4882a593Smuzhiyun
890*4882a593Smuzhiyun task = exynos_drm_ipp_task_alloc(ipp);
891*4882a593Smuzhiyun if (!task)
892*4882a593Smuzhiyun return -ENOMEM;
893*4882a593Smuzhiyun
894*4882a593Smuzhiyun ret = exynos_drm_ipp_task_set(task, arg);
895*4882a593Smuzhiyun if (ret)
896*4882a593Smuzhiyun goto free;
897*4882a593Smuzhiyun
898*4882a593Smuzhiyun ret = exynos_drm_ipp_task_check(task);
899*4882a593Smuzhiyun if (ret)
900*4882a593Smuzhiyun goto free;
901*4882a593Smuzhiyun
902*4882a593Smuzhiyun ret = exynos_drm_ipp_task_setup_buffers(task, file_priv);
903*4882a593Smuzhiyun if (ret || arg->flags & DRM_EXYNOS_IPP_FLAG_TEST_ONLY)
904*4882a593Smuzhiyun goto free;
905*4882a593Smuzhiyun
906*4882a593Smuzhiyun if (arg->flags & DRM_EXYNOS_IPP_FLAG_EVENT) {
907*4882a593Smuzhiyun ret = exynos_drm_ipp_event_create(task, file_priv,
908*4882a593Smuzhiyun arg->user_data);
909*4882a593Smuzhiyun if (ret)
910*4882a593Smuzhiyun goto free;
911*4882a593Smuzhiyun }
912*4882a593Smuzhiyun
913*4882a593Smuzhiyun /*
914*4882a593Smuzhiyun * Queue task for processing on the hardware. task object will be
915*4882a593Smuzhiyun * then freed after exynos_drm_ipp_task_done()
916*4882a593Smuzhiyun */
917*4882a593Smuzhiyun if (arg->flags & DRM_EXYNOS_IPP_FLAG_NONBLOCK) {
918*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(ipp->dev,
919*4882a593Smuzhiyun "ipp: %d, nonblocking processing task %pK\n",
920*4882a593Smuzhiyun ipp->id, task);
921*4882a593Smuzhiyun
922*4882a593Smuzhiyun task->flags |= DRM_EXYNOS_IPP_TASK_ASYNC;
923*4882a593Smuzhiyun exynos_drm_ipp_schedule_task(task->ipp, task);
924*4882a593Smuzhiyun ret = 0;
925*4882a593Smuzhiyun } else {
926*4882a593Smuzhiyun DRM_DEV_DEBUG_DRIVER(ipp->dev, "ipp: %d, processing task %pK\n",
927*4882a593Smuzhiyun ipp->id, task);
928*4882a593Smuzhiyun exynos_drm_ipp_schedule_task(ipp, task);
929*4882a593Smuzhiyun ret = wait_event_interruptible(ipp->done_wq,
930*4882a593Smuzhiyun task->flags & DRM_EXYNOS_IPP_TASK_DONE);
931*4882a593Smuzhiyun if (ret)
932*4882a593Smuzhiyun exynos_drm_ipp_task_abort(ipp, task);
933*4882a593Smuzhiyun else
934*4882a593Smuzhiyun ret = exynos_drm_ipp_task_cleanup(task);
935*4882a593Smuzhiyun }
936*4882a593Smuzhiyun return ret;
937*4882a593Smuzhiyun free:
938*4882a593Smuzhiyun exynos_drm_ipp_task_free(ipp, task);
939*4882a593Smuzhiyun
940*4882a593Smuzhiyun return ret;
941*4882a593Smuzhiyun }
942