1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * vsp1_uif.c -- R-Car VSP1 User Logic Interface
4 *
5 * Copyright (C) 2017-2018 Laurent Pinchart
6 *
7 * Contact: Laurent Pinchart (laurent.pinchart@ideasonboard.com)
8 */
9
10 #include <linux/device.h>
11 #include <linux/gfp.h>
12 #include <linux/sys_soc.h>
13
14 #include <media/media-entity.h>
15 #include <media/v4l2-subdev.h>
16
17 #include "vsp1.h"
18 #include "vsp1_dl.h"
19 #include "vsp1_entity.h"
20 #include "vsp1_uif.h"
21
22 #define UIF_MIN_SIZE 4U
23 #define UIF_MAX_SIZE 8190U
24
25 /* -----------------------------------------------------------------------------
26 * Device Access
27 */
28
vsp1_uif_read(struct vsp1_uif * uif,u32 reg)29 static inline u32 vsp1_uif_read(struct vsp1_uif *uif, u32 reg)
30 {
31 return vsp1_read(uif->entity.vsp1,
32 uif->entity.index * VI6_UIF_OFFSET + reg);
33 }
34
vsp1_uif_write(struct vsp1_uif * uif,struct vsp1_dl_body * dlb,u32 reg,u32 data)35 static inline void vsp1_uif_write(struct vsp1_uif *uif,
36 struct vsp1_dl_body *dlb, u32 reg, u32 data)
37 {
38 vsp1_dl_body_write(dlb, reg + uif->entity.index * VI6_UIF_OFFSET, data);
39 }
40
vsp1_uif_get_crc(struct vsp1_uif * uif)41 u32 vsp1_uif_get_crc(struct vsp1_uif *uif)
42 {
43 return vsp1_uif_read(uif, VI6_UIF_DISCOM_DOCMCCRCR);
44 }
45
46 /* -----------------------------------------------------------------------------
47 * V4L2 Subdevice Pad Operations
48 */
49
50 static const unsigned int uif_codes[] = {
51 MEDIA_BUS_FMT_ARGB8888_1X32,
52 MEDIA_BUS_FMT_AHSV8888_1X32,
53 MEDIA_BUS_FMT_AYUV8_1X32,
54 };
55
uif_enum_mbus_code(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)56 static int uif_enum_mbus_code(struct v4l2_subdev *subdev,
57 struct v4l2_subdev_state *sd_state,
58 struct v4l2_subdev_mbus_code_enum *code)
59 {
60 return vsp1_subdev_enum_mbus_code(subdev, sd_state, code, uif_codes,
61 ARRAY_SIZE(uif_codes));
62 }
63
uif_enum_frame_size(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_frame_size_enum * fse)64 static int uif_enum_frame_size(struct v4l2_subdev *subdev,
65 struct v4l2_subdev_state *sd_state,
66 struct v4l2_subdev_frame_size_enum *fse)
67 {
68 return vsp1_subdev_enum_frame_size(subdev, sd_state, fse,
69 UIF_MIN_SIZE,
70 UIF_MIN_SIZE, UIF_MAX_SIZE,
71 UIF_MAX_SIZE);
72 }
73
uif_set_format(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * fmt)74 static int uif_set_format(struct v4l2_subdev *subdev,
75 struct v4l2_subdev_state *sd_state,
76 struct v4l2_subdev_format *fmt)
77 {
78 return vsp1_subdev_set_pad_format(subdev, sd_state, fmt, uif_codes,
79 ARRAY_SIZE(uif_codes),
80 UIF_MIN_SIZE, UIF_MIN_SIZE,
81 UIF_MAX_SIZE, UIF_MAX_SIZE);
82 }
83
uif_get_selection(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)84 static int uif_get_selection(struct v4l2_subdev *subdev,
85 struct v4l2_subdev_state *sd_state,
86 struct v4l2_subdev_selection *sel)
87 {
88 struct vsp1_uif *uif = to_uif(subdev);
89 struct v4l2_subdev_state *state;
90 struct v4l2_mbus_framefmt *format;
91 int ret = 0;
92
93 if (sel->pad != UIF_PAD_SINK)
94 return -EINVAL;
95
96 mutex_lock(&uif->entity.lock);
97
98 state = vsp1_entity_get_state(&uif->entity, sd_state, sel->which);
99 if (!state) {
100 ret = -EINVAL;
101 goto done;
102 }
103
104 switch (sel->target) {
105 case V4L2_SEL_TGT_CROP_BOUNDS:
106 case V4L2_SEL_TGT_CROP_DEFAULT:
107 format = v4l2_subdev_state_get_format(state, UIF_PAD_SINK);
108 sel->r.left = 0;
109 sel->r.top = 0;
110 sel->r.width = format->width;
111 sel->r.height = format->height;
112 break;
113
114 case V4L2_SEL_TGT_CROP:
115 sel->r = *v4l2_subdev_state_get_crop(state, sel->pad);
116 break;
117
118 default:
119 ret = -EINVAL;
120 break;
121 }
122
123 done:
124 mutex_unlock(&uif->entity.lock);
125 return ret;
126 }
127
uif_set_selection(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)128 static int uif_set_selection(struct v4l2_subdev *subdev,
129 struct v4l2_subdev_state *sd_state,
130 struct v4l2_subdev_selection *sel)
131 {
132 struct vsp1_uif *uif = to_uif(subdev);
133 struct v4l2_subdev_state *state;
134 struct v4l2_mbus_framefmt *format;
135 struct v4l2_rect *selection;
136 int ret = 0;
137
138 if (sel->pad != UIF_PAD_SINK ||
139 sel->target != V4L2_SEL_TGT_CROP)
140 return -EINVAL;
141
142 mutex_lock(&uif->entity.lock);
143
144 state = vsp1_entity_get_state(&uif->entity, sd_state, sel->which);
145 if (!state) {
146 ret = -EINVAL;
147 goto done;
148 }
149
150 /* The crop rectangle must be inside the input frame. */
151 format = v4l2_subdev_state_get_format(state, UIF_PAD_SINK);
152
153 sel->r.left = clamp_t(unsigned int, sel->r.left, 0, format->width - 1);
154 sel->r.top = clamp_t(unsigned int, sel->r.top, 0, format->height - 1);
155 sel->r.width = clamp_t(unsigned int, sel->r.width, UIF_MIN_SIZE,
156 format->width - sel->r.left);
157 sel->r.height = clamp_t(unsigned int, sel->r.height, UIF_MIN_SIZE,
158 format->height - sel->r.top);
159
160 /* Store the crop rectangle. */
161 selection = v4l2_subdev_state_get_crop(state, sel->pad);
162 *selection = sel->r;
163
164 done:
165 mutex_unlock(&uif->entity.lock);
166 return ret;
167 }
168
169 /* -----------------------------------------------------------------------------
170 * V4L2 Subdevice Operations
171 */
172
173 static const struct v4l2_subdev_pad_ops uif_pad_ops = {
174 .enum_mbus_code = uif_enum_mbus_code,
175 .enum_frame_size = uif_enum_frame_size,
176 .get_fmt = vsp1_subdev_get_pad_format,
177 .set_fmt = uif_set_format,
178 .get_selection = uif_get_selection,
179 .set_selection = uif_set_selection,
180 };
181
182 static const struct v4l2_subdev_ops uif_ops = {
183 .pad = &uif_pad_ops,
184 };
185
186 /* -----------------------------------------------------------------------------
187 * VSP1 Entity Operations
188 */
189
uif_configure_stream(struct vsp1_entity * entity,struct v4l2_subdev_state * state,struct vsp1_pipeline * pipe,struct vsp1_dl_list * dl,struct vsp1_dl_body * dlb)190 static void uif_configure_stream(struct vsp1_entity *entity,
191 struct v4l2_subdev_state *state,
192 struct vsp1_pipeline *pipe,
193 struct vsp1_dl_list *dl,
194 struct vsp1_dl_body *dlb)
195 {
196 struct vsp1_uif *uif = to_uif(&entity->subdev);
197 const struct v4l2_rect *crop;
198 unsigned int left;
199 unsigned int width;
200
201 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMPMR,
202 VI6_UIF_DISCOM_DOCMPMR_SEL(9));
203
204 crop = v4l2_subdev_state_get_crop(state, UIF_PAD_SINK);
205
206 left = crop->left;
207 width = crop->width;
208
209 /* On M3-W the horizontal coordinates are twice the register value. */
210 if (uif->m3w_quirk) {
211 left /= 2;
212 width /= 2;
213 }
214
215 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPXR, left);
216 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPYR, crop->top);
217 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZXR, width);
218 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZYR, crop->height);
219
220 vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMCR,
221 VI6_UIF_DISCOM_DOCMCR_CMPR);
222 }
223
224 static const struct vsp1_entity_operations uif_entity_ops = {
225 .configure_stream = uif_configure_stream,
226 };
227
228 /* -----------------------------------------------------------------------------
229 * Initialization and Cleanup
230 */
231
232 static const struct soc_device_attribute vsp1_r8a7796[] = {
233 { .soc_id = "r8a7796" },
234 { /* sentinel */ }
235 };
236
vsp1_uif_create(struct vsp1_device * vsp1,unsigned int index)237 struct vsp1_uif *vsp1_uif_create(struct vsp1_device *vsp1, unsigned int index)
238 {
239 struct vsp1_uif *uif;
240 char name[6];
241 int ret;
242
243 uif = devm_kzalloc(vsp1->dev, sizeof(*uif), GFP_KERNEL);
244 if (!uif)
245 return ERR_PTR(-ENOMEM);
246
247 if (soc_device_match(vsp1_r8a7796))
248 uif->m3w_quirk = true;
249
250 uif->entity.ops = &uif_entity_ops;
251 uif->entity.type = VSP1_ENTITY_UIF;
252 uif->entity.index = index;
253
254 /* The datasheet names the two UIF instances UIF4 and UIF5. */
255 sprintf(name, "uif.%u", index + 4);
256 ret = vsp1_entity_init(vsp1, &uif->entity, name, 2, &uif_ops,
257 MEDIA_ENT_F_PROC_VIDEO_STATISTICS);
258 if (ret < 0)
259 return ERR_PTR(ret);
260
261 return uif;
262 }
263