2 * vsp1_clu.c -- R-Car VSP1 Cubic Look-Up Table
4 * Copyright (C) 2015-2016 Renesas Electronics Corporation
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
14 #include <linux/device.h>
15 #include <linux/slab.h>
17 #include <media/v4l2-subdev.h>
23 #define CLU_MIN_SIZE 4U
24 #define CLU_MAX_SIZE 8190U
26 /* -----------------------------------------------------------------------------
30 static inline void vsp1_clu_write(struct vsp1_clu
*clu
, struct vsp1_dl_list
*dl
,
33 vsp1_dl_list_write(dl
, reg
, data
);
36 /* -----------------------------------------------------------------------------
40 #define V4L2_CID_VSP1_CLU_TABLE (V4L2_CID_USER_BASE | 0x1001)
41 #define V4L2_CID_VSP1_CLU_MODE (V4L2_CID_USER_BASE | 0x1002)
42 #define V4L2_CID_VSP1_CLU_MODE_2D 0
43 #define V4L2_CID_VSP1_CLU_MODE_3D 1
45 static int clu_set_table(struct vsp1_clu
*clu
, struct v4l2_ctrl
*ctrl
)
47 struct vsp1_dl_body
*dlb
;
50 dlb
= vsp1_dl_fragment_alloc(clu
->entity
.vsp1
, 1 + 17 * 17 * 17);
54 vsp1_dl_fragment_write(dlb
, VI6_CLU_ADDR
, 0);
55 for (i
= 0; i
< 17 * 17 * 17; ++i
)
56 vsp1_dl_fragment_write(dlb
, VI6_CLU_DATA
, ctrl
->p_new
.p_u32
[i
]);
60 vsp1_dl_fragment_free(dlb
);
64 static int clu_s_ctrl(struct v4l2_ctrl
*ctrl
)
66 struct vsp1_clu
*clu
=
67 container_of(ctrl
->handler
, struct vsp1_clu
, ctrls
);
70 case V4L2_CID_VSP1_CLU_TABLE
:
71 clu_set_table(clu
, ctrl
);
74 case V4L2_CID_VSP1_CLU_MODE
:
75 clu
->mode
= ctrl
->val
;
82 static const struct v4l2_ctrl_ops clu_ctrl_ops
= {
86 static const struct v4l2_ctrl_config clu_table_control
= {
88 .id
= V4L2_CID_VSP1_CLU_TABLE
,
89 .name
= "Look-Up Table",
90 .type
= V4L2_CTRL_TYPE_U32
,
95 .dims
= { 17, 17, 17 },
98 static const char * const clu_mode_menu
[] = {
104 static const struct v4l2_ctrl_config clu_mode_control
= {
105 .ops
= &clu_ctrl_ops
,
106 .id
= V4L2_CID_VSP1_CLU_MODE
,
108 .type
= V4L2_CTRL_TYPE_MENU
,
112 .qmenu
= clu_mode_menu
,
115 /* -----------------------------------------------------------------------------
116 * V4L2 Subdevice Pad Operations
119 static int clu_enum_mbus_code(struct v4l2_subdev
*subdev
,
120 struct v4l2_subdev_pad_config
*cfg
,
121 struct v4l2_subdev_mbus_code_enum
*code
)
123 static const unsigned int codes
[] = {
124 MEDIA_BUS_FMT_ARGB8888_1X32
,
125 MEDIA_BUS_FMT_AHSV8888_1X32
,
126 MEDIA_BUS_FMT_AYUV8_1X32
,
129 return vsp1_subdev_enum_mbus_code(subdev
, cfg
, code
, codes
,
133 static int clu_enum_frame_size(struct v4l2_subdev
*subdev
,
134 struct v4l2_subdev_pad_config
*cfg
,
135 struct v4l2_subdev_frame_size_enum
*fse
)
137 return vsp1_subdev_enum_frame_size(subdev
, cfg
, fse
, CLU_MIN_SIZE
,
138 CLU_MIN_SIZE
, CLU_MAX_SIZE
,
142 static int clu_set_format(struct v4l2_subdev
*subdev
,
143 struct v4l2_subdev_pad_config
*cfg
,
144 struct v4l2_subdev_format
*fmt
)
146 struct vsp1_clu
*clu
= to_clu(subdev
);
147 struct v4l2_subdev_pad_config
*config
;
148 struct v4l2_mbus_framefmt
*format
;
150 config
= vsp1_entity_get_pad_config(&clu
->entity
, cfg
, fmt
->which
);
154 /* Default to YUV if the requested format is not supported. */
155 if (fmt
->format
.code
!= MEDIA_BUS_FMT_ARGB8888_1X32
&&
156 fmt
->format
.code
!= MEDIA_BUS_FMT_AHSV8888_1X32
&&
157 fmt
->format
.code
!= MEDIA_BUS_FMT_AYUV8_1X32
)
158 fmt
->format
.code
= MEDIA_BUS_FMT_AYUV8_1X32
;
160 format
= vsp1_entity_get_pad_format(&clu
->entity
, config
, fmt
->pad
);
162 if (fmt
->pad
== CLU_PAD_SOURCE
) {
163 /* The CLU output format can't be modified. */
164 fmt
->format
= *format
;
168 format
->code
= fmt
->format
.code
;
169 format
->width
= clamp_t(unsigned int, fmt
->format
.width
,
170 CLU_MIN_SIZE
, CLU_MAX_SIZE
);
171 format
->height
= clamp_t(unsigned int, fmt
->format
.height
,
172 CLU_MIN_SIZE
, CLU_MAX_SIZE
);
173 format
->field
= V4L2_FIELD_NONE
;
174 format
->colorspace
= V4L2_COLORSPACE_SRGB
;
176 fmt
->format
= *format
;
178 /* Propagate the format to the source pad. */
179 format
= vsp1_entity_get_pad_format(&clu
->entity
, config
,
181 *format
= fmt
->format
;
186 /* -----------------------------------------------------------------------------
187 * V4L2 Subdevice Operations
190 static const struct v4l2_subdev_pad_ops clu_pad_ops
= {
191 .init_cfg
= vsp1_entity_init_cfg
,
192 .enum_mbus_code
= clu_enum_mbus_code
,
193 .enum_frame_size
= clu_enum_frame_size
,
194 .get_fmt
= vsp1_subdev_get_pad_format
,
195 .set_fmt
= clu_set_format
,
198 static const struct v4l2_subdev_ops clu_ops
= {
202 /* -----------------------------------------------------------------------------
203 * VSP1 Entity Operations
206 static void clu_configure(struct vsp1_entity
*entity
,
207 struct vsp1_pipeline
*pipe
,
208 struct vsp1_dl_list
*dl
)
210 struct vsp1_clu
*clu
= to_clu(&entity
->subdev
);
211 struct v4l2_mbus_framefmt
*format
;
212 u32 ctrl
= VI6_CLU_CTRL_AAI
| VI6_CLU_CTRL_MVS
| VI6_CLU_CTRL_EN
;
214 format
= vsp1_entity_get_pad_format(&clu
->entity
, clu
->entity
.config
,
217 mutex_lock(clu
->ctrls
.lock
);
219 /* 2D mode can only be used with the YCbCr pixel encoding. */
220 if (clu
->mode
== V4L2_CID_VSP1_CLU_MODE_2D
&&
221 format
->code
== MEDIA_BUS_FMT_AYUV8_1X32
)
222 ctrl
|= VI6_CLU_CTRL_AX1I_2D
| VI6_CLU_CTRL_AX2I_2D
223 | VI6_CLU_CTRL_OS0_2D
| VI6_CLU_CTRL_OS1_2D
224 | VI6_CLU_CTRL_OS2_2D
| VI6_CLU_CTRL_M2D
;
227 vsp1_dl_list_add_fragment(dl
, clu
->clu
);
231 mutex_unlock(clu
->ctrls
.lock
);
233 vsp1_clu_write(clu
, dl
, VI6_CLU_CTRL
, ctrl
);
236 static const struct vsp1_entity_operations clu_entity_ops
= {
237 .configure
= clu_configure
,
240 /* -----------------------------------------------------------------------------
241 * Initialization and Cleanup
244 struct vsp1_clu
*vsp1_clu_create(struct vsp1_device
*vsp1
)
246 struct vsp1_clu
*clu
;
249 clu
= devm_kzalloc(vsp1
->dev
, sizeof(*clu
), GFP_KERNEL
);
251 return ERR_PTR(-ENOMEM
);
253 clu
->entity
.ops
= &clu_entity_ops
;
254 clu
->entity
.type
= VSP1_ENTITY_CLU
;
256 ret
= vsp1_entity_init(vsp1
, &clu
->entity
, "clu", 2, &clu_ops
,
257 MEDIA_ENT_F_PROC_VIDEO_LUT
);
261 /* Initialize the control handler. */
262 v4l2_ctrl_handler_init(&clu
->ctrls
, 2);
263 v4l2_ctrl_new_custom(&clu
->ctrls
, &clu_table_control
, NULL
);
264 v4l2_ctrl_new_custom(&clu
->ctrls
, &clu_mode_control
, NULL
);
266 clu
->entity
.subdev
.ctrl_handler
= &clu
->ctrls
;
268 if (clu
->ctrls
.error
) {
269 dev_err(vsp1
->dev
, "clu: failed to initialize controls\n");
270 ret
= clu
->ctrls
.error
;
271 vsp1_entity_destroy(&clu
->entity
);
275 v4l2_ctrl_handler_setup(&clu
->ctrls
);