Commit 34e77ed8 authored by Laurent Pinchart's avatar Laurent Pinchart Committed by Mauro Carvalho Chehab

[media] v4l: vsp1: Protect against race conditions between get and set format

The subdev userspace API isn't serialized in the core, serialize access
to formats and selection rectangles in the driver.
Signed-off-by: default avatarLaurent Pinchart <laurent.pinchart+renesas@ideasonboard.com>
Acked-by: default avatarNiklas Söderlund <niklas.soderlund+renesas@ragnatech.se>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@s-opensource.com>
parent e4e70a14
...@@ -142,10 +142,15 @@ static int bru_set_format(struct v4l2_subdev *subdev, ...@@ -142,10 +142,15 @@ static int bru_set_format(struct v4l2_subdev *subdev,
struct vsp1_bru *bru = to_bru(subdev); struct vsp1_bru *bru = to_bru(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&bru->entity.lock);
config = vsp1_entity_get_pad_config(&bru->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&bru->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
bru_try_format(bru, config, fmt->pad, &fmt->format); bru_try_format(bru, config, fmt->pad, &fmt->format);
...@@ -174,7 +179,9 @@ static int bru_set_format(struct v4l2_subdev *subdev, ...@@ -174,7 +179,9 @@ static int bru_set_format(struct v4l2_subdev *subdev,
} }
} }
return 0; done:
mutex_unlock(&bru->entity.lock);
return ret;
} }
static int bru_get_selection(struct v4l2_subdev *subdev, static int bru_get_selection(struct v4l2_subdev *subdev,
...@@ -201,7 +208,9 @@ static int bru_get_selection(struct v4l2_subdev *subdev, ...@@ -201,7 +208,9 @@ static int bru_get_selection(struct v4l2_subdev *subdev,
if (!config) if (!config)
return -EINVAL; return -EINVAL;
mutex_lock(&bru->entity.lock);
sel->r = *bru_get_compose(bru, config, sel->pad); sel->r = *bru_get_compose(bru, config, sel->pad);
mutex_unlock(&bru->entity.lock);
return 0; return 0;
default: default:
...@@ -217,6 +226,7 @@ static int bru_set_selection(struct v4l2_subdev *subdev, ...@@ -217,6 +226,7 @@ static int bru_set_selection(struct v4l2_subdev *subdev,
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
struct v4l2_rect *compose; struct v4l2_rect *compose;
int ret = 0;
if (sel->pad == bru->entity.source_pad) if (sel->pad == bru->entity.source_pad)
return -EINVAL; return -EINVAL;
...@@ -224,9 +234,13 @@ static int bru_set_selection(struct v4l2_subdev *subdev, ...@@ -224,9 +234,13 @@ static int bru_set_selection(struct v4l2_subdev *subdev,
if (sel->target != V4L2_SEL_TGT_COMPOSE) if (sel->target != V4L2_SEL_TGT_COMPOSE)
return -EINVAL; return -EINVAL;
mutex_lock(&bru->entity.lock);
config = vsp1_entity_get_pad_config(&bru->entity, cfg, sel->which); config = vsp1_entity_get_pad_config(&bru->entity, cfg, sel->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* The compose rectangle top left corner must be inside the output /* The compose rectangle top left corner must be inside the output
* frame. * frame.
...@@ -246,7 +260,9 @@ static int bru_set_selection(struct v4l2_subdev *subdev, ...@@ -246,7 +260,9 @@ static int bru_set_selection(struct v4l2_subdev *subdev,
compose = bru_get_compose(bru, config, sel->pad); compose = bru_get_compose(bru, config, sel->pad);
*compose = sel->r; *compose = sel->r;
return 0; done:
mutex_unlock(&bru->entity.lock);
return ret;
} }
static const struct v4l2_subdev_pad_ops bru_pad_ops = { static const struct v4l2_subdev_pad_ops bru_pad_ops = {
......
...@@ -148,10 +148,15 @@ static int clu_set_format(struct v4l2_subdev *subdev, ...@@ -148,10 +148,15 @@ static int clu_set_format(struct v4l2_subdev *subdev,
struct vsp1_clu *clu = to_clu(subdev); struct vsp1_clu *clu = to_clu(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&clu->entity.lock);
config = vsp1_entity_get_pad_config(&clu->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&clu->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* Default to YUV if the requested format is not supported. */ /* Default to YUV if the requested format is not supported. */
if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 && if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
...@@ -164,7 +169,7 @@ static int clu_set_format(struct v4l2_subdev *subdev, ...@@ -164,7 +169,7 @@ static int clu_set_format(struct v4l2_subdev *subdev,
if (fmt->pad == CLU_PAD_SOURCE) { if (fmt->pad == CLU_PAD_SOURCE) {
/* The CLU output format can't be modified. */ /* The CLU output format can't be modified. */
fmt->format = *format; fmt->format = *format;
return 0; goto done;
} }
format->code = fmt->format.code; format->code = fmt->format.code;
...@@ -182,7 +187,9 @@ static int clu_set_format(struct v4l2_subdev *subdev, ...@@ -182,7 +187,9 @@ static int clu_set_format(struct v4l2_subdev *subdev,
CLU_PAD_SOURCE); CLU_PAD_SOURCE);
*format = fmt->format; *format = fmt->format;
return 0; done:
mutex_unlock(&clu->entity.lock);
return ret;
} }
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
......
...@@ -51,6 +51,9 @@ void vsp1_entity_route_setup(struct vsp1_entity *source, ...@@ -51,6 +51,9 @@ void vsp1_entity_route_setup(struct vsp1_entity *source,
* @cfg: the TRY pad configuration * @cfg: the TRY pad configuration
* @which: configuration selector (ACTIVE or TRY) * @which: configuration selector (ACTIVE or TRY)
* *
* When called with which set to V4L2_SUBDEV_FORMAT_ACTIVE the caller must hold
* the entity lock to access the returned configuration.
*
* Return the pad configuration requested by the which argument. The TRY * Return the pad configuration requested by the which argument. The TRY
* configuration is passed explicitly to the function through the cfg argument * configuration is passed explicitly to the function through the cfg argument
* and simply returned when requested. The ACTIVE configuration comes from the * and simply returned when requested. The ACTIVE configuration comes from the
...@@ -160,7 +163,9 @@ int vsp1_subdev_get_pad_format(struct v4l2_subdev *subdev, ...@@ -160,7 +163,9 @@ int vsp1_subdev_get_pad_format(struct v4l2_subdev *subdev,
if (!config) if (!config)
return -EINVAL; return -EINVAL;
mutex_lock(&entity->lock);
fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad); fmt->format = *vsp1_entity_get_pad_format(entity, config, fmt->pad);
mutex_unlock(&entity->lock);
return 0; return 0;
} }
...@@ -204,8 +209,10 @@ int vsp1_subdev_enum_mbus_code(struct v4l2_subdev *subdev, ...@@ -204,8 +209,10 @@ int vsp1_subdev_enum_mbus_code(struct v4l2_subdev *subdev,
if (!config) if (!config)
return -EINVAL; return -EINVAL;
mutex_lock(&entity->lock);
format = vsp1_entity_get_pad_format(entity, config, 0); format = vsp1_entity_get_pad_format(entity, config, 0);
code->code = format->code; code->code = format->code;
mutex_unlock(&entity->lock);
} }
return 0; return 0;
...@@ -235,6 +242,7 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -235,6 +242,7 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
struct vsp1_entity *entity = to_vsp1_entity(subdev); struct vsp1_entity *entity = to_vsp1_entity(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
config = vsp1_entity_get_pad_config(entity, cfg, fse->which); config = vsp1_entity_get_pad_config(entity, cfg, fse->which);
if (!config) if (!config)
...@@ -242,8 +250,12 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -242,8 +250,12 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
format = vsp1_entity_get_pad_format(entity, config, fse->pad); format = vsp1_entity_get_pad_format(entity, config, fse->pad);
if (fse->index || fse->code != format->code) mutex_lock(&entity->lock);
return -EINVAL;
if (fse->index || fse->code != format->code) {
ret = -EINVAL;
goto done;
}
if (fse->pad == 0) { if (fse->pad == 0) {
fse->min_width = min_width; fse->min_width = min_width;
...@@ -260,7 +272,9 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -260,7 +272,9 @@ int vsp1_subdev_enum_frame_size(struct v4l2_subdev *subdev,
fse->max_height = format->height; fse->max_height = format->height;
} }
return 0; done:
mutex_unlock(&entity->lock);
return ret;
} }
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
...@@ -358,6 +372,8 @@ int vsp1_entity_init(struct vsp1_device *vsp1, struct vsp1_entity *entity, ...@@ -358,6 +372,8 @@ int vsp1_entity_init(struct vsp1_device *vsp1, struct vsp1_entity *entity,
if (i == ARRAY_SIZE(vsp1_routes)) if (i == ARRAY_SIZE(vsp1_routes))
return -EINVAL; return -EINVAL;
mutex_init(&entity->lock);
entity->vsp1 = vsp1; entity->vsp1 = vsp1;
entity->source_pad = num_pads - 1; entity->source_pad = num_pads - 1;
......
...@@ -14,7 +14,7 @@ ...@@ -14,7 +14,7 @@
#define __VSP1_ENTITY_H__ #define __VSP1_ENTITY_H__
#include <linux/list.h> #include <linux/list.h>
#include <linux/spinlock.h> #include <linux/mutex.h>
#include <media/v4l2-subdev.h> #include <media/v4l2-subdev.h>
...@@ -96,6 +96,8 @@ struct vsp1_entity { ...@@ -96,6 +96,8 @@ struct vsp1_entity {
struct v4l2_subdev subdev; struct v4l2_subdev subdev;
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct mutex lock; /* Protects the pad config */
}; };
static inline struct vsp1_entity *to_vsp1_entity(struct v4l2_subdev *subdev) static inline struct vsp1_entity *to_vsp1_entity(struct v4l2_subdev *subdev)
......
...@@ -71,10 +71,15 @@ static int hsit_set_format(struct v4l2_subdev *subdev, ...@@ -71,10 +71,15 @@ static int hsit_set_format(struct v4l2_subdev *subdev,
struct vsp1_hsit *hsit = to_hsit(subdev); struct vsp1_hsit *hsit = to_hsit(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&hsit->entity.lock);
config = vsp1_entity_get_pad_config(&hsit->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&hsit->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
format = vsp1_entity_get_pad_format(&hsit->entity, config, fmt->pad); format = vsp1_entity_get_pad_format(&hsit->entity, config, fmt->pad);
...@@ -83,7 +88,7 @@ static int hsit_set_format(struct v4l2_subdev *subdev, ...@@ -83,7 +88,7 @@ static int hsit_set_format(struct v4l2_subdev *subdev,
* modified. * modified.
*/ */
fmt->format = *format; fmt->format = *format;
return 0; goto done;
} }
format->code = hsit->inverse ? MEDIA_BUS_FMT_AHSV8888_1X32 format->code = hsit->inverse ? MEDIA_BUS_FMT_AHSV8888_1X32
...@@ -104,7 +109,9 @@ static int hsit_set_format(struct v4l2_subdev *subdev, ...@@ -104,7 +109,9 @@ static int hsit_set_format(struct v4l2_subdev *subdev,
format->code = hsit->inverse ? MEDIA_BUS_FMT_ARGB8888_1X32 format->code = hsit->inverse ? MEDIA_BUS_FMT_ARGB8888_1X32
: MEDIA_BUS_FMT_AHSV8888_1X32; : MEDIA_BUS_FMT_AHSV8888_1X32;
return 0; done:
mutex_unlock(&hsit->entity.lock);
return ret;
} }
static const struct v4l2_subdev_pad_ops hsit_pad_ops = { static const struct v4l2_subdev_pad_ops hsit_pad_ops = {
......
...@@ -66,10 +66,15 @@ static int lif_set_format(struct v4l2_subdev *subdev, ...@@ -66,10 +66,15 @@ static int lif_set_format(struct v4l2_subdev *subdev,
struct vsp1_lif *lif = to_lif(subdev); struct vsp1_lif *lif = to_lif(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&lif->entity.lock);
config = vsp1_entity_get_pad_config(&lif->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&lif->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* Default to YUV if the requested format is not supported. */ /* Default to YUV if the requested format is not supported. */
if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 && if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
...@@ -83,7 +88,7 @@ static int lif_set_format(struct v4l2_subdev *subdev, ...@@ -83,7 +88,7 @@ static int lif_set_format(struct v4l2_subdev *subdev,
* format. * format.
*/ */
fmt->format = *format; fmt->format = *format;
return 0; goto done;
} }
format->code = fmt->format.code; format->code = fmt->format.code;
...@@ -101,7 +106,9 @@ static int lif_set_format(struct v4l2_subdev *subdev, ...@@ -101,7 +106,9 @@ static int lif_set_format(struct v4l2_subdev *subdev,
LIF_PAD_SOURCE); LIF_PAD_SOURCE);
*format = fmt->format; *format = fmt->format;
return 0; done:
mutex_unlock(&lif->entity.lock);
return ret;
} }
static const struct v4l2_subdev_pad_ops lif_pad_ops = { static const struct v4l2_subdev_pad_ops lif_pad_ops = {
......
...@@ -124,10 +124,15 @@ static int lut_set_format(struct v4l2_subdev *subdev, ...@@ -124,10 +124,15 @@ static int lut_set_format(struct v4l2_subdev *subdev,
struct vsp1_lut *lut = to_lut(subdev); struct vsp1_lut *lut = to_lut(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&lut->entity.lock);
config = vsp1_entity_get_pad_config(&lut->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&lut->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* Default to YUV if the requested format is not supported. */ /* Default to YUV if the requested format is not supported. */
if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 && if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
...@@ -140,7 +145,7 @@ static int lut_set_format(struct v4l2_subdev *subdev, ...@@ -140,7 +145,7 @@ static int lut_set_format(struct v4l2_subdev *subdev,
if (fmt->pad == LUT_PAD_SOURCE) { if (fmt->pad == LUT_PAD_SOURCE) {
/* The LUT output format can't be modified. */ /* The LUT output format can't be modified. */
fmt->format = *format; fmt->format = *format;
return 0; goto done;
} }
format->code = fmt->format.code; format->code = fmt->format.code;
...@@ -158,7 +163,9 @@ static int lut_set_format(struct v4l2_subdev *subdev, ...@@ -158,7 +163,9 @@ static int lut_set_format(struct v4l2_subdev *subdev,
LUT_PAD_SOURCE); LUT_PAD_SOURCE);
*format = fmt->format; *format = fmt->format;
return 0; done:
mutex_unlock(&lut->entity.lock);
return ret;
} }
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
......
...@@ -67,10 +67,15 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev, ...@@ -67,10 +67,15 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev,
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
struct v4l2_rect *crop; struct v4l2_rect *crop;
int ret = 0;
mutex_lock(&rwpf->entity.lock);
config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* Default to YUV if the requested format is not supported. */ /* Default to YUV if the requested format is not supported. */
if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 && if (fmt->format.code != MEDIA_BUS_FMT_ARGB8888_1X32 &&
...@@ -85,7 +90,7 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev, ...@@ -85,7 +90,7 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev,
*/ */
format->code = fmt->format.code; format->code = fmt->format.code;
fmt->format = *format; fmt->format = *format;
return 0; goto done;
} }
format->code = fmt->format.code; format->code = fmt->format.code;
...@@ -110,7 +115,9 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev, ...@@ -110,7 +115,9 @@ static int vsp1_rwpf_set_format(struct v4l2_subdev *subdev,
RWPF_PAD_SOURCE); RWPF_PAD_SOURCE);
*format = fmt->format; *format = fmt->format;
return 0; done:
mutex_unlock(&rwpf->entity.lock);
return ret;
} }
static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev, static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev,
...@@ -120,14 +127,19 @@ static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev, ...@@ -120,14 +127,19 @@ static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev,
struct vsp1_rwpf *rwpf = to_rwpf(subdev); struct vsp1_rwpf *rwpf = to_rwpf(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
/* Cropping is implemented on the sink pad. */ /* Cropping is implemented on the sink pad. */
if (sel->pad != RWPF_PAD_SINK) if (sel->pad != RWPF_PAD_SINK)
return -EINVAL; return -EINVAL;
mutex_lock(&rwpf->entity.lock);
config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, sel->which); config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, sel->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
switch (sel->target) { switch (sel->target) {
case V4L2_SEL_TGT_CROP: case V4L2_SEL_TGT_CROP:
...@@ -144,10 +156,13 @@ static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev, ...@@ -144,10 +156,13 @@ static int vsp1_rwpf_get_selection(struct v4l2_subdev *subdev,
break; break;
default: default:
return -EINVAL; ret = -EINVAL;
break;
} }
return 0; done:
mutex_unlock(&rwpf->entity.lock);
return ret;
} }
static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev, static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev,
...@@ -158,6 +173,7 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev, ...@@ -158,6 +173,7 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev,
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
struct v4l2_rect *crop; struct v4l2_rect *crop;
int ret = 0;
/* Cropping is implemented on the sink pad. */ /* Cropping is implemented on the sink pad. */
if (sel->pad != RWPF_PAD_SINK) if (sel->pad != RWPF_PAD_SINK)
...@@ -166,9 +182,13 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev, ...@@ -166,9 +182,13 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev,
if (sel->target != V4L2_SEL_TGT_CROP) if (sel->target != V4L2_SEL_TGT_CROP)
return -EINVAL; return -EINVAL;
mutex_lock(&rwpf->entity.lock);
config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, sel->which); config = vsp1_entity_get_pad_config(&rwpf->entity, cfg, sel->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
/* Make sure the crop rectangle is entirely contained in the image. The /* Make sure the crop rectangle is entirely contained in the image. The
* WPF top and left offsets are limited to 255. * WPF top and left offsets are limited to 255.
...@@ -206,7 +226,9 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev, ...@@ -206,7 +226,9 @@ static int vsp1_rwpf_set_selection(struct v4l2_subdev *subdev,
format->width = crop->width; format->width = crop->width;
format->height = crop->height; format->height = crop->height;
return 0; done:
mutex_unlock(&rwpf->entity.lock);
return ret;
} }
const struct v4l2_subdev_pad_ops vsp1_rwpf_pad_ops = { const struct v4l2_subdev_pad_ops vsp1_rwpf_pad_ops = {
......
...@@ -128,6 +128,7 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -128,6 +128,7 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev,
struct vsp1_sru *sru = to_sru(subdev); struct vsp1_sru *sru = to_sru(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
config = vsp1_entity_get_pad_config(&sru->entity, cfg, fse->which); config = vsp1_entity_get_pad_config(&sru->entity, cfg, fse->which);
if (!config) if (!config)
...@@ -135,8 +136,12 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -135,8 +136,12 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev,
format = vsp1_entity_get_pad_format(&sru->entity, config, SRU_PAD_SINK); format = vsp1_entity_get_pad_format(&sru->entity, config, SRU_PAD_SINK);
if (fse->index || fse->code != format->code) mutex_lock(&sru->entity.lock);
return -EINVAL;
if (fse->index || fse->code != format->code) {
ret = -EINVAL;
goto done;
}
if (fse->pad == SRU_PAD_SINK) { if (fse->pad == SRU_PAD_SINK) {
fse->min_width = SRU_MIN_SIZE; fse->min_width = SRU_MIN_SIZE;
...@@ -156,7 +161,9 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -156,7 +161,9 @@ static int sru_enum_frame_size(struct v4l2_subdev *subdev,
} }
} }
return 0; done:
mutex_unlock(&sru->entity.lock);
return ret;
} }
static void sru_try_format(struct vsp1_sru *sru, static void sru_try_format(struct vsp1_sru *sru,
...@@ -217,10 +224,15 @@ static int sru_set_format(struct v4l2_subdev *subdev, ...@@ -217,10 +224,15 @@ static int sru_set_format(struct v4l2_subdev *subdev,
struct vsp1_sru *sru = to_sru(subdev); struct vsp1_sru *sru = to_sru(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&sru->entity.lock);
config = vsp1_entity_get_pad_config(&sru->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&sru->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
sru_try_format(sru, config, fmt->pad, &fmt->format); sru_try_format(sru, config, fmt->pad, &fmt->format);
...@@ -236,7 +248,9 @@ static int sru_set_format(struct v4l2_subdev *subdev, ...@@ -236,7 +248,9 @@ static int sru_set_format(struct v4l2_subdev *subdev,
sru_try_format(sru, config, SRU_PAD_SOURCE, format); sru_try_format(sru, config, SRU_PAD_SOURCE, format);
} }
return 0; done:
mutex_unlock(&sru->entity.lock);
return ret;
} }
static const struct v4l2_subdev_pad_ops sru_pad_ops = { static const struct v4l2_subdev_pad_ops sru_pad_ops = {
......
...@@ -133,6 +133,7 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -133,6 +133,7 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev,
struct vsp1_uds *uds = to_uds(subdev); struct vsp1_uds *uds = to_uds(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
config = vsp1_entity_get_pad_config(&uds->entity, cfg, fse->which); config = vsp1_entity_get_pad_config(&uds->entity, cfg, fse->which);
if (!config) if (!config)
...@@ -141,8 +142,12 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -141,8 +142,12 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev,
format = vsp1_entity_get_pad_format(&uds->entity, config, format = vsp1_entity_get_pad_format(&uds->entity, config,
UDS_PAD_SINK); UDS_PAD_SINK);
if (fse->index || fse->code != format->code) mutex_lock(&uds->entity.lock);
return -EINVAL;
if (fse->index || fse->code != format->code) {
ret = -EINVAL;
goto done;
}
if (fse->pad == UDS_PAD_SINK) { if (fse->pad == UDS_PAD_SINK) {
fse->min_width = UDS_MIN_SIZE; fse->min_width = UDS_MIN_SIZE;
...@@ -156,7 +161,9 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev, ...@@ -156,7 +161,9 @@ static int uds_enum_frame_size(struct v4l2_subdev *subdev,
&fse->max_height); &fse->max_height);
} }
return 0; done:
mutex_unlock(&uds->entity.lock);
return ret;
} }
static void uds_try_format(struct vsp1_uds *uds, static void uds_try_format(struct vsp1_uds *uds,
...@@ -202,10 +209,15 @@ static int uds_set_format(struct v4l2_subdev *subdev, ...@@ -202,10 +209,15 @@ static int uds_set_format(struct v4l2_subdev *subdev,
struct vsp1_uds *uds = to_uds(subdev); struct vsp1_uds *uds = to_uds(subdev);
struct v4l2_subdev_pad_config *config; struct v4l2_subdev_pad_config *config;
struct v4l2_mbus_framefmt *format; struct v4l2_mbus_framefmt *format;
int ret = 0;
mutex_lock(&uds->entity.lock);
config = vsp1_entity_get_pad_config(&uds->entity, cfg, fmt->which); config = vsp1_entity_get_pad_config(&uds->entity, cfg, fmt->which);
if (!config) if (!config) {
return -EINVAL; ret = -EINVAL;
goto done;
}
uds_try_format(uds, config, fmt->pad, &fmt->format); uds_try_format(uds, config, fmt->pad, &fmt->format);
...@@ -221,7 +233,9 @@ static int uds_set_format(struct v4l2_subdev *subdev, ...@@ -221,7 +233,9 @@ static int uds_set_format(struct v4l2_subdev *subdev,
uds_try_format(uds, config, UDS_PAD_SOURCE, format); uds_try_format(uds, config, UDS_PAD_SOURCE, format);
} }
return 0; done:
mutex_unlock(&uds->entity.lock);
return ret;
} }
/* ----------------------------------------------------------------------------- /* -----------------------------------------------------------------------------
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment