vsp1_uif.c

  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
 29static 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
 35static 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
 41u32 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
 50static 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
 56static 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
 64static 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
 74static 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
 84static 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
123done:
124	mutex_unlock(&uif->entity.lock);
125	return ret;
126}
127
128static 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
164done:
165	mutex_unlock(&uif->entity.lock);
166	return ret;
167}
168
169/* -----------------------------------------------------------------------------
170 * V4L2 Subdevice Operations
171 */
172
173static 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
182static const struct v4l2_subdev_ops uif_ops = {
183	.pad    = &uif_pad_ops,
184};
185
186/* -----------------------------------------------------------------------------
187 * VSP1 Entity Operations
188 */
189
190static 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
224static const struct vsp1_entity_operations uif_entity_ops = {
225	.configure_stream = uif_configure_stream,
226};
227
228/* -----------------------------------------------------------------------------
229 * Initialization and Cleanup
230 */
231
232static const struct soc_device_attribute vsp1_r8a7796[] = {
233	{ .soc_id = "r8a7796" },
234	{ /* sentinel */ }
235};
236
237struct 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}