]>
Commit | Line | Data |
---|---|---|
a5562f65 LP |
1 | /* |
2 | * Xilinx Test Pattern Generator | |
3 | * | |
4 | * Copyright (C) 2013-2015 Ideas on Board | |
5 | * Copyright (C) 2013-2015 Xilinx, Inc. | |
6 | * | |
7 | * Contacts: Hyun Kwon <hyun.kwon@xilinx.com> | |
8 | * Laurent Pinchart <laurent.pinchart@ideasonboard.com> | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License version 2 as | |
12 | * published by the Free Software Foundation. | |
13 | */ | |
14 | ||
15 | #include <linux/device.h> | |
16 | #include <linux/gpio/consumer.h> | |
17 | #include <linux/module.h> | |
18 | #include <linux/of.h> | |
19 | #include <linux/platform_device.h> | |
20 | #include <linux/xilinx-v4l2-controls.h> | |
21 | ||
22 | #include <media/v4l2-async.h> | |
23 | #include <media/v4l2-ctrls.h> | |
24 | #include <media/v4l2-subdev.h> | |
25 | ||
26 | #include "xilinx-vip.h" | |
27 | #include "xilinx-vtc.h" | |
28 | ||
29 | #define XTPG_CTRL_STATUS_SLAVE_ERROR (1 << 16) | |
30 | #define XTPG_CTRL_IRQ_SLAVE_ERROR (1 << 16) | |
31 | ||
32 | #define XTPG_PATTERN_CONTROL 0x0100 | |
33 | #define XTPG_PATTERN_MASK (0xf << 0) | |
34 | #define XTPG_PATTERN_CONTROL_CROSS_HAIRS (1 << 4) | |
35 | #define XTPG_PATTERN_CONTROL_MOVING_BOX (1 << 5) | |
36 | #define XTPG_PATTERN_CONTROL_COLOR_MASK_SHIFT 6 | |
37 | #define XTPG_PATTERN_CONTROL_COLOR_MASK_MASK (0xf << 6) | |
38 | #define XTPG_PATTERN_CONTROL_STUCK_PIXEL (1 << 9) | |
39 | #define XTPG_PATTERN_CONTROL_NOISE (1 << 10) | |
40 | #define XTPG_PATTERN_CONTROL_MOTION (1 << 12) | |
41 | #define XTPG_MOTION_SPEED 0x0104 | |
42 | #define XTPG_CROSS_HAIRS 0x0108 | |
43 | #define XTPG_CROSS_HAIRS_ROW_SHIFT 0 | |
44 | #define XTPG_CROSS_HAIRS_ROW_MASK (0xfff << 0) | |
45 | #define XTPG_CROSS_HAIRS_COLUMN_SHIFT 16 | |
46 | #define XTPG_CROSS_HAIRS_COLUMN_MASK (0xfff << 16) | |
47 | #define XTPG_ZPLATE_HOR_CONTROL 0x010c | |
48 | #define XTPG_ZPLATE_VER_CONTROL 0x0110 | |
49 | #define XTPG_ZPLATE_START_SHIFT 0 | |
50 | #define XTPG_ZPLATE_START_MASK (0xffff << 0) | |
51 | #define XTPG_ZPLATE_SPEED_SHIFT 16 | |
52 | #define XTPG_ZPLATE_SPEED_MASK (0xffff << 16) | |
53 | #define XTPG_BOX_SIZE 0x0114 | |
54 | #define XTPG_BOX_COLOR 0x0118 | |
55 | #define XTPG_STUCK_PIXEL_THRESH 0x011c | |
56 | #define XTPG_NOISE_GAIN 0x0120 | |
57 | #define XTPG_BAYER_PHASE 0x0124 | |
58 | #define XTPG_BAYER_PHASE_RGGB 0 | |
59 | #define XTPG_BAYER_PHASE_GRBG 1 | |
60 | #define XTPG_BAYER_PHASE_GBRG 2 | |
61 | #define XTPG_BAYER_PHASE_BGGR 3 | |
62 | #define XTPG_BAYER_PHASE_OFF 4 | |
63 | ||
64 | /* | |
65 | * The minimum blanking value is one clock cycle for the front porch, one clock | |
66 | * cycle for the sync pulse and one clock cycle for the back porch. | |
67 | */ | |
68 | #define XTPG_MIN_HBLANK 3 | |
69 | #define XTPG_MAX_HBLANK (XVTC_MAX_HSIZE - XVIP_MIN_WIDTH) | |
70 | #define XTPG_MIN_VBLANK 3 | |
71 | #define XTPG_MAX_VBLANK (XVTC_MAX_VSIZE - XVIP_MIN_HEIGHT) | |
72 | ||
73 | /** | |
74 | * struct xtpg_device - Xilinx Test Pattern Generator device structure | |
75 | * @xvip: Xilinx Video IP device | |
76 | * @pads: media pads | |
77 | * @npads: number of pads (1 or 2) | |
78 | * @has_input: whether an input is connected to the sink pad | |
79 | * @formats: active V4L2 media bus format for each pad | |
80 | * @default_format: default V4L2 media bus format | |
81 | * @vip_format: format information corresponding to the active format | |
82 | * @bayer: boolean flag if TPG is set to any bayer format | |
83 | * @ctrl_handler: control handler | |
84 | * @hblank: horizontal blanking control | |
85 | * @vblank: vertical blanking control | |
86 | * @pattern: test pattern control | |
87 | * @streaming: is the video stream active | |
88 | * @vtc: video timing controller | |
89 | * @vtmux_gpio: video timing mux GPIO | |
90 | */ | |
91 | struct xtpg_device { | |
92 | struct xvip_device xvip; | |
93 | ||
94 | struct media_pad pads[2]; | |
95 | unsigned int npads; | |
96 | bool has_input; | |
97 | ||
98 | struct v4l2_mbus_framefmt formats[2]; | |
99 | struct v4l2_mbus_framefmt default_format; | |
100 | const struct xvip_video_format *vip_format; | |
101 | bool bayer; | |
102 | ||
103 | struct v4l2_ctrl_handler ctrl_handler; | |
104 | struct v4l2_ctrl *hblank; | |
105 | struct v4l2_ctrl *vblank; | |
106 | struct v4l2_ctrl *pattern; | |
107 | bool streaming; | |
108 | ||
109 | struct xvtc_device *vtc; | |
110 | struct gpio_desc *vtmux_gpio; | |
111 | }; | |
112 | ||
113 | static inline struct xtpg_device *to_tpg(struct v4l2_subdev *subdev) | |
114 | { | |
115 | return container_of(subdev, struct xtpg_device, xvip.subdev); | |
116 | } | |
117 | ||
118 | static u32 xtpg_get_bayer_phase(unsigned int code) | |
119 | { | |
120 | switch (code) { | |
121 | case MEDIA_BUS_FMT_SRGGB8_1X8: | |
122 | return XTPG_BAYER_PHASE_RGGB; | |
123 | case MEDIA_BUS_FMT_SGRBG8_1X8: | |
124 | return XTPG_BAYER_PHASE_GRBG; | |
125 | case MEDIA_BUS_FMT_SGBRG8_1X8: | |
126 | return XTPG_BAYER_PHASE_GBRG; | |
127 | case MEDIA_BUS_FMT_SBGGR8_1X8: | |
128 | return XTPG_BAYER_PHASE_BGGR; | |
129 | default: | |
130 | return XTPG_BAYER_PHASE_OFF; | |
131 | } | |
132 | } | |
133 | ||
134 | static void __xtpg_update_pattern_control(struct xtpg_device *xtpg, | |
135 | bool passthrough, bool pattern) | |
136 | { | |
137 | u32 pattern_mask = (1 << (xtpg->pattern->maximum + 1)) - 1; | |
138 | ||
139 | /* | |
140 | * If the TPG has no sink pad or no input connected to its sink pad | |
141 | * passthrough mode can't be enabled. | |
142 | */ | |
143 | if (xtpg->npads == 1 || !xtpg->has_input) | |
144 | passthrough = false; | |
145 | ||
146 | /* If passthrough mode is allowed unmask bit 0. */ | |
147 | if (passthrough) | |
148 | pattern_mask &= ~1; | |
149 | ||
150 | /* If test pattern mode is allowed unmask all other bits. */ | |
151 | if (pattern) | |
152 | pattern_mask &= 1; | |
153 | ||
154 | __v4l2_ctrl_modify_range(xtpg->pattern, 0, xtpg->pattern->maximum, | |
155 | pattern_mask, pattern ? 9 : 0); | |
156 | } | |
157 | ||
158 | static void xtpg_update_pattern_control(struct xtpg_device *xtpg, | |
159 | bool passthrough, bool pattern) | |
160 | { | |
161 | mutex_lock(xtpg->ctrl_handler.lock); | |
162 | __xtpg_update_pattern_control(xtpg, passthrough, pattern); | |
163 | mutex_unlock(xtpg->ctrl_handler.lock); | |
164 | } | |
165 | ||
166 | /* ----------------------------------------------------------------------------- | |
167 | * V4L2 Subdevice Video Operations | |
168 | */ | |
169 | ||
170 | static int xtpg_s_stream(struct v4l2_subdev *subdev, int enable) | |
171 | { | |
172 | struct xtpg_device *xtpg = to_tpg(subdev); | |
173 | unsigned int width = xtpg->formats[0].width; | |
174 | unsigned int height = xtpg->formats[0].height; | |
175 | bool passthrough; | |
176 | u32 bayer_phase; | |
177 | ||
178 | if (!enable) { | |
179 | xvip_stop(&xtpg->xvip); | |
180 | if (xtpg->vtc) | |
181 | xvtc_generator_stop(xtpg->vtc); | |
182 | ||
183 | xtpg_update_pattern_control(xtpg, true, true); | |
184 | xtpg->streaming = false; | |
185 | return 0; | |
186 | } | |
187 | ||
188 | xvip_set_frame_size(&xtpg->xvip, &xtpg->formats[0]); | |
189 | ||
190 | if (xtpg->vtc) { | |
191 | struct xvtc_config config = { | |
192 | .hblank_start = width, | |
193 | .hsync_start = width + 1, | |
194 | .vblank_start = height, | |
195 | .vsync_start = height + 1, | |
196 | }; | |
197 | unsigned int htotal; | |
198 | unsigned int vtotal; | |
199 | ||
200 | htotal = min_t(unsigned int, XVTC_MAX_HSIZE, | |
201 | v4l2_ctrl_g_ctrl(xtpg->hblank) + width); | |
202 | vtotal = min_t(unsigned int, XVTC_MAX_VSIZE, | |
203 | v4l2_ctrl_g_ctrl(xtpg->vblank) + height); | |
204 | ||
205 | config.hsync_end = htotal - 1; | |
206 | config.hsize = htotal; | |
207 | config.vsync_end = vtotal - 1; | |
208 | config.vsize = vtotal; | |
209 | ||
210 | xvtc_generator_start(xtpg->vtc, &config); | |
211 | } | |
212 | ||
213 | /* | |
214 | * Configure the bayer phase and video timing mux based on the | |
215 | * operation mode (passthrough or test pattern generation). The test | |
216 | * pattern can be modified by the control set handler, we thus need to | |
217 | * take the control lock here to avoid races. | |
218 | */ | |
219 | mutex_lock(xtpg->ctrl_handler.lock); | |
220 | ||
221 | xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
222 | XTPG_PATTERN_MASK, xtpg->pattern->cur.val); | |
223 | ||
224 | /* | |
225 | * Switching between passthrough and test pattern generation modes isn't | |
226 | * allowed during streaming, update the control range accordingly. | |
227 | */ | |
228 | passthrough = xtpg->pattern->cur.val == 0; | |
229 | __xtpg_update_pattern_control(xtpg, passthrough, !passthrough); | |
230 | ||
231 | xtpg->streaming = true; | |
232 | ||
233 | mutex_unlock(xtpg->ctrl_handler.lock); | |
234 | ||
235 | /* | |
236 | * For TPG v5.0, the bayer phase needs to be off for the pass through | |
237 | * mode, otherwise the external input would be subsampled. | |
238 | */ | |
239 | bayer_phase = passthrough ? XTPG_BAYER_PHASE_OFF | |
240 | : xtpg_get_bayer_phase(xtpg->formats[0].code); | |
241 | xvip_write(&xtpg->xvip, XTPG_BAYER_PHASE, bayer_phase); | |
242 | ||
243 | if (xtpg->vtmux_gpio) | |
244 | gpiod_set_value_cansleep(xtpg->vtmux_gpio, !passthrough); | |
245 | ||
246 | xvip_start(&xtpg->xvip); | |
247 | ||
248 | return 0; | |
249 | } | |
250 | ||
251 | /* ----------------------------------------------------------------------------- | |
252 | * V4L2 Subdevice Pad Operations | |
253 | */ | |
254 | ||
255 | static struct v4l2_mbus_framefmt * | |
256 | __xtpg_get_pad_format(struct xtpg_device *xtpg, | |
257 | struct v4l2_subdev_pad_config *cfg, | |
258 | unsigned int pad, u32 which) | |
259 | { | |
260 | switch (which) { | |
261 | case V4L2_SUBDEV_FORMAT_TRY: | |
262 | return v4l2_subdev_get_try_format(&xtpg->xvip.subdev, cfg, pad); | |
263 | case V4L2_SUBDEV_FORMAT_ACTIVE: | |
264 | return &xtpg->formats[pad]; | |
265 | default: | |
266 | return NULL; | |
267 | } | |
268 | } | |
269 | ||
270 | static int xtpg_get_format(struct v4l2_subdev *subdev, | |
271 | struct v4l2_subdev_pad_config *cfg, | |
272 | struct v4l2_subdev_format *fmt) | |
273 | { | |
274 | struct xtpg_device *xtpg = to_tpg(subdev); | |
275 | ||
276 | fmt->format = *__xtpg_get_pad_format(xtpg, cfg, fmt->pad, fmt->which); | |
277 | ||
278 | return 0; | |
279 | } | |
280 | ||
281 | static int xtpg_set_format(struct v4l2_subdev *subdev, | |
282 | struct v4l2_subdev_pad_config *cfg, | |
283 | struct v4l2_subdev_format *fmt) | |
284 | { | |
285 | struct xtpg_device *xtpg = to_tpg(subdev); | |
286 | struct v4l2_mbus_framefmt *__format; | |
287 | u32 bayer_phase; | |
288 | ||
289 | __format = __xtpg_get_pad_format(xtpg, cfg, fmt->pad, fmt->which); | |
290 | ||
291 | /* In two pads mode the source pad format is always identical to the | |
292 | * sink pad format. | |
293 | */ | |
294 | if (xtpg->npads == 2 && fmt->pad == 1) { | |
295 | fmt->format = *__format; | |
296 | return 0; | |
297 | } | |
298 | ||
299 | /* Bayer phase is configurable at runtime */ | |
300 | if (xtpg->bayer) { | |
301 | bayer_phase = xtpg_get_bayer_phase(fmt->format.code); | |
302 | if (bayer_phase != XTPG_BAYER_PHASE_OFF) | |
303 | __format->code = fmt->format.code; | |
304 | } | |
305 | ||
306 | xvip_set_format_size(__format, fmt); | |
307 | ||
308 | fmt->format = *__format; | |
309 | ||
310 | /* Propagate the format to the source pad. */ | |
311 | if (xtpg->npads == 2) { | |
312 | __format = __xtpg_get_pad_format(xtpg, cfg, 1, fmt->which); | |
313 | *__format = fmt->format; | |
314 | } | |
315 | ||
316 | return 0; | |
317 | } | |
318 | ||
319 | /* ----------------------------------------------------------------------------- | |
320 | * V4L2 Subdevice Operations | |
321 | */ | |
322 | ||
323 | static int xtpg_enum_frame_size(struct v4l2_subdev *subdev, | |
324 | struct v4l2_subdev_pad_config *cfg, | |
325 | struct v4l2_subdev_frame_size_enum *fse) | |
326 | { | |
327 | struct v4l2_mbus_framefmt *format; | |
328 | ||
329 | format = v4l2_subdev_get_try_format(subdev, cfg, fse->pad); | |
330 | ||
331 | if (fse->index || fse->code != format->code) | |
332 | return -EINVAL; | |
333 | ||
334 | /* Min / max values for pad 0 is always fixed in both one and two pads | |
335 | * modes. In two pads mode, the source pad(= 1) size is identical to | |
336 | * the sink pad size */ | |
337 | if (fse->pad == 0) { | |
338 | fse->min_width = XVIP_MIN_WIDTH; | |
339 | fse->max_width = XVIP_MAX_WIDTH; | |
340 | fse->min_height = XVIP_MIN_HEIGHT; | |
341 | fse->max_height = XVIP_MAX_HEIGHT; | |
342 | } else { | |
343 | fse->min_width = format->width; | |
344 | fse->max_width = format->width; | |
345 | fse->min_height = format->height; | |
346 | fse->max_height = format->height; | |
347 | } | |
348 | ||
349 | return 0; | |
350 | } | |
351 | ||
352 | static int xtpg_open(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh) | |
353 | { | |
354 | struct xtpg_device *xtpg = to_tpg(subdev); | |
355 | struct v4l2_mbus_framefmt *format; | |
356 | ||
357 | format = v4l2_subdev_get_try_format(subdev, fh->pad, 0); | |
358 | *format = xtpg->default_format; | |
359 | ||
360 | if (xtpg->npads == 2) { | |
361 | format = v4l2_subdev_get_try_format(subdev, fh->pad, 1); | |
362 | *format = xtpg->default_format; | |
363 | } | |
364 | ||
365 | return 0; | |
366 | } | |
367 | ||
368 | static int xtpg_close(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh) | |
369 | { | |
370 | return 0; | |
371 | } | |
372 | ||
373 | static int xtpg_s_ctrl(struct v4l2_ctrl *ctrl) | |
374 | { | |
375 | struct xtpg_device *xtpg = container_of(ctrl->handler, | |
376 | struct xtpg_device, | |
377 | ctrl_handler); | |
378 | switch (ctrl->id) { | |
379 | case V4L2_CID_TEST_PATTERN: | |
380 | xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
381 | XTPG_PATTERN_MASK, ctrl->val); | |
382 | return 0; | |
383 | case V4L2_CID_XILINX_TPG_CROSS_HAIRS: | |
384 | xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
385 | XTPG_PATTERN_CONTROL_CROSS_HAIRS, ctrl->val); | |
386 | return 0; | |
387 | case V4L2_CID_XILINX_TPG_MOVING_BOX: | |
388 | xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
389 | XTPG_PATTERN_CONTROL_MOVING_BOX, ctrl->val); | |
390 | return 0; | |
391 | case V4L2_CID_XILINX_TPG_COLOR_MASK: | |
392 | xvip_clr_and_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
393 | XTPG_PATTERN_CONTROL_COLOR_MASK_MASK, | |
394 | ctrl->val << | |
395 | XTPG_PATTERN_CONTROL_COLOR_MASK_SHIFT); | |
396 | return 0; | |
397 | case V4L2_CID_XILINX_TPG_STUCK_PIXEL: | |
398 | xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
399 | XTPG_PATTERN_CONTROL_STUCK_PIXEL, ctrl->val); | |
400 | return 0; | |
401 | case V4L2_CID_XILINX_TPG_NOISE: | |
402 | xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
403 | XTPG_PATTERN_CONTROL_NOISE, ctrl->val); | |
404 | return 0; | |
405 | case V4L2_CID_XILINX_TPG_MOTION: | |
406 | xvip_clr_or_set(&xtpg->xvip, XTPG_PATTERN_CONTROL, | |
407 | XTPG_PATTERN_CONTROL_MOTION, ctrl->val); | |
408 | return 0; | |
409 | case V4L2_CID_XILINX_TPG_MOTION_SPEED: | |
410 | xvip_write(&xtpg->xvip, XTPG_MOTION_SPEED, ctrl->val); | |
411 | return 0; | |
412 | case V4L2_CID_XILINX_TPG_CROSS_HAIR_ROW: | |
413 | xvip_clr_and_set(&xtpg->xvip, XTPG_CROSS_HAIRS, | |
414 | XTPG_CROSS_HAIRS_ROW_MASK, | |
415 | ctrl->val << XTPG_CROSS_HAIRS_ROW_SHIFT); | |
416 | return 0; | |
417 | case V4L2_CID_XILINX_TPG_CROSS_HAIR_COLUMN: | |
418 | xvip_clr_and_set(&xtpg->xvip, XTPG_CROSS_HAIRS, | |
419 | XTPG_CROSS_HAIRS_COLUMN_MASK, | |
420 | ctrl->val << XTPG_CROSS_HAIRS_COLUMN_SHIFT); | |
421 | return 0; | |
422 | case V4L2_CID_XILINX_TPG_ZPLATE_HOR_START: | |
423 | xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_HOR_CONTROL, | |
424 | XTPG_ZPLATE_START_MASK, | |
425 | ctrl->val << XTPG_ZPLATE_START_SHIFT); | |
426 | return 0; | |
427 | case V4L2_CID_XILINX_TPG_ZPLATE_HOR_SPEED: | |
428 | xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_HOR_CONTROL, | |
429 | XTPG_ZPLATE_SPEED_MASK, | |
430 | ctrl->val << XTPG_ZPLATE_SPEED_SHIFT); | |
431 | return 0; | |
432 | case V4L2_CID_XILINX_TPG_ZPLATE_VER_START: | |
433 | xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_VER_CONTROL, | |
434 | XTPG_ZPLATE_START_MASK, | |
435 | ctrl->val << XTPG_ZPLATE_START_SHIFT); | |
436 | return 0; | |
437 | case V4L2_CID_XILINX_TPG_ZPLATE_VER_SPEED: | |
438 | xvip_clr_and_set(&xtpg->xvip, XTPG_ZPLATE_VER_CONTROL, | |
439 | XTPG_ZPLATE_SPEED_MASK, | |
440 | ctrl->val << XTPG_ZPLATE_SPEED_SHIFT); | |
441 | return 0; | |
442 | case V4L2_CID_XILINX_TPG_BOX_SIZE: | |
443 | xvip_write(&xtpg->xvip, XTPG_BOX_SIZE, ctrl->val); | |
444 | return 0; | |
445 | case V4L2_CID_XILINX_TPG_BOX_COLOR: | |
446 | xvip_write(&xtpg->xvip, XTPG_BOX_COLOR, ctrl->val); | |
447 | return 0; | |
448 | case V4L2_CID_XILINX_TPG_STUCK_PIXEL_THRESH: | |
449 | xvip_write(&xtpg->xvip, XTPG_STUCK_PIXEL_THRESH, ctrl->val); | |
450 | return 0; | |
451 | case V4L2_CID_XILINX_TPG_NOISE_GAIN: | |
452 | xvip_write(&xtpg->xvip, XTPG_NOISE_GAIN, ctrl->val); | |
453 | return 0; | |
454 | } | |
455 | ||
456 | return 0; | |
457 | } | |
458 | ||
459 | static const struct v4l2_ctrl_ops xtpg_ctrl_ops = { | |
460 | .s_ctrl = xtpg_s_ctrl, | |
461 | }; | |
462 | ||
cebb31c8 | 463 | static const struct v4l2_subdev_core_ops xtpg_core_ops = { |
a5562f65 LP |
464 | }; |
465 | ||
cebb31c8 | 466 | static const struct v4l2_subdev_video_ops xtpg_video_ops = { |
a5562f65 LP |
467 | .s_stream = xtpg_s_stream, |
468 | }; | |
469 | ||
cebb31c8 | 470 | static const struct v4l2_subdev_pad_ops xtpg_pad_ops = { |
a5562f65 LP |
471 | .enum_mbus_code = xvip_enum_mbus_code, |
472 | .enum_frame_size = xtpg_enum_frame_size, | |
473 | .get_fmt = xtpg_get_format, | |
474 | .set_fmt = xtpg_set_format, | |
475 | }; | |
476 | ||
cebb31c8 | 477 | static const struct v4l2_subdev_ops xtpg_ops = { |
a5562f65 LP |
478 | .core = &xtpg_core_ops, |
479 | .video = &xtpg_video_ops, | |
480 | .pad = &xtpg_pad_ops, | |
481 | }; | |
482 | ||
483 | static const struct v4l2_subdev_internal_ops xtpg_internal_ops = { | |
484 | .open = xtpg_open, | |
485 | .close = xtpg_close, | |
486 | }; | |
487 | ||
488 | /* | |
489 | * Control Config | |
490 | */ | |
491 | ||
492 | static const char *const xtpg_pattern_strings[] = { | |
493 | "Passthrough", | |
494 | "Horizontal Ramp", | |
495 | "Vertical Ramp", | |
496 | "Temporal Ramp", | |
497 | "Solid Red", | |
498 | "Solid Green", | |
499 | "Solid Blue", | |
500 | "Solid Black", | |
501 | "Solid White", | |
502 | "Color Bars", | |
503 | "Zone Plate", | |
504 | "Tartan Color Bars", | |
505 | "Cross Hatch", | |
506 | "None", | |
507 | "Vertical/Horizontal Ramps", | |
508 | "Black/White Checker Board", | |
509 | }; | |
510 | ||
511 | static struct v4l2_ctrl_config xtpg_ctrls[] = { | |
512 | { | |
513 | .ops = &xtpg_ctrl_ops, | |
514 | .id = V4L2_CID_XILINX_TPG_CROSS_HAIRS, | |
515 | .name = "Test Pattern: Cross Hairs", | |
516 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
517 | .min = false, | |
518 | .max = true, | |
519 | .step = 1, | |
520 | .def = 0, | |
521 | }, { | |
522 | .ops = &xtpg_ctrl_ops, | |
523 | .id = V4L2_CID_XILINX_TPG_MOVING_BOX, | |
524 | .name = "Test Pattern: Moving Box", | |
525 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
526 | .min = false, | |
527 | .max = true, | |
528 | .step = 1, | |
529 | .def = 0, | |
530 | }, { | |
531 | .ops = &xtpg_ctrl_ops, | |
532 | .id = V4L2_CID_XILINX_TPG_COLOR_MASK, | |
533 | .name = "Test Pattern: Color Mask", | |
534 | .type = V4L2_CTRL_TYPE_BITMASK, | |
535 | .min = 0, | |
536 | .max = 0xf, | |
537 | .def = 0, | |
538 | }, { | |
539 | .ops = &xtpg_ctrl_ops, | |
540 | .id = V4L2_CID_XILINX_TPG_STUCK_PIXEL, | |
541 | .name = "Test Pattern: Stuck Pixel", | |
542 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
543 | .min = false, | |
544 | .max = true, | |
545 | .step = 1, | |
546 | .def = 0, | |
547 | }, { | |
548 | .ops = &xtpg_ctrl_ops, | |
549 | .id = V4L2_CID_XILINX_TPG_NOISE, | |
550 | .name = "Test Pattern: Noise", | |
551 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
552 | .min = false, | |
553 | .max = true, | |
554 | .step = 1, | |
555 | .def = 0, | |
556 | }, { | |
557 | .ops = &xtpg_ctrl_ops, | |
558 | .id = V4L2_CID_XILINX_TPG_MOTION, | |
559 | .name = "Test Pattern: Motion", | |
560 | .type = V4L2_CTRL_TYPE_BOOLEAN, | |
561 | .min = false, | |
562 | .max = true, | |
563 | .step = 1, | |
564 | .def = 0, | |
565 | }, { | |
566 | .ops = &xtpg_ctrl_ops, | |
567 | .id = V4L2_CID_XILINX_TPG_MOTION_SPEED, | |
568 | .name = "Test Pattern: Motion Speed", | |
569 | .type = V4L2_CTRL_TYPE_INTEGER, | |
570 | .min = 0, | |
571 | .max = (1 << 8) - 1, | |
572 | .step = 1, | |
573 | .def = 4, | |
574 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
575 | }, { | |
576 | .ops = &xtpg_ctrl_ops, | |
577 | .id = V4L2_CID_XILINX_TPG_CROSS_HAIR_ROW, | |
578 | .name = "Test Pattern: Cross Hairs Row", | |
579 | .type = V4L2_CTRL_TYPE_INTEGER, | |
580 | .min = 0, | |
581 | .max = (1 << 12) - 1, | |
582 | .step = 1, | |
583 | .def = 0x64, | |
584 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
585 | }, { | |
586 | .ops = &xtpg_ctrl_ops, | |
587 | .id = V4L2_CID_XILINX_TPG_CROSS_HAIR_COLUMN, | |
588 | .name = "Test Pattern: Cross Hairs Column", | |
589 | .type = V4L2_CTRL_TYPE_INTEGER, | |
590 | .min = 0, | |
591 | .max = (1 << 12) - 1, | |
592 | .step = 1, | |
593 | .def = 0x64, | |
594 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
595 | }, { | |
596 | .ops = &xtpg_ctrl_ops, | |
597 | .id = V4L2_CID_XILINX_TPG_ZPLATE_HOR_START, | |
598 | .name = "Test Pattern: Zplate Horizontal Start Pos", | |
599 | .type = V4L2_CTRL_TYPE_INTEGER, | |
600 | .min = 0, | |
601 | .max = (1 << 16) - 1, | |
602 | .step = 1, | |
603 | .def = 0x1e, | |
604 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
605 | }, { | |
606 | .ops = &xtpg_ctrl_ops, | |
607 | .id = V4L2_CID_XILINX_TPG_ZPLATE_HOR_SPEED, | |
608 | .name = "Test Pattern: Zplate Horizontal Speed", | |
609 | .type = V4L2_CTRL_TYPE_INTEGER, | |
610 | .min = 0, | |
611 | .max = (1 << 16) - 1, | |
612 | .step = 1, | |
613 | .def = 0, | |
614 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
615 | }, { | |
616 | .ops = &xtpg_ctrl_ops, | |
617 | .id = V4L2_CID_XILINX_TPG_ZPLATE_VER_START, | |
618 | .name = "Test Pattern: Zplate Vertical Start Pos", | |
619 | .type = V4L2_CTRL_TYPE_INTEGER, | |
620 | .min = 0, | |
621 | .max = (1 << 16) - 1, | |
622 | .step = 1, | |
623 | .def = 1, | |
624 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
625 | }, { | |
626 | .ops = &xtpg_ctrl_ops, | |
627 | .id = V4L2_CID_XILINX_TPG_ZPLATE_VER_SPEED, | |
628 | .name = "Test Pattern: Zplate Vertical Speed", | |
629 | .type = V4L2_CTRL_TYPE_INTEGER, | |
630 | .min = 0, | |
631 | .max = (1 << 16) - 1, | |
632 | .step = 1, | |
633 | .def = 0, | |
634 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
635 | }, { | |
636 | .ops = &xtpg_ctrl_ops, | |
637 | .id = V4L2_CID_XILINX_TPG_BOX_SIZE, | |
638 | .name = "Test Pattern: Box Size", | |
639 | .type = V4L2_CTRL_TYPE_INTEGER, | |
640 | .min = 0, | |
641 | .max = (1 << 12) - 1, | |
642 | .step = 1, | |
643 | .def = 0x32, | |
644 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
645 | }, { | |
646 | .ops = &xtpg_ctrl_ops, | |
647 | .id = V4L2_CID_XILINX_TPG_BOX_COLOR, | |
648 | .name = "Test Pattern: Box Color(RGB)", | |
649 | .type = V4L2_CTRL_TYPE_INTEGER, | |
650 | .min = 0, | |
651 | .max = (1 << 24) - 1, | |
652 | .step = 1, | |
653 | .def = 0, | |
654 | }, { | |
655 | .ops = &xtpg_ctrl_ops, | |
656 | .id = V4L2_CID_XILINX_TPG_STUCK_PIXEL_THRESH, | |
657 | .name = "Test Pattern: Stuck Pixel threshold", | |
658 | .type = V4L2_CTRL_TYPE_INTEGER, | |
659 | .min = 0, | |
660 | .max = (1 << 16) - 1, | |
661 | .step = 1, | |
662 | .def = 0, | |
663 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
664 | }, { | |
665 | .ops = &xtpg_ctrl_ops, | |
666 | .id = V4L2_CID_XILINX_TPG_NOISE_GAIN, | |
667 | .name = "Test Pattern: Noise Gain", | |
668 | .type = V4L2_CTRL_TYPE_INTEGER, | |
669 | .min = 0, | |
670 | .max = (1 << 8) - 1, | |
671 | .step = 1, | |
672 | .def = 0, | |
673 | .flags = V4L2_CTRL_FLAG_SLIDER, | |
674 | }, | |
675 | }; | |
676 | ||
677 | /* ----------------------------------------------------------------------------- | |
678 | * Media Operations | |
679 | */ | |
680 | ||
681 | static const struct media_entity_operations xtpg_media_ops = { | |
682 | .link_validate = v4l2_subdev_link_validate, | |
683 | }; | |
684 | ||
685 | /* ----------------------------------------------------------------------------- | |
686 | * Power Management | |
687 | */ | |
688 | ||
689 | static int __maybe_unused xtpg_pm_suspend(struct device *dev) | |
690 | { | |
691 | struct xtpg_device *xtpg = dev_get_drvdata(dev); | |
692 | ||
693 | xvip_suspend(&xtpg->xvip); | |
694 | ||
695 | return 0; | |
696 | } | |
697 | ||
698 | static int __maybe_unused xtpg_pm_resume(struct device *dev) | |
699 | { | |
700 | struct xtpg_device *xtpg = dev_get_drvdata(dev); | |
701 | ||
702 | xvip_resume(&xtpg->xvip); | |
703 | ||
704 | return 0; | |
705 | } | |
706 | ||
707 | /* ----------------------------------------------------------------------------- | |
708 | * Platform Device Driver | |
709 | */ | |
710 | ||
711 | static int xtpg_parse_of(struct xtpg_device *xtpg) | |
712 | { | |
713 | struct device *dev = xtpg->xvip.dev; | |
714 | struct device_node *node = xtpg->xvip.dev->of_node; | |
715 | struct device_node *ports; | |
716 | struct device_node *port; | |
717 | unsigned int nports = 0; | |
718 | bool has_endpoint = false; | |
719 | ||
720 | ports = of_get_child_by_name(node, "ports"); | |
721 | if (ports == NULL) | |
722 | ports = node; | |
723 | ||
724 | for_each_child_of_node(ports, port) { | |
725 | const struct xvip_video_format *format; | |
726 | struct device_node *endpoint; | |
727 | ||
728 | if (!port->name || of_node_cmp(port->name, "port")) | |
729 | continue; | |
730 | ||
731 | format = xvip_of_get_format(port); | |
732 | if (IS_ERR(format)) { | |
733 | dev_err(dev, "invalid format in DT"); | |
cc331d37 | 734 | of_node_put(port); |
a5562f65 LP |
735 | return PTR_ERR(format); |
736 | } | |
737 | ||
738 | /* Get and check the format description */ | |
739 | if (!xtpg->vip_format) { | |
740 | xtpg->vip_format = format; | |
741 | } else if (xtpg->vip_format != format) { | |
742 | dev_err(dev, "in/out format mismatch in DT"); | |
cc331d37 | 743 | of_node_put(port); |
a5562f65 LP |
744 | return -EINVAL; |
745 | } | |
746 | ||
747 | if (nports == 0) { | |
748 | endpoint = of_get_next_child(port, NULL); | |
749 | if (endpoint) | |
750 | has_endpoint = true; | |
751 | of_node_put(endpoint); | |
752 | } | |
753 | ||
754 | /* Count the number of ports. */ | |
755 | nports++; | |
756 | } | |
757 | ||
758 | if (nports != 1 && nports != 2) { | |
759 | dev_err(dev, "invalid number of ports %u\n", nports); | |
760 | return -EINVAL; | |
761 | } | |
762 | ||
763 | xtpg->npads = nports; | |
764 | if (nports == 2 && has_endpoint) | |
765 | xtpg->has_input = true; | |
766 | ||
767 | return 0; | |
768 | } | |
769 | ||
770 | static int xtpg_probe(struct platform_device *pdev) | |
771 | { | |
772 | struct v4l2_subdev *subdev; | |
773 | struct xtpg_device *xtpg; | |
774 | u32 i, bayer_phase; | |
775 | int ret; | |
776 | ||
777 | xtpg = devm_kzalloc(&pdev->dev, sizeof(*xtpg), GFP_KERNEL); | |
778 | if (!xtpg) | |
779 | return -ENOMEM; | |
780 | ||
781 | xtpg->xvip.dev = &pdev->dev; | |
782 | ||
783 | ret = xtpg_parse_of(xtpg); | |
784 | if (ret < 0) | |
785 | return ret; | |
786 | ||
787 | ret = xvip_init_resources(&xtpg->xvip); | |
788 | if (ret < 0) | |
789 | return ret; | |
790 | ||
791 | xtpg->vtmux_gpio = devm_gpiod_get_optional(&pdev->dev, "timing", | |
792 | GPIOD_OUT_HIGH); | |
793 | if (IS_ERR(xtpg->vtmux_gpio)) { | |
794 | ret = PTR_ERR(xtpg->vtmux_gpio); | |
795 | goto error_resource; | |
796 | } | |
797 | ||
798 | xtpg->vtc = xvtc_of_get(pdev->dev.of_node); | |
799 | if (IS_ERR(xtpg->vtc)) { | |
800 | ret = PTR_ERR(xtpg->vtc); | |
801 | goto error_resource; | |
802 | } | |
803 | ||
804 | /* Reset and initialize the core */ | |
805 | xvip_reset(&xtpg->xvip); | |
806 | ||
807 | /* Initialize V4L2 subdevice and media entity. Pad numbers depend on the | |
808 | * number of pads. | |
809 | */ | |
810 | if (xtpg->npads == 2) { | |
811 | xtpg->pads[0].flags = MEDIA_PAD_FL_SINK; | |
812 | xtpg->pads[1].flags = MEDIA_PAD_FL_SOURCE; | |
813 | } else { | |
814 | xtpg->pads[0].flags = MEDIA_PAD_FL_SOURCE; | |
815 | } | |
816 | ||
817 | /* Initialize the default format */ | |
818 | xtpg->default_format.code = xtpg->vip_format->code; | |
819 | xtpg->default_format.field = V4L2_FIELD_NONE; | |
820 | xtpg->default_format.colorspace = V4L2_COLORSPACE_SRGB; | |
821 | xvip_get_frame_size(&xtpg->xvip, &xtpg->default_format); | |
822 | ||
823 | bayer_phase = xtpg_get_bayer_phase(xtpg->vip_format->code); | |
824 | if (bayer_phase != XTPG_BAYER_PHASE_OFF) | |
825 | xtpg->bayer = true; | |
826 | ||
827 | xtpg->formats[0] = xtpg->default_format; | |
828 | if (xtpg->npads == 2) | |
829 | xtpg->formats[1] = xtpg->default_format; | |
830 | ||
831 | /* Initialize V4L2 subdevice and media entity */ | |
832 | subdev = &xtpg->xvip.subdev; | |
833 | v4l2_subdev_init(subdev, &xtpg_ops); | |
834 | subdev->dev = &pdev->dev; | |
835 | subdev->internal_ops = &xtpg_internal_ops; | |
836 | strlcpy(subdev->name, dev_name(&pdev->dev), sizeof(subdev->name)); | |
837 | v4l2_set_subdevdata(subdev, xtpg); | |
838 | subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; | |
839 | subdev->entity.ops = &xtpg_media_ops; | |
840 | ||
ab22e77c | 841 | ret = media_entity_pads_init(&subdev->entity, xtpg->npads, xtpg->pads); |
a5562f65 LP |
842 | if (ret < 0) |
843 | goto error; | |
844 | ||
845 | v4l2_ctrl_handler_init(&xtpg->ctrl_handler, 3 + ARRAY_SIZE(xtpg_ctrls)); | |
846 | ||
847 | xtpg->vblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops, | |
848 | V4L2_CID_VBLANK, XTPG_MIN_VBLANK, | |
849 | XTPG_MAX_VBLANK, 1, 100); | |
850 | xtpg->hblank = v4l2_ctrl_new_std(&xtpg->ctrl_handler, &xtpg_ctrl_ops, | |
851 | V4L2_CID_HBLANK, XTPG_MIN_HBLANK, | |
852 | XTPG_MAX_HBLANK, 1, 100); | |
853 | xtpg->pattern = v4l2_ctrl_new_std_menu_items(&xtpg->ctrl_handler, | |
854 | &xtpg_ctrl_ops, V4L2_CID_TEST_PATTERN, | |
855 | ARRAY_SIZE(xtpg_pattern_strings) - 1, | |
856 | 1, 9, xtpg_pattern_strings); | |
857 | ||
858 | for (i = 0; i < ARRAY_SIZE(xtpg_ctrls); i++) | |
859 | v4l2_ctrl_new_custom(&xtpg->ctrl_handler, &xtpg_ctrls[i], NULL); | |
860 | ||
861 | if (xtpg->ctrl_handler.error) { | |
862 | dev_err(&pdev->dev, "failed to add controls\n"); | |
863 | ret = xtpg->ctrl_handler.error; | |
864 | goto error; | |
865 | } | |
866 | subdev->ctrl_handler = &xtpg->ctrl_handler; | |
867 | ||
868 | xtpg_update_pattern_control(xtpg, true, true); | |
869 | ||
870 | ret = v4l2_ctrl_handler_setup(&xtpg->ctrl_handler); | |
871 | if (ret < 0) { | |
872 | dev_err(&pdev->dev, "failed to set controls\n"); | |
873 | goto error; | |
874 | } | |
875 | ||
876 | platform_set_drvdata(pdev, xtpg); | |
877 | ||
878 | xvip_print_version(&xtpg->xvip); | |
879 | ||
880 | ret = v4l2_async_register_subdev(subdev); | |
881 | if (ret < 0) { | |
882 | dev_err(&pdev->dev, "failed to register subdev\n"); | |
883 | goto error; | |
884 | } | |
885 | ||
886 | return 0; | |
887 | ||
888 | error: | |
889 | v4l2_ctrl_handler_free(&xtpg->ctrl_handler); | |
890 | media_entity_cleanup(&subdev->entity); | |
891 | xvtc_put(xtpg->vtc); | |
892 | error_resource: | |
893 | xvip_cleanup_resources(&xtpg->xvip); | |
894 | return ret; | |
895 | } | |
896 | ||
897 | static int xtpg_remove(struct platform_device *pdev) | |
898 | { | |
899 | struct xtpg_device *xtpg = platform_get_drvdata(pdev); | |
900 | struct v4l2_subdev *subdev = &xtpg->xvip.subdev; | |
901 | ||
902 | v4l2_async_unregister_subdev(subdev); | |
903 | v4l2_ctrl_handler_free(&xtpg->ctrl_handler); | |
904 | media_entity_cleanup(&subdev->entity); | |
905 | ||
906 | xvip_cleanup_resources(&xtpg->xvip); | |
907 | ||
908 | return 0; | |
909 | } | |
910 | ||
911 | static SIMPLE_DEV_PM_OPS(xtpg_pm_ops, xtpg_pm_suspend, xtpg_pm_resume); | |
912 | ||
913 | static const struct of_device_id xtpg_of_id_table[] = { | |
914 | { .compatible = "xlnx,v-tpg-5.0" }, | |
915 | { } | |
916 | }; | |
917 | MODULE_DEVICE_TABLE(of, xtpg_of_id_table); | |
918 | ||
919 | static struct platform_driver xtpg_driver = { | |
920 | .driver = { | |
921 | .name = "xilinx-tpg", | |
922 | .pm = &xtpg_pm_ops, | |
923 | .of_match_table = xtpg_of_id_table, | |
924 | }, | |
925 | .probe = xtpg_probe, | |
926 | .remove = xtpg_remove, | |
927 | }; | |
928 | ||
929 | module_platform_driver(xtpg_driver); | |
930 | ||
931 | MODULE_AUTHOR("Laurent Pinchart <laurent.pinchart@ideasonboard.com>"); | |
932 | MODULE_DESCRIPTION("Xilinx Test Pattern Generator Driver"); | |
933 | MODULE_LICENSE("GPL v2"); |