18148baabSPratyush Yadav // SPDX-License-Identifier: GPL-2.0-only
28148baabSPratyush Yadav /*
38148baabSPratyush Yadav * TI Camera Access Layer (CAL) - Video Device
48148baabSPratyush Yadav *
58148baabSPratyush Yadav * Copyright (c) 2015-2020 Texas Instruments Inc.
68148baabSPratyush Yadav *
78148baabSPratyush Yadav * Authors:
88148baabSPratyush Yadav * Benoit Parrot <bparrot@ti.com>
98148baabSPratyush Yadav * Laurent Pinchart <laurent.pinchart@ideasonboard.com>
108148baabSPratyush Yadav */
118148baabSPratyush Yadav
128148baabSPratyush Yadav #include <linux/ioctl.h>
138148baabSPratyush Yadav #include <linux/pm_runtime.h>
148148baabSPratyush Yadav #include <linux/videodev2.h>
158148baabSPratyush Yadav
168148baabSPratyush Yadav #include <media/media-device.h>
178148baabSPratyush Yadav #include <media/v4l2-common.h>
188148baabSPratyush Yadav #include <media/v4l2-ctrls.h>
198148baabSPratyush Yadav #include <media/v4l2-device.h>
208148baabSPratyush Yadav #include <media/v4l2-event.h>
218148baabSPratyush Yadav #include <media/v4l2-fh.h>
228148baabSPratyush Yadav #include <media/v4l2-ioctl.h>
238148baabSPratyush Yadav #include <media/videobuf2-core.h>
248148baabSPratyush Yadav #include <media/videobuf2-dma-contig.h>
258148baabSPratyush Yadav
268148baabSPratyush Yadav #include "cal.h"
278148baabSPratyush Yadav
288148baabSPratyush Yadav /* Print Four-character-code (FOURCC) */
fourcc_to_str(u32 fmt)298148baabSPratyush Yadav static char *fourcc_to_str(u32 fmt)
308148baabSPratyush Yadav {
318148baabSPratyush Yadav static char code[5];
328148baabSPratyush Yadav
338148baabSPratyush Yadav code[0] = (unsigned char)(fmt & 0xff);
348148baabSPratyush Yadav code[1] = (unsigned char)((fmt >> 8) & 0xff);
358148baabSPratyush Yadav code[2] = (unsigned char)((fmt >> 16) & 0xff);
368148baabSPratyush Yadav code[3] = (unsigned char)((fmt >> 24) & 0xff);
378148baabSPratyush Yadav code[4] = '\0';
388148baabSPratyush Yadav
398148baabSPratyush Yadav return code;
408148baabSPratyush Yadav }
418148baabSPratyush Yadav
428148baabSPratyush Yadav /* ------------------------------------------------------------------
438148baabSPratyush Yadav * V4L2 Common IOCTLs
448148baabSPratyush Yadav * ------------------------------------------------------------------
458148baabSPratyush Yadav */
468148baabSPratyush Yadav
cal_querycap(struct file * file,void * priv,struct v4l2_capability * cap)478148baabSPratyush Yadav static int cal_querycap(struct file *file, void *priv,
488148baabSPratyush Yadav struct v4l2_capability *cap)
498148baabSPratyush Yadav {
508148baabSPratyush Yadav strscpy(cap->driver, CAL_MODULE_NAME, sizeof(cap->driver));
518148baabSPratyush Yadav strscpy(cap->card, CAL_MODULE_NAME, sizeof(cap->card));
528148baabSPratyush Yadav
538148baabSPratyush Yadav return 0;
548148baabSPratyush Yadav }
558148baabSPratyush Yadav
cal_g_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)568148baabSPratyush Yadav static int cal_g_fmt_vid_cap(struct file *file, void *priv,
578148baabSPratyush Yadav struct v4l2_format *f)
588148baabSPratyush Yadav {
598148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
608148baabSPratyush Yadav
618148baabSPratyush Yadav *f = ctx->v_fmt;
628148baabSPratyush Yadav
638148baabSPratyush Yadav return 0;
648148baabSPratyush Yadav }
658148baabSPratyush Yadav
668148baabSPratyush Yadav /* ------------------------------------------------------------------
678148baabSPratyush Yadav * V4L2 Video Node Centric IOCTLs
688148baabSPratyush Yadav * ------------------------------------------------------------------
698148baabSPratyush Yadav */
708148baabSPratyush Yadav
find_format_by_pix(struct cal_ctx * ctx,u32 pixelformat)718148baabSPratyush Yadav static const struct cal_format_info *find_format_by_pix(struct cal_ctx *ctx,
728148baabSPratyush Yadav u32 pixelformat)
738148baabSPratyush Yadav {
748148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
758148baabSPratyush Yadav unsigned int k;
768148baabSPratyush Yadav
778148baabSPratyush Yadav for (k = 0; k < ctx->num_active_fmt; k++) {
788148baabSPratyush Yadav fmtinfo = ctx->active_fmt[k];
798148baabSPratyush Yadav if (fmtinfo->fourcc == pixelformat)
808148baabSPratyush Yadav return fmtinfo;
818148baabSPratyush Yadav }
828148baabSPratyush Yadav
838148baabSPratyush Yadav return NULL;
848148baabSPratyush Yadav }
858148baabSPratyush Yadav
find_format_by_code(struct cal_ctx * ctx,u32 code)868148baabSPratyush Yadav static const struct cal_format_info *find_format_by_code(struct cal_ctx *ctx,
878148baabSPratyush Yadav u32 code)
888148baabSPratyush Yadav {
898148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
908148baabSPratyush Yadav unsigned int k;
918148baabSPratyush Yadav
928148baabSPratyush Yadav for (k = 0; k < ctx->num_active_fmt; k++) {
938148baabSPratyush Yadav fmtinfo = ctx->active_fmt[k];
948148baabSPratyush Yadav if (fmtinfo->code == code)
958148baabSPratyush Yadav return fmtinfo;
968148baabSPratyush Yadav }
978148baabSPratyush Yadav
988148baabSPratyush Yadav return NULL;
998148baabSPratyush Yadav }
1008148baabSPratyush Yadav
cal_legacy_enum_fmt_vid_cap(struct file * file,void * priv,struct v4l2_fmtdesc * f)1018148baabSPratyush Yadav static int cal_legacy_enum_fmt_vid_cap(struct file *file, void *priv,
1028148baabSPratyush Yadav struct v4l2_fmtdesc *f)
1038148baabSPratyush Yadav {
1048148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
1058148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
1068148baabSPratyush Yadav
1078148baabSPratyush Yadav if (f->index >= ctx->num_active_fmt)
1088148baabSPratyush Yadav return -EINVAL;
1098148baabSPratyush Yadav
1108148baabSPratyush Yadav fmtinfo = ctx->active_fmt[f->index];
1118148baabSPratyush Yadav
1128148baabSPratyush Yadav f->pixelformat = fmtinfo->fourcc;
1138148baabSPratyush Yadav f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1148148baabSPratyush Yadav return 0;
1158148baabSPratyush Yadav }
1168148baabSPratyush Yadav
__subdev_get_format(struct cal_ctx * ctx,struct v4l2_mbus_framefmt * fmt)1178148baabSPratyush Yadav static int __subdev_get_format(struct cal_ctx *ctx,
1188148baabSPratyush Yadav struct v4l2_mbus_framefmt *fmt)
1198148baabSPratyush Yadav {
120ecefa105SLaurent Pinchart struct v4l2_subdev_format sd_fmt = {
121ecefa105SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
122ecefa105SLaurent Pinchart .pad = 0,
123ecefa105SLaurent Pinchart };
1248148baabSPratyush Yadav struct v4l2_mbus_framefmt *mbus_fmt = &sd_fmt.format;
1258148baabSPratyush Yadav int ret;
1268148baabSPratyush Yadav
1278148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, get_fmt, NULL, &sd_fmt);
1288148baabSPratyush Yadav if (ret)
1298148baabSPratyush Yadav return ret;
1308148baabSPratyush Yadav
1318148baabSPratyush Yadav *fmt = *mbus_fmt;
1328148baabSPratyush Yadav
1338148baabSPratyush Yadav ctx_dbg(1, ctx, "%s %dx%d code:%04X\n", __func__,
1348148baabSPratyush Yadav fmt->width, fmt->height, fmt->code);
1358148baabSPratyush Yadav
1368148baabSPratyush Yadav return 0;
1378148baabSPratyush Yadav }
1388148baabSPratyush Yadav
__subdev_set_format(struct cal_ctx * ctx,struct v4l2_mbus_framefmt * fmt)1398148baabSPratyush Yadav static int __subdev_set_format(struct cal_ctx *ctx,
1408148baabSPratyush Yadav struct v4l2_mbus_framefmt *fmt)
1418148baabSPratyush Yadav {
142ecefa105SLaurent Pinchart struct v4l2_subdev_format sd_fmt = {
143ecefa105SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
144ecefa105SLaurent Pinchart .pad = 0,
145ecefa105SLaurent Pinchart };
1468148baabSPratyush Yadav struct v4l2_mbus_framefmt *mbus_fmt = &sd_fmt.format;
1478148baabSPratyush Yadav int ret;
1488148baabSPratyush Yadav
1498148baabSPratyush Yadav *mbus_fmt = *fmt;
1508148baabSPratyush Yadav
1518148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, set_fmt, NULL, &sd_fmt);
1528148baabSPratyush Yadav if (ret)
1538148baabSPratyush Yadav return ret;
1548148baabSPratyush Yadav
1558148baabSPratyush Yadav ctx_dbg(1, ctx, "%s %dx%d code:%04X\n", __func__,
1568148baabSPratyush Yadav fmt->width, fmt->height, fmt->code);
1578148baabSPratyush Yadav
1588148baabSPratyush Yadav return 0;
1598148baabSPratyush Yadav }
1608148baabSPratyush Yadav
cal_calc_format_size(struct cal_ctx * ctx,const struct cal_format_info * fmtinfo,struct v4l2_format * f)1618148baabSPratyush Yadav static void cal_calc_format_size(struct cal_ctx *ctx,
1628148baabSPratyush Yadav const struct cal_format_info *fmtinfo,
1638148baabSPratyush Yadav struct v4l2_format *f)
1648148baabSPratyush Yadav {
1658148baabSPratyush Yadav u32 bpl, max_width;
1668148baabSPratyush Yadav
1678148baabSPratyush Yadav /*
1688148baabSPratyush Yadav * Maximum width is bound by the DMA max width in bytes.
1698148baabSPratyush Yadav * We need to recalculate the actual maxi width depending on the
1708148baabSPratyush Yadav * number of bytes per pixels required.
1718148baabSPratyush Yadav */
1728148baabSPratyush Yadav max_width = CAL_MAX_WIDTH_BYTES / (ALIGN(fmtinfo->bpp, 8) >> 3);
1738148baabSPratyush Yadav v4l_bound_align_image(&f->fmt.pix.width, 48, max_width, 2,
1748148baabSPratyush Yadav &f->fmt.pix.height, 32, CAL_MAX_HEIGHT_LINES,
1758148baabSPratyush Yadav 0, 0);
1768148baabSPratyush Yadav
1778148baabSPratyush Yadav bpl = (f->fmt.pix.width * ALIGN(fmtinfo->bpp, 8)) >> 3;
1788148baabSPratyush Yadav f->fmt.pix.bytesperline = ALIGN(bpl, 16);
1798148baabSPratyush Yadav
1808148baabSPratyush Yadav f->fmt.pix.sizeimage = f->fmt.pix.height *
1818148baabSPratyush Yadav f->fmt.pix.bytesperline;
1828148baabSPratyush Yadav
1838148baabSPratyush Yadav ctx_dbg(3, ctx, "%s: fourcc: %s size: %dx%d bpl:%d img_size:%d\n",
1848148baabSPratyush Yadav __func__, fourcc_to_str(f->fmt.pix.pixelformat),
1858148baabSPratyush Yadav f->fmt.pix.width, f->fmt.pix.height,
1868148baabSPratyush Yadav f->fmt.pix.bytesperline, f->fmt.pix.sizeimage);
1878148baabSPratyush Yadav }
1888148baabSPratyush Yadav
cal_legacy_try_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)1898148baabSPratyush Yadav static int cal_legacy_try_fmt_vid_cap(struct file *file, void *priv,
1908148baabSPratyush Yadav struct v4l2_format *f)
1918148baabSPratyush Yadav {
1928148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
1938148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
194ecefa105SLaurent Pinchart struct v4l2_subdev_frame_size_enum fse = {
195ecefa105SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
196ecefa105SLaurent Pinchart };
1972a50e8d7STomi Valkeinen int found;
1988148baabSPratyush Yadav
1998148baabSPratyush Yadav fmtinfo = find_format_by_pix(ctx, f->fmt.pix.pixelformat);
2008148baabSPratyush Yadav if (!fmtinfo) {
2018148baabSPratyush Yadav ctx_dbg(3, ctx, "Fourcc format (0x%08x) not found.\n",
2028148baabSPratyush Yadav f->fmt.pix.pixelformat);
2038148baabSPratyush Yadav
2048148baabSPratyush Yadav /* Just get the first one enumerated */
2058148baabSPratyush Yadav fmtinfo = ctx->active_fmt[0];
2068148baabSPratyush Yadav f->fmt.pix.pixelformat = fmtinfo->fourcc;
2078148baabSPratyush Yadav }
2088148baabSPratyush Yadav
2098148baabSPratyush Yadav f->fmt.pix.field = ctx->v_fmt.fmt.pix.field;
2108148baabSPratyush Yadav
2118148baabSPratyush Yadav /* check for/find a valid width/height */
2128148baabSPratyush Yadav found = false;
2138148baabSPratyush Yadav fse.pad = 0;
2148148baabSPratyush Yadav fse.code = fmtinfo->code;
2158148baabSPratyush Yadav for (fse.index = 0; ; fse.index++) {
2162a50e8d7STomi Valkeinen int ret;
2172a50e8d7STomi Valkeinen
2188148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, enum_frame_size,
2198148baabSPratyush Yadav NULL, &fse);
2208148baabSPratyush Yadav if (ret)
2218148baabSPratyush Yadav break;
2228148baabSPratyush Yadav
2238148baabSPratyush Yadav if ((f->fmt.pix.width == fse.max_width) &&
2248148baabSPratyush Yadav (f->fmt.pix.height == fse.max_height)) {
2258148baabSPratyush Yadav found = true;
2268148baabSPratyush Yadav break;
2278148baabSPratyush Yadav } else if ((f->fmt.pix.width >= fse.min_width) &&
2288148baabSPratyush Yadav (f->fmt.pix.width <= fse.max_width) &&
2298148baabSPratyush Yadav (f->fmt.pix.height >= fse.min_height) &&
2308148baabSPratyush Yadav (f->fmt.pix.height <= fse.max_height)) {
2318148baabSPratyush Yadav found = true;
2328148baabSPratyush Yadav break;
2338148baabSPratyush Yadav }
2348148baabSPratyush Yadav }
2358148baabSPratyush Yadav
2368148baabSPratyush Yadav if (!found) {
2378148baabSPratyush Yadav /* use existing values as default */
2388148baabSPratyush Yadav f->fmt.pix.width = ctx->v_fmt.fmt.pix.width;
2398148baabSPratyush Yadav f->fmt.pix.height = ctx->v_fmt.fmt.pix.height;
2408148baabSPratyush Yadav }
2418148baabSPratyush Yadav
2428148baabSPratyush Yadav /*
2438148baabSPratyush Yadav * Use current colorspace for now, it will get
2448148baabSPratyush Yadav * updated properly during s_fmt
2458148baabSPratyush Yadav */
2468148baabSPratyush Yadav f->fmt.pix.colorspace = ctx->v_fmt.fmt.pix.colorspace;
2478148baabSPratyush Yadav cal_calc_format_size(ctx, fmtinfo, f);
2488148baabSPratyush Yadav return 0;
2498148baabSPratyush Yadav }
2508148baabSPratyush Yadav
cal_legacy_s_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)2518148baabSPratyush Yadav static int cal_legacy_s_fmt_vid_cap(struct file *file, void *priv,
2528148baabSPratyush Yadav struct v4l2_format *f)
2538148baabSPratyush Yadav {
2548148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
2558148baabSPratyush Yadav struct vb2_queue *q = &ctx->vb_vidq;
2568148baabSPratyush Yadav struct v4l2_subdev_format sd_fmt = {
2578148baabSPratyush Yadav .which = V4L2_SUBDEV_FORMAT_ACTIVE,
2588148baabSPratyush Yadav .pad = CAL_CAMERARX_PAD_SINK,
2598148baabSPratyush Yadav };
2608148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
2618148baabSPratyush Yadav int ret;
2628148baabSPratyush Yadav
2638148baabSPratyush Yadav if (vb2_is_busy(q)) {
2648148baabSPratyush Yadav ctx_dbg(3, ctx, "%s device busy\n", __func__);
2658148baabSPratyush Yadav return -EBUSY;
2668148baabSPratyush Yadav }
2678148baabSPratyush Yadav
2688148baabSPratyush Yadav ret = cal_legacy_try_fmt_vid_cap(file, priv, f);
2698148baabSPratyush Yadav if (ret < 0)
2708148baabSPratyush Yadav return ret;
2718148baabSPratyush Yadav
2728148baabSPratyush Yadav fmtinfo = find_format_by_pix(ctx, f->fmt.pix.pixelformat);
2738148baabSPratyush Yadav
2748148baabSPratyush Yadav v4l2_fill_mbus_format(&sd_fmt.format, &f->fmt.pix, fmtinfo->code);
2758148baabSPratyush Yadav
2768148baabSPratyush Yadav ret = __subdev_set_format(ctx, &sd_fmt.format);
2778148baabSPratyush Yadav if (ret)
2788148baabSPratyush Yadav return ret;
2798148baabSPratyush Yadav
2808148baabSPratyush Yadav /* Just double check nothing has gone wrong */
2818148baabSPratyush Yadav if (sd_fmt.format.code != fmtinfo->code) {
2828148baabSPratyush Yadav ctx_dbg(3, ctx,
2838148baabSPratyush Yadav "%s subdev changed format on us, this should not happen\n",
2848148baabSPratyush Yadav __func__);
2858148baabSPratyush Yadav return -EINVAL;
2868148baabSPratyush Yadav }
2878148baabSPratyush Yadav
2888148baabSPratyush Yadav v4l2_fill_pix_format(&ctx->v_fmt.fmt.pix, &sd_fmt.format);
2898148baabSPratyush Yadav ctx->v_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2908148baabSPratyush Yadav ctx->v_fmt.fmt.pix.pixelformat = fmtinfo->fourcc;
2918148baabSPratyush Yadav ctx->v_fmt.fmt.pix.field = sd_fmt.format.field;
2928148baabSPratyush Yadav cal_calc_format_size(ctx, fmtinfo, &ctx->v_fmt);
2938148baabSPratyush Yadav
2948148baabSPratyush Yadav v4l2_subdev_call(&ctx->phy->subdev, pad, set_fmt, NULL, &sd_fmt);
2958148baabSPratyush Yadav
2968148baabSPratyush Yadav ctx->fmtinfo = fmtinfo;
2978148baabSPratyush Yadav *f = ctx->v_fmt;
2988148baabSPratyush Yadav
2998148baabSPratyush Yadav return 0;
3008148baabSPratyush Yadav }
3018148baabSPratyush Yadav
cal_legacy_enum_framesizes(struct file * file,void * fh,struct v4l2_frmsizeenum * fsize)3028148baabSPratyush Yadav static int cal_legacy_enum_framesizes(struct file *file, void *fh,
3038148baabSPratyush Yadav struct v4l2_frmsizeenum *fsize)
3048148baabSPratyush Yadav {
3058148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
3068148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
307ecefa105SLaurent Pinchart struct v4l2_subdev_frame_size_enum fse = {
308ecefa105SLaurent Pinchart .index = fsize->index,
309ecefa105SLaurent Pinchart .pad = 0,
310ecefa105SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
311ecefa105SLaurent Pinchart };
3128148baabSPratyush Yadav int ret;
3138148baabSPratyush Yadav
3148148baabSPratyush Yadav /* check for valid format */
3158148baabSPratyush Yadav fmtinfo = find_format_by_pix(ctx, fsize->pixel_format);
3168148baabSPratyush Yadav if (!fmtinfo) {
3178148baabSPratyush Yadav ctx_dbg(3, ctx, "Invalid pixel code: %x\n",
3188148baabSPratyush Yadav fsize->pixel_format);
3198148baabSPratyush Yadav return -EINVAL;
3208148baabSPratyush Yadav }
3218148baabSPratyush Yadav
3228148baabSPratyush Yadav fse.code = fmtinfo->code;
3238148baabSPratyush Yadav
3248148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, enum_frame_size, NULL,
3258148baabSPratyush Yadav &fse);
3268148baabSPratyush Yadav if (ret)
3278148baabSPratyush Yadav return ret;
3288148baabSPratyush Yadav
3298148baabSPratyush Yadav ctx_dbg(1, ctx, "%s: index: %d code: %x W:[%d,%d] H:[%d,%d]\n",
3308148baabSPratyush Yadav __func__, fse.index, fse.code, fse.min_width, fse.max_width,
3318148baabSPratyush Yadav fse.min_height, fse.max_height);
3328148baabSPratyush Yadav
3338148baabSPratyush Yadav fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
3348148baabSPratyush Yadav fsize->discrete.width = fse.max_width;
3358148baabSPratyush Yadav fsize->discrete.height = fse.max_height;
3368148baabSPratyush Yadav
3378148baabSPratyush Yadav return 0;
3388148baabSPratyush Yadav }
3398148baabSPratyush Yadav
cal_legacy_enum_input(struct file * file,void * priv,struct v4l2_input * inp)3408148baabSPratyush Yadav static int cal_legacy_enum_input(struct file *file, void *priv,
3418148baabSPratyush Yadav struct v4l2_input *inp)
3428148baabSPratyush Yadav {
3438148baabSPratyush Yadav if (inp->index > 0)
3448148baabSPratyush Yadav return -EINVAL;
3458148baabSPratyush Yadav
3468148baabSPratyush Yadav inp->type = V4L2_INPUT_TYPE_CAMERA;
3478148baabSPratyush Yadav sprintf(inp->name, "Camera %u", inp->index);
3488148baabSPratyush Yadav return 0;
3498148baabSPratyush Yadav }
3508148baabSPratyush Yadav
cal_legacy_g_input(struct file * file,void * priv,unsigned int * i)3518148baabSPratyush Yadav static int cal_legacy_g_input(struct file *file, void *priv, unsigned int *i)
3528148baabSPratyush Yadav {
3538148baabSPratyush Yadav *i = 0;
3548148baabSPratyush Yadav return 0;
3558148baabSPratyush Yadav }
3568148baabSPratyush Yadav
cal_legacy_s_input(struct file * file,void * priv,unsigned int i)3578148baabSPratyush Yadav static int cal_legacy_s_input(struct file *file, void *priv, unsigned int i)
3588148baabSPratyush Yadav {
3598148baabSPratyush Yadav return i > 0 ? -EINVAL : 0;
3608148baabSPratyush Yadav }
3618148baabSPratyush Yadav
3628148baabSPratyush Yadav /* timeperframe is arbitrary and continuous */
cal_legacy_enum_frameintervals(struct file * file,void * priv,struct v4l2_frmivalenum * fival)3638148baabSPratyush Yadav static int cal_legacy_enum_frameintervals(struct file *file, void *priv,
3648148baabSPratyush Yadav struct v4l2_frmivalenum *fival)
3658148baabSPratyush Yadav {
3668148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
3678148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
3688148baabSPratyush Yadav struct v4l2_subdev_frame_interval_enum fie = {
3698148baabSPratyush Yadav .index = fival->index,
3708148baabSPratyush Yadav .width = fival->width,
3718148baabSPratyush Yadav .height = fival->height,
3728148baabSPratyush Yadav .which = V4L2_SUBDEV_FORMAT_ACTIVE,
3738148baabSPratyush Yadav };
3748148baabSPratyush Yadav int ret;
3758148baabSPratyush Yadav
3768148baabSPratyush Yadav fmtinfo = find_format_by_pix(ctx, fival->pixel_format);
3778148baabSPratyush Yadav if (!fmtinfo)
3788148baabSPratyush Yadav return -EINVAL;
3798148baabSPratyush Yadav
3808148baabSPratyush Yadav fie.code = fmtinfo->code;
3818148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, enum_frame_interval,
3828148baabSPratyush Yadav NULL, &fie);
3838148baabSPratyush Yadav if (ret)
3848148baabSPratyush Yadav return ret;
3858148baabSPratyush Yadav fival->type = V4L2_FRMIVAL_TYPE_DISCRETE;
3868148baabSPratyush Yadav fival->discrete = fie.interval;
3878148baabSPratyush Yadav
3888148baabSPratyush Yadav return 0;
3898148baabSPratyush Yadav }
3908148baabSPratyush Yadav
cal_legacy_g_parm(struct file * file,void * fh,struct v4l2_streamparm * a)3918148baabSPratyush Yadav static int cal_legacy_g_parm(struct file *file, void *fh, struct v4l2_streamparm *a)
3928148baabSPratyush Yadav {
3938148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
3948148baabSPratyush Yadav
3958148baabSPratyush Yadav return v4l2_g_parm_cap(video_devdata(file), ctx->phy->source, a);
3968148baabSPratyush Yadav }
3978148baabSPratyush Yadav
cal_legacy_s_parm(struct file * file,void * fh,struct v4l2_streamparm * a)3988148baabSPratyush Yadav static int cal_legacy_s_parm(struct file *file, void *fh, struct v4l2_streamparm *a)
3998148baabSPratyush Yadav {
4008148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
4018148baabSPratyush Yadav
4028148baabSPratyush Yadav return v4l2_s_parm_cap(video_devdata(file), ctx->phy->source, a);
4038148baabSPratyush Yadav }
4048148baabSPratyush Yadav
4058148baabSPratyush Yadav static const struct v4l2_ioctl_ops cal_ioctl_legacy_ops = {
4068148baabSPratyush Yadav .vidioc_querycap = cal_querycap,
4078148baabSPratyush Yadav .vidioc_enum_fmt_vid_cap = cal_legacy_enum_fmt_vid_cap,
4088148baabSPratyush Yadav .vidioc_g_fmt_vid_cap = cal_g_fmt_vid_cap,
4098148baabSPratyush Yadav .vidioc_try_fmt_vid_cap = cal_legacy_try_fmt_vid_cap,
4108148baabSPratyush Yadav .vidioc_s_fmt_vid_cap = cal_legacy_s_fmt_vid_cap,
4118148baabSPratyush Yadav .vidioc_enum_framesizes = cal_legacy_enum_framesizes,
4128148baabSPratyush Yadav .vidioc_reqbufs = vb2_ioctl_reqbufs,
4138148baabSPratyush Yadav .vidioc_create_bufs = vb2_ioctl_create_bufs,
4148148baabSPratyush Yadav .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
4158148baabSPratyush Yadav .vidioc_querybuf = vb2_ioctl_querybuf,
4168148baabSPratyush Yadav .vidioc_qbuf = vb2_ioctl_qbuf,
4178148baabSPratyush Yadav .vidioc_dqbuf = vb2_ioctl_dqbuf,
4188148baabSPratyush Yadav .vidioc_expbuf = vb2_ioctl_expbuf,
4198148baabSPratyush Yadav .vidioc_enum_input = cal_legacy_enum_input,
4208148baabSPratyush Yadav .vidioc_g_input = cal_legacy_g_input,
4218148baabSPratyush Yadav .vidioc_s_input = cal_legacy_s_input,
4228148baabSPratyush Yadav .vidioc_enum_frameintervals = cal_legacy_enum_frameintervals,
4238148baabSPratyush Yadav .vidioc_streamon = vb2_ioctl_streamon,
4248148baabSPratyush Yadav .vidioc_streamoff = vb2_ioctl_streamoff,
4258148baabSPratyush Yadav .vidioc_log_status = v4l2_ctrl_log_status,
4268148baabSPratyush Yadav .vidioc_subscribe_event = v4l2_ctrl_subscribe_event,
4278148baabSPratyush Yadav .vidioc_unsubscribe_event = v4l2_event_unsubscribe,
4288148baabSPratyush Yadav .vidioc_g_parm = cal_legacy_g_parm,
4298148baabSPratyush Yadav .vidioc_s_parm = cal_legacy_s_parm,
4308148baabSPratyush Yadav };
4318148baabSPratyush Yadav
4328148baabSPratyush Yadav /* ------------------------------------------------------------------
4338148baabSPratyush Yadav * V4L2 Media Controller Centric IOCTLs
4348148baabSPratyush Yadav * ------------------------------------------------------------------
4358148baabSPratyush Yadav */
4368148baabSPratyush Yadav
cal_mc_enum_fmt_vid_cap(struct file * file,void * priv,struct v4l2_fmtdesc * f)4378148baabSPratyush Yadav static int cal_mc_enum_fmt_vid_cap(struct file *file, void *priv,
4388148baabSPratyush Yadav struct v4l2_fmtdesc *f)
4398148baabSPratyush Yadav {
4408148baabSPratyush Yadav unsigned int i;
4418148baabSPratyush Yadav unsigned int idx;
4428148baabSPratyush Yadav
4438148baabSPratyush Yadav if (f->index >= cal_num_formats)
4448148baabSPratyush Yadav return -EINVAL;
4458148baabSPratyush Yadav
4468148baabSPratyush Yadav idx = 0;
4478148baabSPratyush Yadav
4488148baabSPratyush Yadav for (i = 0; i < cal_num_formats; ++i) {
4498148baabSPratyush Yadav if (f->mbus_code && cal_formats[i].code != f->mbus_code)
4508148baabSPratyush Yadav continue;
4518148baabSPratyush Yadav
4528148baabSPratyush Yadav if (idx == f->index) {
4538148baabSPratyush Yadav f->pixelformat = cal_formats[i].fourcc;
4548148baabSPratyush Yadav f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
4558148baabSPratyush Yadav return 0;
4568148baabSPratyush Yadav }
4578148baabSPratyush Yadav
4588148baabSPratyush Yadav idx++;
4598148baabSPratyush Yadav }
4608148baabSPratyush Yadav
4618148baabSPratyush Yadav return -EINVAL;
4628148baabSPratyush Yadav }
4638148baabSPratyush Yadav
cal_mc_try_fmt(struct cal_ctx * ctx,struct v4l2_format * f,const struct cal_format_info ** info)4648148baabSPratyush Yadav static void cal_mc_try_fmt(struct cal_ctx *ctx, struct v4l2_format *f,
4658148baabSPratyush Yadav const struct cal_format_info **info)
4668148baabSPratyush Yadav {
4678148baabSPratyush Yadav struct v4l2_pix_format *format = &f->fmt.pix;
4688148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
4698148baabSPratyush Yadav unsigned int bpp;
4708148baabSPratyush Yadav
4718148baabSPratyush Yadav /*
4728148baabSPratyush Yadav * Default to the first format if the requested pixel format code isn't
4738148baabSPratyush Yadav * supported.
4748148baabSPratyush Yadav */
4758148baabSPratyush Yadav fmtinfo = cal_format_by_fourcc(f->fmt.pix.pixelformat);
4768148baabSPratyush Yadav if (!fmtinfo)
4778148baabSPratyush Yadav fmtinfo = &cal_formats[0];
4788148baabSPratyush Yadav
4798148baabSPratyush Yadav /*
4808148baabSPratyush Yadav * Clamp the size, update the pixel format. The field and colorspace are
4818148baabSPratyush Yadav * accepted as-is, except for V4L2_FIELD_ANY that is turned into
4828148baabSPratyush Yadav * V4L2_FIELD_NONE.
4838148baabSPratyush Yadav */
4848148baabSPratyush Yadav bpp = ALIGN(fmtinfo->bpp, 8);
4858148baabSPratyush Yadav
4868148baabSPratyush Yadav format->width = clamp_t(unsigned int, format->width,
4878148baabSPratyush Yadav CAL_MIN_WIDTH_BYTES * 8 / bpp,
4888148baabSPratyush Yadav CAL_MAX_WIDTH_BYTES * 8 / bpp);
4898148baabSPratyush Yadav format->height = clamp_t(unsigned int, format->height,
4908148baabSPratyush Yadav CAL_MIN_HEIGHT_LINES, CAL_MAX_HEIGHT_LINES);
4918148baabSPratyush Yadav format->pixelformat = fmtinfo->fourcc;
4928148baabSPratyush Yadav
4938148baabSPratyush Yadav if (format->field == V4L2_FIELD_ANY)
4948148baabSPratyush Yadav format->field = V4L2_FIELD_NONE;
4958148baabSPratyush Yadav
4968148baabSPratyush Yadav /*
4978148baabSPratyush Yadav * Calculate the number of bytes per line and the image size. The
4988148baabSPratyush Yadav * hardware stores the stride as a number of 16 bytes words, in a
4998148baabSPratyush Yadav * signed 15-bit value. Only 14 bits are thus usable.
5008148baabSPratyush Yadav */
5018148baabSPratyush Yadav format->bytesperline = ALIGN(clamp(format->bytesperline,
5028148baabSPratyush Yadav format->width * bpp / 8,
5038148baabSPratyush Yadav ((1U << 14) - 1) * 16), 16);
5048148baabSPratyush Yadav
5058148baabSPratyush Yadav format->sizeimage = format->height * format->bytesperline;
5068148baabSPratyush Yadav
5078148baabSPratyush Yadav format->colorspace = ctx->v_fmt.fmt.pix.colorspace;
5088148baabSPratyush Yadav
5098148baabSPratyush Yadav if (info)
5108148baabSPratyush Yadav *info = fmtinfo;
5118148baabSPratyush Yadav
5128148baabSPratyush Yadav ctx_dbg(3, ctx, "%s: %s %ux%u (bytesperline %u sizeimage %u)\n",
5138148baabSPratyush Yadav __func__, fourcc_to_str(format->pixelformat),
5148148baabSPratyush Yadav format->width, format->height,
5158148baabSPratyush Yadav format->bytesperline, format->sizeimage);
5168148baabSPratyush Yadav }
5178148baabSPratyush Yadav
cal_mc_try_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)5188148baabSPratyush Yadav static int cal_mc_try_fmt_vid_cap(struct file *file, void *priv,
5198148baabSPratyush Yadav struct v4l2_format *f)
5208148baabSPratyush Yadav {
5218148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
5228148baabSPratyush Yadav
5238148baabSPratyush Yadav cal_mc_try_fmt(ctx, f, NULL);
5248148baabSPratyush Yadav return 0;
5258148baabSPratyush Yadav }
5268148baabSPratyush Yadav
cal_mc_s_fmt_vid_cap(struct file * file,void * priv,struct v4l2_format * f)5278148baabSPratyush Yadav static int cal_mc_s_fmt_vid_cap(struct file *file, void *priv,
5288148baabSPratyush Yadav struct v4l2_format *f)
5298148baabSPratyush Yadav {
5308148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
5318148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
5328148baabSPratyush Yadav
5338148baabSPratyush Yadav if (vb2_is_busy(&ctx->vb_vidq)) {
5348148baabSPratyush Yadav ctx_dbg(3, ctx, "%s device busy\n", __func__);
5358148baabSPratyush Yadav return -EBUSY;
5368148baabSPratyush Yadav }
5378148baabSPratyush Yadav
5388148baabSPratyush Yadav cal_mc_try_fmt(ctx, f, &fmtinfo);
5398148baabSPratyush Yadav
5408148baabSPratyush Yadav ctx->v_fmt = *f;
5418148baabSPratyush Yadav ctx->fmtinfo = fmtinfo;
5428148baabSPratyush Yadav
5438148baabSPratyush Yadav return 0;
5448148baabSPratyush Yadav }
5458148baabSPratyush Yadav
cal_mc_enum_framesizes(struct file * file,void * fh,struct v4l2_frmsizeenum * fsize)5468148baabSPratyush Yadav static int cal_mc_enum_framesizes(struct file *file, void *fh,
5478148baabSPratyush Yadav struct v4l2_frmsizeenum *fsize)
5488148baabSPratyush Yadav {
5498148baabSPratyush Yadav struct cal_ctx *ctx = video_drvdata(file);
5508148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
5518148baabSPratyush Yadav unsigned int bpp;
5528148baabSPratyush Yadav
5538148baabSPratyush Yadav if (fsize->index > 0)
5548148baabSPratyush Yadav return -EINVAL;
5558148baabSPratyush Yadav
5568148baabSPratyush Yadav fmtinfo = cal_format_by_fourcc(fsize->pixel_format);
5578148baabSPratyush Yadav if (!fmtinfo) {
5588148baabSPratyush Yadav ctx_dbg(3, ctx, "Invalid pixel format 0x%08x\n",
5598148baabSPratyush Yadav fsize->pixel_format);
5608148baabSPratyush Yadav return -EINVAL;
5618148baabSPratyush Yadav }
5628148baabSPratyush Yadav
5638148baabSPratyush Yadav bpp = ALIGN(fmtinfo->bpp, 8);
5648148baabSPratyush Yadav
5658148baabSPratyush Yadav fsize->type = V4L2_FRMSIZE_TYPE_STEPWISE;
5668148baabSPratyush Yadav fsize->stepwise.min_width = CAL_MIN_WIDTH_BYTES * 8 / bpp;
5678148baabSPratyush Yadav fsize->stepwise.max_width = CAL_MAX_WIDTH_BYTES * 8 / bpp;
5688148baabSPratyush Yadav fsize->stepwise.step_width = 64 / bpp;
5698148baabSPratyush Yadav fsize->stepwise.min_height = CAL_MIN_HEIGHT_LINES;
5708148baabSPratyush Yadav fsize->stepwise.max_height = CAL_MAX_HEIGHT_LINES;
5718148baabSPratyush Yadav fsize->stepwise.step_height = 1;
5728148baabSPratyush Yadav
5738148baabSPratyush Yadav return 0;
5748148baabSPratyush Yadav }
5758148baabSPratyush Yadav
5768148baabSPratyush Yadav static const struct v4l2_ioctl_ops cal_ioctl_mc_ops = {
5778148baabSPratyush Yadav .vidioc_querycap = cal_querycap,
5788148baabSPratyush Yadav .vidioc_enum_fmt_vid_cap = cal_mc_enum_fmt_vid_cap,
5798148baabSPratyush Yadav .vidioc_g_fmt_vid_cap = cal_g_fmt_vid_cap,
5808148baabSPratyush Yadav .vidioc_try_fmt_vid_cap = cal_mc_try_fmt_vid_cap,
5818148baabSPratyush Yadav .vidioc_s_fmt_vid_cap = cal_mc_s_fmt_vid_cap,
5828148baabSPratyush Yadav .vidioc_enum_framesizes = cal_mc_enum_framesizes,
5838148baabSPratyush Yadav .vidioc_reqbufs = vb2_ioctl_reqbufs,
5848148baabSPratyush Yadav .vidioc_create_bufs = vb2_ioctl_create_bufs,
5858148baabSPratyush Yadav .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
5868148baabSPratyush Yadav .vidioc_querybuf = vb2_ioctl_querybuf,
5878148baabSPratyush Yadav .vidioc_qbuf = vb2_ioctl_qbuf,
5888148baabSPratyush Yadav .vidioc_dqbuf = vb2_ioctl_dqbuf,
5898148baabSPratyush Yadav .vidioc_expbuf = vb2_ioctl_expbuf,
5908148baabSPratyush Yadav .vidioc_streamon = vb2_ioctl_streamon,
5918148baabSPratyush Yadav .vidioc_streamoff = vb2_ioctl_streamoff,
5928148baabSPratyush Yadav .vidioc_log_status = v4l2_ctrl_log_status,
5938148baabSPratyush Yadav };
5948148baabSPratyush Yadav
5958148baabSPratyush Yadav /* ------------------------------------------------------------------
5968148baabSPratyush Yadav * videobuf2 Common Operations
5978148baabSPratyush Yadav * ------------------------------------------------------------------
5988148baabSPratyush Yadav */
5998148baabSPratyush Yadav
cal_queue_setup(struct vb2_queue * vq,unsigned int * nbuffers,unsigned int * nplanes,unsigned int sizes[],struct device * alloc_devs[])6008148baabSPratyush Yadav static int cal_queue_setup(struct vb2_queue *vq,
6018148baabSPratyush Yadav unsigned int *nbuffers, unsigned int *nplanes,
6028148baabSPratyush Yadav unsigned int sizes[], struct device *alloc_devs[])
6038148baabSPratyush Yadav {
6048148baabSPratyush Yadav struct cal_ctx *ctx = vb2_get_drv_priv(vq);
6058148baabSPratyush Yadav unsigned int size = ctx->v_fmt.fmt.pix.sizeimage;
6068148baabSPratyush Yadav
6078148baabSPratyush Yadav if (vq->num_buffers + *nbuffers < 3)
6088148baabSPratyush Yadav *nbuffers = 3 - vq->num_buffers;
6098148baabSPratyush Yadav
6108148baabSPratyush Yadav if (*nplanes) {
6118148baabSPratyush Yadav if (sizes[0] < size)
6128148baabSPratyush Yadav return -EINVAL;
6138148baabSPratyush Yadav size = sizes[0];
6148148baabSPratyush Yadav }
6158148baabSPratyush Yadav
6168148baabSPratyush Yadav *nplanes = 1;
6178148baabSPratyush Yadav sizes[0] = size;
6188148baabSPratyush Yadav
6198148baabSPratyush Yadav ctx_dbg(3, ctx, "nbuffers=%d, size=%d\n", *nbuffers, sizes[0]);
6208148baabSPratyush Yadav
6218148baabSPratyush Yadav return 0;
6228148baabSPratyush Yadav }
6238148baabSPratyush Yadav
cal_buffer_prepare(struct vb2_buffer * vb)6248148baabSPratyush Yadav static int cal_buffer_prepare(struct vb2_buffer *vb)
6258148baabSPratyush Yadav {
6268148baabSPratyush Yadav struct cal_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
6278148baabSPratyush Yadav struct cal_buffer *buf = container_of(vb, struct cal_buffer,
6288148baabSPratyush Yadav vb.vb2_buf);
6298148baabSPratyush Yadav unsigned long size;
6308148baabSPratyush Yadav
6318148baabSPratyush Yadav size = ctx->v_fmt.fmt.pix.sizeimage;
6328148baabSPratyush Yadav if (vb2_plane_size(vb, 0) < size) {
6338148baabSPratyush Yadav ctx_err(ctx,
6348148baabSPratyush Yadav "data will not fit into plane (%lu < %lu)\n",
6358148baabSPratyush Yadav vb2_plane_size(vb, 0), size);
6368148baabSPratyush Yadav return -EINVAL;
6378148baabSPratyush Yadav }
6388148baabSPratyush Yadav
6398148baabSPratyush Yadav vb2_set_plane_payload(&buf->vb.vb2_buf, 0, size);
6408148baabSPratyush Yadav return 0;
6418148baabSPratyush Yadav }
6428148baabSPratyush Yadav
cal_buffer_queue(struct vb2_buffer * vb)6438148baabSPratyush Yadav static void cal_buffer_queue(struct vb2_buffer *vb)
6448148baabSPratyush Yadav {
6458148baabSPratyush Yadav struct cal_ctx *ctx = vb2_get_drv_priv(vb->vb2_queue);
6468148baabSPratyush Yadav struct cal_buffer *buf = container_of(vb, struct cal_buffer,
6478148baabSPratyush Yadav vb.vb2_buf);
6488148baabSPratyush Yadav unsigned long flags;
6498148baabSPratyush Yadav
6508148baabSPratyush Yadav /* recheck locking */
6518148baabSPratyush Yadav spin_lock_irqsave(&ctx->dma.lock, flags);
6528148baabSPratyush Yadav list_add_tail(&buf->list, &ctx->dma.queue);
6538148baabSPratyush Yadav spin_unlock_irqrestore(&ctx->dma.lock, flags);
6548148baabSPratyush Yadav }
6558148baabSPratyush Yadav
cal_release_buffers(struct cal_ctx * ctx,enum vb2_buffer_state state)6568148baabSPratyush Yadav static void cal_release_buffers(struct cal_ctx *ctx,
6578148baabSPratyush Yadav enum vb2_buffer_state state)
6588148baabSPratyush Yadav {
6598148baabSPratyush Yadav struct cal_buffer *buf, *tmp;
6608148baabSPratyush Yadav
6618148baabSPratyush Yadav /* Release all queued buffers. */
6628148baabSPratyush Yadav spin_lock_irq(&ctx->dma.lock);
6638148baabSPratyush Yadav
6648148baabSPratyush Yadav list_for_each_entry_safe(buf, tmp, &ctx->dma.queue, list) {
6658148baabSPratyush Yadav list_del(&buf->list);
6668148baabSPratyush Yadav vb2_buffer_done(&buf->vb.vb2_buf, state);
6678148baabSPratyush Yadav }
6688148baabSPratyush Yadav
6698148baabSPratyush Yadav if (ctx->dma.pending) {
6708148baabSPratyush Yadav vb2_buffer_done(&ctx->dma.pending->vb.vb2_buf, state);
6718148baabSPratyush Yadav ctx->dma.pending = NULL;
6728148baabSPratyush Yadav }
6738148baabSPratyush Yadav
6748148baabSPratyush Yadav if (ctx->dma.active) {
6758148baabSPratyush Yadav vb2_buffer_done(&ctx->dma.active->vb.vb2_buf, state);
6768148baabSPratyush Yadav ctx->dma.active = NULL;
6778148baabSPratyush Yadav }
6788148baabSPratyush Yadav
6798148baabSPratyush Yadav spin_unlock_irq(&ctx->dma.lock);
6808148baabSPratyush Yadav }
6818148baabSPratyush Yadav
6828148baabSPratyush Yadav /* ------------------------------------------------------------------
6838148baabSPratyush Yadav * videobuf2 Operations
6848148baabSPratyush Yadav * ------------------------------------------------------------------
6858148baabSPratyush Yadav */
6868148baabSPratyush Yadav
cal_video_check_format(struct cal_ctx * ctx)6878148baabSPratyush Yadav static int cal_video_check_format(struct cal_ctx *ctx)
6888148baabSPratyush Yadav {
6898148baabSPratyush Yadav const struct v4l2_mbus_framefmt *format;
690*e7bbe653STomi Valkeinen struct v4l2_subdev_state *state;
6918148baabSPratyush Yadav struct media_pad *remote_pad;
692*e7bbe653STomi Valkeinen int ret = 0;
6938148baabSPratyush Yadav
694b2e44430SLaurent Pinchart remote_pad = media_pad_remote_pad_first(&ctx->pad);
6958148baabSPratyush Yadav if (!remote_pad)
6968148baabSPratyush Yadav return -ENODEV;
6978148baabSPratyush Yadav
698*e7bbe653STomi Valkeinen state = v4l2_subdev_lock_and_get_active_state(&ctx->phy->subdev);
699*e7bbe653STomi Valkeinen
700*e7bbe653STomi Valkeinen format = v4l2_subdev_get_pad_format(&ctx->phy->subdev, state, remote_pad->index);
701*e7bbe653STomi Valkeinen if (!format) {
702*e7bbe653STomi Valkeinen ret = -EINVAL;
703*e7bbe653STomi Valkeinen goto out;
704*e7bbe653STomi Valkeinen }
7058148baabSPratyush Yadav
7068148baabSPratyush Yadav if (ctx->fmtinfo->code != format->code ||
7078148baabSPratyush Yadav ctx->v_fmt.fmt.pix.height != format->height ||
7088148baabSPratyush Yadav ctx->v_fmt.fmt.pix.width != format->width ||
709*e7bbe653STomi Valkeinen ctx->v_fmt.fmt.pix.field != format->field) {
710*e7bbe653STomi Valkeinen ret = -EPIPE;
711*e7bbe653STomi Valkeinen goto out;
712*e7bbe653STomi Valkeinen }
7138148baabSPratyush Yadav
714*e7bbe653STomi Valkeinen out:
715*e7bbe653STomi Valkeinen v4l2_subdev_unlock_state(state);
716*e7bbe653STomi Valkeinen
717*e7bbe653STomi Valkeinen return ret;
7188148baabSPratyush Yadav }
7198148baabSPratyush Yadav
cal_start_streaming(struct vb2_queue * vq,unsigned int count)7208148baabSPratyush Yadav static int cal_start_streaming(struct vb2_queue *vq, unsigned int count)
7218148baabSPratyush Yadav {
7228148baabSPratyush Yadav struct cal_ctx *ctx = vb2_get_drv_priv(vq);
7238148baabSPratyush Yadav struct cal_buffer *buf;
7248148baabSPratyush Yadav dma_addr_t addr;
7258148baabSPratyush Yadav int ret;
7268148baabSPratyush Yadav
7276eaff06aSTomi Valkeinen ret = video_device_pipeline_alloc_start(&ctx->vdev);
7288148baabSPratyush Yadav if (ret < 0) {
7298148baabSPratyush Yadav ctx_err(ctx, "Failed to start media pipeline: %d\n", ret);
7308148baabSPratyush Yadav goto error_release_buffers;
7318148baabSPratyush Yadav }
7328148baabSPratyush Yadav
7338148baabSPratyush Yadav /*
7348148baabSPratyush Yadav * Verify that the currently configured format matches the output of
7358148baabSPratyush Yadav * the connected CAMERARX.
7368148baabSPratyush Yadav */
7378148baabSPratyush Yadav ret = cal_video_check_format(ctx);
7388148baabSPratyush Yadav if (ret < 0) {
7398148baabSPratyush Yadav ctx_dbg(3, ctx,
7408148baabSPratyush Yadav "Format mismatch between CAMERARX and video node\n");
7418148baabSPratyush Yadav goto error_pipeline;
7428148baabSPratyush Yadav }
7438148baabSPratyush Yadav
7448148baabSPratyush Yadav ret = cal_ctx_prepare(ctx);
7458148baabSPratyush Yadav if (ret) {
7468148baabSPratyush Yadav ctx_err(ctx, "Failed to prepare context: %d\n", ret);
7478148baabSPratyush Yadav goto error_pipeline;
7488148baabSPratyush Yadav }
7498148baabSPratyush Yadav
7508148baabSPratyush Yadav spin_lock_irq(&ctx->dma.lock);
7518148baabSPratyush Yadav buf = list_first_entry(&ctx->dma.queue, struct cal_buffer, list);
7528148baabSPratyush Yadav ctx->dma.active = buf;
7538148baabSPratyush Yadav list_del(&buf->list);
7548148baabSPratyush Yadav spin_unlock_irq(&ctx->dma.lock);
7558148baabSPratyush Yadav
7568148baabSPratyush Yadav addr = vb2_dma_contig_plane_dma_addr(&buf->vb.vb2_buf, 0);
7578148baabSPratyush Yadav
7588148baabSPratyush Yadav ret = pm_runtime_resume_and_get(ctx->cal->dev);
7598148baabSPratyush Yadav if (ret < 0)
7608148baabSPratyush Yadav goto error_pipeline;
7618148baabSPratyush Yadav
7628148baabSPratyush Yadav cal_ctx_set_dma_addr(ctx, addr);
7638148baabSPratyush Yadav cal_ctx_start(ctx);
7648148baabSPratyush Yadav
7658148baabSPratyush Yadav ret = v4l2_subdev_call(&ctx->phy->subdev, video, s_stream, 1);
7668148baabSPratyush Yadav if (ret)
7678148baabSPratyush Yadav goto error_stop;
7688148baabSPratyush Yadav
7698148baabSPratyush Yadav if (cal_debug >= 4)
7708148baabSPratyush Yadav cal_quickdump_regs(ctx->cal);
7718148baabSPratyush Yadav
7728148baabSPratyush Yadav return 0;
7738148baabSPratyush Yadav
7748148baabSPratyush Yadav error_stop:
7758148baabSPratyush Yadav cal_ctx_stop(ctx);
7768148baabSPratyush Yadav pm_runtime_put_sync(ctx->cal->dev);
7778148baabSPratyush Yadav cal_ctx_unprepare(ctx);
7788148baabSPratyush Yadav
7798148baabSPratyush Yadav error_pipeline:
78012cecbf9STomi Valkeinen video_device_pipeline_stop(&ctx->vdev);
7818148baabSPratyush Yadav error_release_buffers:
7828148baabSPratyush Yadav cal_release_buffers(ctx, VB2_BUF_STATE_QUEUED);
7838148baabSPratyush Yadav
7848148baabSPratyush Yadav return ret;
7858148baabSPratyush Yadav }
7868148baabSPratyush Yadav
cal_stop_streaming(struct vb2_queue * vq)7878148baabSPratyush Yadav static void cal_stop_streaming(struct vb2_queue *vq)
7888148baabSPratyush Yadav {
7898148baabSPratyush Yadav struct cal_ctx *ctx = vb2_get_drv_priv(vq);
7908148baabSPratyush Yadav
7918148baabSPratyush Yadav cal_ctx_stop(ctx);
7928148baabSPratyush Yadav
7938148baabSPratyush Yadav v4l2_subdev_call(&ctx->phy->subdev, video, s_stream, 0);
7948148baabSPratyush Yadav
7958148baabSPratyush Yadav pm_runtime_put_sync(ctx->cal->dev);
7968148baabSPratyush Yadav
7978148baabSPratyush Yadav cal_ctx_unprepare(ctx);
7988148baabSPratyush Yadav
7998148baabSPratyush Yadav cal_release_buffers(ctx, VB2_BUF_STATE_ERROR);
8008148baabSPratyush Yadav
80112cecbf9STomi Valkeinen video_device_pipeline_stop(&ctx->vdev);
8028148baabSPratyush Yadav }
8038148baabSPratyush Yadav
8048148baabSPratyush Yadav static const struct vb2_ops cal_video_qops = {
8058148baabSPratyush Yadav .queue_setup = cal_queue_setup,
8068148baabSPratyush Yadav .buf_prepare = cal_buffer_prepare,
8078148baabSPratyush Yadav .buf_queue = cal_buffer_queue,
8088148baabSPratyush Yadav .start_streaming = cal_start_streaming,
8098148baabSPratyush Yadav .stop_streaming = cal_stop_streaming,
8108148baabSPratyush Yadav .wait_prepare = vb2_ops_wait_prepare,
8118148baabSPratyush Yadav .wait_finish = vb2_ops_wait_finish,
8128148baabSPratyush Yadav };
8138148baabSPratyush Yadav
8148148baabSPratyush Yadav /* ------------------------------------------------------------------
8158148baabSPratyush Yadav * V4L2 Initialization and Registration
8168148baabSPratyush Yadav * ------------------------------------------------------------------
8178148baabSPratyush Yadav */
8188148baabSPratyush Yadav
8198148baabSPratyush Yadav static const struct v4l2_file_operations cal_fops = {
8208148baabSPratyush Yadav .owner = THIS_MODULE,
8218148baabSPratyush Yadav .open = v4l2_fh_open,
8228148baabSPratyush Yadav .release = vb2_fop_release,
8238148baabSPratyush Yadav .poll = vb2_fop_poll,
8248148baabSPratyush Yadav .unlocked_ioctl = video_ioctl2, /* V4L2 ioctl handler */
8258148baabSPratyush Yadav .mmap = vb2_fop_mmap,
8268148baabSPratyush Yadav };
8278148baabSPratyush Yadav
cal_ctx_v4l2_init_formats(struct cal_ctx * ctx)8288148baabSPratyush Yadav static int cal_ctx_v4l2_init_formats(struct cal_ctx *ctx)
8298148baabSPratyush Yadav {
8308148baabSPratyush Yadav struct v4l2_mbus_framefmt mbus_fmt;
8318148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
8328148baabSPratyush Yadav unsigned int i, j, k;
8338148baabSPratyush Yadav int ret = 0;
8348148baabSPratyush Yadav
8358148baabSPratyush Yadav /* Enumerate sub device formats and enable all matching local formats */
8368148baabSPratyush Yadav ctx->active_fmt = devm_kcalloc(ctx->cal->dev, cal_num_formats,
8378148baabSPratyush Yadav sizeof(*ctx->active_fmt), GFP_KERNEL);
8388148baabSPratyush Yadav if (!ctx->active_fmt)
8398148baabSPratyush Yadav return -ENOMEM;
8408148baabSPratyush Yadav
8418148baabSPratyush Yadav ctx->num_active_fmt = 0;
8428148baabSPratyush Yadav
8438148baabSPratyush Yadav for (j = 0, i = 0; ; ++j) {
844e3a69496SLaurent Pinchart struct v4l2_subdev_mbus_code_enum mbus_code = {
845e3a69496SLaurent Pinchart .index = j,
846e3a69496SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
847e3a69496SLaurent Pinchart };
8488148baabSPratyush Yadav
8498148baabSPratyush Yadav ret = v4l2_subdev_call(ctx->phy->source, pad, enum_mbus_code,
8508148baabSPratyush Yadav NULL, &mbus_code);
8518148baabSPratyush Yadav if (ret == -EINVAL)
8528148baabSPratyush Yadav break;
8538148baabSPratyush Yadav
8548148baabSPratyush Yadav if (ret) {
8558148baabSPratyush Yadav ctx_err(ctx, "Error enumerating mbus codes in subdev %s: %d\n",
8568148baabSPratyush Yadav ctx->phy->source->name, ret);
8578148baabSPratyush Yadav return ret;
8588148baabSPratyush Yadav }
8598148baabSPratyush Yadav
8608148baabSPratyush Yadav ctx_dbg(2, ctx,
8618148baabSPratyush Yadav "subdev %s: code: %04x idx: %u\n",
8628148baabSPratyush Yadav ctx->phy->source->name, mbus_code.code, j);
8638148baabSPratyush Yadav
8648148baabSPratyush Yadav for (k = 0; k < cal_num_formats; k++) {
8658148baabSPratyush Yadav fmtinfo = &cal_formats[k];
8668148baabSPratyush Yadav
8678148baabSPratyush Yadav if (mbus_code.code == fmtinfo->code) {
8688148baabSPratyush Yadav ctx->active_fmt[i] = fmtinfo;
8698148baabSPratyush Yadav ctx_dbg(2, ctx,
8708148baabSPratyush Yadav "matched fourcc: %s: code: %04x idx: %u\n",
8718148baabSPratyush Yadav fourcc_to_str(fmtinfo->fourcc),
8728148baabSPratyush Yadav fmtinfo->code, i);
8738148baabSPratyush Yadav ctx->num_active_fmt = ++i;
8748148baabSPratyush Yadav }
8758148baabSPratyush Yadav }
8768148baabSPratyush Yadav }
8778148baabSPratyush Yadav
8788148baabSPratyush Yadav if (i == 0) {
8798148baabSPratyush Yadav ctx_err(ctx, "No suitable format reported by subdev %s\n",
8808148baabSPratyush Yadav ctx->phy->source->name);
8818148baabSPratyush Yadav return -EINVAL;
8828148baabSPratyush Yadav }
8838148baabSPratyush Yadav
8848148baabSPratyush Yadav ret = __subdev_get_format(ctx, &mbus_fmt);
8858148baabSPratyush Yadav if (ret)
8868148baabSPratyush Yadav return ret;
8878148baabSPratyush Yadav
8888148baabSPratyush Yadav fmtinfo = find_format_by_code(ctx, mbus_fmt.code);
8898148baabSPratyush Yadav if (!fmtinfo) {
8908148baabSPratyush Yadav ctx_dbg(3, ctx, "mbus code format (0x%08x) not found.\n",
8918148baabSPratyush Yadav mbus_fmt.code);
8928148baabSPratyush Yadav return -EINVAL;
8938148baabSPratyush Yadav }
8948148baabSPratyush Yadav
8958148baabSPratyush Yadav /* Save current format */
8968148baabSPratyush Yadav v4l2_fill_pix_format(&ctx->v_fmt.fmt.pix, &mbus_fmt);
8978148baabSPratyush Yadav ctx->v_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
8988148baabSPratyush Yadav ctx->v_fmt.fmt.pix.pixelformat = fmtinfo->fourcc;
8998148baabSPratyush Yadav cal_calc_format_size(ctx, fmtinfo, &ctx->v_fmt);
9008148baabSPratyush Yadav ctx->fmtinfo = fmtinfo;
9018148baabSPratyush Yadav
9028148baabSPratyush Yadav return 0;
9038148baabSPratyush Yadav }
9048148baabSPratyush Yadav
cal_ctx_v4l2_init_mc_format(struct cal_ctx * ctx)9058148baabSPratyush Yadav static int cal_ctx_v4l2_init_mc_format(struct cal_ctx *ctx)
9068148baabSPratyush Yadav {
9078148baabSPratyush Yadav const struct cal_format_info *fmtinfo;
9088148baabSPratyush Yadav struct v4l2_pix_format *pix_fmt = &ctx->v_fmt.fmt.pix;
9098148baabSPratyush Yadav
910662cf98dSTomi Valkeinen fmtinfo = cal_format_by_code(MEDIA_BUS_FMT_UYVY8_1X16);
9118148baabSPratyush Yadav if (!fmtinfo)
9128148baabSPratyush Yadav return -EINVAL;
9138148baabSPratyush Yadav
9148148baabSPratyush Yadav pix_fmt->width = 640;
9158148baabSPratyush Yadav pix_fmt->height = 480;
9168148baabSPratyush Yadav pix_fmt->field = V4L2_FIELD_NONE;
9178148baabSPratyush Yadav pix_fmt->colorspace = V4L2_COLORSPACE_SRGB;
9188148baabSPratyush Yadav pix_fmt->ycbcr_enc = V4L2_YCBCR_ENC_601;
9198148baabSPratyush Yadav pix_fmt->quantization = V4L2_QUANTIZATION_LIM_RANGE;
9208148baabSPratyush Yadav pix_fmt->xfer_func = V4L2_XFER_FUNC_SRGB;
9218148baabSPratyush Yadav pix_fmt->pixelformat = fmtinfo->fourcc;
9228148baabSPratyush Yadav
9238148baabSPratyush Yadav ctx->v_fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
9248148baabSPratyush Yadav
9258148baabSPratyush Yadav /* Save current format */
9268148baabSPratyush Yadav cal_calc_format_size(ctx, fmtinfo, &ctx->v_fmt);
9278148baabSPratyush Yadav ctx->fmtinfo = fmtinfo;
9288148baabSPratyush Yadav
9298148baabSPratyush Yadav return 0;
9308148baabSPratyush Yadav }
9318148baabSPratyush Yadav
cal_ctx_v4l2_register(struct cal_ctx * ctx)9328148baabSPratyush Yadav int cal_ctx_v4l2_register(struct cal_ctx *ctx)
9338148baabSPratyush Yadav {
9348148baabSPratyush Yadav struct video_device *vfd = &ctx->vdev;
9358148baabSPratyush Yadav int ret;
9368148baabSPratyush Yadav
9378148baabSPratyush Yadav if (!cal_mc_api) {
9388148baabSPratyush Yadav struct v4l2_ctrl_handler *hdl = &ctx->ctrl_handler;
9398148baabSPratyush Yadav
9408148baabSPratyush Yadav ret = cal_ctx_v4l2_init_formats(ctx);
9418148baabSPratyush Yadav if (ret) {
9428148baabSPratyush Yadav ctx_err(ctx, "Failed to init formats: %d\n", ret);
9438148baabSPratyush Yadav return ret;
9448148baabSPratyush Yadav }
9458148baabSPratyush Yadav
9468148baabSPratyush Yadav ret = v4l2_ctrl_add_handler(hdl, ctx->phy->source->ctrl_handler,
9478148baabSPratyush Yadav NULL, true);
9488148baabSPratyush Yadav if (ret < 0) {
9498148baabSPratyush Yadav ctx_err(ctx, "Failed to add source ctrl handler\n");
9508148baabSPratyush Yadav return ret;
9518148baabSPratyush Yadav }
9528148baabSPratyush Yadav } else {
9538148baabSPratyush Yadav ret = cal_ctx_v4l2_init_mc_format(ctx);
9548148baabSPratyush Yadav if (ret) {
9558148baabSPratyush Yadav ctx_err(ctx, "Failed to init format: %d\n", ret);
9568148baabSPratyush Yadav return ret;
9578148baabSPratyush Yadav }
9588148baabSPratyush Yadav }
9598148baabSPratyush Yadav
9608148baabSPratyush Yadav ret = video_register_device(vfd, VFL_TYPE_VIDEO, cal_video_nr);
9618148baabSPratyush Yadav if (ret < 0) {
9628148baabSPratyush Yadav ctx_err(ctx, "Failed to register video device\n");
9638148baabSPratyush Yadav return ret;
9648148baabSPratyush Yadav }
9658148baabSPratyush Yadav
9668148baabSPratyush Yadav ret = media_create_pad_link(&ctx->phy->subdev.entity,
9678148baabSPratyush Yadav CAL_CAMERARX_PAD_FIRST_SOURCE,
9688148baabSPratyush Yadav &vfd->entity, 0,
9698148baabSPratyush Yadav MEDIA_LNK_FL_IMMUTABLE |
9708148baabSPratyush Yadav MEDIA_LNK_FL_ENABLED);
9718148baabSPratyush Yadav if (ret) {
9728148baabSPratyush Yadav ctx_err(ctx, "Failed to create media link for context %u\n",
9738148baabSPratyush Yadav ctx->dma_ctx);
9748148baabSPratyush Yadav video_unregister_device(vfd);
9758148baabSPratyush Yadav return ret;
9768148baabSPratyush Yadav }
9778148baabSPratyush Yadav
9788148baabSPratyush Yadav ctx_info(ctx, "V4L2 device registered as %s\n",
9798148baabSPratyush Yadav video_device_node_name(vfd));
9808148baabSPratyush Yadav
9818148baabSPratyush Yadav return 0;
9828148baabSPratyush Yadav }
9838148baabSPratyush Yadav
cal_ctx_v4l2_unregister(struct cal_ctx * ctx)9848148baabSPratyush Yadav void cal_ctx_v4l2_unregister(struct cal_ctx *ctx)
9858148baabSPratyush Yadav {
9868148baabSPratyush Yadav ctx_dbg(1, ctx, "unregistering %s\n",
9878148baabSPratyush Yadav video_device_node_name(&ctx->vdev));
9888148baabSPratyush Yadav
9898148baabSPratyush Yadav video_unregister_device(&ctx->vdev);
9908148baabSPratyush Yadav }
9918148baabSPratyush Yadav
cal_ctx_v4l2_init(struct cal_ctx * ctx)9928148baabSPratyush Yadav int cal_ctx_v4l2_init(struct cal_ctx *ctx)
9938148baabSPratyush Yadav {
9948148baabSPratyush Yadav struct video_device *vfd = &ctx->vdev;
9958148baabSPratyush Yadav struct vb2_queue *q = &ctx->vb_vidq;
9968148baabSPratyush Yadav int ret;
9978148baabSPratyush Yadav
9988148baabSPratyush Yadav INIT_LIST_HEAD(&ctx->dma.queue);
9998148baabSPratyush Yadav spin_lock_init(&ctx->dma.lock);
10008148baabSPratyush Yadav mutex_init(&ctx->mutex);
10018148baabSPratyush Yadav init_waitqueue_head(&ctx->dma.wait);
10028148baabSPratyush Yadav
10038148baabSPratyush Yadav /* Initialize the vb2 queue. */
10048148baabSPratyush Yadav q->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
10058148baabSPratyush Yadav q->io_modes = VB2_MMAP | VB2_DMABUF;
10068148baabSPratyush Yadav q->drv_priv = ctx;
10078148baabSPratyush Yadav q->buf_struct_size = sizeof(struct cal_buffer);
10088148baabSPratyush Yadav q->ops = &cal_video_qops;
10098148baabSPratyush Yadav q->mem_ops = &vb2_dma_contig_memops;
10108148baabSPratyush Yadav q->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
10118148baabSPratyush Yadav q->lock = &ctx->mutex;
10128148baabSPratyush Yadav q->min_buffers_needed = 3;
10138148baabSPratyush Yadav q->dev = ctx->cal->dev;
10148148baabSPratyush Yadav
10158148baabSPratyush Yadav ret = vb2_queue_init(q);
10168148baabSPratyush Yadav if (ret)
10178148baabSPratyush Yadav return ret;
10188148baabSPratyush Yadav
10198148baabSPratyush Yadav /* Initialize the video device and media entity. */
10208148baabSPratyush Yadav vfd->fops = &cal_fops;
10218148baabSPratyush Yadav vfd->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING
10228148baabSPratyush Yadav | (cal_mc_api ? V4L2_CAP_IO_MC : 0);
10238148baabSPratyush Yadav vfd->v4l2_dev = &ctx->cal->v4l2_dev;
10248148baabSPratyush Yadav vfd->queue = q;
10258148baabSPratyush Yadav snprintf(vfd->name, sizeof(vfd->name), "CAL output %u", ctx->dma_ctx);
10268148baabSPratyush Yadav vfd->release = video_device_release_empty;
10278148baabSPratyush Yadav vfd->ioctl_ops = cal_mc_api ? &cal_ioctl_mc_ops : &cal_ioctl_legacy_ops;
10288148baabSPratyush Yadav vfd->lock = &ctx->mutex;
10298148baabSPratyush Yadav video_set_drvdata(vfd, ctx);
10308148baabSPratyush Yadav
10318148baabSPratyush Yadav ctx->pad.flags = MEDIA_PAD_FL_SINK;
10328148baabSPratyush Yadav ret = media_entity_pads_init(&vfd->entity, 1, &ctx->pad);
10338148baabSPratyush Yadav if (ret < 0)
10348148baabSPratyush Yadav return ret;
10358148baabSPratyush Yadav
10368148baabSPratyush Yadav if (!cal_mc_api) {
10378148baabSPratyush Yadav /* Initialize the control handler. */
10388148baabSPratyush Yadav struct v4l2_ctrl_handler *hdl = &ctx->ctrl_handler;
10398148baabSPratyush Yadav
10408148baabSPratyush Yadav ret = v4l2_ctrl_handler_init(hdl, 11);
10418148baabSPratyush Yadav if (ret < 0) {
10428148baabSPratyush Yadav ctx_err(ctx, "Failed to init ctrl handler\n");
10438148baabSPratyush Yadav goto error;
10448148baabSPratyush Yadav }
10458148baabSPratyush Yadav
10468148baabSPratyush Yadav vfd->ctrl_handler = hdl;
10478148baabSPratyush Yadav }
10488148baabSPratyush Yadav
10498148baabSPratyush Yadav return 0;
10508148baabSPratyush Yadav
10518148baabSPratyush Yadav error:
10528148baabSPratyush Yadav media_entity_cleanup(&vfd->entity);
10538148baabSPratyush Yadav return ret;
10548148baabSPratyush Yadav }
10558148baabSPratyush Yadav
cal_ctx_v4l2_cleanup(struct cal_ctx * ctx)10568148baabSPratyush Yadav void cal_ctx_v4l2_cleanup(struct cal_ctx *ctx)
10578148baabSPratyush Yadav {
10588148baabSPratyush Yadav if (!cal_mc_api)
10598148baabSPratyush Yadav v4l2_ctrl_handler_free(&ctx->ctrl_handler);
10608148baabSPratyush Yadav
10618148baabSPratyush Yadav media_entity_cleanup(&ctx->vdev.entity);
10628148baabSPratyush Yadav }
1063