Re: [PATCH v4 25/45] media: sun6i-csi: Rework capture format management with helper

["Jernej Škrabec" <jernej.skrabec@gmail.com>]

Dne petek, 15. april 2022 ob 17:27:51 CEST je Paul Kocialkowski napisal(a):
> Remove the need for local copies of the v4l2 format and add a common
> helper to prepare a format compatible with the driver, using the
> relevant v4l2 helpers.
> 
> Report a raw colorspace for bayer-encoded pixel formats instead of SRGB.
> Also cleanup the size bound defines while at it.
> 
> Signed-off-by: Paul Kocialkowski <paul.kocialkowski@bootlin.com>

Acked-by: Jernej Skrabec <jernej.skrabec@gmail.com>

Best regards,
Jernej

> ---
>  .../sunxi/sun6i-csi/sun6i_csi_capture.c       | 122 +++++++++---------
>  .../sunxi/sun6i-csi/sun6i_csi_capture.h       |   5 +
>  2 files changed, 66 insertions(+), 61 deletions(-)
> 
> diff --git a/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.c
> b/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.c index
> c1d3b352d988..2aa65a4ddb85 100644
> --- a/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.c
> +++ b/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.c
> @@ -20,12 +20,6 @@
>  #include "sun6i_csi_capture.h"
>  #include "sun6i_csi_reg.h"
> 
> -/* This is got from BSP sources. */
> -#define MIN_WIDTH	(32)
> -#define MIN_HEIGHT	(32)
> -#define MAX_WIDTH	(4800)
> -#define MAX_HEIGHT	(4800)
> -
>  /* Helpers */
> 
>  void sun6i_csi_capture_dimensions(struct sun6i_csi_device *csi_dev,
> @@ -833,6 +827,55 @@ static const struct vb2_ops sun6i_csi_capture_queue_ops
> = {
> 
>  /* V4L2 Device */
> 
> +static void sun6i_csi_capture_format_prepare(struct v4l2_format *format)
> +{
> +	struct v4l2_pix_format *pix_format = &format->fmt.pix;
> +	const struct v4l2_format_info *info;
> +	unsigned int width, height;
> +
> +	v4l_bound_align_image(&pix_format->width, 
SUN6I_CSI_CAPTURE_WIDTH_MIN,
> +			      SUN6I_CSI_CAPTURE_WIDTH_MAX, 1,
> +			      &pix_format->height, 
SUN6I_CSI_CAPTURE_HEIGHT_MIN,
> +			      SUN6I_CSI_CAPTURE_HEIGHT_MAX, 1, 0);
> +
> +	if (!sun6i_csi_capture_format_check(pix_format->pixelformat))
> +		pix_format->pixelformat = sun6i_csi_capture_formats[0];
> +
> +	width = pix_format->width;
> +	height = pix_format->height;
> +
> +	info = v4l2_format_info(pix_format->pixelformat);
> +
> +	switch (pix_format->pixelformat) {
> +	case V4L2_PIX_FMT_NV12_16L16:
> +		pix_format->bytesperline = width * 12 / 8;
> +		pix_format->sizeimage = pix_format->bytesperline * 
height;
> +		break;
> +	case V4L2_PIX_FMT_JPEG:
> +		pix_format->bytesperline = width;
> +		pix_format->sizeimage = pix_format->bytesperline * 
height;
> +		break;
> +	default:
> +		v4l2_fill_pixfmt(pix_format, pix_format->pixelformat,
> +				 width, height);
> +		break;
> +	}
> +
> +	if (pix_format->field == V4L2_FIELD_ANY)
> +		pix_format->field = V4L2_FIELD_NONE;
> +
> +	if (pix_format->pixelformat == V4L2_PIX_FMT_JPEG)
> +		pix_format->colorspace = V4L2_COLORSPACE_JPEG;
> +	else if (info && info->pixel_enc == V4L2_PIXEL_ENC_BAYER)
> +		pix_format->colorspace = V4L2_COLORSPACE_RAW;
> +	else
> +		pix_format->colorspace = V4L2_COLORSPACE_SRGB;
> +
> +	pix_format->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
> +	pix_format->quantization = V4L2_QUANTIZATION_DEFAULT;
> +	pix_format->xfer_func = V4L2_XFER_FUNC_DEFAULT;
> +}
> +
>  static int sun6i_csi_capture_querycap(struct file *file, void *private,
>  				      struct v4l2_capability 
*capability)
>  {
> @@ -864,54 +907,8 @@ static int sun6i_csi_capture_g_fmt(struct file *file,
> void *private, struct v4l2_format *format)
>  {
>  	struct sun6i_csi_device *csi_dev = video_drvdata(file);
> -	struct sun6i_csi_capture *capture = &csi_dev->capture;
> 
> -	*format = capture->format;
> -
> -	return 0;
> -}
> -
> -static int sun6i_csi_capture_format_try(struct sun6i_csi_capture *capture,
> -					struct v4l2_format 
*format)
> -{
> -	struct v4l2_pix_format *pix_format = &format->fmt.pix;
> -	int bpp;
> -
> -	if (!sun6i_csi_capture_format_check(pix_format->pixelformat))
> -		pix_format->pixelformat = sun6i_csi_capture_formats[0];
> -
> -	v4l_bound_align_image(&pix_format->width, MIN_WIDTH, MAX_WIDTH, 1,
> -			      &pix_format->height, MIN_HEIGHT, 
MAX_WIDTH, 1, 1);
> -
> -	bpp = sun6i_csi_get_bpp(pix_format->pixelformat);
> -	pix_format->bytesperline = (pix_format->width * bpp) >> 3;
> -	pix_format->sizeimage = pix_format->bytesperline * pix_format-
>height;
> -
> -	if (pix_format->field == V4L2_FIELD_ANY)
> -		pix_format->field = V4L2_FIELD_NONE;
> -
> -	if (pix_format->pixelformat == V4L2_PIX_FMT_JPEG)
> -		pix_format->colorspace = V4L2_COLORSPACE_JPEG;
> -	else
> -		pix_format->colorspace = V4L2_COLORSPACE_SRGB;
> -
> -	pix_format->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT;
> -	pix_format->quantization = V4L2_QUANTIZATION_DEFAULT;
> -	pix_format->xfer_func = V4L2_XFER_FUNC_DEFAULT;
> -
> -	return 0;
> -}
> -
> -static int sun6i_csi_capture_format_set(struct sun6i_csi_capture *capture,
> -					struct v4l2_format 
*format)
> -{
> -	int ret;
> -
> -	ret = sun6i_csi_capture_format_try(capture, format);
> -	if (ret)
> -		return ret;
> -
> -	capture->format = *format;
> +	*format = csi_dev->capture.format;
> 
>  	return 0;
>  }
> @@ -925,16 +922,19 @@ static int sun6i_csi_capture_s_fmt(struct file *file,
> void *private, if (vb2_is_busy(&capture->queue))
>  		return -EBUSY;
> 
> -	return sun6i_csi_capture_format_set(capture, format);
> +	sun6i_csi_capture_format_prepare(format);
> +
> +	csi_dev->capture.format = *format;
> +
> +	return 0;
>  }
> 
>  static int sun6i_csi_capture_try_fmt(struct file *file, void *private,
>  				     struct v4l2_format *format)
>  {
> -	struct sun6i_csi_device *csi_dev = video_drvdata(file);
> -	struct sun6i_csi_capture *capture = &csi_dev->capture;
> +	sun6i_csi_capture_format_prepare(format);
> 
> -	return sun6i_csi_capture_format_try(capture, format);
> +	return 0;
>  }
> 
>  static int sun6i_csi_capture_enum_input(struct file *file, void *private,
> @@ -1129,8 +1129,8 @@ int sun6i_csi_capture_setup(struct sun6i_csi_device
> *csi_dev) struct video_device *video_dev = &capture->video_dev;
>  	struct vb2_queue *queue = &capture->queue;
>  	struct media_pad *pad = &capture->pad;
> -	struct v4l2_format format = { 0 };
> -	struct v4l2_pix_format *pix_format = &format.fmt.pix;
> +	struct v4l2_format *format = &csi_dev->capture.format;
> +	struct v4l2_pix_format *pix_format = &format->fmt.pix;
>  	int ret;
> 
>  	/* State */
> @@ -1173,13 +1173,13 @@ int sun6i_csi_capture_setup(struct sun6i_csi_device
> *csi_dev)
> 
>  	/* V4L2 Format */
> 
> -	format.type = queue->type;
> +	format->type = queue->type;
>  	pix_format->pixelformat = sun6i_csi_capture_formats[0];
>  	pix_format->width = 1280;
>  	pix_format->height = 720;
>  	pix_format->field = V4L2_FIELD_NONE;
> 
> -	sun6i_csi_capture_format_set(capture, &format);
> +	sun6i_csi_capture_format_prepare(format);
> 
>  	/* Video Device */
> 
> diff --git a/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.h
> b/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.h index
> 935f35b7049a..02bdf45f7ca5 100644
> --- a/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.h
> +++ b/drivers/media/platform/sunxi/sun6i-csi/sun6i_csi_capture.h
> @@ -11,6 +11,11 @@
>  #include <media/v4l2-dev.h>
>  #include <media/videobuf2-core.h>
> 
> +#define SUN6I_CSI_CAPTURE_WIDTH_MIN	32
> +#define SUN6I_CSI_CAPTURE_WIDTH_MAX	4800
> +#define SUN6I_CSI_CAPTURE_HEIGHT_MIN	32
> +#define SUN6I_CSI_CAPTURE_HEIGHT_MAX	4800
> +
>  struct sun6i_csi_device;
> 
>  #undef current