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 *config;
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 	config = vsp1_entity_get_pad_config(&uif->entity, sd_state,
99 					    sel->which);
100 	if (!config) {
101 		ret = -EINVAL;
102 		goto done;
103 	}
104 
105 	switch (sel->target) {
106 	case V4L2_SEL_TGT_CROP_BOUNDS:
107 	case V4L2_SEL_TGT_CROP_DEFAULT:
108 		format = vsp1_entity_get_pad_format(&uif->entity, config,
109 						    UIF_PAD_SINK);
110 		sel->r.left = 0;
111 		sel->r.top = 0;
112 		sel->r.width = format->width;
113 		sel->r.height = format->height;
114 		break;
115 
116 	case V4L2_SEL_TGT_CROP:
117 		sel->r = *vsp1_entity_get_pad_selection(&uif->entity, config,
118 							sel->pad, sel->target);
119 		break;
120 
121 	default:
122 		ret = -EINVAL;
123 		break;
124 	}
125 
126 done:
127 	mutex_unlock(&uif->entity.lock);
128 	return ret;
129 }
130 
uif_set_selection(struct v4l2_subdev * subdev,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_selection * sel)131 static int uif_set_selection(struct v4l2_subdev *subdev,
132 			     struct v4l2_subdev_state *sd_state,
133 			     struct v4l2_subdev_selection *sel)
134 {
135 	struct vsp1_uif *uif = to_uif(subdev);
136 	struct v4l2_subdev_state *config;
137 	struct v4l2_mbus_framefmt *format;
138 	struct v4l2_rect *selection;
139 	int ret = 0;
140 
141 	if (sel->pad != UIF_PAD_SINK ||
142 	    sel->target != V4L2_SEL_TGT_CROP)
143 		return -EINVAL;
144 
145 	mutex_lock(&uif->entity.lock);
146 
147 	config = vsp1_entity_get_pad_config(&uif->entity, sd_state,
148 					    sel->which);
149 	if (!config) {
150 		ret = -EINVAL;
151 		goto done;
152 	}
153 
154 	/* The crop rectangle must be inside the input frame. */
155 	format = vsp1_entity_get_pad_format(&uif->entity, config, UIF_PAD_SINK);
156 
157 	sel->r.left = clamp_t(unsigned int, sel->r.left, 0, format->width - 1);
158 	sel->r.top = clamp_t(unsigned int, sel->r.top, 0, format->height - 1);
159 	sel->r.width = clamp_t(unsigned int, sel->r.width, UIF_MIN_SIZE,
160 			       format->width - sel->r.left);
161 	sel->r.height = clamp_t(unsigned int, sel->r.height, UIF_MIN_SIZE,
162 				format->height - sel->r.top);
163 
164 	/* Store the crop rectangle. */
165 	selection = vsp1_entity_get_pad_selection(&uif->entity, config,
166 						  sel->pad, V4L2_SEL_TGT_CROP);
167 	*selection = sel->r;
168 
169 done:
170 	mutex_unlock(&uif->entity.lock);
171 	return ret;
172 }
173 
174 /* -----------------------------------------------------------------------------
175  * V4L2 Subdevice Operations
176  */
177 
178 static const struct v4l2_subdev_pad_ops uif_pad_ops = {
179 	.init_cfg = vsp1_entity_init_cfg,
180 	.enum_mbus_code = uif_enum_mbus_code,
181 	.enum_frame_size = uif_enum_frame_size,
182 	.get_fmt = vsp1_subdev_get_pad_format,
183 	.set_fmt = uif_set_format,
184 	.get_selection = uif_get_selection,
185 	.set_selection = uif_set_selection,
186 };
187 
188 static const struct v4l2_subdev_ops uif_ops = {
189 	.pad    = &uif_pad_ops,
190 };
191 
192 /* -----------------------------------------------------------------------------
193  * VSP1 Entity Operations
194  */
195 
uif_configure_stream(struct vsp1_entity * entity,struct vsp1_pipeline * pipe,struct vsp1_dl_list * dl,struct vsp1_dl_body * dlb)196 static void uif_configure_stream(struct vsp1_entity *entity,
197 				 struct vsp1_pipeline *pipe,
198 				 struct vsp1_dl_list *dl,
199 				 struct vsp1_dl_body *dlb)
200 {
201 	struct vsp1_uif *uif = to_uif(&entity->subdev);
202 	const struct v4l2_rect *crop;
203 	unsigned int left;
204 	unsigned int width;
205 
206 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMPMR,
207 		       VI6_UIF_DISCOM_DOCMPMR_SEL(9));
208 
209 	crop = vsp1_entity_get_pad_selection(entity, entity->config,
210 					     UIF_PAD_SINK, V4L2_SEL_TGT_CROP);
211 
212 	left = crop->left;
213 	width = crop->width;
214 
215 	/* On M3-W the horizontal coordinates are twice the register value. */
216 	if (uif->m3w_quirk) {
217 		left /= 2;
218 		width /= 2;
219 	}
220 
221 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPXR, left);
222 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSPYR, crop->top);
223 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZXR, width);
224 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMSZYR, crop->height);
225 
226 	vsp1_uif_write(uif, dlb, VI6_UIF_DISCOM_DOCMCR,
227 		       VI6_UIF_DISCOM_DOCMCR_CMPR);
228 }
229 
230 static const struct vsp1_entity_operations uif_entity_ops = {
231 	.configure_stream = uif_configure_stream,
232 };
233 
234 /* -----------------------------------------------------------------------------
235  * Initialization and Cleanup
236  */
237 
238 static const struct soc_device_attribute vsp1_r8a7796[] = {
239 	{ .soc_id = "r8a7796" },
240 	{ /* sentinel */ }
241 };
242 
vsp1_uif_create(struct vsp1_device * vsp1,unsigned int index)243 struct vsp1_uif *vsp1_uif_create(struct vsp1_device *vsp1, unsigned int index)
244 {
245 	struct vsp1_uif *uif;
246 	char name[6];
247 	int ret;
248 
249 	uif = devm_kzalloc(vsp1->dev, sizeof(*uif), GFP_KERNEL);
250 	if (!uif)
251 		return ERR_PTR(-ENOMEM);
252 
253 	if (soc_device_match(vsp1_r8a7796))
254 		uif->m3w_quirk = true;
255 
256 	uif->entity.ops = &uif_entity_ops;
257 	uif->entity.type = VSP1_ENTITY_UIF;
258 	uif->entity.index = index;
259 
260 	/* The datasheet names the two UIF instances UIF4 and UIF5. */
261 	sprintf(name, "uif.%u", index + 4);
262 	ret = vsp1_entity_init(vsp1, &uif->entity, name, 2, &uif_ops,
263 			       MEDIA_ENT_F_PROC_VIDEO_STATISTICS);
264 	if (ret < 0)
265 		return ERR_PTR(ret);
266 
267 	return uif;
268 }
269