2 * vsp1_lut.c -- R-Car VSP1 Look-Up Table
4 * Copyright (C) 2013 Renesas 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/gfp.h>
17 #include <media/v4l2-subdev.h>
23 #define LUT_MIN_SIZE 4U
24 #define LUT_MAX_SIZE 8190U
26 /* -----------------------------------------------------------------------------
30 static inline void vsp1_lut_write(struct vsp1_lut *lut, struct vsp1_dl_list *dl,
33 vsp1_dl_list_write(dl, reg, data);
36 /* -----------------------------------------------------------------------------
40 #define V4L2_CID_VSP1_LUT_TABLE (V4L2_CID_USER_BASE | 0x1001)
42 static int lut_set_table(struct vsp1_lut *lut, struct v4l2_ctrl *ctrl)
44 struct vsp1_dl_body *dlb;
47 dlb = vsp1_dl_fragment_alloc(lut->entity.vsp1, 256);
51 for (i = 0; i < 256; ++i)
52 vsp1_dl_fragment_write(dlb, VI6_LUT_TABLE + 4 * i,
53 ctrl->p_new.p_u32[i]);
55 spin_lock_irq(&lut->lock);
57 spin_unlock_irq(&lut->lock);
59 vsp1_dl_fragment_free(dlb);
63 static int lut_s_ctrl(struct v4l2_ctrl *ctrl)
65 struct vsp1_lut *lut =
66 container_of(ctrl->handler, struct vsp1_lut, ctrls);
69 case V4L2_CID_VSP1_LUT_TABLE:
70 lut_set_table(lut, ctrl);
77 static const struct v4l2_ctrl_ops lut_ctrl_ops = {
81 static const struct v4l2_ctrl_config lut_table_control = {
83 .id = V4L2_CID_VSP1_LUT_TABLE,
84 .name = "Look-Up Table",
85 .type = V4L2_CTRL_TYPE_U32,
93 /* -----------------------------------------------------------------------------
94 * V4L2 Subdevice Pad Operations
97 static int lut_enum_mbus_code(struct v4l2_subdev *subdev,
98 struct v4l2_subdev_pad_config *cfg,
99 struct v4l2_subdev_mbus_code_enum *code)
101 static const unsigned int codes[] = {
102 MEDIA_BUS_FMT_ARGB8888_1X32,
103 MEDIA_BUS_FMT_AHSV8888_1X32,
104 MEDIA_BUS_FMT_AYUV8_1X32,
107 return vsp1_subdev_enum_mbus_code(subdev, cfg, code, codes,
111 static int lut_enum_frame_size(struct v4l2_subdev *subdev,
112 struct v4l2_subdev_pad_config *cfg,
113 struct v4l2_subdev_frame_size_enum *fse)
115 return vsp1_subdev_enum_frame_size(subdev, cfg, fse, LUT_MIN_SIZE,
116 LUT_MIN_SIZE, LUT_MAX_SIZE,
120 static int lut_set_format(struct v4l2_subdev *subdev,
121 struct v4l2_subdev_pad_config *cfg,
122 struct v4l2_subdev_format *fmt)
124 struct vsp1_lut *lut = to_lut(subdev);
125 struct v4l2_subdev_pad_config *config;
126 struct v4l2_mbus_framefmt *format;
128 config = vsp1_entity_get_pad_config(&lut->entity, cfg, fmt->which);
132 /* Default to YUV if the requested format is not supported. */
133 if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
134 fmt->format.code != MEDIA_BUS_FMT_AHSV8888_1X32 &&
135 fmt->format.code != MEDIA_BUS_FMT_AYUV8_1X32)
136 fmt->format.code = MEDIA_BUS_FMT_AYUV8_1X32;
138 format = vsp1_entity_get_pad_format(&lut->entity, config, fmt->pad);
140 if (fmt->pad == LUT_PAD_SOURCE) {
141 /* The LUT output format can't be modified. */
142 fmt->format = *format;
146 format->code = fmt->format.code;
147 format->width = clamp_t(unsigned int, fmt->format.width,
148 LUT_MIN_SIZE, LUT_MAX_SIZE);
149 format->height = clamp_t(unsigned int, fmt->format.height,
150 LUT_MIN_SIZE, LUT_MAX_SIZE);
151 format->field = V4L2_FIELD_NONE;
152 format->colorspace = V4L2_COLORSPACE_SRGB;
154 fmt->format = *format;
156 /* Propagate the format to the source pad. */
157 format = vsp1_entity_get_pad_format(&lut->entity, config,
159 *format = fmt->format;
164 /* -----------------------------------------------------------------------------
165 * V4L2 Subdevice Operations
168 static const struct v4l2_subdev_pad_ops lut_pad_ops = {
169 .init_cfg = vsp1_entity_init_cfg,
170 .enum_mbus_code = lut_enum_mbus_code,
171 .enum_frame_size = lut_enum_frame_size,
172 .get_fmt = vsp1_subdev_get_pad_format,
173 .set_fmt = lut_set_format,
176 static const struct v4l2_subdev_ops lut_ops = {
180 /* -----------------------------------------------------------------------------
181 * VSP1 Entity Operations
184 static void lut_configure(struct vsp1_entity *entity,
185 struct vsp1_pipeline *pipe,
186 struct vsp1_dl_list *dl, bool full)
188 struct vsp1_lut *lut = to_lut(&entity->subdev);
189 struct vsp1_dl_body *dlb;
193 vsp1_lut_write(lut, dl, VI6_LUT_CTRL, VI6_LUT_CTRL_EN);
197 spin_lock_irqsave(&lut->lock, flags);
200 spin_unlock_irqrestore(&lut->lock, flags);
203 vsp1_dl_list_add_fragment(dl, dlb);
206 static const struct vsp1_entity_operations lut_entity_ops = {
207 .configure = lut_configure,
210 /* -----------------------------------------------------------------------------
211 * Initialization and Cleanup
214 struct vsp1_lut *vsp1_lut_create(struct vsp1_device *vsp1)
216 struct vsp1_lut *lut;
219 lut = devm_kzalloc(vsp1->dev, sizeof(*lut), GFP_KERNEL);
221 return ERR_PTR(-ENOMEM);
223 spin_lock_init(&lut->lock);
225 lut->entity.ops = &lut_entity_ops;
226 lut->entity.type = VSP1_ENTITY_LUT;
228 ret = vsp1_entity_init(vsp1, &lut->entity, "lut", 2, &lut_ops,
229 MEDIA_ENT_F_PROC_VIDEO_LUT);
233 /* Initialize the control handler. */
234 v4l2_ctrl_handler_init(&lut->ctrls, 1);
235 v4l2_ctrl_new_custom(&lut->ctrls, &lut_table_control, NULL);
237 lut->entity.subdev.ctrl_handler = &lut->ctrls;
239 if (lut->ctrls.error) {
240 dev_err(vsp1->dev, "lut: failed to initialize controls\n");
241 ret = lut->ctrls.error;
242 vsp1_entity_destroy(&lut->entity);
246 v4l2_ctrl_handler_setup(&lut->ctrls);