263 lines · c
1// SPDX-License-Identifier: GPL-2.0+2/*3 * vsp1_uif.c -- R-Car VSP1 User Logic Interface4 *5 * Copyright (C) 2017-2018 Laurent Pinchart6 *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 4U23#define UIF_MAX_SIZE 8190U24 25/* -----------------------------------------------------------------------------26 * Device Access27 */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 Operations48 */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 Operations171 */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 Operations188 */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 Cleanup230 */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}263