1 /*
2 * vsp1_lut.c -- R-Car VSP1 Look-Up Table
3 *
4 * Copyright (C) 2013 Renesas Corporation
5 *
6 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
7 *
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.
12 */
13
14 #include <linux/device.h>
15 #include <linux/gfp.h>
16 #include <linux/vsp1.h>
17
18 #include <media/v4l2-subdev.h>
19
20 #include "vsp1.h"
21 #include "vsp1_lut.h"
22
23 #define LUT_MIN_SIZE 4U
24 #define LUT_MAX_SIZE 8190U
25
26 /* -----------------------------------------------------------------------------
27 * Device Access
28 */
29
vsp1_lut_read(struct vsp1_lut * lut,u32 reg)30 static inline u32 vsp1_lut_read(struct vsp1_lut *lut, u32 reg)
31 {
32 return vsp1_read(lut->entity.vsp1, reg);
33 }
34
vsp1_lut_write(struct vsp1_lut * lut,u32 reg,u32 data)35 static inline void vsp1_lut_write(struct vsp1_lut *lut, u32 reg, u32 data)
36 {
37 vsp1_write(lut->entity.vsp1, reg, data);
38 }
39
40 /* -----------------------------------------------------------------------------
41 * V4L2 Subdevice Core Operations
42 */
43
lut_configure(struct vsp1_lut * lut,struct vsp1_lut_config * config)44 static void lut_configure(struct vsp1_lut *lut, struct vsp1_lut_config *config)
45 {
46 memcpy_toio(lut->entity.vsp1->mmio + VI6_LUT_TABLE, config->lut,
47 sizeof(config->lut));
48 }
49
lut_ioctl(struct v4l2_subdev * subdev,unsigned int cmd,void * arg)50 static long lut_ioctl(struct v4l2_subdev *subdev, unsigned int cmd, void *arg)
51 {
52 struct vsp1_lut *lut = to_lut(subdev);
53
54 switch (cmd) {
55 case VIDIOC_VSP1_LUT_CONFIG:
56 lut_configure(lut, arg);
57 return 0;
58
59 default:
60 return -ENOIOCTLCMD;
61 }
62 }
63
64 /* -----------------------------------------------------------------------------
65 * V4L2 Subdevice Video Operations
66 */
67
lut_s_stream(struct v4l2_subdev * subdev,int enable)68 static int lut_s_stream(struct v4l2_subdev *subdev, int enable)
69 {
70 struct vsp1_lut *lut = to_lut(subdev);
71
72 if (!enable)
73 return 0;
74
75 vsp1_lut_write(lut, VI6_LUT_CTRL, VI6_LUT_CTRL_EN);
76
77 return 0;
78 }
79
80 /* -----------------------------------------------------------------------------
81 * V4L2 Subdevice Pad Operations
82 */
83
lut_enum_mbus_code(struct v4l2_subdev * subdev,struct v4l2_subdev_fh * fh,struct v4l2_subdev_mbus_code_enum * code)84 static int lut_enum_mbus_code(struct v4l2_subdev *subdev,
85 struct v4l2_subdev_fh *fh,
86 struct v4l2_subdev_mbus_code_enum *code)
87 {
88 static const unsigned int codes[] = {
89 V4L2_MBUS_FMT_ARGB8888_1X32,
90 V4L2_MBUS_FMT_AHSV8888_1X32,
91 V4L2_MBUS_FMT_AYUV8_1X32,
92 };
93 struct v4l2_mbus_framefmt *format;
94
95 if (code->pad == LUT_PAD_SINK) {
96 if (code->index >= ARRAY_SIZE(codes))
97 return -EINVAL;
98
99 code->code = codes[code->index];
100 } else {
101 /* The LUT can't perform format conversion, the sink format is
102 * always identical to the source format.
103 */
104 if (code->index)
105 return -EINVAL;
106
107 format = v4l2_subdev_get_try_format(fh, LUT_PAD_SINK);
108 code->code = format->code;
109 }
110
111 return 0;
112 }
113
lut_enum_frame_size(struct v4l2_subdev * subdev,struct v4l2_subdev_fh * fh,struct v4l2_subdev_frame_size_enum * fse)114 static int lut_enum_frame_size(struct v4l2_subdev *subdev,
115 struct v4l2_subdev_fh *fh,
116 struct v4l2_subdev_frame_size_enum *fse)
117 {
118 struct v4l2_mbus_framefmt *format;
119
120 format = v4l2_subdev_get_try_format(fh, fse->pad);
121
122 if (fse->index || fse->code != format->code)
123 return -EINVAL;
124
125 if (fse->pad == LUT_PAD_SINK) {
126 fse->min_width = LUT_MIN_SIZE;
127 fse->max_width = LUT_MAX_SIZE;
128 fse->min_height = LUT_MIN_SIZE;
129 fse->max_height = LUT_MAX_SIZE;
130 } else {
131 /* The size on the source pad are fixed and always identical to
132 * the size on the sink pad.
133 */
134 fse->min_width = format->width;
135 fse->max_width = format->width;
136 fse->min_height = format->height;
137 fse->max_height = format->height;
138 }
139
140 return 0;
141 }
142
lut_get_format(struct v4l2_subdev * subdev,struct v4l2_subdev_fh * fh,struct v4l2_subdev_format * fmt)143 static int lut_get_format(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh,
144 struct v4l2_subdev_format *fmt)
145 {
146 struct vsp1_lut *lut = to_lut(subdev);
147
148 fmt->format = *vsp1_entity_get_pad_format(&lut->entity, fh, fmt->pad,
149 fmt->which);
150
151 return 0;
152 }
153
lut_set_format(struct v4l2_subdev * subdev,struct v4l2_subdev_fh * fh,struct v4l2_subdev_format * fmt)154 static int lut_set_format(struct v4l2_subdev *subdev, struct v4l2_subdev_fh *fh,
155 struct v4l2_subdev_format *fmt)
156 {
157 struct vsp1_lut *lut = to_lut(subdev);
158 struct v4l2_mbus_framefmt *format;
159
160 /* Default to YUV if the requested format is not supported. */
161 if (fmt->format.code != V4L2_MBUS_FMT_ARGB8888_1X32 &&
162 fmt->format.code != V4L2_MBUS_FMT_AHSV8888_1X32 &&
163 fmt->format.code != V4L2_MBUS_FMT_AYUV8_1X32)
164 fmt->format.code = V4L2_MBUS_FMT_AYUV8_1X32;
165
166 format = vsp1_entity_get_pad_format(&lut->entity, fh, fmt->pad,
167 fmt->which);
168
169 if (fmt->pad == LUT_PAD_SOURCE) {
170 /* The LUT output format can't be modified. */
171 fmt->format = *format;
172 return 0;
173 }
174
175 format->width = clamp_t(unsigned int, fmt->format.width,
176 LUT_MIN_SIZE, LUT_MAX_SIZE);
177 format->height = clamp_t(unsigned int, fmt->format.height,
178 LUT_MIN_SIZE, LUT_MAX_SIZE);
179 format->field = V4L2_FIELD_NONE;
180 format->colorspace = V4L2_COLORSPACE_SRGB;
181
182 fmt->format = *format;
183
184 /* Propagate the format to the source pad. */
185 format = vsp1_entity_get_pad_format(&lut->entity, fh, LUT_PAD_SOURCE,
186 fmt->which);
187 *format = fmt->format;
188
189 return 0;
190 }
191
192 /* -----------------------------------------------------------------------------
193 * V4L2 Subdevice Operations
194 */
195
196 static struct v4l2_subdev_core_ops lut_core_ops = {
197 .ioctl = lut_ioctl,
198 };
199
200 static struct v4l2_subdev_video_ops lut_video_ops = {
201 .s_stream = lut_s_stream,
202 };
203
204 static struct v4l2_subdev_pad_ops lut_pad_ops = {
205 .enum_mbus_code = lut_enum_mbus_code,
206 .enum_frame_size = lut_enum_frame_size,
207 .get_fmt = lut_get_format,
208 .set_fmt = lut_set_format,
209 };
210
211 static struct v4l2_subdev_ops lut_ops = {
212 .core = &lut_core_ops,
213 .video = &lut_video_ops,
214 .pad = &lut_pad_ops,
215 };
216
217 /* -----------------------------------------------------------------------------
218 * Initialization and Cleanup
219 */
220
vsp1_lut_create(struct vsp1_device * vsp1)221 struct vsp1_lut *vsp1_lut_create(struct vsp1_device *vsp1)
222 {
223 struct v4l2_subdev *subdev;
224 struct vsp1_lut *lut;
225 int ret;
226
227 lut = devm_kzalloc(vsp1->dev, sizeof(*lut), GFP_KERNEL);
228 if (lut == NULL)
229 return ERR_PTR(-ENOMEM);
230
231 lut->entity.type = VSP1_ENTITY_LUT;
232
233 ret = vsp1_entity_init(vsp1, &lut->entity, 2);
234 if (ret < 0)
235 return ERR_PTR(ret);
236
237 /* Initialize the V4L2 subdev. */
238 subdev = &lut->entity.subdev;
239 v4l2_subdev_init(subdev, &lut_ops);
240
241 subdev->entity.ops = &vsp1_media_ops;
242 subdev->internal_ops = &vsp1_subdev_internal_ops;
243 snprintf(subdev->name, sizeof(subdev->name), "%s lut",
244 dev_name(vsp1->dev));
245 v4l2_set_subdevdata(subdev, lut);
246 subdev->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
247
248 vsp1_entity_init_formats(subdev, NULL);
249
250 return lut;
251 }
252