19f257f50SLaurent Pinchart // SPDX-License-Identifier: GPL-2.0
29f257f50SLaurent Pinchart /*
39f257f50SLaurent Pinchart * V4L2 Capture CSI Subdev for Freescale i.MX6UL/L / i.MX7 SOC
49f257f50SLaurent Pinchart *
59f257f50SLaurent Pinchart * Copyright (c) 2019 Linaro Ltd
69f257f50SLaurent Pinchart *
79f257f50SLaurent Pinchart */
89f257f50SLaurent Pinchart
99f257f50SLaurent Pinchart #include <linux/clk.h>
109f257f50SLaurent Pinchart #include <linux/delay.h>
119f257f50SLaurent Pinchart #include <linux/interrupt.h>
129f257f50SLaurent Pinchart #include <linux/math.h>
139f257f50SLaurent Pinchart #include <linux/mfd/syscon.h>
147c7e33b7SRob Herring #include <linux/minmax.h>
159f257f50SLaurent Pinchart #include <linux/module.h>
169f257f50SLaurent Pinchart #include <linux/of.h>
179f257f50SLaurent Pinchart #include <linux/of_graph.h>
189f257f50SLaurent Pinchart #include <linux/pinctrl/consumer.h>
199f257f50SLaurent Pinchart #include <linux/platform_device.h>
209f257f50SLaurent Pinchart #include <linux/regmap.h>
219f257f50SLaurent Pinchart #include <linux/slab.h>
229f257f50SLaurent Pinchart #include <linux/spinlock.h>
239f257f50SLaurent Pinchart #include <linux/types.h>
249f257f50SLaurent Pinchart
259f257f50SLaurent Pinchart #include <media/v4l2-device.h>
269f257f50SLaurent Pinchart #include <media/v4l2-fwnode.h>
279f257f50SLaurent Pinchart #include <media/v4l2-ioctl.h>
289f257f50SLaurent Pinchart #include <media/v4l2-mc.h>
299f257f50SLaurent Pinchart #include <media/v4l2-subdev.h>
309f257f50SLaurent Pinchart #include <media/videobuf2-dma-contig.h>
319f257f50SLaurent Pinchart
329f257f50SLaurent Pinchart #define IMX7_CSI_PAD_SINK 0
339f257f50SLaurent Pinchart #define IMX7_CSI_PAD_SRC 1
349f257f50SLaurent Pinchart #define IMX7_CSI_PADS_NUM 2
359f257f50SLaurent Pinchart
369f257f50SLaurent Pinchart /* csi control reg 1 */
379f257f50SLaurent Pinchart #define BIT_SWAP16_EN BIT(31)
389f257f50SLaurent Pinchart #define BIT_EXT_VSYNC BIT(30)
399f257f50SLaurent Pinchart #define BIT_EOF_INT_EN BIT(29)
409f257f50SLaurent Pinchart #define BIT_PRP_IF_EN BIT(28)
419f257f50SLaurent Pinchart #define BIT_CCIR_MODE BIT(27)
429f257f50SLaurent Pinchart #define BIT_COF_INT_EN BIT(26)
439f257f50SLaurent Pinchart #define BIT_SF_OR_INTEN BIT(25)
449f257f50SLaurent Pinchart #define BIT_RF_OR_INTEN BIT(24)
459f257f50SLaurent Pinchart #define BIT_SFF_DMA_DONE_INTEN BIT(22)
469f257f50SLaurent Pinchart #define BIT_STATFF_INTEN BIT(21)
479f257f50SLaurent Pinchart #define BIT_FB2_DMA_DONE_INTEN BIT(20)
489f257f50SLaurent Pinchart #define BIT_FB1_DMA_DONE_INTEN BIT(19)
499f257f50SLaurent Pinchart #define BIT_RXFF_INTEN BIT(18)
509f257f50SLaurent Pinchart #define BIT_SOF_POL BIT(17)
519f257f50SLaurent Pinchart #define BIT_SOF_INTEN BIT(16)
529f257f50SLaurent Pinchart #define BIT_MCLKDIV(n) ((n) << 12)
539f257f50SLaurent Pinchart #define BIT_MCLKDIV_MASK (0xf << 12)
549f257f50SLaurent Pinchart #define BIT_HSYNC_POL BIT(11)
559f257f50SLaurent Pinchart #define BIT_CCIR_EN BIT(10)
569f257f50SLaurent Pinchart #define BIT_MCLKEN BIT(9)
579f257f50SLaurent Pinchart #define BIT_FCC BIT(8)
589f257f50SLaurent Pinchart #define BIT_PACK_DIR BIT(7)
599f257f50SLaurent Pinchart #define BIT_CLR_STATFIFO BIT(6)
609f257f50SLaurent Pinchart #define BIT_CLR_RXFIFO BIT(5)
619f257f50SLaurent Pinchart #define BIT_GCLK_MODE BIT(4)
629f257f50SLaurent Pinchart #define BIT_INV_DATA BIT(3)
639f257f50SLaurent Pinchart #define BIT_INV_PCLK BIT(2)
649f257f50SLaurent Pinchart #define BIT_REDGE BIT(1)
659f257f50SLaurent Pinchart #define BIT_PIXEL_BIT BIT(0)
669f257f50SLaurent Pinchart
679f257f50SLaurent Pinchart /* control reg 2 */
689f257f50SLaurent Pinchart #define BIT_DMA_BURST_TYPE_RFF_INCR4 (1 << 30)
699f257f50SLaurent Pinchart #define BIT_DMA_BURST_TYPE_RFF_INCR8 (2 << 30)
709f257f50SLaurent Pinchart #define BIT_DMA_BURST_TYPE_RFF_INCR16 (3 << 30)
719f257f50SLaurent Pinchart #define BIT_DMA_BURST_TYPE_RFF_MASK (3 << 30)
729f257f50SLaurent Pinchart
739f257f50SLaurent Pinchart /* control reg 3 */
749f257f50SLaurent Pinchart #define BIT_FRMCNT(n) ((n) << 16)
759f257f50SLaurent Pinchart #define BIT_FRMCNT_MASK (0xffff << 16)
769f257f50SLaurent Pinchart #define BIT_FRMCNT_RST BIT(15)
779f257f50SLaurent Pinchart #define BIT_DMA_REFLASH_RFF BIT(14)
789f257f50SLaurent Pinchart #define BIT_DMA_REFLASH_SFF BIT(13)
799f257f50SLaurent Pinchart #define BIT_DMA_REQ_EN_RFF BIT(12)
809f257f50SLaurent Pinchart #define BIT_DMA_REQ_EN_SFF BIT(11)
819f257f50SLaurent Pinchart #define BIT_STATFF_LEVEL(n) ((n) << 8)
829f257f50SLaurent Pinchart #define BIT_STATFF_LEVEL_MASK (0x7 << 8)
839f257f50SLaurent Pinchart #define BIT_HRESP_ERR_EN BIT(7)
849f257f50SLaurent Pinchart #define BIT_RXFF_LEVEL(n) ((n) << 4)
859f257f50SLaurent Pinchart #define BIT_RXFF_LEVEL_MASK (0x7 << 4)
869f257f50SLaurent Pinchart #define BIT_TWO_8BIT_SENSOR BIT(3)
879f257f50SLaurent Pinchart #define BIT_ZERO_PACK_EN BIT(2)
889f257f50SLaurent Pinchart #define BIT_ECC_INT_EN BIT(1)
899f257f50SLaurent Pinchart #define BIT_ECC_AUTO_EN BIT(0)
909f257f50SLaurent Pinchart
919f257f50SLaurent Pinchart /* csi status reg */
929f257f50SLaurent Pinchart #define BIT_ADDR_CH_ERR_INT BIT(28)
939f257f50SLaurent Pinchart #define BIT_FIELD0_INT BIT(27)
949f257f50SLaurent Pinchart #define BIT_FIELD1_INT BIT(26)
959f257f50SLaurent Pinchart #define BIT_SFF_OR_INT BIT(25)
969f257f50SLaurent Pinchart #define BIT_RFF_OR_INT BIT(24)
979f257f50SLaurent Pinchart #define BIT_DMA_TSF_DONE_SFF BIT(22)
989f257f50SLaurent Pinchart #define BIT_STATFF_INT BIT(21)
999f257f50SLaurent Pinchart #define BIT_DMA_TSF_DONE_FB2 BIT(20)
1009f257f50SLaurent Pinchart #define BIT_DMA_TSF_DONE_FB1 BIT(19)
1019f257f50SLaurent Pinchart #define BIT_RXFF_INT BIT(18)
1029f257f50SLaurent Pinchart #define BIT_EOF_INT BIT(17)
1039f257f50SLaurent Pinchart #define BIT_SOF_INT BIT(16)
1049f257f50SLaurent Pinchart #define BIT_F2_INT BIT(15)
1059f257f50SLaurent Pinchart #define BIT_F1_INT BIT(14)
1069f257f50SLaurent Pinchart #define BIT_COF_INT BIT(13)
1079f257f50SLaurent Pinchart #define BIT_HRESP_ERR_INT BIT(7)
1089f257f50SLaurent Pinchart #define BIT_ECC_INT BIT(1)
1099f257f50SLaurent Pinchart #define BIT_DRDY BIT(0)
1109f257f50SLaurent Pinchart
1119f257f50SLaurent Pinchart /* csi image parameter reg */
1129f257f50SLaurent Pinchart #define BIT_IMAGE_WIDTH(n) ((n) << 16)
1139f257f50SLaurent Pinchart #define BIT_IMAGE_HEIGHT(n) (n)
1149f257f50SLaurent Pinchart
1159f257f50SLaurent Pinchart /* csi control reg 18 */
1169f257f50SLaurent Pinchart #define BIT_CSI_HW_ENABLE BIT(31)
1179f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_RAW8 (0x2a << 25)
1189f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_RAW10 (0x2b << 25)
1199f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_RAW12 (0x2c << 25)
1209f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_RAW14 (0x2d << 25)
1219f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_YUV422_8B (0x1e << 25)
1229f257f50SLaurent Pinchart #define BIT_MIPI_DATA_FORMAT_MASK (0x3f << 25)
1239f257f50SLaurent Pinchart #define BIT_DATA_FROM_MIPI BIT(22)
1249f257f50SLaurent Pinchart #define BIT_MIPI_YU_SWAP BIT(21)
1259f257f50SLaurent Pinchart #define BIT_MIPI_DOUBLE_CMPNT BIT(20)
1269f257f50SLaurent Pinchart #define BIT_MASK_OPTION_FIRST_FRAME (0 << 18)
1279f257f50SLaurent Pinchart #define BIT_MASK_OPTION_CSI_EN (1 << 18)
1289f257f50SLaurent Pinchart #define BIT_MASK_OPTION_SECOND_FRAME (2 << 18)
1299f257f50SLaurent Pinchart #define BIT_MASK_OPTION_ON_DATA (3 << 18)
1309f257f50SLaurent Pinchart #define BIT_BASEADDR_CHG_ERR_EN BIT(9)
1319f257f50SLaurent Pinchart #define BIT_BASEADDR_SWITCH_SEL BIT(5)
1329f257f50SLaurent Pinchart #define BIT_BASEADDR_SWITCH_EN BIT(4)
1339f257f50SLaurent Pinchart #define BIT_PARALLEL24_EN BIT(3)
1349f257f50SLaurent Pinchart #define BIT_DEINTERLACE_EN BIT(2)
1359f257f50SLaurent Pinchart #define BIT_TVDECODER_IN_EN BIT(1)
1369f257f50SLaurent Pinchart #define BIT_NTSC_EN BIT(0)
1379f257f50SLaurent Pinchart
1389f257f50SLaurent Pinchart #define CSI_MCLK_VF 1
1399f257f50SLaurent Pinchart #define CSI_MCLK_ENC 2
1409f257f50SLaurent Pinchart #define CSI_MCLK_RAW 4
1419f257f50SLaurent Pinchart #define CSI_MCLK_I2C 8
1429f257f50SLaurent Pinchart
1439f257f50SLaurent Pinchart #define CSI_CSICR1 0x00
1449f257f50SLaurent Pinchart #define CSI_CSICR2 0x04
1459f257f50SLaurent Pinchart #define CSI_CSICR3 0x08
1469f257f50SLaurent Pinchart #define CSI_STATFIFO 0x0c
1479f257f50SLaurent Pinchart #define CSI_CSIRXFIFO 0x10
1489f257f50SLaurent Pinchart #define CSI_CSIRXCNT 0x14
1499f257f50SLaurent Pinchart #define CSI_CSISR 0x18
1509f257f50SLaurent Pinchart
1519f257f50SLaurent Pinchart #define CSI_CSIDBG 0x1c
1529f257f50SLaurent Pinchart #define CSI_CSIDMASA_STATFIFO 0x20
1539f257f50SLaurent Pinchart #define CSI_CSIDMATS_STATFIFO 0x24
1549f257f50SLaurent Pinchart #define CSI_CSIDMASA_FB1 0x28
1559f257f50SLaurent Pinchart #define CSI_CSIDMASA_FB2 0x2c
1569f257f50SLaurent Pinchart #define CSI_CSIFBUF_PARA 0x30
1579f257f50SLaurent Pinchart #define CSI_CSIIMAG_PARA 0x34
1589f257f50SLaurent Pinchart
1599f257f50SLaurent Pinchart #define CSI_CSICR18 0x48
1609f257f50SLaurent Pinchart #define CSI_CSICR19 0x4c
1619f257f50SLaurent Pinchart
1629f257f50SLaurent Pinchart #define IMX7_CSI_VIDEO_NAME "imx-capture"
1639f257f50SLaurent Pinchart /* In bytes, per queue */
1649f257f50SLaurent Pinchart #define IMX7_CSI_VIDEO_MEM_LIMIT SZ_512M
1659f257f50SLaurent Pinchart #define IMX7_CSI_VIDEO_EOF_TIMEOUT 2000
1669f257f50SLaurent Pinchart
1679f257f50SLaurent Pinchart #define IMX7_CSI_DEF_MBUS_CODE MEDIA_BUS_FMT_UYVY8_2X8
1689f257f50SLaurent Pinchart #define IMX7_CSI_DEF_PIX_FORMAT V4L2_PIX_FMT_UYVY
1699f257f50SLaurent Pinchart #define IMX7_CSI_DEF_PIX_WIDTH 640
1709f257f50SLaurent Pinchart #define IMX7_CSI_DEF_PIX_HEIGHT 480
1719f257f50SLaurent Pinchart
1729f257f50SLaurent Pinchart enum imx_csi_model {
1739f257f50SLaurent Pinchart IMX7_CSI_IMX7 = 0,
1749f257f50SLaurent Pinchart IMX7_CSI_IMX8MQ,
1759f257f50SLaurent Pinchart };
1769f257f50SLaurent Pinchart
1779f257f50SLaurent Pinchart struct imx7_csi_pixfmt {
1789f257f50SLaurent Pinchart /* the in-memory FourCC pixel format */
1799f257f50SLaurent Pinchart u32 fourcc;
1809f257f50SLaurent Pinchart /*
1819f257f50SLaurent Pinchart * the set of equivalent media bus codes for the fourcc.
1829f257f50SLaurent Pinchart * NOTE! codes pointer is NULL for in-memory-only formats.
1839f257f50SLaurent Pinchart */
1849f257f50SLaurent Pinchart const u32 *codes;
1859f257f50SLaurent Pinchart int bpp; /* total bpp */
1869f257f50SLaurent Pinchart bool yuv;
1879f257f50SLaurent Pinchart };
1889f257f50SLaurent Pinchart
1899f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer {
1909f257f50SLaurent Pinchart struct vb2_v4l2_buffer vbuf;
1919f257f50SLaurent Pinchart struct list_head list;
1929f257f50SLaurent Pinchart };
1939f257f50SLaurent Pinchart
1949f257f50SLaurent Pinchart static inline struct imx7_csi_vb2_buffer *
to_imx7_csi_vb2_buffer(struct vb2_buffer * vb)1959f257f50SLaurent Pinchart to_imx7_csi_vb2_buffer(struct vb2_buffer *vb)
1969f257f50SLaurent Pinchart {
1979f257f50SLaurent Pinchart struct vb2_v4l2_buffer *vbuf = to_vb2_v4l2_buffer(vb);
1989f257f50SLaurent Pinchart
1999f257f50SLaurent Pinchart return container_of(vbuf, struct imx7_csi_vb2_buffer, vbuf);
2009f257f50SLaurent Pinchart }
2019f257f50SLaurent Pinchart
2029f257f50SLaurent Pinchart struct imx7_csi_dma_buf {
2039f257f50SLaurent Pinchart void *virt;
2049f257f50SLaurent Pinchart dma_addr_t dma_addr;
2059f257f50SLaurent Pinchart unsigned long len;
2069f257f50SLaurent Pinchart };
2079f257f50SLaurent Pinchart
2089f257f50SLaurent Pinchart struct imx7_csi {
2099f257f50SLaurent Pinchart struct device *dev;
2109f257f50SLaurent Pinchart
2119f257f50SLaurent Pinchart /* Resources and locks */
2129f257f50SLaurent Pinchart void __iomem *regbase;
2139f257f50SLaurent Pinchart int irq;
2149f257f50SLaurent Pinchart struct clk *mclk;
2159f257f50SLaurent Pinchart
2169f257f50SLaurent Pinchart spinlock_t irqlock; /* Protects last_eof */
2179f257f50SLaurent Pinchart
2189f257f50SLaurent Pinchart /* Media and V4L2 device */
2199f257f50SLaurent Pinchart struct media_device mdev;
2209f257f50SLaurent Pinchart struct v4l2_device v4l2_dev;
2219f257f50SLaurent Pinchart struct v4l2_async_notifier notifier;
2229f257f50SLaurent Pinchart struct media_pipeline pipe;
2239f257f50SLaurent Pinchart
2249f257f50SLaurent Pinchart struct v4l2_subdev *src_sd;
2259f257f50SLaurent Pinchart bool is_csi2;
2269f257f50SLaurent Pinchart
2279f257f50SLaurent Pinchart /* V4L2 subdev */
2289f257f50SLaurent Pinchart struct v4l2_subdev sd;
2299f257f50SLaurent Pinchart struct media_pad pad[IMX7_CSI_PADS_NUM];
2309f257f50SLaurent Pinchart
2319f257f50SLaurent Pinchart /* Video device */
2329f257f50SLaurent Pinchart struct video_device *vdev; /* Video device */
2339f257f50SLaurent Pinchart struct media_pad vdev_pad; /* Video device pad */
2349f257f50SLaurent Pinchart
2359f257f50SLaurent Pinchart struct v4l2_pix_format vdev_fmt; /* The user format */
2369f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *vdev_cc;
2379f257f50SLaurent Pinchart struct v4l2_rect vdev_compose; /* The compose rectangle */
2389f257f50SLaurent Pinchart
2399f257f50SLaurent Pinchart struct mutex vdev_mutex; /* Protect vdev operations */
2409f257f50SLaurent Pinchart
2419f257f50SLaurent Pinchart struct vb2_queue q; /* The videobuf2 queue */
2429f257f50SLaurent Pinchart struct list_head ready_q; /* List of queued buffers */
2439f257f50SLaurent Pinchart spinlock_t q_lock; /* Protect ready_q */
2449f257f50SLaurent Pinchart
2459f257f50SLaurent Pinchart /* Buffers and streaming state */
2469f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *active_vb2_buf[2];
2479f257f50SLaurent Pinchart struct imx7_csi_dma_buf underrun_buf;
2489f257f50SLaurent Pinchart
2499f257f50SLaurent Pinchart bool is_streaming;
2509f257f50SLaurent Pinchart int buf_num;
2519f257f50SLaurent Pinchart u32 frame_sequence;
2529f257f50SLaurent Pinchart
2539f257f50SLaurent Pinchart bool last_eof;
2549f257f50SLaurent Pinchart struct completion last_eof_completion;
2559f257f50SLaurent Pinchart
2569f257f50SLaurent Pinchart enum imx_csi_model model;
2579f257f50SLaurent Pinchart };
2589f257f50SLaurent Pinchart
2599f257f50SLaurent Pinchart static struct imx7_csi *
imx7_csi_notifier_to_dev(struct v4l2_async_notifier * n)2609f257f50SLaurent Pinchart imx7_csi_notifier_to_dev(struct v4l2_async_notifier *n)
2619f257f50SLaurent Pinchart {
2629f257f50SLaurent Pinchart return container_of(n, struct imx7_csi, notifier);
2639f257f50SLaurent Pinchart }
2649f257f50SLaurent Pinchart
2659f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
2669f257f50SLaurent Pinchart * Hardware Configuration
2679f257f50SLaurent Pinchart */
2689f257f50SLaurent Pinchart
imx7_csi_reg_read(struct imx7_csi * csi,unsigned int offset)2699f257f50SLaurent Pinchart static u32 imx7_csi_reg_read(struct imx7_csi *csi, unsigned int offset)
2709f257f50SLaurent Pinchart {
2719f257f50SLaurent Pinchart return readl(csi->regbase + offset);
2729f257f50SLaurent Pinchart }
2739f257f50SLaurent Pinchart
imx7_csi_reg_write(struct imx7_csi * csi,unsigned int value,unsigned int offset)2749f257f50SLaurent Pinchart static void imx7_csi_reg_write(struct imx7_csi *csi, unsigned int value,
2759f257f50SLaurent Pinchart unsigned int offset)
2769f257f50SLaurent Pinchart {
2779f257f50SLaurent Pinchart writel(value, csi->regbase + offset);
2789f257f50SLaurent Pinchart }
2799f257f50SLaurent Pinchart
imx7_csi_irq_clear(struct imx7_csi * csi)2809f257f50SLaurent Pinchart static u32 imx7_csi_irq_clear(struct imx7_csi *csi)
2819f257f50SLaurent Pinchart {
2829f257f50SLaurent Pinchart u32 isr;
2839f257f50SLaurent Pinchart
2849f257f50SLaurent Pinchart isr = imx7_csi_reg_read(csi, CSI_CSISR);
2859f257f50SLaurent Pinchart imx7_csi_reg_write(csi, isr, CSI_CSISR);
2869f257f50SLaurent Pinchart
2879f257f50SLaurent Pinchart return isr;
2889f257f50SLaurent Pinchart }
2899f257f50SLaurent Pinchart
imx7_csi_init_default(struct imx7_csi * csi)2909f257f50SLaurent Pinchart static void imx7_csi_init_default(struct imx7_csi *csi)
2919f257f50SLaurent Pinchart {
2929f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_SOF_POL | BIT_REDGE | BIT_GCLK_MODE |
2939f257f50SLaurent Pinchart BIT_HSYNC_POL | BIT_FCC | BIT_MCLKDIV(1) |
2949f257f50SLaurent Pinchart BIT_MCLKEN, CSI_CSICR1);
2959f257f50SLaurent Pinchart imx7_csi_reg_write(csi, 0, CSI_CSICR2);
2969f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_FRMCNT_RST, CSI_CSICR3);
2979f257f50SLaurent Pinchart
2989f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_IMAGE_WIDTH(IMX7_CSI_DEF_PIX_WIDTH) |
2999f257f50SLaurent Pinchart BIT_IMAGE_HEIGHT(IMX7_CSI_DEF_PIX_HEIGHT),
3009f257f50SLaurent Pinchart CSI_CSIIMAG_PARA);
3019f257f50SLaurent Pinchart
3029f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_DMA_REFLASH_RFF, CSI_CSICR3);
3039f257f50SLaurent Pinchart }
3049f257f50SLaurent Pinchart
imx7_csi_hw_enable_irq(struct imx7_csi * csi)3059f257f50SLaurent Pinchart static void imx7_csi_hw_enable_irq(struct imx7_csi *csi)
3069f257f50SLaurent Pinchart {
3079f257f50SLaurent Pinchart u32 cr1 = imx7_csi_reg_read(csi, CSI_CSICR1);
3089f257f50SLaurent Pinchart
3099f257f50SLaurent Pinchart cr1 |= BIT_RFF_OR_INT;
3109f257f50SLaurent Pinchart cr1 |= BIT_FB1_DMA_DONE_INTEN;
3119f257f50SLaurent Pinchart cr1 |= BIT_FB2_DMA_DONE_INTEN;
3129f257f50SLaurent Pinchart
3139f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1, CSI_CSICR1);
3149f257f50SLaurent Pinchart }
3159f257f50SLaurent Pinchart
imx7_csi_hw_disable_irq(struct imx7_csi * csi)3169f257f50SLaurent Pinchart static void imx7_csi_hw_disable_irq(struct imx7_csi *csi)
3179f257f50SLaurent Pinchart {
3189f257f50SLaurent Pinchart u32 cr1 = imx7_csi_reg_read(csi, CSI_CSICR1);
3199f257f50SLaurent Pinchart
3209f257f50SLaurent Pinchart cr1 &= ~BIT_RFF_OR_INT;
3219f257f50SLaurent Pinchart cr1 &= ~BIT_FB1_DMA_DONE_INTEN;
3229f257f50SLaurent Pinchart cr1 &= ~BIT_FB2_DMA_DONE_INTEN;
3239f257f50SLaurent Pinchart
3249f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1, CSI_CSICR1);
3259f257f50SLaurent Pinchart }
3269f257f50SLaurent Pinchart
imx7_csi_hw_enable(struct imx7_csi * csi)3279f257f50SLaurent Pinchart static void imx7_csi_hw_enable(struct imx7_csi *csi)
3289f257f50SLaurent Pinchart {
3299f257f50SLaurent Pinchart u32 cr = imx7_csi_reg_read(csi, CSI_CSICR18);
3309f257f50SLaurent Pinchart
3319f257f50SLaurent Pinchart cr |= BIT_CSI_HW_ENABLE;
3329f257f50SLaurent Pinchart
3339f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr, CSI_CSICR18);
3349f257f50SLaurent Pinchart }
3359f257f50SLaurent Pinchart
imx7_csi_hw_disable(struct imx7_csi * csi)3369f257f50SLaurent Pinchart static void imx7_csi_hw_disable(struct imx7_csi *csi)
3379f257f50SLaurent Pinchart {
3389f257f50SLaurent Pinchart u32 cr = imx7_csi_reg_read(csi, CSI_CSICR18);
3399f257f50SLaurent Pinchart
3409f257f50SLaurent Pinchart cr &= ~BIT_CSI_HW_ENABLE;
3419f257f50SLaurent Pinchart
3429f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr, CSI_CSICR18);
3439f257f50SLaurent Pinchart }
3449f257f50SLaurent Pinchart
imx7_csi_dma_reflash(struct imx7_csi * csi)3459f257f50SLaurent Pinchart static void imx7_csi_dma_reflash(struct imx7_csi *csi)
3469f257f50SLaurent Pinchart {
3479f257f50SLaurent Pinchart u32 cr3;
3489f257f50SLaurent Pinchart
3499f257f50SLaurent Pinchart cr3 = imx7_csi_reg_read(csi, CSI_CSICR3);
3509f257f50SLaurent Pinchart cr3 |= BIT_DMA_REFLASH_RFF;
3519f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr3, CSI_CSICR3);
3529f257f50SLaurent Pinchart }
3539f257f50SLaurent Pinchart
imx7_csi_rx_fifo_clear(struct imx7_csi * csi)3549f257f50SLaurent Pinchart static void imx7_csi_rx_fifo_clear(struct imx7_csi *csi)
3559f257f50SLaurent Pinchart {
3569f257f50SLaurent Pinchart u32 cr1 = imx7_csi_reg_read(csi, CSI_CSICR1) & ~BIT_FCC;
3579f257f50SLaurent Pinchart
3589f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1, CSI_CSICR1);
3599f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1 | BIT_CLR_RXFIFO, CSI_CSICR1);
3609f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1 | BIT_FCC, CSI_CSICR1);
3619f257f50SLaurent Pinchart }
3629f257f50SLaurent Pinchart
imx7_csi_dmareq_rff_enable(struct imx7_csi * csi)3639f257f50SLaurent Pinchart static void imx7_csi_dmareq_rff_enable(struct imx7_csi *csi)
3649f257f50SLaurent Pinchart {
3659f257f50SLaurent Pinchart u32 cr3 = imx7_csi_reg_read(csi, CSI_CSICR3);
3669f257f50SLaurent Pinchart
3679f257f50SLaurent Pinchart cr3 |= BIT_DMA_REQ_EN_RFF;
3689f257f50SLaurent Pinchart cr3 |= BIT_HRESP_ERR_EN;
3699f257f50SLaurent Pinchart cr3 &= ~BIT_RXFF_LEVEL_MASK;
3709f257f50SLaurent Pinchart cr3 |= BIT_RXFF_LEVEL(2);
3719f257f50SLaurent Pinchart
3729f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr3, CSI_CSICR3);
3739f257f50SLaurent Pinchart }
3749f257f50SLaurent Pinchart
imx7_csi_dmareq_rff_disable(struct imx7_csi * csi)3759f257f50SLaurent Pinchart static void imx7_csi_dmareq_rff_disable(struct imx7_csi *csi)
3769f257f50SLaurent Pinchart {
3779f257f50SLaurent Pinchart u32 cr3 = imx7_csi_reg_read(csi, CSI_CSICR3);
3789f257f50SLaurent Pinchart
3799f257f50SLaurent Pinchart cr3 &= ~BIT_DMA_REQ_EN_RFF;
3809f257f50SLaurent Pinchart cr3 &= ~BIT_HRESP_ERR_EN;
3819f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr3, CSI_CSICR3);
3829f257f50SLaurent Pinchart }
3839f257f50SLaurent Pinchart
imx7_csi_update_buf(struct imx7_csi * csi,dma_addr_t dma_addr,int buf_num)3849f257f50SLaurent Pinchart static void imx7_csi_update_buf(struct imx7_csi *csi, dma_addr_t dma_addr,
3859f257f50SLaurent Pinchart int buf_num)
3869f257f50SLaurent Pinchart {
3879f257f50SLaurent Pinchart if (buf_num == 1)
3889f257f50SLaurent Pinchart imx7_csi_reg_write(csi, dma_addr, CSI_CSIDMASA_FB2);
3899f257f50SLaurent Pinchart else
3909f257f50SLaurent Pinchart imx7_csi_reg_write(csi, dma_addr, CSI_CSIDMASA_FB1);
3919f257f50SLaurent Pinchart }
3929f257f50SLaurent Pinchart
3939f257f50SLaurent Pinchart static struct imx7_csi_vb2_buffer *imx7_csi_video_next_buf(struct imx7_csi *csi);
3949f257f50SLaurent Pinchart
imx7_csi_setup_vb2_buf(struct imx7_csi * csi)3959f257f50SLaurent Pinchart static void imx7_csi_setup_vb2_buf(struct imx7_csi *csi)
3969f257f50SLaurent Pinchart {
3979f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf;
3989f257f50SLaurent Pinchart struct vb2_buffer *vb2_buf;
3999f257f50SLaurent Pinchart int i;
4009f257f50SLaurent Pinchart
4019f257f50SLaurent Pinchart for (i = 0; i < 2; i++) {
4029f257f50SLaurent Pinchart dma_addr_t dma_addr;
4039f257f50SLaurent Pinchart
4049f257f50SLaurent Pinchart buf = imx7_csi_video_next_buf(csi);
4059f257f50SLaurent Pinchart if (buf) {
4069f257f50SLaurent Pinchart csi->active_vb2_buf[i] = buf;
4079f257f50SLaurent Pinchart vb2_buf = &buf->vbuf.vb2_buf;
4089f257f50SLaurent Pinchart dma_addr = vb2_dma_contig_plane_dma_addr(vb2_buf, 0);
4099f257f50SLaurent Pinchart } else {
4109f257f50SLaurent Pinchart csi->active_vb2_buf[i] = NULL;
4119f257f50SLaurent Pinchart dma_addr = csi->underrun_buf.dma_addr;
4129f257f50SLaurent Pinchart }
4139f257f50SLaurent Pinchart
4149f257f50SLaurent Pinchart imx7_csi_update_buf(csi, dma_addr, i);
4159f257f50SLaurent Pinchart }
4169f257f50SLaurent Pinchart }
4179f257f50SLaurent Pinchart
imx7_csi_dma_unsetup_vb2_buf(struct imx7_csi * csi,enum vb2_buffer_state return_status)4189f257f50SLaurent Pinchart static void imx7_csi_dma_unsetup_vb2_buf(struct imx7_csi *csi,
4199f257f50SLaurent Pinchart enum vb2_buffer_state return_status)
4209f257f50SLaurent Pinchart {
4219f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf;
4229f257f50SLaurent Pinchart int i;
4239f257f50SLaurent Pinchart
4249f257f50SLaurent Pinchart /* return any remaining active frames with return_status */
4259f257f50SLaurent Pinchart for (i = 0; i < 2; i++) {
4269f257f50SLaurent Pinchart buf = csi->active_vb2_buf[i];
4279f257f50SLaurent Pinchart if (buf) {
4289f257f50SLaurent Pinchart struct vb2_buffer *vb = &buf->vbuf.vb2_buf;
4299f257f50SLaurent Pinchart
4309f257f50SLaurent Pinchart vb->timestamp = ktime_get_ns();
4319f257f50SLaurent Pinchart vb2_buffer_done(vb, return_status);
4329f257f50SLaurent Pinchart csi->active_vb2_buf[i] = NULL;
4339f257f50SLaurent Pinchart }
4349f257f50SLaurent Pinchart }
4359f257f50SLaurent Pinchart }
4369f257f50SLaurent Pinchart
imx7_csi_free_dma_buf(struct imx7_csi * csi,struct imx7_csi_dma_buf * buf)4379f257f50SLaurent Pinchart static void imx7_csi_free_dma_buf(struct imx7_csi *csi,
4389f257f50SLaurent Pinchart struct imx7_csi_dma_buf *buf)
4399f257f50SLaurent Pinchart {
4409f257f50SLaurent Pinchart if (buf->virt)
4419f257f50SLaurent Pinchart dma_free_coherent(csi->dev, buf->len, buf->virt, buf->dma_addr);
4429f257f50SLaurent Pinchart
4439f257f50SLaurent Pinchart buf->virt = NULL;
4449f257f50SLaurent Pinchart buf->dma_addr = 0;
4459f257f50SLaurent Pinchart }
4469f257f50SLaurent Pinchart
imx7_csi_alloc_dma_buf(struct imx7_csi * csi,struct imx7_csi_dma_buf * buf,int size)4479f257f50SLaurent Pinchart static int imx7_csi_alloc_dma_buf(struct imx7_csi *csi,
4489f257f50SLaurent Pinchart struct imx7_csi_dma_buf *buf, int size)
4499f257f50SLaurent Pinchart {
4509f257f50SLaurent Pinchart imx7_csi_free_dma_buf(csi, buf);
4519f257f50SLaurent Pinchart
4529f257f50SLaurent Pinchart buf->len = PAGE_ALIGN(size);
4539f257f50SLaurent Pinchart buf->virt = dma_alloc_coherent(csi->dev, buf->len, &buf->dma_addr,
4549f257f50SLaurent Pinchart GFP_DMA | GFP_KERNEL);
4559f257f50SLaurent Pinchart if (!buf->virt)
4569f257f50SLaurent Pinchart return -ENOMEM;
4579f257f50SLaurent Pinchart
4589f257f50SLaurent Pinchart return 0;
4599f257f50SLaurent Pinchart }
4609f257f50SLaurent Pinchart
imx7_csi_dma_setup(struct imx7_csi * csi)4619f257f50SLaurent Pinchart static int imx7_csi_dma_setup(struct imx7_csi *csi)
4629f257f50SLaurent Pinchart {
4639f257f50SLaurent Pinchart int ret;
4649f257f50SLaurent Pinchart
4659f257f50SLaurent Pinchart ret = imx7_csi_alloc_dma_buf(csi, &csi->underrun_buf,
4669f257f50SLaurent Pinchart csi->vdev_fmt.sizeimage);
4679f257f50SLaurent Pinchart if (ret < 0) {
4689f257f50SLaurent Pinchart v4l2_warn(&csi->sd, "consider increasing the CMA area\n");
4699f257f50SLaurent Pinchart return ret;
4709f257f50SLaurent Pinchart }
4719f257f50SLaurent Pinchart
4729f257f50SLaurent Pinchart csi->frame_sequence = 0;
4739f257f50SLaurent Pinchart csi->last_eof = false;
4749f257f50SLaurent Pinchart init_completion(&csi->last_eof_completion);
4759f257f50SLaurent Pinchart
4769f257f50SLaurent Pinchart imx7_csi_setup_vb2_buf(csi);
4779f257f50SLaurent Pinchart
4789f257f50SLaurent Pinchart return 0;
4799f257f50SLaurent Pinchart }
4809f257f50SLaurent Pinchart
imx7_csi_dma_cleanup(struct imx7_csi * csi,enum vb2_buffer_state return_status)4819f257f50SLaurent Pinchart static void imx7_csi_dma_cleanup(struct imx7_csi *csi,
4829f257f50SLaurent Pinchart enum vb2_buffer_state return_status)
4839f257f50SLaurent Pinchart {
4849f257f50SLaurent Pinchart imx7_csi_dma_unsetup_vb2_buf(csi, return_status);
4859f257f50SLaurent Pinchart imx7_csi_free_dma_buf(csi, &csi->underrun_buf);
4869f257f50SLaurent Pinchart }
4879f257f50SLaurent Pinchart
imx7_csi_dma_stop(struct imx7_csi * csi)4889f257f50SLaurent Pinchart static void imx7_csi_dma_stop(struct imx7_csi *csi)
4899f257f50SLaurent Pinchart {
4909f257f50SLaurent Pinchart unsigned long timeout_jiffies;
4919f257f50SLaurent Pinchart unsigned long flags;
4929f257f50SLaurent Pinchart int ret;
4939f257f50SLaurent Pinchart
4949f257f50SLaurent Pinchart /* mark next EOF interrupt as the last before stream off */
4959f257f50SLaurent Pinchart spin_lock_irqsave(&csi->irqlock, flags);
4969f257f50SLaurent Pinchart csi->last_eof = true;
4979f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->irqlock, flags);
4989f257f50SLaurent Pinchart
4999f257f50SLaurent Pinchart /*
5009f257f50SLaurent Pinchart * and then wait for interrupt handler to mark completion.
5019f257f50SLaurent Pinchart */
5029f257f50SLaurent Pinchart timeout_jiffies = msecs_to_jiffies(IMX7_CSI_VIDEO_EOF_TIMEOUT);
5039f257f50SLaurent Pinchart ret = wait_for_completion_timeout(&csi->last_eof_completion,
5049f257f50SLaurent Pinchart timeout_jiffies);
5059f257f50SLaurent Pinchart if (ret == 0)
5069f257f50SLaurent Pinchart v4l2_warn(&csi->sd, "wait last EOF timeout\n");
5079f257f50SLaurent Pinchart
5089f257f50SLaurent Pinchart imx7_csi_hw_disable_irq(csi);
5091d59fbebSLaurent Pinchart }
5101d59fbebSLaurent Pinchart
imx7_csi_configure(struct imx7_csi * csi,struct v4l2_subdev_state * sd_state)5119f257f50SLaurent Pinchart static void imx7_csi_configure(struct imx7_csi *csi,
5129f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state)
5139f257f50SLaurent Pinchart {
5149f257f50SLaurent Pinchart struct v4l2_pix_format *out_pix = &csi->vdev_fmt;
5159f257f50SLaurent Pinchart int width = out_pix->width;
5169f257f50SLaurent Pinchart u32 stride = 0;
5179f257f50SLaurent Pinchart u32 cr3 = BIT_FRMCNT_RST;
5189f257f50SLaurent Pinchart u32 cr1, cr18;
5199f257f50SLaurent Pinchart
5209f257f50SLaurent Pinchart cr18 = imx7_csi_reg_read(csi, CSI_CSICR18);
5219f257f50SLaurent Pinchart
5229f257f50SLaurent Pinchart cr18 &= ~(BIT_CSI_HW_ENABLE | BIT_MIPI_DATA_FORMAT_MASK |
5239f257f50SLaurent Pinchart BIT_DATA_FROM_MIPI | BIT_MIPI_DOUBLE_CMPNT |
5249f257f50SLaurent Pinchart BIT_BASEADDR_CHG_ERR_EN | BIT_BASEADDR_SWITCH_SEL |
5259f257f50SLaurent Pinchart BIT_BASEADDR_SWITCH_EN | BIT_DEINTERLACE_EN);
5269f257f50SLaurent Pinchart
5279f257f50SLaurent Pinchart if (out_pix->field == V4L2_FIELD_INTERLACED) {
5289f257f50SLaurent Pinchart cr18 |= BIT_DEINTERLACE_EN;
5299f257f50SLaurent Pinchart stride = out_pix->width;
5309f257f50SLaurent Pinchart }
5319f257f50SLaurent Pinchart
5329f257f50SLaurent Pinchart if (!csi->is_csi2) {
5339f257f50SLaurent Pinchart cr1 = BIT_SOF_POL | BIT_REDGE | BIT_GCLK_MODE | BIT_HSYNC_POL
5349f257f50SLaurent Pinchart | BIT_FCC | BIT_MCLKDIV(1) | BIT_MCLKEN;
5359f257f50SLaurent Pinchart
5369f257f50SLaurent Pinchart cr18 |= BIT_BASEADDR_SWITCH_EN | BIT_BASEADDR_SWITCH_SEL |
5379f257f50SLaurent Pinchart BIT_BASEADDR_CHG_ERR_EN;
5389f257f50SLaurent Pinchart
5399f257f50SLaurent Pinchart if (out_pix->pixelformat == V4L2_PIX_FMT_UYVY ||
5409f257f50SLaurent Pinchart out_pix->pixelformat == V4L2_PIX_FMT_YUYV)
5411d59fbebSLaurent Pinchart width *= 2;
5421d59fbebSLaurent Pinchart } else {
5431d59fbebSLaurent Pinchart const struct v4l2_mbus_framefmt *sink_fmt;
5441d59fbebSLaurent Pinchart
5451d59fbebSLaurent Pinchart sink_fmt = v4l2_subdev_get_pad_format(&csi->sd, sd_state,
5469f257f50SLaurent Pinchart IMX7_CSI_PAD_SINK);
5479f257f50SLaurent Pinchart
5489f257f50SLaurent Pinchart cr1 = BIT_SOF_POL | BIT_REDGE | BIT_HSYNC_POL | BIT_FCC
5499f257f50SLaurent Pinchart | BIT_MCLKDIV(1) | BIT_MCLKEN;
5509f257f50SLaurent Pinchart
5511d59fbebSLaurent Pinchart cr18 |= BIT_DATA_FROM_MIPI;
5529f257f50SLaurent Pinchart
5539f257f50SLaurent Pinchart switch (sink_fmt->code) {
5549f257f50SLaurent Pinchart case MEDIA_BUS_FMT_Y8_1X8:
5559f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SBGGR8_1X8:
5569f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGBRG8_1X8:
5579f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGRBG8_1X8:
5589f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SRGGB8_1X8:
5599f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_RAW8;
5609f257f50SLaurent Pinchart break;
5619f257f50SLaurent Pinchart case MEDIA_BUS_FMT_Y10_1X10:
5629f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SBGGR10_1X10:
5639f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGBRG10_1X10:
5649f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGRBG10_1X10:
5659f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SRGGB10_1X10:
5669f257f50SLaurent Pinchart cr3 |= BIT_TWO_8BIT_SENSOR;
5679f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_RAW10;
5689f257f50SLaurent Pinchart break;
5699f257f50SLaurent Pinchart case MEDIA_BUS_FMT_Y12_1X12:
5709f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SBGGR12_1X12:
5719f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGBRG12_1X12:
5729f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGRBG12_1X12:
5739f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SRGGB12_1X12:
5749f257f50SLaurent Pinchart cr3 |= BIT_TWO_8BIT_SENSOR;
5759f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_RAW12;
5769f257f50SLaurent Pinchart break;
5779f257f50SLaurent Pinchart case MEDIA_BUS_FMT_Y14_1X14:
5789f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SBGGR14_1X14:
5799f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGBRG14_1X14:
5809f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SGRBG14_1X14:
5819f257f50SLaurent Pinchart case MEDIA_BUS_FMT_SRGGB14_1X14:
5829f257f50SLaurent Pinchart cr3 |= BIT_TWO_8BIT_SENSOR;
5839f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_RAW14;
5849f257f50SLaurent Pinchart break;
5859f257f50SLaurent Pinchart
5869f257f50SLaurent Pinchart /*
5879f257f50SLaurent Pinchart * The CSI bridge has a 16-bit input bus. Depending on the
5889f257f50SLaurent Pinchart * connected source, data may be transmitted with 8 or 10 bits
5899f257f50SLaurent Pinchart * per clock sample (in bits [9:2] or [9:0] respectively) or
5909f257f50SLaurent Pinchart * with 16 bits per clock sample (in bits [15:0]). The data is
5919f257f50SLaurent Pinchart * then packed into a 32-bit FIFO (as shown in figure 13-11 of
5929f257f50SLaurent Pinchart * the i.MX8MM reference manual rev. 3).
5939f257f50SLaurent Pinchart *
5949f257f50SLaurent Pinchart * The data packing in a 32-bit FIFO input word is controlled by
5959f257f50SLaurent Pinchart * the CR3 TWO_8BIT_SENSOR field (also known as SENSOR_16BITS in
5969f257f50SLaurent Pinchart * the i.MX8MM reference manual). When set to 0, data packing
5979f257f50SLaurent Pinchart * groups four 8-bit input samples (bits [9:2]). When set to 1,
5989f257f50SLaurent Pinchart * data packing groups two 16-bit input samples (bits [15:0]).
5999f257f50SLaurent Pinchart *
6009f257f50SLaurent Pinchart * The register field CR18 MIPI_DOUBLE_CMPNT also needs to be
6019f257f50SLaurent Pinchart * configured according to the input format for YUV 4:2:2 data.
6029f257f50SLaurent Pinchart * The field controls the gasket between the CSI-2 receiver and
6039f257f50SLaurent Pinchart * the CSI bridge. On i.MX7 and i.MX8MM, the field must be set
6049f257f50SLaurent Pinchart * to 1 when the CSIS outputs 16-bit samples. On i.MX8MQ, the
6059f257f50SLaurent Pinchart * gasket ignores the MIPI_DOUBLE_CMPNT bit and YUV 4:2:2 always
6069f257f50SLaurent Pinchart * uses 16-bit samples. Setting MIPI_DOUBLE_CMPNT in that case
6079f257f50SLaurent Pinchart * has no effect, but doesn't cause any issue.
6089f257f50SLaurent Pinchart */
6099f257f50SLaurent Pinchart case MEDIA_BUS_FMT_UYVY8_2X8:
6109f257f50SLaurent Pinchart case MEDIA_BUS_FMT_YUYV8_2X8:
6119f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_YUV422_8B;
6129f257f50SLaurent Pinchart break;
6139f257f50SLaurent Pinchart case MEDIA_BUS_FMT_UYVY8_1X16:
6149f257f50SLaurent Pinchart case MEDIA_BUS_FMT_YUYV8_1X16:
6159f257f50SLaurent Pinchart cr3 |= BIT_TWO_8BIT_SENSOR;
6169f257f50SLaurent Pinchart cr18 |= BIT_MIPI_DATA_FORMAT_YUV422_8B |
6179f257f50SLaurent Pinchart BIT_MIPI_DOUBLE_CMPNT;
6189f257f50SLaurent Pinchart break;
6199f257f50SLaurent Pinchart }
6209f257f50SLaurent Pinchart }
6219f257f50SLaurent Pinchart
6229f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr1, CSI_CSICR1);
6239f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_DMA_BURST_TYPE_RFF_INCR16, CSI_CSICR2);
6249f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr3, CSI_CSICR3);
6259f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr18, CSI_CSICR18);
6269f257f50SLaurent Pinchart
6279f257f50SLaurent Pinchart imx7_csi_reg_write(csi, (width * out_pix->height) >> 2, CSI_CSIRXCNT);
6289f257f50SLaurent Pinchart imx7_csi_reg_write(csi, BIT_IMAGE_WIDTH(width) |
6299f257f50SLaurent Pinchart BIT_IMAGE_HEIGHT(out_pix->height),
6309f257f50SLaurent Pinchart CSI_CSIIMAG_PARA);
6319f257f50SLaurent Pinchart imx7_csi_reg_write(csi, stride, CSI_CSIFBUF_PARA);
6321d59fbebSLaurent Pinchart }
6331d59fbebSLaurent Pinchart
imx7_csi_init(struct imx7_csi * csi,struct v4l2_subdev_state * sd_state)6349f257f50SLaurent Pinchart static int imx7_csi_init(struct imx7_csi *csi,
6359f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state)
6369f257f50SLaurent Pinchart {
6379f257f50SLaurent Pinchart int ret;
6389f257f50SLaurent Pinchart
6399f257f50SLaurent Pinchart ret = clk_prepare_enable(csi->mclk);
6409f257f50SLaurent Pinchart if (ret < 0)
6411d59fbebSLaurent Pinchart return ret;
6429f257f50SLaurent Pinchart
6439f257f50SLaurent Pinchart imx7_csi_configure(csi, sd_state);
644cea606d9SYang Yingliang
645cea606d9SYang Yingliang ret = imx7_csi_dma_setup(csi);
6469f257f50SLaurent Pinchart if (ret < 0) {
647cea606d9SYang Yingliang clk_disable_unprepare(csi->mclk);
6489f257f50SLaurent Pinchart return ret;
6499f257f50SLaurent Pinchart }
6509f257f50SLaurent Pinchart
6519f257f50SLaurent Pinchart return 0;
6529f257f50SLaurent Pinchart }
6539f257f50SLaurent Pinchart
imx7_csi_deinit(struct imx7_csi * csi,enum vb2_buffer_state return_status)6549f257f50SLaurent Pinchart static void imx7_csi_deinit(struct imx7_csi *csi,
6559f257f50SLaurent Pinchart enum vb2_buffer_state return_status)
6569f257f50SLaurent Pinchart {
6579f257f50SLaurent Pinchart imx7_csi_dma_cleanup(csi, return_status);
6589f257f50SLaurent Pinchart imx7_csi_init_default(csi);
6599f257f50SLaurent Pinchart imx7_csi_dmareq_rff_disable(csi);
6609f257f50SLaurent Pinchart clk_disable_unprepare(csi->mclk);
6619f257f50SLaurent Pinchart }
6629f257f50SLaurent Pinchart
imx7_csi_baseaddr_switch_on_second_frame(struct imx7_csi * csi)6639f257f50SLaurent Pinchart static void imx7_csi_baseaddr_switch_on_second_frame(struct imx7_csi *csi)
6649f257f50SLaurent Pinchart {
6659f257f50SLaurent Pinchart u32 cr18 = imx7_csi_reg_read(csi, CSI_CSICR18);
6669f257f50SLaurent Pinchart
6679f257f50SLaurent Pinchart cr18 |= BIT_BASEADDR_SWITCH_EN | BIT_BASEADDR_SWITCH_SEL |
6689f257f50SLaurent Pinchart BIT_BASEADDR_CHG_ERR_EN;
6699f257f50SLaurent Pinchart cr18 |= BIT_MASK_OPTION_SECOND_FRAME;
6709f257f50SLaurent Pinchart imx7_csi_reg_write(csi, cr18, CSI_CSICR18);
6719f257f50SLaurent Pinchart }
6729f257f50SLaurent Pinchart
imx7_csi_enable(struct imx7_csi * csi)6739f257f50SLaurent Pinchart static void imx7_csi_enable(struct imx7_csi *csi)
6749f257f50SLaurent Pinchart {
6759f257f50SLaurent Pinchart /* Clear the Rx FIFO and reflash the DMA controller. */
6769f257f50SLaurent Pinchart imx7_csi_rx_fifo_clear(csi);
6779f257f50SLaurent Pinchart imx7_csi_dma_reflash(csi);
6789f257f50SLaurent Pinchart
6799f257f50SLaurent Pinchart usleep_range(2000, 3000);
6809f257f50SLaurent Pinchart
6819f257f50SLaurent Pinchart /* Clear and enable the interrupts. */
6829f257f50SLaurent Pinchart imx7_csi_irq_clear(csi);
6839f257f50SLaurent Pinchart imx7_csi_hw_enable_irq(csi);
6849f257f50SLaurent Pinchart
6859f257f50SLaurent Pinchart /* Enable the RxFIFO DMA and the CSI. */
6869f257f50SLaurent Pinchart imx7_csi_dmareq_rff_enable(csi);
6879f257f50SLaurent Pinchart imx7_csi_hw_enable(csi);
6889f257f50SLaurent Pinchart
6899f257f50SLaurent Pinchart if (csi->model == IMX7_CSI_IMX8MQ)
6909f257f50SLaurent Pinchart imx7_csi_baseaddr_switch_on_second_frame(csi);
6919f257f50SLaurent Pinchart }
6929f257f50SLaurent Pinchart
imx7_csi_disable(struct imx7_csi * csi)6939f257f50SLaurent Pinchart static void imx7_csi_disable(struct imx7_csi *csi)
6949f257f50SLaurent Pinchart {
6959f257f50SLaurent Pinchart imx7_csi_dma_stop(csi);
6969f257f50SLaurent Pinchart
6979f257f50SLaurent Pinchart imx7_csi_dmareq_rff_disable(csi);
6989f257f50SLaurent Pinchart
6999f257f50SLaurent Pinchart imx7_csi_hw_disable_irq(csi);
7009f257f50SLaurent Pinchart
7019f257f50SLaurent Pinchart imx7_csi_hw_disable(csi);
7029f257f50SLaurent Pinchart }
7039f257f50SLaurent Pinchart
7049f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
7059f257f50SLaurent Pinchart * Interrupt Handling
7069f257f50SLaurent Pinchart */
7079f257f50SLaurent Pinchart
imx7_csi_error_recovery(struct imx7_csi * csi)7089f257f50SLaurent Pinchart static void imx7_csi_error_recovery(struct imx7_csi *csi)
7099f257f50SLaurent Pinchart {
7109f257f50SLaurent Pinchart imx7_csi_hw_disable(csi);
7119f257f50SLaurent Pinchart
7129f257f50SLaurent Pinchart imx7_csi_rx_fifo_clear(csi);
7139f257f50SLaurent Pinchart
7149f257f50SLaurent Pinchart imx7_csi_dma_reflash(csi);
7159f257f50SLaurent Pinchart
7169f257f50SLaurent Pinchart imx7_csi_hw_enable(csi);
7179f257f50SLaurent Pinchart }
7189f257f50SLaurent Pinchart
imx7_csi_vb2_buf_done(struct imx7_csi * csi)7199f257f50SLaurent Pinchart static void imx7_csi_vb2_buf_done(struct imx7_csi *csi)
7209f257f50SLaurent Pinchart {
7219f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *done, *next;
7229f257f50SLaurent Pinchart struct vb2_buffer *vb;
7239f257f50SLaurent Pinchart dma_addr_t dma_addr;
7249f257f50SLaurent Pinchart
7259f257f50SLaurent Pinchart done = csi->active_vb2_buf[csi->buf_num];
7269f257f50SLaurent Pinchart if (done) {
7279f257f50SLaurent Pinchart done->vbuf.field = csi->vdev_fmt.field;
7289f257f50SLaurent Pinchart done->vbuf.sequence = csi->frame_sequence;
7299f257f50SLaurent Pinchart vb = &done->vbuf.vb2_buf;
7309f257f50SLaurent Pinchart vb->timestamp = ktime_get_ns();
7319f257f50SLaurent Pinchart vb2_buffer_done(vb, VB2_BUF_STATE_DONE);
7329f257f50SLaurent Pinchart }
7339f257f50SLaurent Pinchart csi->frame_sequence++;
7349f257f50SLaurent Pinchart
7359f257f50SLaurent Pinchart /* get next queued buffer */
7369f257f50SLaurent Pinchart next = imx7_csi_video_next_buf(csi);
7379f257f50SLaurent Pinchart if (next) {
7389f257f50SLaurent Pinchart dma_addr = vb2_dma_contig_plane_dma_addr(&next->vbuf.vb2_buf, 0);
7399f257f50SLaurent Pinchart csi->active_vb2_buf[csi->buf_num] = next;
7409f257f50SLaurent Pinchart } else {
7419f257f50SLaurent Pinchart dma_addr = csi->underrun_buf.dma_addr;
7429f257f50SLaurent Pinchart csi->active_vb2_buf[csi->buf_num] = NULL;
7439f257f50SLaurent Pinchart }
7449f257f50SLaurent Pinchart
7459f257f50SLaurent Pinchart imx7_csi_update_buf(csi, dma_addr, csi->buf_num);
7469f257f50SLaurent Pinchart }
7479f257f50SLaurent Pinchart
imx7_csi_irq_handler(int irq,void * data)7489f257f50SLaurent Pinchart static irqreturn_t imx7_csi_irq_handler(int irq, void *data)
7499f257f50SLaurent Pinchart {
7509f257f50SLaurent Pinchart struct imx7_csi *csi = data;
7519f257f50SLaurent Pinchart u32 status;
7529f257f50SLaurent Pinchart
7539f257f50SLaurent Pinchart spin_lock(&csi->irqlock);
7549f257f50SLaurent Pinchart
7559f257f50SLaurent Pinchart status = imx7_csi_irq_clear(csi);
7569f257f50SLaurent Pinchart
7579f257f50SLaurent Pinchart if (status & BIT_RFF_OR_INT) {
7589f257f50SLaurent Pinchart dev_warn(csi->dev, "Rx fifo overflow\n");
7599f257f50SLaurent Pinchart imx7_csi_error_recovery(csi);
7609f257f50SLaurent Pinchart }
7619f257f50SLaurent Pinchart
7629f257f50SLaurent Pinchart if (status & BIT_HRESP_ERR_INT) {
7639f257f50SLaurent Pinchart dev_warn(csi->dev, "Hresponse error detected\n");
7649f257f50SLaurent Pinchart imx7_csi_error_recovery(csi);
7659f257f50SLaurent Pinchart }
7669f257f50SLaurent Pinchart
7679f257f50SLaurent Pinchart if (status & BIT_ADDR_CH_ERR_INT) {
7689f257f50SLaurent Pinchart imx7_csi_hw_disable(csi);
7699f257f50SLaurent Pinchart
7709f257f50SLaurent Pinchart imx7_csi_dma_reflash(csi);
7719f257f50SLaurent Pinchart
7729f257f50SLaurent Pinchart imx7_csi_hw_enable(csi);
7739f257f50SLaurent Pinchart }
7749f257f50SLaurent Pinchart
7759f257f50SLaurent Pinchart if ((status & BIT_DMA_TSF_DONE_FB1) &&
7769f257f50SLaurent Pinchart (status & BIT_DMA_TSF_DONE_FB2)) {
7779f257f50SLaurent Pinchart /*
7789f257f50SLaurent Pinchart * For both FB1 and FB2 interrupter bits set case,
7799f257f50SLaurent Pinchart * CSI DMA is work in one of FB1 and FB2 buffer,
7809f257f50SLaurent Pinchart * but software can not know the state.
7819f257f50SLaurent Pinchart * Skip it to avoid base address updated
7829f257f50SLaurent Pinchart * when csi work in field0 and field1 will write to
7839f257f50SLaurent Pinchart * new base address.
7849f257f50SLaurent Pinchart */
7859f257f50SLaurent Pinchart } else if (status & BIT_DMA_TSF_DONE_FB1) {
7869f257f50SLaurent Pinchart csi->buf_num = 0;
7879f257f50SLaurent Pinchart } else if (status & BIT_DMA_TSF_DONE_FB2) {
7889f257f50SLaurent Pinchart csi->buf_num = 1;
7899f257f50SLaurent Pinchart }
7909f257f50SLaurent Pinchart
7919f257f50SLaurent Pinchart if ((status & BIT_DMA_TSF_DONE_FB1) ||
7929f257f50SLaurent Pinchart (status & BIT_DMA_TSF_DONE_FB2)) {
7939f257f50SLaurent Pinchart imx7_csi_vb2_buf_done(csi);
7949f257f50SLaurent Pinchart
7959f257f50SLaurent Pinchart if (csi->last_eof) {
7969f257f50SLaurent Pinchart complete(&csi->last_eof_completion);
7979f257f50SLaurent Pinchart csi->last_eof = false;
7989f257f50SLaurent Pinchart }
7999f257f50SLaurent Pinchart }
8009f257f50SLaurent Pinchart
8019f257f50SLaurent Pinchart spin_unlock(&csi->irqlock);
8029f257f50SLaurent Pinchart
8039f257f50SLaurent Pinchart return IRQ_HANDLED;
8049f257f50SLaurent Pinchart }
8059f257f50SLaurent Pinchart
8069f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
8079f257f50SLaurent Pinchart * Format Helpers
8089f257f50SLaurent Pinchart */
8099f257f50SLaurent Pinchart
8109f257f50SLaurent Pinchart #define IMX_BUS_FMTS(fmt...) (const u32[]) {fmt, 0}
8119f257f50SLaurent Pinchart
8129f257f50SLaurent Pinchart /*
8139f257f50SLaurent Pinchart * List of supported pixel formats for the subdevs. Keep V4L2_PIX_FMT_UYVY and
8149f257f50SLaurent Pinchart * MEDIA_BUS_FMT_UYVY8_2X8 first to match IMX7_CSI_DEF_PIX_FORMAT and
8159f257f50SLaurent Pinchart * IMX7_CSI_DEF_MBUS_CODE.
8169f257f50SLaurent Pinchart *
8179f257f50SLaurent Pinchart * TODO: Restrict the supported formats list based on the SoC integration.
8189f257f50SLaurent Pinchart *
8199f257f50SLaurent Pinchart * The CSI bridge can be configured to sample pixel components from the Rx queue
8209f257f50SLaurent Pinchart * in single (8bpp) or double (16bpp) component modes. Image format variants
8219f257f50SLaurent Pinchart * with different sample sizes (ie YUYV_2X8 vs YUYV_1X16) determine the pixel
8229f257f50SLaurent Pinchart * components sampling size per each clock cycle and their packing mode (see
8239f257f50SLaurent Pinchart * imx7_csi_configure() for details).
8249f257f50SLaurent Pinchart *
8259f257f50SLaurent Pinchart * As the CSI bridge can be interfaced with different IP blocks depending on the
8269f257f50SLaurent Pinchart * SoC model it is integrated on, the Rx queue sampling size should match the
8279f257f50SLaurent Pinchart * size of the samples transferred by the transmitting IP block. To avoid
8289f257f50SLaurent Pinchart * misconfigurations of the capture pipeline, the enumeration of the supported
8299f257f50SLaurent Pinchart * formats should be restricted to match the pixel source transmitting mode.
8309f257f50SLaurent Pinchart *
8319f257f50SLaurent Pinchart * Example: i.MX8MM SoC integrates the CSI bridge with the Samsung CSIS CSI-2
8329f257f50SLaurent Pinchart * receiver which operates in dual pixel sampling mode. The CSI bridge should
8339f257f50SLaurent Pinchart * only expose the 1X16 formats variant which instructs it to operate in dual
8349f257f50SLaurent Pinchart * pixel sampling mode. When the CSI bridge is instead integrated on an i.MX7,
8359f257f50SLaurent Pinchart * which supports both serial and parallel input, it should expose both
8369f257f50SLaurent Pinchart * variants.
8379f257f50SLaurent Pinchart *
8389f257f50SLaurent Pinchart * This currently only applies to YUYV formats, but other formats might need to
8399f257f50SLaurent Pinchart * be handled in the same way.
8409f257f50SLaurent Pinchart */
8419f257f50SLaurent Pinchart static const struct imx7_csi_pixfmt pixel_formats[] = {
8429f257f50SLaurent Pinchart /*** YUV formats start here ***/
8439f257f50SLaurent Pinchart {
8449f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_UYVY,
8459f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(
8469f257f50SLaurent Pinchart MEDIA_BUS_FMT_UYVY8_2X8,
8479f257f50SLaurent Pinchart MEDIA_BUS_FMT_UYVY8_1X16
8489f257f50SLaurent Pinchart ),
8499f257f50SLaurent Pinchart .yuv = true,
8509f257f50SLaurent Pinchart .bpp = 16,
8519f257f50SLaurent Pinchart }, {
8529f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_YUYV,
8539f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(
8549f257f50SLaurent Pinchart MEDIA_BUS_FMT_YUYV8_2X8,
8559f257f50SLaurent Pinchart MEDIA_BUS_FMT_YUYV8_1X16
8569f257f50SLaurent Pinchart ),
8579f257f50SLaurent Pinchart .yuv = true,
8589f257f50SLaurent Pinchart .bpp = 16,
8599f257f50SLaurent Pinchart },
8609f257f50SLaurent Pinchart /*** raw bayer and grayscale formats start here ***/
8619f257f50SLaurent Pinchart {
8629f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SBGGR8,
8639f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SBGGR8_1X8),
8649f257f50SLaurent Pinchart .bpp = 8,
8659f257f50SLaurent Pinchart }, {
8669f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGBRG8,
8679f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGBRG8_1X8),
8689f257f50SLaurent Pinchart .bpp = 8,
8699f257f50SLaurent Pinchart }, {
8709f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGRBG8,
8719f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGRBG8_1X8),
8729f257f50SLaurent Pinchart .bpp = 8,
8739f257f50SLaurent Pinchart }, {
8749f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SRGGB8,
8759f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SRGGB8_1X8),
8769f257f50SLaurent Pinchart .bpp = 8,
8779f257f50SLaurent Pinchart }, {
8789f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SBGGR10,
8799f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SBGGR10_1X10),
8809f257f50SLaurent Pinchart .bpp = 16,
8819f257f50SLaurent Pinchart }, {
8829f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGBRG10,
8839f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGBRG10_1X10),
8849f257f50SLaurent Pinchart .bpp = 16,
8859f257f50SLaurent Pinchart }, {
8869f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGRBG10,
8879f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGRBG10_1X10),
8889f257f50SLaurent Pinchart .bpp = 16,
8899f257f50SLaurent Pinchart }, {
8909f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SRGGB10,
8919f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SRGGB10_1X10),
8929f257f50SLaurent Pinchart .bpp = 16,
8939f257f50SLaurent Pinchart }, {
8949f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SBGGR12,
8959f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SBGGR12_1X12),
8969f257f50SLaurent Pinchart .bpp = 16,
8979f257f50SLaurent Pinchart }, {
8989f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGBRG12,
8999f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGBRG12_1X12),
9009f257f50SLaurent Pinchart .bpp = 16,
9019f257f50SLaurent Pinchart }, {
9029f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGRBG12,
9039f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGRBG12_1X12),
9049f257f50SLaurent Pinchart .bpp = 16,
9059f257f50SLaurent Pinchart }, {
9069f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SRGGB12,
9079f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SRGGB12_1X12),
9089f257f50SLaurent Pinchart .bpp = 16,
9099f257f50SLaurent Pinchart }, {
9109f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SBGGR14,
9119f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SBGGR14_1X14),
9129f257f50SLaurent Pinchart .bpp = 16,
9139f257f50SLaurent Pinchart }, {
9149f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGBRG14,
9159f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGBRG14_1X14),
9169f257f50SLaurent Pinchart .bpp = 16,
9179f257f50SLaurent Pinchart }, {
9189f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SGRBG14,
9199f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SGRBG14_1X14),
9209f257f50SLaurent Pinchart .bpp = 16,
9219f257f50SLaurent Pinchart }, {
9229f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_SRGGB14,
9239f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_SRGGB14_1X14),
9249f257f50SLaurent Pinchart .bpp = 16,
9259f257f50SLaurent Pinchart }, {
9269f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_GREY,
9279f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_Y8_1X8),
9289f257f50SLaurent Pinchart .bpp = 8,
9299f257f50SLaurent Pinchart }, {
9309f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_Y10,
9319f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_Y10_1X10),
9329f257f50SLaurent Pinchart .bpp = 16,
9339f257f50SLaurent Pinchart }, {
9349f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_Y12,
9359f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_Y12_1X12),
9369f257f50SLaurent Pinchart .bpp = 16,
9379f257f50SLaurent Pinchart }, {
9389f257f50SLaurent Pinchart .fourcc = V4L2_PIX_FMT_Y14,
9399f257f50SLaurent Pinchart .codes = IMX_BUS_FMTS(MEDIA_BUS_FMT_Y14_1X14),
9409f257f50SLaurent Pinchart .bpp = 16,
9419f257f50SLaurent Pinchart },
9429f257f50SLaurent Pinchart };
9439f257f50SLaurent Pinchart
9449f257f50SLaurent Pinchart /*
9459f257f50SLaurent Pinchart * Search in the pixel_formats[] array for an entry with the given fourcc
9469f257f50SLaurent Pinchart * return it.
9479f257f50SLaurent Pinchart */
imx7_csi_find_pixel_format(u32 fourcc)9489f257f50SLaurent Pinchart static const struct imx7_csi_pixfmt *imx7_csi_find_pixel_format(u32 fourcc)
9499f257f50SLaurent Pinchart {
9509f257f50SLaurent Pinchart unsigned int i;
9519f257f50SLaurent Pinchart
9529f257f50SLaurent Pinchart for (i = 0; i < ARRAY_SIZE(pixel_formats); i++) {
9539f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *fmt = &pixel_formats[i];
9549f257f50SLaurent Pinchart
9559f257f50SLaurent Pinchart if (fmt->fourcc == fourcc)
9569f257f50SLaurent Pinchart return fmt;
9579f257f50SLaurent Pinchart }
9589f257f50SLaurent Pinchart
9599f257f50SLaurent Pinchart return NULL;
9609f257f50SLaurent Pinchart }
9619f257f50SLaurent Pinchart
9629f257f50SLaurent Pinchart /*
9639f257f50SLaurent Pinchart * Search in the pixel_formats[] array for an entry with the given media
9649f257f50SLaurent Pinchart * bus code and return it.
9659f257f50SLaurent Pinchart */
imx7_csi_find_mbus_format(u32 code)9669f257f50SLaurent Pinchart static const struct imx7_csi_pixfmt *imx7_csi_find_mbus_format(u32 code)
9679f257f50SLaurent Pinchart {
9689f257f50SLaurent Pinchart unsigned int i;
9699f257f50SLaurent Pinchart
9709f257f50SLaurent Pinchart for (i = 0; i < ARRAY_SIZE(pixel_formats); i++) {
9719f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *fmt = &pixel_formats[i];
9729f257f50SLaurent Pinchart unsigned int j;
9739f257f50SLaurent Pinchart
9749f257f50SLaurent Pinchart if (!fmt->codes)
9759f257f50SLaurent Pinchart continue;
9769f257f50SLaurent Pinchart
9779f257f50SLaurent Pinchart for (j = 0; fmt->codes[j]; j++) {
9789f257f50SLaurent Pinchart if (code == fmt->codes[j])
9799f257f50SLaurent Pinchart return fmt;
9809f257f50SLaurent Pinchart }
9819f257f50SLaurent Pinchart }
9829f257f50SLaurent Pinchart
9839f257f50SLaurent Pinchart return NULL;
9849f257f50SLaurent Pinchart }
9859f257f50SLaurent Pinchart
9869f257f50SLaurent Pinchart /*
9879f257f50SLaurent Pinchart * Enumerate entries in the pixel_formats[] array that match the
9889f257f50SLaurent Pinchart * requested search criteria. Return the media-bus code that matches
9899f257f50SLaurent Pinchart * the search criteria at the requested match index.
9909f257f50SLaurent Pinchart *
9919f257f50SLaurent Pinchart * @code: The returned media-bus code that matches the search criteria at
9929f257f50SLaurent Pinchart * the requested match index.
9939f257f50SLaurent Pinchart * @index: The requested match index.
9949f257f50SLaurent Pinchart */
imx7_csi_enum_mbus_formats(u32 * code,u32 index)9959f257f50SLaurent Pinchart static int imx7_csi_enum_mbus_formats(u32 *code, u32 index)
9969f257f50SLaurent Pinchart {
9979f257f50SLaurent Pinchart unsigned int i;
9989f257f50SLaurent Pinchart
9999f257f50SLaurent Pinchart for (i = 0; i < ARRAY_SIZE(pixel_formats); i++) {
10009f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *fmt = &pixel_formats[i];
10019f257f50SLaurent Pinchart unsigned int j;
10029f257f50SLaurent Pinchart
10039f257f50SLaurent Pinchart if (!fmt->codes)
10049f257f50SLaurent Pinchart continue;
10059f257f50SLaurent Pinchart
10069f257f50SLaurent Pinchart for (j = 0; fmt->codes[j]; j++) {
10079f257f50SLaurent Pinchart if (index == 0) {
10089f257f50SLaurent Pinchart *code = fmt->codes[j];
10099f257f50SLaurent Pinchart return 0;
10109f257f50SLaurent Pinchart }
10119f257f50SLaurent Pinchart
10129f257f50SLaurent Pinchart index--;
10139f257f50SLaurent Pinchart }
10149f257f50SLaurent Pinchart }
10159f257f50SLaurent Pinchart
10169f257f50SLaurent Pinchart return -EINVAL;
10179f257f50SLaurent Pinchart }
10189f257f50SLaurent Pinchart
10199f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
10209f257f50SLaurent Pinchart * Video Capture Device - IOCTLs
10219f257f50SLaurent Pinchart */
10229f257f50SLaurent Pinchart
imx7_csi_video_querycap(struct file * file,void * fh,struct v4l2_capability * cap)10239f257f50SLaurent Pinchart static int imx7_csi_video_querycap(struct file *file, void *fh,
10249f257f50SLaurent Pinchart struct v4l2_capability *cap)
10259f257f50SLaurent Pinchart {
10269f257f50SLaurent Pinchart struct imx7_csi *csi = video_drvdata(file);
10279f257f50SLaurent Pinchart
10289f257f50SLaurent Pinchart strscpy(cap->driver, IMX7_CSI_VIDEO_NAME, sizeof(cap->driver));
10299f257f50SLaurent Pinchart strscpy(cap->card, IMX7_CSI_VIDEO_NAME, sizeof(cap->card));
10309f257f50SLaurent Pinchart snprintf(cap->bus_info, sizeof(cap->bus_info),
10319f257f50SLaurent Pinchart "platform:%s", dev_name(csi->dev));
10329f257f50SLaurent Pinchart
10339f257f50SLaurent Pinchart return 0;
10349f257f50SLaurent Pinchart }
10359f257f50SLaurent Pinchart
imx7_csi_video_enum_fmt_vid_cap(struct file * file,void * fh,struct v4l2_fmtdesc * f)10369f257f50SLaurent Pinchart static int imx7_csi_video_enum_fmt_vid_cap(struct file *file, void *fh,
10379f257f50SLaurent Pinchart struct v4l2_fmtdesc *f)
10389f257f50SLaurent Pinchart {
10399f257f50SLaurent Pinchart unsigned int index = f->index;
10409f257f50SLaurent Pinchart unsigned int i;
10419f257f50SLaurent Pinchart
10429f257f50SLaurent Pinchart for (i = 0; i < ARRAY_SIZE(pixel_formats); i++) {
10439f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *fmt = &pixel_formats[i];
10449f257f50SLaurent Pinchart
10459f257f50SLaurent Pinchart /*
10469f257f50SLaurent Pinchart * If a media bus code is specified, only consider formats that
10479f257f50SLaurent Pinchart * match it.
10489f257f50SLaurent Pinchart */
10499f257f50SLaurent Pinchart if (f->mbus_code) {
10509f257f50SLaurent Pinchart unsigned int j;
10519f257f50SLaurent Pinchart
10529f257f50SLaurent Pinchart if (!fmt->codes)
10539f257f50SLaurent Pinchart continue;
10549f257f50SLaurent Pinchart
10559f257f50SLaurent Pinchart for (j = 0; fmt->codes[j]; j++) {
10569f257f50SLaurent Pinchart if (f->mbus_code == fmt->codes[j])
10579f257f50SLaurent Pinchart break;
10589f257f50SLaurent Pinchart }
10599f257f50SLaurent Pinchart
10609f257f50SLaurent Pinchart if (!fmt->codes[j])
10619f257f50SLaurent Pinchart continue;
10629f257f50SLaurent Pinchart }
10639f257f50SLaurent Pinchart
10649f257f50SLaurent Pinchart if (index == 0) {
10659f257f50SLaurent Pinchart f->pixelformat = fmt->fourcc;
10669f257f50SLaurent Pinchart return 0;
10679f257f50SLaurent Pinchart }
10689f257f50SLaurent Pinchart
10699f257f50SLaurent Pinchart index--;
10709f257f50SLaurent Pinchart }
10719f257f50SLaurent Pinchart
10729f257f50SLaurent Pinchart return -EINVAL;
10739f257f50SLaurent Pinchart }
10749f257f50SLaurent Pinchart
imx7_csi_video_enum_framesizes(struct file * file,void * fh,struct v4l2_frmsizeenum * fsize)10759f257f50SLaurent Pinchart static int imx7_csi_video_enum_framesizes(struct file *file, void *fh,
10769f257f50SLaurent Pinchart struct v4l2_frmsizeenum *fsize)
1077*6308759eSLaurent Pinchart {
10789f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
10799f257f50SLaurent Pinchart u32 walign;
10809f257f50SLaurent Pinchart
10819f257f50SLaurent Pinchart if (fsize->index > 0)
10829f257f50SLaurent Pinchart return -EINVAL;
10839f257f50SLaurent Pinchart
10849f257f50SLaurent Pinchart cc = imx7_csi_find_pixel_format(fsize->pixel_format);
10859f257f50SLaurent Pinchart if (!cc)
10869f257f50SLaurent Pinchart return -EINVAL;
1087*6308759eSLaurent Pinchart
1088*6308759eSLaurent Pinchart /*
10899f257f50SLaurent Pinchart * The width alignment is 8 bytes as indicated by the
1090*6308759eSLaurent Pinchart * CSI_IMAG_PARA.IMAGE_WIDTH documentation. Convert it to pixels.
1091*6308759eSLaurent Pinchart */
10929f257f50SLaurent Pinchart walign = 8 * 8 / cc->bpp;
1093*6308759eSLaurent Pinchart
1094*6308759eSLaurent Pinchart fsize->type = V4L2_FRMSIZE_TYPE_CONTINUOUS;
10959f257f50SLaurent Pinchart fsize->stepwise.min_width = walign;
10969f257f50SLaurent Pinchart fsize->stepwise.max_width = round_down(65535U, walign);
1097*6308759eSLaurent Pinchart fsize->stepwise.min_height = 1;
10989f257f50SLaurent Pinchart fsize->stepwise.max_height = 65535;
10999f257f50SLaurent Pinchart fsize->stepwise.step_width = walign;
11009f257f50SLaurent Pinchart fsize->stepwise.step_height = 1;
11019f257f50SLaurent Pinchart
11029f257f50SLaurent Pinchart return 0;
11039f257f50SLaurent Pinchart }
11049f257f50SLaurent Pinchart
imx7_csi_video_g_fmt_vid_cap(struct file * file,void * fh,struct v4l2_format * f)11059f257f50SLaurent Pinchart static int imx7_csi_video_g_fmt_vid_cap(struct file *file, void *fh,
11069f257f50SLaurent Pinchart struct v4l2_format *f)
11079f257f50SLaurent Pinchart {
11089f257f50SLaurent Pinchart struct imx7_csi *csi = video_drvdata(file);
11099f257f50SLaurent Pinchart
11109f257f50SLaurent Pinchart f->fmt.pix = csi->vdev_fmt;
11119f257f50SLaurent Pinchart
11129f257f50SLaurent Pinchart return 0;
11139f257f50SLaurent Pinchart }
11149f257f50SLaurent Pinchart
11159f257f50SLaurent Pinchart static const struct imx7_csi_pixfmt *
__imx7_csi_video_try_fmt(struct v4l2_pix_format * pixfmt,struct v4l2_rect * compose)11169f257f50SLaurent Pinchart __imx7_csi_video_try_fmt(struct v4l2_pix_format *pixfmt,
11179f257f50SLaurent Pinchart struct v4l2_rect *compose)
1118bef1bb62SAlexander Stein {
11199f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
11206f482c47SAlexander Stein u32 walign;
11216f482c47SAlexander Stein
11226f482c47SAlexander Stein if (compose) {
11236f482c47SAlexander Stein compose->width = pixfmt->width;
11246f482c47SAlexander Stein compose->height = pixfmt->height;
11259f257f50SLaurent Pinchart }
11269f257f50SLaurent Pinchart
11279f257f50SLaurent Pinchart /*
11289f257f50SLaurent Pinchart * Find the pixel format, default to the first supported format if not
11299f257f50SLaurent Pinchart * found.
11309f257f50SLaurent Pinchart */
11319f257f50SLaurent Pinchart cc = imx7_csi_find_pixel_format(pixfmt->pixelformat);
11329f257f50SLaurent Pinchart if (!cc) {
11339f257f50SLaurent Pinchart pixfmt->pixelformat = IMX7_CSI_DEF_PIX_FORMAT;
11349f257f50SLaurent Pinchart cc = imx7_csi_find_pixel_format(pixfmt->pixelformat);
11356f482c47SAlexander Stein }
1136bef1bb62SAlexander Stein
1137bef1bb62SAlexander Stein /*
11386f482c47SAlexander Stein * The width alignment is 8 bytes as indicated by the
1139bef1bb62SAlexander Stein * CSI_IMAG_PARA.IMAGE_WIDTH documentation. Convert it to pixels.
11406f482c47SAlexander Stein *
1141bef1bb62SAlexander Stein * TODO: Implement configurable stride support.
1142bef1bb62SAlexander Stein */
11436f482c47SAlexander Stein walign = 8 * 8 / cc->bpp;
11449f257f50SLaurent Pinchart pixfmt->width = clamp(round_up(pixfmt->width, walign), walign,
11456f482c47SAlexander Stein round_down(65535U, walign));
11466f482c47SAlexander Stein pixfmt->height = clamp(pixfmt->height, 1U, 65535U);
114779bb4c7dSAlexander Stein
11489f257f50SLaurent Pinchart pixfmt->bytesperline = pixfmt->width * cc->bpp / 8;
11499f257f50SLaurent Pinchart pixfmt->sizeimage = pixfmt->bytesperline * pixfmt->height;
11509f257f50SLaurent Pinchart pixfmt->field = V4L2_FIELD_NONE;
11519f257f50SLaurent Pinchart
11529f257f50SLaurent Pinchart return cc;
11539f257f50SLaurent Pinchart }
11549f257f50SLaurent Pinchart
imx7_csi_video_try_fmt_vid_cap(struct file * file,void * fh,struct v4l2_format * f)11559f257f50SLaurent Pinchart static int imx7_csi_video_try_fmt_vid_cap(struct file *file, void *fh,
11569f257f50SLaurent Pinchart struct v4l2_format *f)
11579f257f50SLaurent Pinchart {
11589f257f50SLaurent Pinchart __imx7_csi_video_try_fmt(&f->fmt.pix, NULL);
11599f257f50SLaurent Pinchart return 0;
11609f257f50SLaurent Pinchart }
11619f257f50SLaurent Pinchart
imx7_csi_video_s_fmt_vid_cap(struct file * file,void * fh,struct v4l2_format * f)11629f257f50SLaurent Pinchart static int imx7_csi_video_s_fmt_vid_cap(struct file *file, void *fh,
11639f257f50SLaurent Pinchart struct v4l2_format *f)
11649f257f50SLaurent Pinchart {
11659f257f50SLaurent Pinchart struct imx7_csi *csi = video_drvdata(file);
11669f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
11679f257f50SLaurent Pinchart
11689f257f50SLaurent Pinchart if (vb2_is_busy(&csi->q)) {
11699f257f50SLaurent Pinchart dev_err(csi->dev, "%s queue busy\n", __func__);
11709f257f50SLaurent Pinchart return -EBUSY;
11719f257f50SLaurent Pinchart }
11729f257f50SLaurent Pinchart
11739f257f50SLaurent Pinchart cc = __imx7_csi_video_try_fmt(&f->fmt.pix, &csi->vdev_compose);
11749f257f50SLaurent Pinchart
11759f257f50SLaurent Pinchart csi->vdev_cc = cc;
11769f257f50SLaurent Pinchart csi->vdev_fmt = f->fmt.pix;
11779f257f50SLaurent Pinchart
11789f257f50SLaurent Pinchart return 0;
11799f257f50SLaurent Pinchart }
11809f257f50SLaurent Pinchart
imx7_csi_video_g_selection(struct file * file,void * fh,struct v4l2_selection * s)11819f257f50SLaurent Pinchart static int imx7_csi_video_g_selection(struct file *file, void *fh,
11829f257f50SLaurent Pinchart struct v4l2_selection *s)
11836cf9e357SAlexander Stein {
11846cf9e357SAlexander Stein struct imx7_csi *csi = video_drvdata(file);
11856cf9e357SAlexander Stein
11869f257f50SLaurent Pinchart if (s->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
11879f257f50SLaurent Pinchart return -EINVAL;
11889f257f50SLaurent Pinchart
11899f257f50SLaurent Pinchart switch (s->target) {
11909f257f50SLaurent Pinchart case V4L2_SEL_TGT_COMPOSE:
11919f257f50SLaurent Pinchart case V4L2_SEL_TGT_COMPOSE_DEFAULT:
11929f257f50SLaurent Pinchart case V4L2_SEL_TGT_COMPOSE_BOUNDS:
11939f257f50SLaurent Pinchart /* The compose rectangle is fixed to the source format. */
11949f257f50SLaurent Pinchart s->r = csi->vdev_compose;
11959f257f50SLaurent Pinchart break;
11969f257f50SLaurent Pinchart case V4L2_SEL_TGT_COMPOSE_PADDED:
11979f257f50SLaurent Pinchart /*
11989f257f50SLaurent Pinchart * The hardware writes with a configurable but fixed DMA burst
11999f257f50SLaurent Pinchart * size. If the source format width is not burst size aligned,
12009f257f50SLaurent Pinchart * the written frame contains padding to the right.
12019f257f50SLaurent Pinchart */
12029f257f50SLaurent Pinchart s->r.left = 0;
12039f257f50SLaurent Pinchart s->r.top = 0;
12049f257f50SLaurent Pinchart s->r.width = csi->vdev_fmt.width;
12059f257f50SLaurent Pinchart s->r.height = csi->vdev_fmt.height;
12069f257f50SLaurent Pinchart break;
12079f257f50SLaurent Pinchart default:
12089f257f50SLaurent Pinchart return -EINVAL;
12099f257f50SLaurent Pinchart }
12109f257f50SLaurent Pinchart
12119f257f50SLaurent Pinchart return 0;
12129f257f50SLaurent Pinchart }
12139f257f50SLaurent Pinchart
12149f257f50SLaurent Pinchart static const struct v4l2_ioctl_ops imx7_csi_video_ioctl_ops = {
12159f257f50SLaurent Pinchart .vidioc_querycap = imx7_csi_video_querycap,
12169f257f50SLaurent Pinchart
12179f257f50SLaurent Pinchart .vidioc_enum_fmt_vid_cap = imx7_csi_video_enum_fmt_vid_cap,
12189f257f50SLaurent Pinchart .vidioc_enum_framesizes = imx7_csi_video_enum_framesizes,
12199f257f50SLaurent Pinchart
12209f257f50SLaurent Pinchart .vidioc_g_fmt_vid_cap = imx7_csi_video_g_fmt_vid_cap,
12219f257f50SLaurent Pinchart .vidioc_try_fmt_vid_cap = imx7_csi_video_try_fmt_vid_cap,
12229f257f50SLaurent Pinchart .vidioc_s_fmt_vid_cap = imx7_csi_video_s_fmt_vid_cap,
12239f257f50SLaurent Pinchart
12249f257f50SLaurent Pinchart .vidioc_g_selection = imx7_csi_video_g_selection,
12259f257f50SLaurent Pinchart
12269f257f50SLaurent Pinchart .vidioc_reqbufs = vb2_ioctl_reqbufs,
12279f257f50SLaurent Pinchart .vidioc_create_bufs = vb2_ioctl_create_bufs,
12289f257f50SLaurent Pinchart .vidioc_prepare_buf = vb2_ioctl_prepare_buf,
12299f257f50SLaurent Pinchart .vidioc_querybuf = vb2_ioctl_querybuf,
12309f257f50SLaurent Pinchart .vidioc_qbuf = vb2_ioctl_qbuf,
12319f257f50SLaurent Pinchart .vidioc_dqbuf = vb2_ioctl_dqbuf,
12329f257f50SLaurent Pinchart .vidioc_expbuf = vb2_ioctl_expbuf,
12339f257f50SLaurent Pinchart .vidioc_streamon = vb2_ioctl_streamon,
12349f257f50SLaurent Pinchart .vidioc_streamoff = vb2_ioctl_streamoff,
12359f257f50SLaurent Pinchart };
12369f257f50SLaurent Pinchart
12379f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
12389f257f50SLaurent Pinchart * Video Capture Device - Queue Operations
12399f257f50SLaurent Pinchart */
12409f257f50SLaurent Pinchart
imx7_csi_video_queue_setup(struct vb2_queue * vq,unsigned int * nbuffers,unsigned int * nplanes,unsigned int sizes[],struct device * alloc_devs[])12419f257f50SLaurent Pinchart static int imx7_csi_video_queue_setup(struct vb2_queue *vq,
12429f257f50SLaurent Pinchart unsigned int *nbuffers,
12439f257f50SLaurent Pinchart unsigned int *nplanes,
12449f257f50SLaurent Pinchart unsigned int sizes[],
12459f257f50SLaurent Pinchart struct device *alloc_devs[])
12469f257f50SLaurent Pinchart {
12479f257f50SLaurent Pinchart struct imx7_csi *csi = vb2_get_drv_priv(vq);
12489f257f50SLaurent Pinchart struct v4l2_pix_format *pix = &csi->vdev_fmt;
12499f257f50SLaurent Pinchart unsigned int count = *nbuffers;
12509f257f50SLaurent Pinchart
12519f257f50SLaurent Pinchart if (vq->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
12529f257f50SLaurent Pinchart return -EINVAL;
12539f257f50SLaurent Pinchart
12549f257f50SLaurent Pinchart if (*nplanes) {
12559f257f50SLaurent Pinchart if (*nplanes != 1 || sizes[0] < pix->sizeimage)
12569f257f50SLaurent Pinchart return -EINVAL;
12579f257f50SLaurent Pinchart count += vq->num_buffers;
12589f257f50SLaurent Pinchart }
12599f257f50SLaurent Pinchart
12609f257f50SLaurent Pinchart count = min_t(__u32, IMX7_CSI_VIDEO_MEM_LIMIT / pix->sizeimage, count);
12619f257f50SLaurent Pinchart
12629f257f50SLaurent Pinchart if (*nplanes)
12639f257f50SLaurent Pinchart *nbuffers = (count < vq->num_buffers) ? 0 :
12649f257f50SLaurent Pinchart count - vq->num_buffers;
12659f257f50SLaurent Pinchart else
12669f257f50SLaurent Pinchart *nbuffers = count;
12679f257f50SLaurent Pinchart
12689f257f50SLaurent Pinchart *nplanes = 1;
12699f257f50SLaurent Pinchart sizes[0] = pix->sizeimage;
12709f257f50SLaurent Pinchart
12719f257f50SLaurent Pinchart return 0;
12729f257f50SLaurent Pinchart }
12739f257f50SLaurent Pinchart
imx7_csi_video_buf_init(struct vb2_buffer * vb)12749f257f50SLaurent Pinchart static int imx7_csi_video_buf_init(struct vb2_buffer *vb)
12759f257f50SLaurent Pinchart {
12769f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf = to_imx7_csi_vb2_buffer(vb);
12779f257f50SLaurent Pinchart
12789f257f50SLaurent Pinchart INIT_LIST_HEAD(&buf->list);
12799f257f50SLaurent Pinchart
12809f257f50SLaurent Pinchart return 0;
12819f257f50SLaurent Pinchart }
12829f257f50SLaurent Pinchart
imx7_csi_video_buf_prepare(struct vb2_buffer * vb)12839f257f50SLaurent Pinchart static int imx7_csi_video_buf_prepare(struct vb2_buffer *vb)
12849f257f50SLaurent Pinchart {
12859f257f50SLaurent Pinchart struct imx7_csi *csi = vb2_get_drv_priv(vb->vb2_queue);
12869f257f50SLaurent Pinchart struct v4l2_pix_format *pix = &csi->vdev_fmt;
12879f257f50SLaurent Pinchart
12889f257f50SLaurent Pinchart if (vb2_plane_size(vb, 0) < pix->sizeimage) {
12899f257f50SLaurent Pinchart dev_err(csi->dev,
12909f257f50SLaurent Pinchart "data will not fit into plane (%lu < %lu)\n",
12919f257f50SLaurent Pinchart vb2_plane_size(vb, 0), (long)pix->sizeimage);
12929f257f50SLaurent Pinchart return -EINVAL;
12939f257f50SLaurent Pinchart }
12949f257f50SLaurent Pinchart
12959f257f50SLaurent Pinchart vb2_set_plane_payload(vb, 0, pix->sizeimage);
12969f257f50SLaurent Pinchart
12979f257f50SLaurent Pinchart return 0;
12989f257f50SLaurent Pinchart }
12999f257f50SLaurent Pinchart
imx7_csi_fast_track_buffer(struct imx7_csi * csi,struct imx7_csi_vb2_buffer * buf)13009f257f50SLaurent Pinchart static bool imx7_csi_fast_track_buffer(struct imx7_csi *csi,
13019f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf)
13029f257f50SLaurent Pinchart {
13039f257f50SLaurent Pinchart unsigned long flags;
13049f257f50SLaurent Pinchart dma_addr_t dma_addr;
13059f257f50SLaurent Pinchart int buf_num;
13069f257f50SLaurent Pinchart u32 isr;
13079f257f50SLaurent Pinchart
13089f257f50SLaurent Pinchart if (!csi->is_streaming)
13099f257f50SLaurent Pinchart return false;
13109f257f50SLaurent Pinchart
13119f257f50SLaurent Pinchart dma_addr = vb2_dma_contig_plane_dma_addr(&buf->vbuf.vb2_buf, 0);
13129f257f50SLaurent Pinchart
13139f257f50SLaurent Pinchart /*
13149f257f50SLaurent Pinchart * buf_num holds the framebuffer ID of the most recently (*not* the
13159f257f50SLaurent Pinchart * next anticipated) triggered interrupt. Without loss of generality,
13169f257f50SLaurent Pinchart * if buf_num is 0, the hardware is capturing to FB2. If FB1 has been
13179f257f50SLaurent Pinchart * programmed with a dummy buffer (as indicated by active_vb2_buf[0]
13189f257f50SLaurent Pinchart * being NULL), then we can fast-track the new buffer by programming
13199f257f50SLaurent Pinchart * its address in FB1 before the hardware completes FB2, instead of
13209f257f50SLaurent Pinchart * adding it to the buffer queue and incurring a delay of one
13219f257f50SLaurent Pinchart * additional frame.
13229f257f50SLaurent Pinchart *
13239f257f50SLaurent Pinchart * The irqlock prevents races with the interrupt handler that updates
13249f257f50SLaurent Pinchart * buf_num when it programs the next buffer, but we can still race with
13259f257f50SLaurent Pinchart * the hardware if we program the buffer in FB1 just after the hardware
13269f257f50SLaurent Pinchart * completes FB2 and switches to FB1 and before buf_num can be updated
13279f257f50SLaurent Pinchart * by the interrupt handler for FB2. The fast-tracked buffer would
13289f257f50SLaurent Pinchart * then be ignored by the hardware while the driver would think it has
13299f257f50SLaurent Pinchart * successfully been processed.
13309f257f50SLaurent Pinchart *
13319f257f50SLaurent Pinchart * To avoid this problem, if we can't avoid the race, we can detect
13329f257f50SLaurent Pinchart * that we have lost it by checking, after programming the buffer in
13339f257f50SLaurent Pinchart * FB1, if the interrupt flag indicating completion of FB2 has been
13349f257f50SLaurent Pinchart * raised. If that is not the case, fast-tracking succeeded, and we can
13359f257f50SLaurent Pinchart * update active_vb2_buf[0]. Otherwise, we may or may not have lost the
13369f257f50SLaurent Pinchart * race (as the interrupt flag may have been raised just after
13379f257f50SLaurent Pinchart * programming FB1 and before we read the interrupt status register),
13389f257f50SLaurent Pinchart * and we need to assume the worst case of a race loss and queue the
13399f257f50SLaurent Pinchart * buffer through the slow path.
13409f257f50SLaurent Pinchart */
13419f257f50SLaurent Pinchart
13429f257f50SLaurent Pinchart spin_lock_irqsave(&csi->irqlock, flags);
13439f257f50SLaurent Pinchart
13449f257f50SLaurent Pinchart buf_num = csi->buf_num;
13459f257f50SLaurent Pinchart if (csi->active_vb2_buf[buf_num]) {
13469f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->irqlock, flags);
13479f257f50SLaurent Pinchart return false;
13489f257f50SLaurent Pinchart }
13499f257f50SLaurent Pinchart
13509f257f50SLaurent Pinchart imx7_csi_update_buf(csi, dma_addr, buf_num);
13519f257f50SLaurent Pinchart
13529f257f50SLaurent Pinchart isr = imx7_csi_reg_read(csi, CSI_CSISR);
13539f257f50SLaurent Pinchart if (isr & (buf_num ? BIT_DMA_TSF_DONE_FB1 : BIT_DMA_TSF_DONE_FB2)) {
13549f257f50SLaurent Pinchart /*
13559f257f50SLaurent Pinchart * The interrupt for the /other/ FB just came (the isr hasn't
13569f257f50SLaurent Pinchart * run yet though, because we have the lock here); we can't be
13579f257f50SLaurent Pinchart * sure we've programmed buf_num FB in time, so queue the buffer
13589f257f50SLaurent Pinchart * to the buffer queue normally. No need to undo writing the FB
13599f257f50SLaurent Pinchart * register, since we won't return it as active_vb2_buf is NULL,
13609f257f50SLaurent Pinchart * so it's okay to potentially write it to both FB1 and FB2;
13619f257f50SLaurent Pinchart * only the one where it was queued normally will be returned.
13629f257f50SLaurent Pinchart */
13639f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->irqlock, flags);
13649f257f50SLaurent Pinchart return false;
13659f257f50SLaurent Pinchart }
13669f257f50SLaurent Pinchart
13679f257f50SLaurent Pinchart csi->active_vb2_buf[buf_num] = buf;
13689f257f50SLaurent Pinchart
13699f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->irqlock, flags);
13709f257f50SLaurent Pinchart return true;
13719f257f50SLaurent Pinchart }
13729f257f50SLaurent Pinchart
imx7_csi_video_buf_queue(struct vb2_buffer * vb)13739f257f50SLaurent Pinchart static void imx7_csi_video_buf_queue(struct vb2_buffer *vb)
13749f257f50SLaurent Pinchart {
13759f257f50SLaurent Pinchart struct imx7_csi *csi = vb2_get_drv_priv(vb->vb2_queue);
13769f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf = to_imx7_csi_vb2_buffer(vb);
13779f257f50SLaurent Pinchart unsigned long flags;
13789f257f50SLaurent Pinchart
13799f257f50SLaurent Pinchart if (imx7_csi_fast_track_buffer(csi, buf))
13809f257f50SLaurent Pinchart return;
13819f257f50SLaurent Pinchart
13829f257f50SLaurent Pinchart spin_lock_irqsave(&csi->q_lock, flags);
13839f257f50SLaurent Pinchart
13849f257f50SLaurent Pinchart list_add_tail(&buf->list, &csi->ready_q);
13859f257f50SLaurent Pinchart
13869f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->q_lock, flags);
13879f257f50SLaurent Pinchart }
1388d01a1c30SLaurent Pinchart
imx7_csi_video_validate_fmt(struct imx7_csi * csi)1389d01a1c30SLaurent Pinchart static int imx7_csi_video_validate_fmt(struct imx7_csi *csi)
1390d01a1c30SLaurent Pinchart {
1391d01a1c30SLaurent Pinchart struct v4l2_subdev_format fmt_src = {
13929f257f50SLaurent Pinchart .pad = IMX7_CSI_PAD_SRC,
13939f257f50SLaurent Pinchart .which = V4L2_SUBDEV_FORMAT_ACTIVE,
13949f257f50SLaurent Pinchart };
13959f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
13961d59fbebSLaurent Pinchart int ret;
13979f257f50SLaurent Pinchart
13989f257f50SLaurent Pinchart /* Retrieve the media bus format on the source subdev. */
13999f257f50SLaurent Pinchart ret = v4l2_subdev_call_state_active(&csi->sd, pad, get_fmt, &fmt_src);
14009f257f50SLaurent Pinchart if (ret)
14019f257f50SLaurent Pinchart return ret;
14029f257f50SLaurent Pinchart
14039f257f50SLaurent Pinchart /*
14049f257f50SLaurent Pinchart * Verify that the media bus size matches the size set on the video
14059f257f50SLaurent Pinchart * node. It is sufficient to check the compose rectangle size without
14069f257f50SLaurent Pinchart * checking the rounded size from pix_fmt, as the rounded size is
14079f257f50SLaurent Pinchart * derived directly from the compose rectangle size, and will thus
14089f257f50SLaurent Pinchart * always match if the compose rectangle matches.
14099f257f50SLaurent Pinchart */
14109f257f50SLaurent Pinchart if (csi->vdev_compose.width != fmt_src.format.width ||
14119f257f50SLaurent Pinchart csi->vdev_compose.height != fmt_src.format.height)
14129f257f50SLaurent Pinchart return -EPIPE;
14139f257f50SLaurent Pinchart
14149f257f50SLaurent Pinchart /*
14159f257f50SLaurent Pinchart * Verify that the media bus code is compatible with the pixel format
14169f257f50SLaurent Pinchart * set on the video node.
14179f257f50SLaurent Pinchart */
14189f257f50SLaurent Pinchart cc = imx7_csi_find_mbus_format(fmt_src.format.code);
14199f257f50SLaurent Pinchart if (!cc || csi->vdev_cc->yuv != cc->yuv)
14209f257f50SLaurent Pinchart return -EPIPE;
14219f257f50SLaurent Pinchart
14229f257f50SLaurent Pinchart return 0;
14239f257f50SLaurent Pinchart }
14249f257f50SLaurent Pinchart
imx7_csi_video_start_streaming(struct vb2_queue * vq,unsigned int count)14259f257f50SLaurent Pinchart static int imx7_csi_video_start_streaming(struct vb2_queue *vq,
14269f257f50SLaurent Pinchart unsigned int count)
14279f257f50SLaurent Pinchart {
14289f257f50SLaurent Pinchart struct imx7_csi *csi = vb2_get_drv_priv(vq);
14299f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf, *tmp;
14309f257f50SLaurent Pinchart unsigned long flags;
14319f257f50SLaurent Pinchart int ret;
14329f257f50SLaurent Pinchart
14339f257f50SLaurent Pinchart ret = imx7_csi_video_validate_fmt(csi);
14349f257f50SLaurent Pinchart if (ret) {
14359f257f50SLaurent Pinchart dev_err(csi->dev, "capture format not valid\n");
14369f257f50SLaurent Pinchart goto err_buffers;
14379f257f50SLaurent Pinchart }
14389f257f50SLaurent Pinchart
14399f257f50SLaurent Pinchart mutex_lock(&csi->mdev.graph_mutex);
14409f257f50SLaurent Pinchart
14419f257f50SLaurent Pinchart ret = __video_device_pipeline_start(csi->vdev, &csi->pipe);
14429f257f50SLaurent Pinchart if (ret)
14439f257f50SLaurent Pinchart goto err_unlock;
14449f257f50SLaurent Pinchart
14459f257f50SLaurent Pinchart ret = v4l2_subdev_call(&csi->sd, video, s_stream, 1);
14469f257f50SLaurent Pinchart if (ret)
14479f257f50SLaurent Pinchart goto err_stop;
14489f257f50SLaurent Pinchart
14499f257f50SLaurent Pinchart mutex_unlock(&csi->mdev.graph_mutex);
14509f257f50SLaurent Pinchart
14519f257f50SLaurent Pinchart return 0;
14529f257f50SLaurent Pinchart
14539f257f50SLaurent Pinchart err_stop:
14549f257f50SLaurent Pinchart __video_device_pipeline_stop(csi->vdev);
14559f257f50SLaurent Pinchart err_unlock:
14569f257f50SLaurent Pinchart mutex_unlock(&csi->mdev.graph_mutex);
14579f257f50SLaurent Pinchart dev_err(csi->dev, "pipeline start failed with %d\n", ret);
14589f257f50SLaurent Pinchart err_buffers:
14599f257f50SLaurent Pinchart spin_lock_irqsave(&csi->q_lock, flags);
14609f257f50SLaurent Pinchart list_for_each_entry_safe(buf, tmp, &csi->ready_q, list) {
14619f257f50SLaurent Pinchart list_del(&buf->list);
14629f257f50SLaurent Pinchart vb2_buffer_done(&buf->vbuf.vb2_buf, VB2_BUF_STATE_QUEUED);
14639f257f50SLaurent Pinchart }
14649f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->q_lock, flags);
14659f257f50SLaurent Pinchart return ret;
14669f257f50SLaurent Pinchart }
14679f257f50SLaurent Pinchart
imx7_csi_video_stop_streaming(struct vb2_queue * vq)14689f257f50SLaurent Pinchart static void imx7_csi_video_stop_streaming(struct vb2_queue *vq)
14699f257f50SLaurent Pinchart {
14709f257f50SLaurent Pinchart struct imx7_csi *csi = vb2_get_drv_priv(vq);
14719f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *frame;
14729f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *tmp;
14739f257f50SLaurent Pinchart unsigned long flags;
14749f257f50SLaurent Pinchart
14759f257f50SLaurent Pinchart mutex_lock(&csi->mdev.graph_mutex);
14769f257f50SLaurent Pinchart v4l2_subdev_call(&csi->sd, video, s_stream, 0);
14779f257f50SLaurent Pinchart __video_device_pipeline_stop(csi->vdev);
14789f257f50SLaurent Pinchart mutex_unlock(&csi->mdev.graph_mutex);
14799f257f50SLaurent Pinchart
14809f257f50SLaurent Pinchart /* release all active buffers */
14819f257f50SLaurent Pinchart spin_lock_irqsave(&csi->q_lock, flags);
14829f257f50SLaurent Pinchart list_for_each_entry_safe(frame, tmp, &csi->ready_q, list) {
14839f257f50SLaurent Pinchart list_del(&frame->list);
14849f257f50SLaurent Pinchart vb2_buffer_done(&frame->vbuf.vb2_buf, VB2_BUF_STATE_ERROR);
14859f257f50SLaurent Pinchart }
14869f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->q_lock, flags);
14879f257f50SLaurent Pinchart }
14889f257f50SLaurent Pinchart
14899f257f50SLaurent Pinchart static const struct vb2_ops imx7_csi_video_qops = {
14909f257f50SLaurent Pinchart .queue_setup = imx7_csi_video_queue_setup,
14919f257f50SLaurent Pinchart .buf_init = imx7_csi_video_buf_init,
14929f257f50SLaurent Pinchart .buf_prepare = imx7_csi_video_buf_prepare,
14939f257f50SLaurent Pinchart .buf_queue = imx7_csi_video_buf_queue,
14949f257f50SLaurent Pinchart .wait_prepare = vb2_ops_wait_prepare,
14959f257f50SLaurent Pinchart .wait_finish = vb2_ops_wait_finish,
14969f257f50SLaurent Pinchart .start_streaming = imx7_csi_video_start_streaming,
14979f257f50SLaurent Pinchart .stop_streaming = imx7_csi_video_stop_streaming,
14989f257f50SLaurent Pinchart };
14999f257f50SLaurent Pinchart
15009f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
15019f257f50SLaurent Pinchart * Video Capture Device - File Operations
15029f257f50SLaurent Pinchart */
15039f257f50SLaurent Pinchart
imx7_csi_video_open(struct file * file)15049f257f50SLaurent Pinchart static int imx7_csi_video_open(struct file *file)
15059f257f50SLaurent Pinchart {
15069f257f50SLaurent Pinchart struct imx7_csi *csi = video_drvdata(file);
15079f257f50SLaurent Pinchart int ret;
15089f257f50SLaurent Pinchart
15099f257f50SLaurent Pinchart if (mutex_lock_interruptible(&csi->vdev_mutex))
15109f257f50SLaurent Pinchart return -ERESTARTSYS;
15119f257f50SLaurent Pinchart
15129f257f50SLaurent Pinchart ret = v4l2_fh_open(file);
15139f257f50SLaurent Pinchart if (ret) {
15149f257f50SLaurent Pinchart dev_err(csi->dev, "v4l2_fh_open failed\n");
15159f257f50SLaurent Pinchart goto out;
15169f257f50SLaurent Pinchart }
15179f257f50SLaurent Pinchart
15189f257f50SLaurent Pinchart ret = v4l2_pipeline_pm_get(&csi->vdev->entity);
15199f257f50SLaurent Pinchart if (ret)
15209f257f50SLaurent Pinchart v4l2_fh_release(file);
15219f257f50SLaurent Pinchart
15229f257f50SLaurent Pinchart out:
15239f257f50SLaurent Pinchart mutex_unlock(&csi->vdev_mutex);
15249f257f50SLaurent Pinchart return ret;
15259f257f50SLaurent Pinchart }
15269f257f50SLaurent Pinchart
imx7_csi_video_release(struct file * file)15279f257f50SLaurent Pinchart static int imx7_csi_video_release(struct file *file)
15289f257f50SLaurent Pinchart {
15299f257f50SLaurent Pinchart struct imx7_csi *csi = video_drvdata(file);
15309f257f50SLaurent Pinchart struct vb2_queue *vq = &csi->q;
15319f257f50SLaurent Pinchart
15329f257f50SLaurent Pinchart mutex_lock(&csi->vdev_mutex);
15339f257f50SLaurent Pinchart
15349f257f50SLaurent Pinchart if (file->private_data == vq->owner) {
15359f257f50SLaurent Pinchart vb2_queue_release(vq);
15369f257f50SLaurent Pinchart vq->owner = NULL;
15379f257f50SLaurent Pinchart }
15389f257f50SLaurent Pinchart
15399f257f50SLaurent Pinchart v4l2_pipeline_pm_put(&csi->vdev->entity);
15409f257f50SLaurent Pinchart
15419f257f50SLaurent Pinchart v4l2_fh_release(file);
15429f257f50SLaurent Pinchart mutex_unlock(&csi->vdev_mutex);
15439f257f50SLaurent Pinchart return 0;
15449f257f50SLaurent Pinchart }
15459f257f50SLaurent Pinchart
15469f257f50SLaurent Pinchart static const struct v4l2_file_operations imx7_csi_video_fops = {
15479f257f50SLaurent Pinchart .owner = THIS_MODULE,
15489f257f50SLaurent Pinchart .open = imx7_csi_video_open,
15499f257f50SLaurent Pinchart .release = imx7_csi_video_release,
15509f257f50SLaurent Pinchart .poll = vb2_fop_poll,
15519f257f50SLaurent Pinchart .unlocked_ioctl = video_ioctl2,
15529f257f50SLaurent Pinchart .mmap = vb2_fop_mmap,
15539f257f50SLaurent Pinchart };
15549f257f50SLaurent Pinchart
15559f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
15569f257f50SLaurent Pinchart * Video Capture Device - Init & Cleanup
15579f257f50SLaurent Pinchart */
15589f257f50SLaurent Pinchart
imx7_csi_video_next_buf(struct imx7_csi * csi)15599f257f50SLaurent Pinchart static struct imx7_csi_vb2_buffer *imx7_csi_video_next_buf(struct imx7_csi *csi)
15609f257f50SLaurent Pinchart {
15619f257f50SLaurent Pinchart struct imx7_csi_vb2_buffer *buf = NULL;
15629f257f50SLaurent Pinchart unsigned long flags;
15639f257f50SLaurent Pinchart
15649f257f50SLaurent Pinchart spin_lock_irqsave(&csi->q_lock, flags);
15659f257f50SLaurent Pinchart
15669f257f50SLaurent Pinchart /* get next queued buffer */
15679f257f50SLaurent Pinchart if (!list_empty(&csi->ready_q)) {
15689f257f50SLaurent Pinchart buf = list_entry(csi->ready_q.next, struct imx7_csi_vb2_buffer,
15699f257f50SLaurent Pinchart list);
15709f257f50SLaurent Pinchart list_del(&buf->list);
15719f257f50SLaurent Pinchart }
15729f257f50SLaurent Pinchart
15739f257f50SLaurent Pinchart spin_unlock_irqrestore(&csi->q_lock, flags);
15749f257f50SLaurent Pinchart
15759f43234eSLaurent Pinchart return buf;
15769f257f50SLaurent Pinchart }
15779f43234eSLaurent Pinchart
imx7_csi_video_init_format(struct imx7_csi * csi)15789f257f50SLaurent Pinchart static void imx7_csi_video_init_format(struct imx7_csi *csi)
15799f43234eSLaurent Pinchart {
15809f43234eSLaurent Pinchart struct v4l2_pix_format *pixfmt = &csi->vdev_fmt;
1581bc0d3df3SLaurent Pinchart
15829f43234eSLaurent Pinchart pixfmt->width = IMX7_CSI_DEF_PIX_WIDTH;
15839f257f50SLaurent Pinchart pixfmt->height = IMX7_CSI_DEF_PIX_HEIGHT;
15849f257f50SLaurent Pinchart
15859f257f50SLaurent Pinchart csi->vdev_cc = __imx7_csi_video_try_fmt(pixfmt, &csi->vdev_compose);
15869f257f50SLaurent Pinchart }
15879f257f50SLaurent Pinchart
imx7_csi_video_register(struct imx7_csi * csi)15889f257f50SLaurent Pinchart static int imx7_csi_video_register(struct imx7_csi *csi)
15899f257f50SLaurent Pinchart {
15909f257f50SLaurent Pinchart struct v4l2_subdev *sd = &csi->sd;
15919f257f50SLaurent Pinchart struct v4l2_device *v4l2_dev = sd->v4l2_dev;
15929f257f50SLaurent Pinchart struct video_device *vdev = csi->vdev;
15939f257f50SLaurent Pinchart int ret;
15949f257f50SLaurent Pinchart
15959f43234eSLaurent Pinchart vdev->v4l2_dev = v4l2_dev;
15969f257f50SLaurent Pinchart
15979f257f50SLaurent Pinchart /* Initialize the default format and compose rectangle. */
15989f257f50SLaurent Pinchart imx7_csi_video_init_format(csi);
15999f257f50SLaurent Pinchart
16009f257f50SLaurent Pinchart /* Register the video device. */
16019f257f50SLaurent Pinchart ret = video_register_device(vdev, VFL_TYPE_VIDEO, -1);
16029f257f50SLaurent Pinchart if (ret) {
16039f257f50SLaurent Pinchart dev_err(csi->dev, "Failed to register video device\n");
16049f257f50SLaurent Pinchart return ret;
16059f257f50SLaurent Pinchart }
16069f257f50SLaurent Pinchart
16079f257f50SLaurent Pinchart dev_info(csi->dev, "Registered %s as /dev/%s\n", vdev->name,
16089f257f50SLaurent Pinchart video_device_node_name(vdev));
16099f257f50SLaurent Pinchart
16109f257f50SLaurent Pinchart /* Create the link from the CSI subdev to the video device. */
16119f257f50SLaurent Pinchart ret = media_create_pad_link(&sd->entity, IMX7_CSI_PAD_SRC,
16129f257f50SLaurent Pinchart &vdev->entity, 0, MEDIA_LNK_FL_IMMUTABLE |
16139f257f50SLaurent Pinchart MEDIA_LNK_FL_ENABLED);
16149f257f50SLaurent Pinchart if (ret) {
16159f257f50SLaurent Pinchart dev_err(csi->dev, "failed to create link to device node\n");
16169f257f50SLaurent Pinchart video_unregister_device(vdev);
16179f257f50SLaurent Pinchart return ret;
16189f257f50SLaurent Pinchart }
16199f257f50SLaurent Pinchart
16209f257f50SLaurent Pinchart return 0;
16219f257f50SLaurent Pinchart }
16229f257f50SLaurent Pinchart
imx7_csi_video_unregister(struct imx7_csi * csi)16239f257f50SLaurent Pinchart static void imx7_csi_video_unregister(struct imx7_csi *csi)
16249f257f50SLaurent Pinchart {
16259f257f50SLaurent Pinchart media_entity_cleanup(&csi->vdev->entity);
16269f257f50SLaurent Pinchart video_unregister_device(csi->vdev);
16279f257f50SLaurent Pinchart }
16289f257f50SLaurent Pinchart
imx7_csi_video_init(struct imx7_csi * csi)16299f257f50SLaurent Pinchart static int imx7_csi_video_init(struct imx7_csi *csi)
16309f257f50SLaurent Pinchart {
16319f257f50SLaurent Pinchart struct video_device *vdev;
16329f257f50SLaurent Pinchart struct vb2_queue *vq;
16339f257f50SLaurent Pinchart int ret;
16349f257f50SLaurent Pinchart
16359f257f50SLaurent Pinchart mutex_init(&csi->vdev_mutex);
16369f257f50SLaurent Pinchart INIT_LIST_HEAD(&csi->ready_q);
16379f257f50SLaurent Pinchart spin_lock_init(&csi->q_lock);
16389f257f50SLaurent Pinchart
16399f257f50SLaurent Pinchart /* Allocate and initialize the video device. */
16409f257f50SLaurent Pinchart vdev = video_device_alloc();
16419f257f50SLaurent Pinchart if (!vdev)
16429f257f50SLaurent Pinchart return -ENOMEM;
16439f257f50SLaurent Pinchart
16449f257f50SLaurent Pinchart vdev->fops = &imx7_csi_video_fops;
16459f257f50SLaurent Pinchart vdev->ioctl_ops = &imx7_csi_video_ioctl_ops;
16469f257f50SLaurent Pinchart vdev->minor = -1;
16479f257f50SLaurent Pinchart vdev->release = video_device_release;
16489f257f50SLaurent Pinchart vdev->vfl_dir = VFL_DIR_RX;
16499f257f50SLaurent Pinchart vdev->tvnorms = V4L2_STD_NTSC | V4L2_STD_PAL | V4L2_STD_SECAM;
16509f257f50SLaurent Pinchart vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING
16519f257f50SLaurent Pinchart | V4L2_CAP_IO_MC;
16529f257f50SLaurent Pinchart vdev->lock = &csi->vdev_mutex;
16539f257f50SLaurent Pinchart vdev->queue = &csi->q;
16549f257f50SLaurent Pinchart
16559f257f50SLaurent Pinchart snprintf(vdev->name, sizeof(vdev->name), "%s capture", csi->sd.name);
16569f257f50SLaurent Pinchart
16579f257f50SLaurent Pinchart video_set_drvdata(vdev, csi);
16589f257f50SLaurent Pinchart csi->vdev = vdev;
16599f257f50SLaurent Pinchart
16609f257f50SLaurent Pinchart /* Initialize the video device pad. */
16619f257f50SLaurent Pinchart csi->vdev_pad.flags = MEDIA_PAD_FL_SINK;
16629f257f50SLaurent Pinchart ret = media_entity_pads_init(&vdev->entity, 1, &csi->vdev_pad);
16639f257f50SLaurent Pinchart if (ret) {
16649f257f50SLaurent Pinchart video_device_release(vdev);
16659f257f50SLaurent Pinchart return ret;
16669f257f50SLaurent Pinchart }
16679f257f50SLaurent Pinchart
16689f257f50SLaurent Pinchart /* Initialize the vb2 queue. */
16699f257f50SLaurent Pinchart vq = &csi->q;
16709f257f50SLaurent Pinchart vq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
16719f257f50SLaurent Pinchart vq->io_modes = VB2_MMAP | VB2_DMABUF;
16729f257f50SLaurent Pinchart vq->drv_priv = csi;
16739f257f50SLaurent Pinchart vq->buf_struct_size = sizeof(struct imx7_csi_vb2_buffer);
16749f257f50SLaurent Pinchart vq->ops = &imx7_csi_video_qops;
16759f257f50SLaurent Pinchart vq->mem_ops = &vb2_dma_contig_memops;
16769f257f50SLaurent Pinchart vq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC;
16779f257f50SLaurent Pinchart vq->lock = &csi->vdev_mutex;
16789f257f50SLaurent Pinchart vq->min_buffers_needed = 2;
16799f257f50SLaurent Pinchart vq->dev = csi->dev;
16809f257f50SLaurent Pinchart
16819f257f50SLaurent Pinchart ret = vb2_queue_init(vq);
16829f257f50SLaurent Pinchart if (ret) {
16839f257f50SLaurent Pinchart dev_err(csi->dev, "vb2_queue_init failed\n");
16849f257f50SLaurent Pinchart video_device_release(vdev);
16859f257f50SLaurent Pinchart return ret;
16869f257f50SLaurent Pinchart }
16879f257f50SLaurent Pinchart
16889f257f50SLaurent Pinchart return 0;
16899f257f50SLaurent Pinchart }
16909f257f50SLaurent Pinchart
16919f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
16929f257f50SLaurent Pinchart * V4L2 Subdev Operations
16939f257f50SLaurent Pinchart */
16949f257f50SLaurent Pinchart
imx7_csi_s_stream(struct v4l2_subdev * sd,int enable)16951d59fbebSLaurent Pinchart static int imx7_csi_s_stream(struct v4l2_subdev *sd, int enable)
16969f257f50SLaurent Pinchart {
16979f257f50SLaurent Pinchart struct imx7_csi *csi = v4l2_get_subdevdata(sd);
16981d59fbebSLaurent Pinchart struct v4l2_subdev_state *sd_state;
16999f257f50SLaurent Pinchart int ret = 0;
17009f257f50SLaurent Pinchart
17011d59fbebSLaurent Pinchart sd_state = v4l2_subdev_lock_and_get_active_state(sd);
17029f257f50SLaurent Pinchart
17039f257f50SLaurent Pinchart if (enable) {
17049f257f50SLaurent Pinchart ret = imx7_csi_init(csi, sd_state);
17059f257f50SLaurent Pinchart if (ret < 0)
17069f257f50SLaurent Pinchart goto out_unlock;
17079f257f50SLaurent Pinchart
17089f257f50SLaurent Pinchart ret = v4l2_subdev_call(csi->src_sd, video, s_stream, 1);
17099f257f50SLaurent Pinchart if (ret < 0) {
17109f257f50SLaurent Pinchart imx7_csi_deinit(csi, VB2_BUF_STATE_QUEUED);
17119f257f50SLaurent Pinchart goto out_unlock;
17129f257f50SLaurent Pinchart }
17139f257f50SLaurent Pinchart
17149f257f50SLaurent Pinchart imx7_csi_enable(csi);
17159f257f50SLaurent Pinchart } else {
17169f257f50SLaurent Pinchart imx7_csi_disable(csi);
17179f257f50SLaurent Pinchart
17189f257f50SLaurent Pinchart v4l2_subdev_call(csi->src_sd, video, s_stream, 0);
17199f257f50SLaurent Pinchart
17209f257f50SLaurent Pinchart imx7_csi_deinit(csi, VB2_BUF_STATE_ERROR);
17219f257f50SLaurent Pinchart }
17229f257f50SLaurent Pinchart
17231d59fbebSLaurent Pinchart csi->is_streaming = !!enable;
17249f257f50SLaurent Pinchart
17259f257f50SLaurent Pinchart out_unlock:
17269f257f50SLaurent Pinchart v4l2_subdev_unlock_state(sd_state);
17279f257f50SLaurent Pinchart
17289f257f50SLaurent Pinchart return ret;
17299f257f50SLaurent Pinchart }
17309f257f50SLaurent Pinchart
imx7_csi_init_cfg(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state)17319f257f50SLaurent Pinchart static int imx7_csi_init_cfg(struct v4l2_subdev *sd,
17329f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state)
17339f257f50SLaurent Pinchart {
17349f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
17359f257f50SLaurent Pinchart int i;
17369f257f50SLaurent Pinchart
17379f257f50SLaurent Pinchart cc = imx7_csi_find_mbus_format(IMX7_CSI_DEF_MBUS_CODE);
17381d59fbebSLaurent Pinchart
17399f257f50SLaurent Pinchart for (i = 0; i < IMX7_CSI_PADS_NUM; i++) {
17409f257f50SLaurent Pinchart struct v4l2_mbus_framefmt *mf =
17419f257f50SLaurent Pinchart v4l2_subdev_get_pad_format(sd, sd_state, i);
17429f257f50SLaurent Pinchart
17439f257f50SLaurent Pinchart mf->code = IMX7_CSI_DEF_MBUS_CODE;
17449f257f50SLaurent Pinchart mf->width = IMX7_CSI_DEF_PIX_WIDTH;
17459f257f50SLaurent Pinchart mf->height = IMX7_CSI_DEF_PIX_HEIGHT;
17469f257f50SLaurent Pinchart mf->field = V4L2_FIELD_NONE;
17479f257f50SLaurent Pinchart
17489f257f50SLaurent Pinchart mf->colorspace = V4L2_COLORSPACE_SRGB;
17499f257f50SLaurent Pinchart mf->xfer_func = V4L2_MAP_XFER_FUNC_DEFAULT(mf->colorspace);
17509f257f50SLaurent Pinchart mf->ycbcr_enc = V4L2_MAP_YCBCR_ENC_DEFAULT(mf->colorspace);
17519f257f50SLaurent Pinchart mf->quantization = V4L2_MAP_QUANTIZATION_DEFAULT(!cc->yuv,
17529f257f50SLaurent Pinchart mf->colorspace, mf->ycbcr_enc);
17539f257f50SLaurent Pinchart }
17549f257f50SLaurent Pinchart
17559f257f50SLaurent Pinchart return 0;
17569f257f50SLaurent Pinchart }
17579f257f50SLaurent Pinchart
imx7_csi_enum_mbus_code(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_mbus_code_enum * code)17589f257f50SLaurent Pinchart static int imx7_csi_enum_mbus_code(struct v4l2_subdev *sd,
17599f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state,
17609f257f50SLaurent Pinchart struct v4l2_subdev_mbus_code_enum *code)
17619f257f50SLaurent Pinchart {
17621d59fbebSLaurent Pinchart struct v4l2_mbus_framefmt *in_fmt;
17639f257f50SLaurent Pinchart int ret = 0;
17649f257f50SLaurent Pinchart
17659f257f50SLaurent Pinchart in_fmt = v4l2_subdev_get_pad_format(sd, sd_state, IMX7_CSI_PAD_SINK);
17669f257f50SLaurent Pinchart
17679f257f50SLaurent Pinchart switch (code->pad) {
17681d59fbebSLaurent Pinchart case IMX7_CSI_PAD_SINK:
17699f257f50SLaurent Pinchart ret = imx7_csi_enum_mbus_formats(&code->code, code->index);
17709f257f50SLaurent Pinchart break;
17719f257f50SLaurent Pinchart
17721d59fbebSLaurent Pinchart case IMX7_CSI_PAD_SRC:
17739f257f50SLaurent Pinchart if (code->index != 0) {
17749f257f50SLaurent Pinchart ret = -EINVAL;
17759f257f50SLaurent Pinchart break;
17769f257f50SLaurent Pinchart }
17771d59fbebSLaurent Pinchart
17789f257f50SLaurent Pinchart code->code = in_fmt->code;
17799f257f50SLaurent Pinchart break;
17801d59fbebSLaurent Pinchart
17819f257f50SLaurent Pinchart default:
17829f257f50SLaurent Pinchart ret = -EINVAL;
17839f257f50SLaurent Pinchart break;
17849f257f50SLaurent Pinchart }
17859f257f50SLaurent Pinchart
17869f257f50SLaurent Pinchart return ret;
17879f257f50SLaurent Pinchart }
17889f257f50SLaurent Pinchart
17899f257f50SLaurent Pinchart /*
17909f257f50SLaurent Pinchart * Default the colorspace in tryfmt to SRGB if set to an unsupported
17919f257f50SLaurent Pinchart * colorspace or not initialized. Then set the remaining colorimetry
17929f257f50SLaurent Pinchart * parameters based on the colorspace if they are uninitialized.
17939f257f50SLaurent Pinchart *
17949f257f50SLaurent Pinchart * tryfmt->code must be set on entry.
17959f257f50SLaurent Pinchart */
imx7_csi_try_colorimetry(struct v4l2_mbus_framefmt * tryfmt)17969f257f50SLaurent Pinchart static void imx7_csi_try_colorimetry(struct v4l2_mbus_framefmt *tryfmt)
17979f257f50SLaurent Pinchart {
17989f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
17999f257f50SLaurent Pinchart bool is_rgb = false;
18009f257f50SLaurent Pinchart
18019f257f50SLaurent Pinchart cc = imx7_csi_find_mbus_format(tryfmt->code);
18029f257f50SLaurent Pinchart if (cc && !cc->yuv)
18039f257f50SLaurent Pinchart is_rgb = true;
18049f257f50SLaurent Pinchart
18059f257f50SLaurent Pinchart switch (tryfmt->colorspace) {
18069f257f50SLaurent Pinchart case V4L2_COLORSPACE_SMPTE170M:
18079f257f50SLaurent Pinchart case V4L2_COLORSPACE_REC709:
18089f257f50SLaurent Pinchart case V4L2_COLORSPACE_JPEG:
18099f257f50SLaurent Pinchart case V4L2_COLORSPACE_SRGB:
18109f257f50SLaurent Pinchart case V4L2_COLORSPACE_BT2020:
18119f257f50SLaurent Pinchart case V4L2_COLORSPACE_OPRGB:
18129f257f50SLaurent Pinchart case V4L2_COLORSPACE_DCI_P3:
18139f257f50SLaurent Pinchart case V4L2_COLORSPACE_RAW:
18149f257f50SLaurent Pinchart break;
18159f257f50SLaurent Pinchart default:
18169f257f50SLaurent Pinchart tryfmt->colorspace = V4L2_COLORSPACE_SRGB;
18179f257f50SLaurent Pinchart break;
18189f257f50SLaurent Pinchart }
18199f257f50SLaurent Pinchart
18209f257f50SLaurent Pinchart if (tryfmt->xfer_func == V4L2_XFER_FUNC_DEFAULT)
18219f257f50SLaurent Pinchart tryfmt->xfer_func =
18229f257f50SLaurent Pinchart V4L2_MAP_XFER_FUNC_DEFAULT(tryfmt->colorspace);
18239f257f50SLaurent Pinchart
18249f257f50SLaurent Pinchart if (tryfmt->ycbcr_enc == V4L2_YCBCR_ENC_DEFAULT)
18259f257f50SLaurent Pinchart tryfmt->ycbcr_enc =
18269f257f50SLaurent Pinchart V4L2_MAP_YCBCR_ENC_DEFAULT(tryfmt->colorspace);
18279f257f50SLaurent Pinchart
18289f257f50SLaurent Pinchart if (tryfmt->quantization == V4L2_QUANTIZATION_DEFAULT)
18299f257f50SLaurent Pinchart tryfmt->quantization =
18309f257f50SLaurent Pinchart V4L2_MAP_QUANTIZATION_DEFAULT(is_rgb,
18319f257f50SLaurent Pinchart tryfmt->colorspace,
18321d59fbebSLaurent Pinchart tryfmt->ycbcr_enc);
18339f257f50SLaurent Pinchart }
18349f257f50SLaurent Pinchart
imx7_csi_try_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * sdformat,const struct imx7_csi_pixfmt ** cc)18359f257f50SLaurent Pinchart static void imx7_csi_try_fmt(struct v4l2_subdev *sd,
18369f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state,
18379f257f50SLaurent Pinchart struct v4l2_subdev_format *sdformat,
18389f257f50SLaurent Pinchart const struct imx7_csi_pixfmt **cc)
18399f257f50SLaurent Pinchart {
18409f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *in_cc;
18411d59fbebSLaurent Pinchart struct v4l2_mbus_framefmt *in_fmt;
18429f257f50SLaurent Pinchart u32 code;
18439f257f50SLaurent Pinchart
18449f257f50SLaurent Pinchart in_fmt = v4l2_subdev_get_pad_format(sd, sd_state, IMX7_CSI_PAD_SINK);
18459f257f50SLaurent Pinchart
18469f257f50SLaurent Pinchart switch (sdformat->pad) {
18479f257f50SLaurent Pinchart case IMX7_CSI_PAD_SRC:
18489f257f50SLaurent Pinchart in_cc = imx7_csi_find_mbus_format(in_fmt->code);
18499f257f50SLaurent Pinchart
18509f257f50SLaurent Pinchart sdformat->format.width = in_fmt->width;
18519f257f50SLaurent Pinchart sdformat->format.height = in_fmt->height;
18529f257f50SLaurent Pinchart sdformat->format.code = in_fmt->code;
18539f257f50SLaurent Pinchart sdformat->format.field = in_fmt->field;
18549f257f50SLaurent Pinchart *cc = in_cc;
18559f257f50SLaurent Pinchart
18569f257f50SLaurent Pinchart sdformat->format.colorspace = in_fmt->colorspace;
18579f257f50SLaurent Pinchart sdformat->format.xfer_func = in_fmt->xfer_func;
185849a82584SLaurent Pinchart sdformat->format.quantization = in_fmt->quantization;
18599f257f50SLaurent Pinchart sdformat->format.ycbcr_enc = in_fmt->ycbcr_enc;
18609f257f50SLaurent Pinchart break;
18619f257f50SLaurent Pinchart
18629f257f50SLaurent Pinchart case IMX7_CSI_PAD_SINK:
18639f257f50SLaurent Pinchart *cc = imx7_csi_find_mbus_format(sdformat->format.code);
18649f257f50SLaurent Pinchart if (!*cc) {
18659f257f50SLaurent Pinchart code = IMX7_CSI_DEF_MBUS_CODE;
18669f257f50SLaurent Pinchart *cc = imx7_csi_find_mbus_format(code);
18679f257f50SLaurent Pinchart sdformat->format.code = code;
18689f257f50SLaurent Pinchart }
18699f257f50SLaurent Pinchart
18709f257f50SLaurent Pinchart if (sdformat->format.field != V4L2_FIELD_INTERLACED)
18719f257f50SLaurent Pinchart sdformat->format.field = V4L2_FIELD_NONE;
18729f257f50SLaurent Pinchart break;
18739f257f50SLaurent Pinchart }
18749f257f50SLaurent Pinchart
18759f257f50SLaurent Pinchart imx7_csi_try_colorimetry(&sdformat->format);
18769f257f50SLaurent Pinchart }
18779f257f50SLaurent Pinchart
imx7_csi_set_fmt(struct v4l2_subdev * sd,struct v4l2_subdev_state * sd_state,struct v4l2_subdev_format * sdformat)18789f257f50SLaurent Pinchart static int imx7_csi_set_fmt(struct v4l2_subdev *sd,
18799f257f50SLaurent Pinchart struct v4l2_subdev_state *sd_state,
18809f257f50SLaurent Pinchart struct v4l2_subdev_format *sdformat)
18819f257f50SLaurent Pinchart {
18829f257f50SLaurent Pinchart struct imx7_csi *csi = v4l2_get_subdevdata(sd);
18839f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *outcc;
18849f257f50SLaurent Pinchart struct v4l2_mbus_framefmt *outfmt;
18859f257f50SLaurent Pinchart const struct imx7_csi_pixfmt *cc;
18861d59fbebSLaurent Pinchart struct v4l2_mbus_framefmt *fmt;
18871d59fbebSLaurent Pinchart struct v4l2_subdev_format format;
18889f257f50SLaurent Pinchart
18891d59fbebSLaurent Pinchart if (csi->is_streaming)
18909f257f50SLaurent Pinchart return -EBUSY;
18911d59fbebSLaurent Pinchart
18929f257f50SLaurent Pinchart imx7_csi_try_fmt(sd, sd_state, sdformat, &cc);
18939f257f50SLaurent Pinchart
18949f257f50SLaurent Pinchart fmt = v4l2_subdev_get_pad_format(sd, sd_state, sdformat->pad);
18959f257f50SLaurent Pinchart
18969f257f50SLaurent Pinchart *fmt = sdformat->format;
18979f257f50SLaurent Pinchart
18989f257f50SLaurent Pinchart if (sdformat->pad == IMX7_CSI_PAD_SINK) {
18999f257f50SLaurent Pinchart /* propagate format to source pads */
19001d59fbebSLaurent Pinchart format.pad = IMX7_CSI_PAD_SRC;
19011d59fbebSLaurent Pinchart format.which = sdformat->which;
19021d59fbebSLaurent Pinchart format.format = sdformat->format;
19031d59fbebSLaurent Pinchart imx7_csi_try_fmt(sd, sd_state, &format, &outcc);
19049f257f50SLaurent Pinchart
19059f257f50SLaurent Pinchart outfmt = v4l2_subdev_get_pad_format(sd, sd_state,
19069f257f50SLaurent Pinchart IMX7_CSI_PAD_SRC);
19071d59fbebSLaurent Pinchart *outfmt = format.format;
19089f257f50SLaurent Pinchart }
19099f257f50SLaurent Pinchart
19109f257f50SLaurent Pinchart return 0;
19119f257f50SLaurent Pinchart }
19129f257f50SLaurent Pinchart
imx7_csi_pad_link_validate(struct v4l2_subdev * sd,struct media_link * link,struct v4l2_subdev_format * source_fmt,struct v4l2_subdev_format * sink_fmt)19139f257f50SLaurent Pinchart static int imx7_csi_pad_link_validate(struct v4l2_subdev *sd,
19149f257f50SLaurent Pinchart struct media_link *link,
19159f257f50SLaurent Pinchart struct v4l2_subdev_format *source_fmt,
19169f257f50SLaurent Pinchart struct v4l2_subdev_format *sink_fmt)
19179f257f50SLaurent Pinchart {
19189f257f50SLaurent Pinchart struct imx7_csi *csi = v4l2_get_subdevdata(sd);
19199f257f50SLaurent Pinchart struct media_pad *pad = NULL;
19209f257f50SLaurent Pinchart unsigned int i;
19219f257f50SLaurent Pinchart int ret;
19229f257f50SLaurent Pinchart
19239f257f50SLaurent Pinchart /*
19249f257f50SLaurent Pinchart * Validate the source link, and record whether the source uses the
19259f257f50SLaurent Pinchart * parallel input or the CSI-2 receiver.
19269f257f50SLaurent Pinchart */
19279f257f50SLaurent Pinchart ret = v4l2_subdev_link_validate_default(sd, link, source_fmt, sink_fmt);
19289f257f50SLaurent Pinchart if (ret)
19299f257f50SLaurent Pinchart return ret;
19309f257f50SLaurent Pinchart
19319f257f50SLaurent Pinchart switch (csi->src_sd->entity.function) {
19329f257f50SLaurent Pinchart case MEDIA_ENT_F_VID_IF_BRIDGE:
19339f257f50SLaurent Pinchart /* The input is the CSI-2 receiver. */
19349f257f50SLaurent Pinchart csi->is_csi2 = true;
19359f257f50SLaurent Pinchart break;
19369f257f50SLaurent Pinchart
19379f257f50SLaurent Pinchart case MEDIA_ENT_F_VID_MUX:
19389f257f50SLaurent Pinchart /* The input is the mux, check its input. */
19399f257f50SLaurent Pinchart for (i = 0; i < csi->src_sd->entity.num_pads; i++) {
19409f257f50SLaurent Pinchart struct media_pad *spad = &csi->src_sd->entity.pads[i];
19419f257f50SLaurent Pinchart
19429f257f50SLaurent Pinchart if (!(spad->flags & MEDIA_PAD_FL_SINK))
19439f257f50SLaurent Pinchart continue;
19449f257f50SLaurent Pinchart
19459f257f50SLaurent Pinchart pad = media_pad_remote_pad_first(spad);
19469f257f50SLaurent Pinchart if (pad)
19479f257f50SLaurent Pinchart break;
19489f257f50SLaurent Pinchart }
19499f257f50SLaurent Pinchart
19509f257f50SLaurent Pinchart if (!pad)
19519f257f50SLaurent Pinchart return -ENODEV;
19529f257f50SLaurent Pinchart
19539f257f50SLaurent Pinchart csi->is_csi2 = pad->entity->function == MEDIA_ENT_F_VID_IF_BRIDGE;
19549f257f50SLaurent Pinchart break;
19559f257f50SLaurent Pinchart
19569f257f50SLaurent Pinchart default:
19579f257f50SLaurent Pinchart /*
19589f257f50SLaurent Pinchart * The input is an external entity, it must use the parallel
19599f257f50SLaurent Pinchart * bus.
19609f257f50SLaurent Pinchart */
19619f257f50SLaurent Pinchart csi->is_csi2 = false;
19629f257f50SLaurent Pinchart break;
19639f257f50SLaurent Pinchart }
19649f257f50SLaurent Pinchart
19659f257f50SLaurent Pinchart return 0;
19669f257f50SLaurent Pinchart }
19679f257f50SLaurent Pinchart
imx7_csi_registered(struct v4l2_subdev * sd)19689f257f50SLaurent Pinchart static int imx7_csi_registered(struct v4l2_subdev *sd)
19699f257f50SLaurent Pinchart {
19709f257f50SLaurent Pinchart struct imx7_csi *csi = v4l2_get_subdevdata(sd);
19719f257f50SLaurent Pinchart int ret;
19729f257f50SLaurent Pinchart
19739f257f50SLaurent Pinchart ret = imx7_csi_video_init(csi);
19749f257f50SLaurent Pinchart if (ret)
19759f257f50SLaurent Pinchart return ret;
19769f257f50SLaurent Pinchart
19779f257f50SLaurent Pinchart ret = imx7_csi_video_register(csi);
19789f257f50SLaurent Pinchart if (ret)
19799f257f50SLaurent Pinchart return ret;
19809f257f50SLaurent Pinchart
19819f257f50SLaurent Pinchart ret = v4l2_device_register_subdev_nodes(&csi->v4l2_dev);
19829f257f50SLaurent Pinchart if (ret)
19839f257f50SLaurent Pinchart goto err_unreg;
19849f257f50SLaurent Pinchart
19859f257f50SLaurent Pinchart ret = media_device_register(&csi->mdev);
19869f257f50SLaurent Pinchart if (ret)
19879f257f50SLaurent Pinchart goto err_unreg;
19889f257f50SLaurent Pinchart
19899f257f50SLaurent Pinchart return 0;
19909f257f50SLaurent Pinchart
19919f257f50SLaurent Pinchart err_unreg:
19929f257f50SLaurent Pinchart imx7_csi_video_unregister(csi);
19939f257f50SLaurent Pinchart return ret;
19949f257f50SLaurent Pinchart }
19959f257f50SLaurent Pinchart
imx7_csi_unregistered(struct v4l2_subdev * sd)19969f257f50SLaurent Pinchart static void imx7_csi_unregistered(struct v4l2_subdev *sd)
19979f257f50SLaurent Pinchart {
19989f257f50SLaurent Pinchart struct imx7_csi *csi = v4l2_get_subdevdata(sd);
19999f257f50SLaurent Pinchart
20009f257f50SLaurent Pinchart imx7_csi_video_unregister(csi);
20019f257f50SLaurent Pinchart }
20029f257f50SLaurent Pinchart
20039f257f50SLaurent Pinchart static const struct v4l2_subdev_video_ops imx7_csi_video_ops = {
20049f257f50SLaurent Pinchart .s_stream = imx7_csi_s_stream,
20059f257f50SLaurent Pinchart };
20069f257f50SLaurent Pinchart
20071d59fbebSLaurent Pinchart static const struct v4l2_subdev_pad_ops imx7_csi_pad_ops = {
20089f257f50SLaurent Pinchart .init_cfg = imx7_csi_init_cfg,
20099f257f50SLaurent Pinchart .enum_mbus_code = imx7_csi_enum_mbus_code,
20109f257f50SLaurent Pinchart .get_fmt = v4l2_subdev_get_fmt,
20119f257f50SLaurent Pinchart .set_fmt = imx7_csi_set_fmt,
20129f257f50SLaurent Pinchart .link_validate = imx7_csi_pad_link_validate,
20139f257f50SLaurent Pinchart };
20149f257f50SLaurent Pinchart
20159f257f50SLaurent Pinchart static const struct v4l2_subdev_ops imx7_csi_subdev_ops = {
20169f257f50SLaurent Pinchart .video = &imx7_csi_video_ops,
20179f257f50SLaurent Pinchart .pad = &imx7_csi_pad_ops,
20189f257f50SLaurent Pinchart };
20199f257f50SLaurent Pinchart
20209f257f50SLaurent Pinchart static const struct v4l2_subdev_internal_ops imx7_csi_internal_ops = {
20219f257f50SLaurent Pinchart .registered = imx7_csi_registered,
20229f257f50SLaurent Pinchart .unregistered = imx7_csi_unregistered,
20239f257f50SLaurent Pinchart };
20249f257f50SLaurent Pinchart
20259f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
20269f257f50SLaurent Pinchart * Media Entity Operations
20279f257f50SLaurent Pinchart */
20289f257f50SLaurent Pinchart
20299f257f50SLaurent Pinchart static const struct media_entity_operations imx7_csi_entity_ops = {
20309f257f50SLaurent Pinchart .link_validate = v4l2_subdev_link_validate,
20319f257f50SLaurent Pinchart .get_fwnode_pad = v4l2_subdev_get_fwnode_pad_1_to_1,
20329f257f50SLaurent Pinchart };
20339f257f50SLaurent Pinchart
20349f257f50SLaurent Pinchart /* -----------------------------------------------------------------------------
20359f257f50SLaurent Pinchart * Probe & Remove
20369f257f50SLaurent Pinchart */
2037adb2dcd5SSakari Ailus
imx7_csi_notify_bound(struct v4l2_async_notifier * notifier,struct v4l2_subdev * sd,struct v4l2_async_connection * asd)20389f257f50SLaurent Pinchart static int imx7_csi_notify_bound(struct v4l2_async_notifier *notifier,
20399f257f50SLaurent Pinchart struct v4l2_subdev *sd,
20409f257f50SLaurent Pinchart struct v4l2_async_connection *asd)
20419f257f50SLaurent Pinchart {
20429f257f50SLaurent Pinchart struct imx7_csi *csi = imx7_csi_notifier_to_dev(notifier);
20439f257f50SLaurent Pinchart struct media_pad *sink = &csi->sd.entity.pads[IMX7_CSI_PAD_SINK];
20449f257f50SLaurent Pinchart
20459f257f50SLaurent Pinchart csi->src_sd = sd;
20469f257f50SLaurent Pinchart
20479f257f50SLaurent Pinchart return v4l2_create_fwnode_links_to_pad(sd, sink, MEDIA_LNK_FL_ENABLED |
20489f257f50SLaurent Pinchart MEDIA_LNK_FL_IMMUTABLE);
20499f257f50SLaurent Pinchart }
20509f257f50SLaurent Pinchart
imx7_csi_notify_complete(struct v4l2_async_notifier * notifier)20519f257f50SLaurent Pinchart static int imx7_csi_notify_complete(struct v4l2_async_notifier *notifier)
20529f257f50SLaurent Pinchart {
20539f257f50SLaurent Pinchart struct imx7_csi *csi = imx7_csi_notifier_to_dev(notifier);
20549f257f50SLaurent Pinchart
20559f257f50SLaurent Pinchart return v4l2_device_register_subdev_nodes(&csi->v4l2_dev);
20569f257f50SLaurent Pinchart }
20579f257f50SLaurent Pinchart
20589f257f50SLaurent Pinchart static const struct v4l2_async_notifier_operations imx7_csi_notify_ops = {
20599f257f50SLaurent Pinchart .bound = imx7_csi_notify_bound,
20609f257f50SLaurent Pinchart .complete = imx7_csi_notify_complete,
20619f257f50SLaurent Pinchart };
2062adb2dcd5SSakari Ailus
imx7_csi_async_register(struct imx7_csi * csi)20639f257f50SLaurent Pinchart static int imx7_csi_async_register(struct imx7_csi *csi)
20649f257f50SLaurent Pinchart {
20659f257f50SLaurent Pinchart struct v4l2_async_connection *asd;
2066b8ec754aSSakari Ailus struct fwnode_handle *ep;
20679f257f50SLaurent Pinchart int ret;
20689f257f50SLaurent Pinchart
20699f257f50SLaurent Pinchart v4l2_async_nf_init(&csi->notifier, &csi->v4l2_dev);
2070a56b3e15SFrieder Schrempf
2071a56b3e15SFrieder Schrempf ep = fwnode_graph_get_endpoint_by_id(dev_fwnode(csi->dev), 0, 0,
2072a56b3e15SFrieder Schrempf FWNODE_GRAPH_ENDPOINT_NEXT);
2073a56b3e15SFrieder Schrempf if (!ep) {
2074a56b3e15SFrieder Schrempf ret = dev_err_probe(csi->dev, -ENOTCONN,
2075a56b3e15SFrieder Schrempf "Failed to get remote endpoint\n");
20769f257f50SLaurent Pinchart goto error;
2077adb2dcd5SSakari Ailus }
20789f257f50SLaurent Pinchart
20799f257f50SLaurent Pinchart asd = v4l2_async_nf_add_fwnode_remote(&csi->notifier, ep,
20809f257f50SLaurent Pinchart struct v4l2_async_connection);
20819f257f50SLaurent Pinchart
2082a56b3e15SFrieder Schrempf fwnode_handle_put(ep);
2083a56b3e15SFrieder Schrempf
20842c117550SLaurent Pinchart if (IS_ERR(asd)) {
20859f257f50SLaurent Pinchart ret = dev_err_probe(csi->dev, PTR_ERR(asd),
20869f257f50SLaurent Pinchart "Failed to add remote subdev to notifier\n");
20879f257f50SLaurent Pinchart goto error;
20889f257f50SLaurent Pinchart }
2089b8ec754aSSakari Ailus
20909f257f50SLaurent Pinchart csi->notifier.ops = &imx7_csi_notify_ops;
20912c117550SLaurent Pinchart
20929f257f50SLaurent Pinchart ret = v4l2_async_nf_register(&csi->notifier);
20939f257f50SLaurent Pinchart if (ret)
20942c117550SLaurent Pinchart goto error;
20952c117550SLaurent Pinchart
20962c117550SLaurent Pinchart return 0;
20972c117550SLaurent Pinchart
20989f257f50SLaurent Pinchart error:
20999f257f50SLaurent Pinchart v4l2_async_nf_cleanup(&csi->notifier);
21009f257f50SLaurent Pinchart return ret;
21019f257f50SLaurent Pinchart }
21029f257f50SLaurent Pinchart
imx7_csi_media_cleanup(struct imx7_csi * csi)21039f257f50SLaurent Pinchart static void imx7_csi_media_cleanup(struct imx7_csi *csi)
21041d59fbebSLaurent Pinchart {
21059f257f50SLaurent Pinchart v4l2_device_unregister(&csi->v4l2_dev);
21069f257f50SLaurent Pinchart media_device_unregister(&csi->mdev);
21079f257f50SLaurent Pinchart v4l2_subdev_cleanup(&csi->sd);
21089f257f50SLaurent Pinchart media_device_cleanup(&csi->mdev);
21099f257f50SLaurent Pinchart }
21109f257f50SLaurent Pinchart
21119f257f50SLaurent Pinchart static const struct media_device_ops imx7_csi_media_ops = {
21129f257f50SLaurent Pinchart .link_notify = v4l2_pipeline_link_notify,
21139f257f50SLaurent Pinchart };
21149f257f50SLaurent Pinchart
imx7_csi_media_dev_init(struct imx7_csi * csi)21159f257f50SLaurent Pinchart static int imx7_csi_media_dev_init(struct imx7_csi *csi)
21169f257f50SLaurent Pinchart {
21179f257f50SLaurent Pinchart int ret;
21189f257f50SLaurent Pinchart
21199f257f50SLaurent Pinchart strscpy(csi->mdev.model, "imx-media", sizeof(csi->mdev.model));
21209f257f50SLaurent Pinchart csi->mdev.ops = &imx7_csi_media_ops;
21219f257f50SLaurent Pinchart csi->mdev.dev = csi->dev;
21229f257f50SLaurent Pinchart
21239f257f50SLaurent Pinchart csi->v4l2_dev.mdev = &csi->mdev;
21249f257f50SLaurent Pinchart strscpy(csi->v4l2_dev.name, "imx-media",
21259f257f50SLaurent Pinchart sizeof(csi->v4l2_dev.name));
21269f257f50SLaurent Pinchart snprintf(csi->mdev.bus_info, sizeof(csi->mdev.bus_info),
21279f257f50SLaurent Pinchart "platform:%s", dev_name(csi->mdev.dev));
21289f257f50SLaurent Pinchart
21299f257f50SLaurent Pinchart media_device_init(&csi->mdev);
21309f257f50SLaurent Pinchart
21319f257f50SLaurent Pinchart ret = v4l2_device_register(csi->dev, &csi->v4l2_dev);
21329f257f50SLaurent Pinchart if (ret < 0) {
21339f257f50SLaurent Pinchart v4l2_err(&csi->v4l2_dev,
21349f257f50SLaurent Pinchart "Failed to register v4l2_device: %d\n", ret);
21359f257f50SLaurent Pinchart goto cleanup;
21369f257f50SLaurent Pinchart }
21379f257f50SLaurent Pinchart
21389f257f50SLaurent Pinchart return 0;
21399f257f50SLaurent Pinchart
21409f257f50SLaurent Pinchart cleanup:
21419f257f50SLaurent Pinchart media_device_cleanup(&csi->mdev);
21429f257f50SLaurent Pinchart
21439f257f50SLaurent Pinchart return ret;
21449f257f50SLaurent Pinchart }
21459f257f50SLaurent Pinchart
imx7_csi_media_init(struct imx7_csi * csi)21469f257f50SLaurent Pinchart static int imx7_csi_media_init(struct imx7_csi *csi)
21479f257f50SLaurent Pinchart {
21489f257f50SLaurent Pinchart unsigned int i;
21499f257f50SLaurent Pinchart int ret;
21509f257f50SLaurent Pinchart
21519f257f50SLaurent Pinchart /* add media device */
21529f257f50SLaurent Pinchart ret = imx7_csi_media_dev_init(csi);
21539f257f50SLaurent Pinchart if (ret)
21549f257f50SLaurent Pinchart return ret;
21559f257f50SLaurent Pinchart
21569f257f50SLaurent Pinchart v4l2_subdev_init(&csi->sd, &imx7_csi_subdev_ops);
21579f257f50SLaurent Pinchart v4l2_set_subdevdata(&csi->sd, csi);
21589f257f50SLaurent Pinchart csi->sd.internal_ops = &imx7_csi_internal_ops;
21599f257f50SLaurent Pinchart csi->sd.entity.ops = &imx7_csi_entity_ops;
21609f257f50SLaurent Pinchart csi->sd.entity.function = MEDIA_ENT_F_VID_IF_BRIDGE;
21619f257f50SLaurent Pinchart csi->sd.dev = csi->dev;
21629f257f50SLaurent Pinchart csi->sd.owner = THIS_MODULE;
21639f257f50SLaurent Pinchart csi->sd.flags = V4L2_SUBDEV_FL_HAS_DEVNODE;
21649f257f50SLaurent Pinchart snprintf(csi->sd.name, sizeof(csi->sd.name), "csi");
21659f257f50SLaurent Pinchart
21669f257f50SLaurent Pinchart for (i = 0; i < IMX7_CSI_PADS_NUM; i++)
21679f257f50SLaurent Pinchart csi->pad[i].flags = (i == IMX7_CSI_PAD_SINK) ?
21689f257f50SLaurent Pinchart MEDIA_PAD_FL_SINK : MEDIA_PAD_FL_SOURCE;
21699f257f50SLaurent Pinchart
21709f257f50SLaurent Pinchart ret = media_entity_pads_init(&csi->sd.entity, IMX7_CSI_PADS_NUM,
21719f257f50SLaurent Pinchart csi->pad);
21721d59fbebSLaurent Pinchart if (ret)
21731d59fbebSLaurent Pinchart goto error;
21741d59fbebSLaurent Pinchart
21751d59fbebSLaurent Pinchart ret = v4l2_subdev_init_finalize(&csi->sd);
21769f257f50SLaurent Pinchart if (ret)
21779f257f50SLaurent Pinchart goto error;
21789f257f50SLaurent Pinchart
21799f257f50SLaurent Pinchart ret = v4l2_device_register_subdev(&csi->v4l2_dev, &csi->sd);
21809f257f50SLaurent Pinchart if (ret)
21819f257f50SLaurent Pinchart goto error;
21829f257f50SLaurent Pinchart
21839f257f50SLaurent Pinchart return 0;
21849f257f50SLaurent Pinchart
21859f257f50SLaurent Pinchart error:
21869f257f50SLaurent Pinchart imx7_csi_media_cleanup(csi);
21879f257f50SLaurent Pinchart return ret;
21889f257f50SLaurent Pinchart }
21899f257f50SLaurent Pinchart
imx7_csi_probe(struct platform_device * pdev)21909f257f50SLaurent Pinchart static int imx7_csi_probe(struct platform_device *pdev)
21919f257f50SLaurent Pinchart {
21929f257f50SLaurent Pinchart struct device *dev = &pdev->dev;
21939f257f50SLaurent Pinchart struct imx7_csi *csi;
21949f257f50SLaurent Pinchart int ret;
21959f257f50SLaurent Pinchart
21969f257f50SLaurent Pinchart csi = devm_kzalloc(&pdev->dev, sizeof(*csi), GFP_KERNEL);
21979f257f50SLaurent Pinchart if (!csi)
21989f257f50SLaurent Pinchart return -ENOMEM;
21999f257f50SLaurent Pinchart
22009f257f50SLaurent Pinchart csi->dev = dev;
22019f257f50SLaurent Pinchart platform_set_drvdata(pdev, csi);
22029f257f50SLaurent Pinchart
22039f257f50SLaurent Pinchart spin_lock_init(&csi->irqlock);
22049f257f50SLaurent Pinchart
22059f257f50SLaurent Pinchart /* Acquire resources and install interrupt handler. */
22069f257f50SLaurent Pinchart csi->mclk = devm_clk_get(&pdev->dev, "mclk");
22071d59fbebSLaurent Pinchart if (IS_ERR(csi->mclk)) {
22089f257f50SLaurent Pinchart ret = PTR_ERR(csi->mclk);
22099f257f50SLaurent Pinchart dev_err(dev, "Failed to get mclk: %d", ret);
22109f257f50SLaurent Pinchart return ret;
22111d59fbebSLaurent Pinchart }
22121d59fbebSLaurent Pinchart
22139f257f50SLaurent Pinchart csi->irq = platform_get_irq(pdev, 0);
22149f257f50SLaurent Pinchart if (csi->irq < 0)
22151d59fbebSLaurent Pinchart return csi->irq;
22161d59fbebSLaurent Pinchart
22179f257f50SLaurent Pinchart csi->regbase = devm_platform_ioremap_resource(pdev, 0);
22189f257f50SLaurent Pinchart if (IS_ERR(csi->regbase))
22199f257f50SLaurent Pinchart return PTR_ERR(csi->regbase);
22209f257f50SLaurent Pinchart
22219f257f50SLaurent Pinchart csi->model = (enum imx_csi_model)(uintptr_t)of_device_get_match_data(&pdev->dev);
22229f257f50SLaurent Pinchart
22239f257f50SLaurent Pinchart ret = devm_request_irq(dev, csi->irq, imx7_csi_irq_handler, 0, "csi",
22241d59fbebSLaurent Pinchart (void *)csi);
22259f257f50SLaurent Pinchart if (ret < 0) {
22269f257f50SLaurent Pinchart dev_err(dev, "Request CSI IRQ failed.\n");
22279f257f50SLaurent Pinchart return ret;
22289f257f50SLaurent Pinchart }
22299f257f50SLaurent Pinchart
22301d59fbebSLaurent Pinchart /* Initialize all the media device infrastructure. */
22319f257f50SLaurent Pinchart ret = imx7_csi_media_init(csi);
22329f257f50SLaurent Pinchart if (ret)
22339f257f50SLaurent Pinchart return ret;
22341d59fbebSLaurent Pinchart
22359f257f50SLaurent Pinchart ret = imx7_csi_async_register(csi);
22369f257f50SLaurent Pinchart if (ret)
22379f257f50SLaurent Pinchart goto err_media_cleanup;
22381d59fbebSLaurent Pinchart
22399f257f50SLaurent Pinchart return 0;
22409f257f50SLaurent Pinchart
22419f257f50SLaurent Pinchart err_media_cleanup:
22429f257f50SLaurent Pinchart imx7_csi_media_cleanup(csi);
22439f257f50SLaurent Pinchart
22441b289dbcSUwe Kleine-König return ret;
22459f257f50SLaurent Pinchart }
22469f257f50SLaurent Pinchart
imx7_csi_remove(struct platform_device * pdev)22479f257f50SLaurent Pinchart static void imx7_csi_remove(struct platform_device *pdev)
22489f257f50SLaurent Pinchart {
22499f257f50SLaurent Pinchart struct imx7_csi *csi = platform_get_drvdata(pdev);
22509f257f50SLaurent Pinchart
22519f257f50SLaurent Pinchart imx7_csi_media_cleanup(csi);
22529f257f50SLaurent Pinchart
22539f257f50SLaurent Pinchart v4l2_async_nf_unregister(&csi->notifier);
22549f257f50SLaurent Pinchart v4l2_async_nf_cleanup(&csi->notifier);
22559f257f50SLaurent Pinchart v4l2_async_unregister_subdev(&csi->sd);
22569f257f50SLaurent Pinchart }
22579f257f50SLaurent Pinchart
22589f257f50SLaurent Pinchart static const struct of_device_id imx7_csi_of_match[] = {
22599f257f50SLaurent Pinchart { .compatible = "fsl,imx8mq-csi", .data = (void *)IMX7_CSI_IMX8MQ },
22609f257f50SLaurent Pinchart { .compatible = "fsl,imx7-csi", .data = (void *)IMX7_CSI_IMX7 },
22619f257f50SLaurent Pinchart { .compatible = "fsl,imx6ul-csi", .data = (void *)IMX7_CSI_IMX7 },
22629f257f50SLaurent Pinchart { },
22639f257f50SLaurent Pinchart };
22649f257f50SLaurent Pinchart MODULE_DEVICE_TABLE(of, imx7_csi_of_match);
22651b289dbcSUwe Kleine-König
22669f257f50SLaurent Pinchart static struct platform_driver imx7_csi_driver = {
22679f257f50SLaurent Pinchart .probe = imx7_csi_probe,
22689f257f50SLaurent Pinchart .remove_new = imx7_csi_remove,
22699f257f50SLaurent Pinchart .driver = {
22709f257f50SLaurent Pinchart .of_match_table = imx7_csi_of_match,
22719f257f50SLaurent Pinchart .name = "imx7-csi",
22729f257f50SLaurent Pinchart },
22739f257f50SLaurent Pinchart };
22749f257f50SLaurent Pinchart module_platform_driver(imx7_csi_driver);
22759f257f50SLaurent Pinchart
22769f257f50SLaurent Pinchart MODULE_DESCRIPTION("i.MX7 CSI subdev driver");
2277 MODULE_AUTHOR("Rui Miguel Silva <rui.silva@linaro.org>");
2278 MODULE_LICENSE("GPL v2");
2279 MODULE_ALIAS("platform:imx7-csi");
2280