1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/device.h>
15#include <linux/gfp.h>
16
17#include <media/v4l2-subdev.h>
18
19#include "vsp1.h"
20#include "vsp1_dl.h"
21#include "vsp1_pipe.h"
22#include "vsp1_uds.h"
23
24#define UDS_MIN_SIZE 4U
25#define UDS_MAX_SIZE 8190U
26
27#define UDS_MIN_FACTOR 0x0100
28#define UDS_MAX_FACTOR 0xffff
29
30
31
32
33
34static inline void vsp1_uds_write(struct vsp1_uds *uds, struct vsp1_dl_list *dl,
35 u32 reg, u32 data)
36{
37 vsp1_dl_list_write(dl, reg + uds->entity.index * VI6_UDS_OFFSET, data);
38}
39
40
41
42
43
44void vsp1_uds_set_alpha(struct vsp1_entity *entity, struct vsp1_dl_list *dl,
45 unsigned int alpha)
46{
47 struct vsp1_uds *uds = to_uds(&entity->subdev);
48
49 vsp1_uds_write(uds, dl, VI6_UDS_ALPVAL,
50 alpha << VI6_UDS_ALPVAL_VAL0_SHIFT);
51}
52
53
54
55
56
57
58static unsigned int uds_output_size(unsigned int input, unsigned int ratio)
59{
60 if (ratio > 4096) {
61
62 unsigned int mp;
63
64 mp = ratio / 4096;
65 mp = mp < 4 ? 1 : (mp < 8 ? 2 : 4);
66
67 return (input - 1) / mp * mp * 4096 / ratio + 1;
68 } else {
69
70 return (input - 1) * 4096 / ratio + 1;
71 }
72}
73
74
75
76
77
78
79
80static void uds_output_limits(unsigned int input,
81 unsigned int *minimum, unsigned int *maximum)
82{
83 *minimum = max(uds_output_size(input, UDS_MAX_FACTOR), UDS_MIN_SIZE);
84 *maximum = min(uds_output_size(input, UDS_MIN_FACTOR), UDS_MAX_SIZE);
85}
86
87
88
89
90
91static unsigned int uds_passband_width(unsigned int ratio)
92{
93 if (ratio >= 4096) {
94
95 unsigned int mp;
96
97 mp = ratio / 4096;
98 mp = mp < 4 ? 1 : (mp < 8 ? 2 : 4);
99
100 return 64 * 4096 * mp / ratio;
101 } else {
102
103 return 64;
104 }
105}
106
107static unsigned int uds_compute_ratio(unsigned int input, unsigned int output)
108{
109
110 return (input - 1) * 4096 / (output - 1);
111}
112
113
114
115
116
117static int uds_enum_mbus_code(struct v4l2_subdev *subdev,
118 struct v4l2_subdev_pad_config *cfg,
119 struct v4l2_subdev_mbus_code_enum *code)
120{
121 static const unsigned int codes[] = {
122 MEDIA_BUS_FMT_ARGB8888_1X32,
123 MEDIA_BUS_FMT_AYUV8_1X32,
124 };
125
126 return vsp1_subdev_enum_mbus_code(subdev, cfg, code, codes,
127 ARRAY_SIZE(codes));
128}
129
130static int uds_enum_frame_size(struct v4l2_subdev *subdev,
131 struct v4l2_subdev_pad_config *cfg,
132 struct v4l2_subdev_frame_size_enum *fse)
133{
134 struct vsp1_uds *uds = to_uds(subdev);
135 struct v4l2_subdev_pad_config *config;
136 struct v4l2_mbus_framefmt *format;
137 int ret = 0;
138
139 config = vsp1_entity_get_pad_config(&uds->entity, cfg, fse->which);
140 if (!config)
141 return -EINVAL;
142
143 format = vsp1_entity_get_pad_format(&uds->entity, config,
144 UDS_PAD_SINK);
145
146 mutex_lock(&uds->entity.lock);
147
148 if (fse->index || fse->code != format->code) {
149 ret = -EINVAL;
150 goto done;
151 }
152
153 if (fse->pad == UDS_PAD_SINK) {
154 fse->min_width = UDS_MIN_SIZE;
155 fse->max_width = UDS_MAX_SIZE;
156 fse->min_height = UDS_MIN_SIZE;
157 fse->max_height = UDS_MAX_SIZE;
158 } else {
159 uds_output_limits(format->width, &fse->min_width,
160 &fse->max_width);
161 uds_output_limits(format->height, &fse->min_height,
162 &fse->max_height);
163 }
164
165done:
166 mutex_unlock(&uds->entity.lock);
167 return ret;
168}
169
170static void uds_try_format(struct vsp1_uds *uds,
171 struct v4l2_subdev_pad_config *config,
172 unsigned int pad, struct v4l2_mbus_framefmt *fmt)
173{
174 struct v4l2_mbus_framefmt *format;
175 unsigned int minimum;
176 unsigned int maximum;
177
178 switch (pad) {
179 case UDS_PAD_SINK:
180
181 if (fmt->code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
182 fmt->code != MEDIA_BUS_FMT_AYUV8_1X32)
183 fmt->code = MEDIA_BUS_FMT_AYUV8_1X32;
184
185 fmt->width = clamp(fmt->width, UDS_MIN_SIZE, UDS_MAX_SIZE);
186 fmt->height = clamp(fmt->height, UDS_MIN_SIZE, UDS_MAX_SIZE);
187 break;
188
189 case UDS_PAD_SOURCE:
190
191 format = vsp1_entity_get_pad_format(&uds->entity, config,
192 UDS_PAD_SINK);
193 fmt->code = format->code;
194
195 uds_output_limits(format->width, &minimum, &maximum);
196 fmt->width = clamp(fmt->width, minimum, maximum);
197 uds_output_limits(format->height, &minimum, &maximum);
198 fmt->height = clamp(fmt->height, minimum, maximum);
199 break;
200 }
201
202 fmt->field = V4L2_FIELD_NONE;
203 fmt->colorspace = V4L2_COLORSPACE_SRGB;
204}
205
206static int uds_set_format(struct v4l2_subdev *subdev,
207 struct v4l2_subdev_pad_config *cfg,
208 struct v4l2_subdev_format *fmt)
209{
210 struct vsp1_uds *uds = to_uds(subdev);
211 struct v4l2_subdev_pad_config *config;
212 struct v4l2_mbus_framefmt *format;
213 int ret = 0;
214
215 mutex_lock(&uds->entity.lock);
216
217 config = vsp1_entity_get_pad_config(&uds->entity, cfg, fmt->which);
218 if (!config) {
219 ret = -EINVAL;
220 goto done;
221 }
222
223 uds_try_format(uds, config, fmt->pad, &fmt->format);
224
225 format = vsp1_entity_get_pad_format(&uds->entity, config, fmt->pad);
226 *format = fmt->format;
227
228 if (fmt->pad == UDS_PAD_SINK) {
229
230 format = vsp1_entity_get_pad_format(&uds->entity, config,
231 UDS_PAD_SOURCE);
232 *format = fmt->format;
233
234 uds_try_format(uds, config, UDS_PAD_SOURCE, format);
235 }
236
237done:
238 mutex_unlock(&uds->entity.lock);
239 return ret;
240}
241
242
243
244
245
246static const struct v4l2_subdev_pad_ops uds_pad_ops = {
247 .init_cfg = vsp1_entity_init_cfg,
248 .enum_mbus_code = uds_enum_mbus_code,
249 .enum_frame_size = uds_enum_frame_size,
250 .get_fmt = vsp1_subdev_get_pad_format,
251 .set_fmt = uds_set_format,
252};
253
254static const struct v4l2_subdev_ops uds_ops = {
255 .pad = &uds_pad_ops,
256};
257
258
259
260
261
262static void uds_configure(struct vsp1_entity *entity,
263 struct vsp1_pipeline *pipe,
264 struct vsp1_dl_list *dl,
265 enum vsp1_entity_params params)
266{
267 struct vsp1_uds *uds = to_uds(&entity->subdev);
268 const struct v4l2_mbus_framefmt *output;
269 const struct v4l2_mbus_framefmt *input;
270 unsigned int hscale;
271 unsigned int vscale;
272 bool multitap;
273
274 if (params == VSP1_ENTITY_PARAMS_PARTITION) {
275 const struct v4l2_rect *clip = &pipe->partition;
276
277 vsp1_uds_write(uds, dl, VI6_UDS_CLIP_SIZE,
278 (clip->width << VI6_UDS_CLIP_SIZE_HSIZE_SHIFT) |
279 (clip->height << VI6_UDS_CLIP_SIZE_VSIZE_SHIFT));
280 return;
281 }
282
283 if (params != VSP1_ENTITY_PARAMS_INIT)
284 return;
285
286 input = vsp1_entity_get_pad_format(&uds->entity, uds->entity.config,
287 UDS_PAD_SINK);
288 output = vsp1_entity_get_pad_format(&uds->entity, uds->entity.config,
289 UDS_PAD_SOURCE);
290
291 hscale = uds_compute_ratio(input->width, output->width);
292 vscale = uds_compute_ratio(input->height, output->height);
293
294 dev_dbg(uds->entity.vsp1->dev, "hscale %u vscale %u\n", hscale, vscale);
295
296
297
298
299
300 if (uds->scale_alpha && (hscale >= 8192 || vscale >= 8192))
301 multitap = false;
302 else
303 multitap = true;
304
305 vsp1_uds_write(uds, dl, VI6_UDS_CTRL,
306 (uds->scale_alpha ? VI6_UDS_CTRL_AON : 0) |
307 (multitap ? VI6_UDS_CTRL_BC : 0));
308
309 vsp1_uds_write(uds, dl, VI6_UDS_PASS_BWIDTH,
310 (uds_passband_width(hscale)
311 << VI6_UDS_PASS_BWIDTH_H_SHIFT) |
312 (uds_passband_width(vscale)
313 << VI6_UDS_PASS_BWIDTH_V_SHIFT));
314
315
316 vsp1_uds_write(uds, dl, VI6_UDS_SCALE,
317 (hscale << VI6_UDS_SCALE_HFRAC_SHIFT) |
318 (vscale << VI6_UDS_SCALE_VFRAC_SHIFT));
319}
320
321static unsigned int uds_max_width(struct vsp1_entity *entity,
322 struct vsp1_pipeline *pipe)
323{
324 struct vsp1_uds *uds = to_uds(&entity->subdev);
325 const struct v4l2_mbus_framefmt *output;
326 const struct v4l2_mbus_framefmt *input;
327 unsigned int hscale;
328
329 input = vsp1_entity_get_pad_format(&uds->entity, uds->entity.config,
330 UDS_PAD_SINK);
331 output = vsp1_entity_get_pad_format(&uds->entity, uds->entity.config,
332 UDS_PAD_SOURCE);
333 hscale = output->width / input->width;
334
335 if (hscale <= 2)
336 return 256;
337 else if (hscale <= 4)
338 return 512;
339 else if (hscale <= 8)
340 return 1024;
341 else
342 return 2048;
343}
344
345static const struct vsp1_entity_operations uds_entity_ops = {
346 .configure = uds_configure,
347 .max_width = uds_max_width,
348};
349
350
351
352
353
354struct vsp1_uds *vsp1_uds_create(struct vsp1_device *vsp1, unsigned int index)
355{
356 struct vsp1_uds *uds;
357 char name[6];
358 int ret;
359
360 uds = devm_kzalloc(vsp1->dev, sizeof(*uds), GFP_KERNEL);
361 if (uds == NULL)
362 return ERR_PTR(-ENOMEM);
363
364 uds->entity.ops = &uds_entity_ops;
365 uds->entity.type = VSP1_ENTITY_UDS;
366 uds->entity.index = index;
367
368 sprintf(name, "uds.%u", index);
369 ret = vsp1_entity_init(vsp1, &uds->entity, name, 2, &uds_ops,
370 MEDIA_ENT_F_PROC_VIDEO_SCALER);
371 if (ret < 0)
372 return ERR_PTR(ret);
373
374 return uds;
375}
376