| Message ID | 1499730214-9005-4-git-send-email-yong.zhi@intel.com (mailing list archive) |
|---|---|
| State | New, archived |
| Headers | show |
Hi Yong, Thanks for the update! This looks pretty good in general, still some more comments below. Do you happen to have a todo list for the changes that are still planned? AFAIR we should have two items in the list at least --- 1. Extend the format example to include the DMA word boundary and 2. Separate formats on the sub-device and on the video node. On Mon, Jul 10, 2017 at 06:43:34PM -0500, Yong Zhi wrote: > This patch adds CIO2 CSI-2 device driver for > Intel's IPU3 camera sub-system support. > > Signed-off-by: Yong Zhi <yong.zhi@intel.com> > Signed-off-by: Hyungwoo Yang <hyungwoo.yang@intel.com> > Signed-off-by: Ramya Vijaykumar <ramya.vijaykumar@intel.com> > --- > drivers/media/pci/Kconfig | 2 + > drivers/media/pci/Makefile | 3 +- > drivers/media/pci/intel/Makefile | 5 + > drivers/media/pci/intel/ipu3/Kconfig | 17 + > drivers/media/pci/intel/ipu3/Makefile | 1 + > drivers/media/pci/intel/ipu3/ipu3-cio2.c | 1873 ++++++++++++++++++++++++++++++ > drivers/media/pci/intel/ipu3/ipu3-cio2.h | 442 +++++++ > 7 files changed, 2342 insertions(+), 1 deletion(-) > create mode 100644 drivers/media/pci/intel/Makefile > create mode 100644 drivers/media/pci/intel/ipu3/Kconfig > create mode 100644 drivers/media/pci/intel/ipu3/Makefile > create mode 100644 drivers/media/pci/intel/ipu3/ipu3-cio2.c > create mode 100644 drivers/media/pci/intel/ipu3/ipu3-cio2.h > > diff --git a/drivers/media/pci/Kconfig b/drivers/media/pci/Kconfig > index da28e68..5932e22 100644 > --- a/drivers/media/pci/Kconfig > +++ b/drivers/media/pci/Kconfig > @@ -54,5 +54,7 @@ source "drivers/media/pci/smipcie/Kconfig" > source "drivers/media/pci/netup_unidvb/Kconfig" > endif > > +source "drivers/media/pci/intel/ipu3/Kconfig" > + > endif #MEDIA_PCI_SUPPORT > endif #PCI > diff --git a/drivers/media/pci/Makefile b/drivers/media/pci/Makefile > index a7e8af0..d8f9843 100644 > --- a/drivers/media/pci/Makefile > +++ b/drivers/media/pci/Makefile > @@ -13,7 +13,8 @@ obj-y += ttpci/ \ > ddbridge/ \ > saa7146/ \ > smipcie/ \ > - netup_unidvb/ > + netup_unidvb/ \ > + intel/ > > obj-$(CONFIG_VIDEO_IVTV) += ivtv/ > obj-$(CONFIG_VIDEO_ZORAN) += zoran/ > diff --git a/drivers/media/pci/intel/Makefile b/drivers/media/pci/intel/Makefile > new file mode 100644 > index 0000000..745c8b2 > --- /dev/null > +++ b/drivers/media/pci/intel/Makefile > @@ -0,0 +1,5 @@ > +# > +# Makefile for the IPU3 cio2 and ImGU drivers > +# > + > +obj-y += ipu3/ > diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig > new file mode 100644 > index 0000000..2a895d6 > --- /dev/null > +++ b/drivers/media/pci/intel/ipu3/Kconfig > @@ -0,0 +1,17 @@ > +config VIDEO_IPU3_CIO2 > + tristate "Intel ipu3-cio2 driver" > + depends on VIDEO_V4L2 && PCI > + depends on MEDIA_CONTROLLER Could you also add VIDEO_V4L2_SUBDEV_API, please? > + depends on HAS_DMA > + depends on ACPI > + select V4L2_FWNODE > + select VIDEOBUF2_DMA_SG > + > + ---help--- > + This is the Intel IPU3 CIO2 CSI-2 receiver unit, found in Intel > + Skylake and Kaby Lake SoCs and used for capturing images and > + video from a camera sensor. > + > + Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2 > + connected camera. > + The module will be called ipu3-cio2. > diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile > new file mode 100644 > index 0000000..20186e3 > --- /dev/null > +++ b/drivers/media/pci/intel/ipu3/Makefile > @@ -0,0 +1 @@ > +obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o > diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.c b/drivers/media/pci/intel/ipu3/ipu3-cio2.c > new file mode 100644 > index 0000000..8ecb17f > --- /dev/null > +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.c > @@ -0,0 +1,1873 @@ > +/* > + * Copyright (c) 2017 Intel Corporation. > + * > + * This program is free software; you can redistribute it and/or > + * modify it under the terms of the GNU General Public License version > + * 2 as published by the Free Software Foundation. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + * > + * Based partially on Intel IPU4 driver written by > + * Sakari Ailus <sakari.ailus@linux.intel.com> > + * Samu Onkalo <samu.onkalo@intel.com> > + * Jouni Högander <jouni.hogander@intel.com> > + * Jouni Ukkonen <jouni.ukkonen@intel.com> > + * Antti Laakso <antti.laakso@intel.com> > + * et al. > + * > + */ > + > +#include <linux/delay.h> > +#include <linux/interrupt.h> > +#include <linux/module.h> > +#include <linux/pci.h> > +#include <linux/pm_runtime.h> > +#include <linux/property.h> > +#include <linux/vmalloc.h> > +#include <media/v4l2-ctrls.h> > +#include <media/v4l2-device.h> > +#include <media/v4l2-event.h> > +#include <media/v4l2-fwnode.h> > +#include <media/v4l2-ioctl.h> > +#include <media/videobuf2-dma-sg.h> > + > +#include "ipu3-cio2.h" > + > +/* > + * These are raw formats used in Intel's third generation of > + * Image Processing Unit known as IPU3. > + * 10bit raw bayer packed, 32 bytes for every 25 pixels, > + * last LSB 6 bits unused. > + */ > +static const u32 cio2_csi2_fmts[] = { > + V4L2_PIX_FMT_IPU3_SRGGB10, > + V4L2_PIX_FMT_IPU3_SGBRG10, > + V4L2_PIX_FMT_IPU3_SGRBG10, > + V4L2_PIX_FMT_IPU3_SBGGR10, > +}; > + > +static inline u32 cio2_bytesperline(const unsigned int width) > +{ > + /* > + * 64 bytes for every 50 pixels, the line length > + * in bytes is multiple of 64 (line end alignment). > + */ > + return DIV_ROUND_UP(width, 50) * 64; > +} > + > +/**************** FBPT operations ****************/ > + > +static void cio2_fbpt_exit_dummy(struct cio2_device *cio2) > +{ > + if (cio2->dummy_lop) { > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > + cio2->dummy_lop, cio2->dummy_lop_bus_addr); > + cio2->dummy_lop = NULL; > + } > + if (cio2->dummy_page) { > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > + cio2->dummy_page, cio2->dummy_page_bus_addr); > + cio2->dummy_page = NULL; > + } > +} > + > +static int cio2_fbpt_init_dummy(struct cio2_device *cio2) > +{ > + unsigned int i; > + > + cio2->dummy_page = dma_alloc_coherent(&cio2->pci_dev->dev, > + CIO2_PAGE_SIZE, &cio2->dummy_page_bus_addr, > + GFP_KERNEL); > + cio2->dummy_lop = dma_alloc_coherent(&cio2->pci_dev->dev, > + CIO2_PAGE_SIZE, &cio2->dummy_lop_bus_addr, > + GFP_KERNEL); > + if (!cio2->dummy_page || !cio2->dummy_lop) { > + cio2_fbpt_exit_dummy(cio2); > + return -ENOMEM; > + } > + /* > + * List of Pointers(LOP) contains 1024x32b pointers to 4KB page each > + * Initialize each entry to dummy_page bus base address. > + */ > + for (i = 0; i < CIO2_PAGE_SIZE / sizeof(*cio2->dummy_lop); i++) > + cio2->dummy_lop[i] = cio2->dummy_page_bus_addr >> PAGE_SHIFT; > + > + return 0; > +} > + > +static void cio2_fbpt_entry_enable(struct cio2_device *cio2, > + struct cio2_fbpt_entry entry[CIO2_MAX_LOPS]) > +{ > + /* > + * The CPU first initializes some fields in fbpt, then sets > + * the VALID bit, this barrier is to ensure that the DMA(device) > + * does not see the VALID bit enabled before other fields are > + * initialized; otherwise it could lead to havoc. > + */ > + dma_wmb(); > + > + /* > + * Request interrupts for start and completion > + * Valid bit is applicable only to 1st entry > + */ > + entry[0].first_entry.ctrl = CIO2_FBPT_CTRL_VALID | > + CIO2_FBPT_CTRL_IOC | CIO2_FBPT_CTRL_IOS; > +} > + > +/* Initialize fpbt entries to point to dummy frame */ > +static void cio2_fbpt_entry_init_dummy(struct cio2_device *cio2, > + struct cio2_fbpt_entry > + entry[CIO2_MAX_LOPS]) > +{ > + unsigned int i; > + > + entry[0].first_entry.first_page_offset = 0; > + entry[1].second_entry.num_of_pages = > + CIO2_PAGE_SIZE / sizeof(u32) * CIO2_MAX_LOPS; > + entry[1].second_entry.last_page_available_bytes = CIO2_PAGE_SIZE - 1; > + > + for (i = 0; i < CIO2_MAX_LOPS; i++) > + entry[i].lop_page_addr = cio2->dummy_lop_bus_addr >> PAGE_SHIFT; > + > + cio2_fbpt_entry_enable(cio2, entry); > +} > + > +/* Initialize fpbt entries to point to a given buffer */ > +static void cio2_fbpt_entry_init_buf(struct cio2_device *cio2, > + struct cio2_buffer *b, > + struct cio2_fbpt_entry > + entry[CIO2_MAX_LOPS]) > +{ > + struct vb2_buffer *vb = &b->vbb.vb2_buf; > + unsigned int length = vb->planes[0].length; > + int remaining, i; > + > + entry[0].first_entry.first_page_offset = > + offset_in_page(vb2_plane_vaddr(vb, 0)); > + remaining = length + entry[0].first_entry.first_page_offset; > + entry[1].second_entry.num_of_pages = > + DIV_ROUND_UP(remaining, CIO2_PAGE_SIZE); > + /* > + * last_page_available_bytes has the offset of the last byte in the > + * last page which is still accessible by DMA. DMA cannot access > + * beyond this point. Valid range for this is from 0 to 4095. > + * 0 indicates 1st byte in the page is DMA accessible. > + * 4095 (CIO2_PAGE_SIZE - 1) means every single byte in the last page > + * is available for DMA transfer. > + */ > + entry[1].second_entry.last_page_available_bytes = > + (remaining & ~PAGE_MASK) ? > + (remaining & ~PAGE_MASK) - 1 : > + CIO2_PAGE_SIZE - 1; > + /* Fill FBPT */ > + remaining = length; > + i = 0; > + while (remaining > 0) { > + entry->lop_page_addr = b->lop_bus_addr[i] >> PAGE_SHIFT; > + remaining -= CIO2_PAGE_SIZE / sizeof(u32) * CIO2_PAGE_SIZE; > + entry++; > + i++; > + } > + > + /* > + * The first not meaningful FBPT entry should point to a valid LOP > + */ > + entry->lop_page_addr = cio2->dummy_lop_bus_addr >> PAGE_SHIFT; > + > + cio2_fbpt_entry_enable(cio2, entry); > +} > + > +static int cio2_fbpt_init(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + struct device *dev = &cio2->pci_dev->dev; > + > + q->fbpt = dma_alloc_coherent(dev, CIO2_FBPT_SIZE, > + &q->fbpt_bus_addr, GFP_KERNEL); This could be aligned better. > + if (!q->fbpt) > + return -ENOMEM; > + > + memset(q->fbpt, 0, CIO2_FBPT_SIZE); > + > + return 0; > +} > + > +static void cio2_fbpt_exit(struct cio2_queue *q, struct device *dev) > +{ > + dma_free_coherent(dev, CIO2_FBPT_SIZE, q->fbpt, q->fbpt_bus_addr); > +} > + > +/**************** CSI2 hardware setup ****************/ > + > +/* > + * The CSI2 receiver has several parameters affecting > + * the receiver timings. These depend on the MIPI bus frequency > + * F in Hz (sensor transmitter rate) as follows: > + * register value = (A/1e9 + B * UI) / COUNT_ACC > + * where > + * UI = 1 / (2 * F) in seconds > + * COUNT_ACC = counter accuracy in seconds > + * For IPU3 COUNT_ACC = 0.0625 > + * > + * A and B are coefficients from the table below, > + * depending whether the register minimum or maximum value is > + * calculated. > + * Minimum Maximum > + * Clock lane A B A B > + * reg_rx_csi_dly_cnt_termen_clane 0 0 38 0 > + * reg_rx_csi_dly_cnt_settle_clane 95 -8 300 -16 > + * Data lanes > + * reg_rx_csi_dly_cnt_termen_dlane0 0 0 35 4 > + * reg_rx_csi_dly_cnt_settle_dlane0 85 -2 145 -6 > + * reg_rx_csi_dly_cnt_termen_dlane1 0 0 35 4 > + * reg_rx_csi_dly_cnt_settle_dlane1 85 -2 145 -6 > + * reg_rx_csi_dly_cnt_termen_dlane2 0 0 35 4 > + * reg_rx_csi_dly_cnt_settle_dlane2 85 -2 145 -6 > + * reg_rx_csi_dly_cnt_termen_dlane3 0 0 35 4 > + * reg_rx_csi_dly_cnt_settle_dlane3 85 -2 145 -6 > + * > + * We use the minimum values of both A and B. > + */ > + > +/* > + * shift for keeping value range suitable for 32-bit integer arithmetics > + */ > +#define LIMIT_SHIFT 8 > + > +static int cio2_rx_timing(s32 a, s32 b, s64 freq, int def) > +{ > + const u32 accinv = 16; /* invert of counter resolution */ > + const u32 uiinv = 500000000; /* 1/2 * 1/1e9 */ 1e9 / 2 ? > + int r; > + > + freq >>= LIMIT_SHIFT; > + > + if (WARN_ON(freq <= 0 || freq > S32_MAX)) > + return def; > + /* > + * b could be 0, -2 or -8, so |accinv * b| is always > + * less than (1 << ds) and thus |r| < 500000000. > + */ > + r = accinv * b * (uiinv >> LIMIT_SHIFT); > + r = (s32) r / freq; Please cast freq to s32; r should b s32 to begin with. > + /* max value of a is 95 */ > + r += accinv * a; > + > + return r; > +}; > + > +/* Calculate the the delay value for termination enable of clock lane HS Rx */ > +static int cio2_csi2_calc_timing(struct cio2_device *cio2, struct cio2_queue *q, > + struct cio2_csi2_timing *timing) > +{ > + struct device *dev = &cio2->pci_dev->dev; > + struct v4l2_querymenu qm = {.id = V4L2_CID_LINK_FREQ, }; > + struct v4l2_ctrl *link_freq; > + s64 freq; > + int r; > + > + if (!q->sensor) > + return -ENODEV; > + > + link_freq = v4l2_ctrl_find(q->sensor->ctrl_handler, > + V4L2_CID_LINK_FREQ); Fits on previous line. > + if (!link_freq) { > + dev_err(dev, "failed to find LINK_FREQ\n"); > + return -EPIPE; > + }; > + > + qm.index = v4l2_ctrl_g_ctrl(link_freq); > + r = v4l2_querymenu(q->sensor->ctrl_handler, &qm); > + if (r) { > + dev_err(dev, "failed to get menu item\n"); > + return r; > + } > + > + if (!qm.value) { > + dev_err(dev, "error invalid link_freq\n"); > + return -EINVAL; > + } > + freq = qm.value; > + > + timing->clk_termen = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A, > + CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B, freq, > + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); > + timing->clk_settle = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A, > + CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B, freq, > + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); > + timing->dat_termen = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A, > + CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B, freq, > + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); > + timing->dat_settle = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A, > + CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B, freq, > + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); > + > + dev_dbg(dev, "freq ct value is %d\n", timing->clk_termen); > + dev_dbg(dev, "freq cs value is %d\n", timing->clk_settle); > + dev_dbg(dev, "freq dt value is %d\n", timing->dat_termen); > + dev_dbg(dev, "freq ds value is %d\n", timing->dat_settle); > + > + return 0; > +}; > + > +static int cio2_hw_mbus_to_mipicode(__u32 code, u8 *mipicode) > +{ > + static const struct { > + u32 mbuscode; > + u8 mipicode; > + } mbus2mipi[] = { > + { MEDIA_BUS_FMT_SBGGR10_1X10, 0x2b }, > + { MEDIA_BUS_FMT_SGBRG10_1X10, 0x2b }, > + { MEDIA_BUS_FMT_SGRBG10_1X10, 0x2b }, > + { MEDIA_BUS_FMT_SRGGB10_1X10, 0x2b }, > + }; > + unsigned int i; > + > + for (i = 0; i < ARRAY_SIZE(mbus2mipi); i++) > + if (mbus2mipi[i].mbuscode == code) { > + *mipicode = mbus2mipi[i].mipicode; > + return 0; > + } > + > + return -EINVAL; > +} > + > +static int cio2_hw_init(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + static const int NUM_VCS = 4; > + static const int SID; /* Stream id */ > + static const int ENTRY; > + static const int FBPT_WIDTH = DIV_ROUND_UP(CIO2_MAX_LOPS, > + CIO2_FBPT_SUBENTRY_UNIT); > + const u32 num_buffers1 = CIO2_MAX_BUFFERS - 1; > + void __iomem *const base = cio2->base; > + u8 mipicode, lanes, csi2bus = q->csi2.port; > + u8 sensor_vc = SENSOR_VIR_CH_DFLT; > + struct cio2_csi2_timing timing; > + int i, r; > + > + r = cio2_hw_mbus_to_mipicode(q->subdev_fmt.code, &mipicode); > + if (r < 0) > + return r; > + > + lanes = q->csi2.num_of_lanes; > + > + r = cio2_csi2_calc_timing(cio2, q, &timing); > + if (r) > + return r; > + > + writel(timing.clk_termen, q->csi_rx_base + > + CIO2_REG_CSIRX_DLY_CNT_TERMEN(CIO2_CSIRX_DLY_CNT_CLANE_IDX)); > + writel(timing.clk_settle, q->csi_rx_base + > + CIO2_REG_CSIRX_DLY_CNT_SETTLE(CIO2_CSIRX_DLY_CNT_CLANE_IDX)); > + > + for (i = 0; i < lanes; i++) { > + writel(timing.dat_termen, q->csi_rx_base + > + CIO2_REG_CSIRX_DLY_CNT_TERMEN(i)); > + writel(timing.dat_settle, q->csi_rx_base + > + CIO2_REG_CSIRX_DLY_CNT_SETTLE(i)); > + } > + > + writel(CIO2_PBM_WMCTRL1_MIN_2CK | > + CIO2_PBM_WMCTRL1_MID1_2CK | > + CIO2_PBM_WMCTRL1_MID2_2CK, base + CIO2_REG_PBM_WMCTRL1); > + writel(CIO2_PBM_WMCTRL2_HWM_2CK << CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT | > + CIO2_PBM_WMCTRL2_LWM_2CK << CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT | > + CIO2_PBM_WMCTRL2_OBFFWM_2CK << > + CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT | > + CIO2_PBM_WMCTRL2_TRANSDYN << CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT | > + CIO2_PBM_WMCTRL2_OBFF_MEM_EN, base + CIO2_REG_PBM_WMCTRL2); > + writel(CIO2_PBM_ARB_CTRL_LANES_DIV << > + CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT | > + CIO2_PBM_ARB_CTRL_LE_EN | > + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN << > + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT | > + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP << > + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT, > + base + CIO2_REG_PBM_ARB_CTRL); > + writel(CIO2_CSIRX_STATUS_DLANE_HS_MASK, > + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_HS); > + writel(CIO2_CSIRX_STATUS_DLANE_LP_MASK, > + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_LP); > + > + writel(CIO2_FB_HPLL_FREQ, base + CIO2_REG_FB_HPLL_FREQ); > + writel(CIO2_ISCLK_RATIO, base + CIO2_REG_ISCLK_RATIO); > + > + /* Configure MIPI backend */ > + for (i = 0; i < NUM_VCS; i++) > + writel(1, q->csi_rx_base + CIO2_REG_MIPIBE_SP_LUT_ENTRY(i)); > + > + /* There are 16 short packet LUT entry */ > + for (i = 0; i < 16; i++) > + writel(CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD, > + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(i)); > + writel(CIO2_MIPIBE_GLOBAL_LUT_DISREGARD, > + q->csi_rx_base + CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD); > + > + writel(CIO2_INT_EN_EXT_IE_MASK, base + CIO2_REG_INT_EN_EXT_IE); > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_MASK); > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_ENABLE); > + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_EDGE); > + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE); > + writel(CIO2_INT_EN_EXT_OE_MASK, base + CIO2_REG_INT_EN_EXT_OE); > + > + writel(CIO2_REG_INT_EN_IRQ | CIO2_INT_IOC(CIO2_DMA_CHAN) | > + CIO2_REG_INT_EN_IOS(CIO2_DMA_CHAN), > + base + CIO2_REG_INT_EN); > + > + writel((CIO2_PXM_PXF_FMT_CFG_BPP_10 | CIO2_PXM_PXF_FMT_CFG_PCK_64B) > + << CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT, > + base + CIO2_REG_PXM_PXF_FMT_CFG0(csi2bus)); > + writel(SID << CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT | > + sensor_vc << CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT | > + mipicode << CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT, > + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(ENTRY)); > + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_COMP_FORMAT(sensor_vc)); > + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_FORCE_RAW8); > + writel(0, base + CIO2_REG_PXM_SID2BID0(csi2bus)); > + > + writel(lanes, q->csi_rx_base + CIO2_REG_CSIRX_NOF_ENABLED_LANES); > + writel(CIO2_CGC_PRIM_TGE | > + CIO2_CGC_SIDE_TGE | > + CIO2_CGC_XOSC_TGE | > + CIO2_CGC_D3I3_TGE | > + CIO2_CGC_CSI2_INTERFRAME_TGE | > + CIO2_CGC_CSI2_PORT_DCGE | > + CIO2_CGC_SIDE_DCGE | > + CIO2_CGC_PRIM_DCGE | > + CIO2_CGC_ROSC_DCGE | > + CIO2_CGC_XOSC_DCGE | > + CIO2_CGC_CLKGATE_HOLDOFF << CIO2_CGC_CLKGATE_HOLDOFF_SHIFT | > + CIO2_CGC_CSI_CLKGATE_HOLDOFF > + << CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT, base + CIO2_REG_CGC); > + writel(CIO2_LTRVAL0_VAL << CIO2_LTRVAL02_VAL_SHIFT | > + CIO2_LTRVAL0_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | > + CIO2_LTRVAL1_VAL << CIO2_LTRVAL13_VAL_SHIFT | > + CIO2_LTRVAL1_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, > + base + CIO2_REG_LTRVAL01); > + writel(CIO2_LTRVAL2_VAL << CIO2_LTRVAL02_VAL_SHIFT | > + CIO2_LTRVAL2_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | > + CIO2_LTRVAL3_VAL << CIO2_LTRVAL13_VAL_SHIFT | > + CIO2_LTRVAL3_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, > + base + CIO2_REG_LTRVAL23); > + > + for (i = 0; i < CIO2_NUM_DMA_CHAN; i++) { > + writel(0, base + CIO2_REG_CDMABA(i)); > + writel(0, base + CIO2_REG_CDMAC0(i)); > + writel(0, base + CIO2_REG_CDMAC1(i)); > + } > + > + /* Enable DMA */ > + writel(q->fbpt_bus_addr >> PAGE_SHIFT, > + base + CIO2_REG_CDMABA(CIO2_DMA_CHAN)); > + > + writel(num_buffers1 << CIO2_CDMAC0_FBPT_LEN_SHIFT | > + FBPT_WIDTH << CIO2_CDMAC0_FBPT_WIDTH_SHIFT | > + CIO2_CDMAC0_DMA_INTR_ON_FE | > + CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL | > + CIO2_CDMAC0_DMA_EN | > + CIO2_CDMAC0_DMA_INTR_ON_FS | > + CIO2_CDMAC0_DMA_HALTED, base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); > + > + writel(1 << CIO2_CDMAC1_LINENUMUPDATE_SHIFT, > + base + CIO2_REG_CDMAC1(CIO2_DMA_CHAN)); > + > + writel(0, base + CIO2_REG_PBM_FOPN_ABORT); > + > + writel(CIO2_PXM_FRF_CFG_CRC_TH << CIO2_PXM_FRF_CFG_CRC_TH_SHIFT | > + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR | > + CIO2_PXM_FRF_CFG_MSK_ECC_RE | > + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE, > + base + CIO2_REG_PXM_FRF_CFG(q->csi2.port)); > + > + /* Clear interrupts */ > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_CLEAR); > + writel(~0, base + CIO2_REG_INT_STS_EXT_OE); > + writel(~0, base + CIO2_REG_INT_STS_EXT_IE); > + writel(~0, base + CIO2_REG_INT_STS); > + > + /* Enable devices, starting from the last device in the pipe */ > + writel(1, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); > + writel(1, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); > + > + return 0; > +} > + > +static void cio2_hw_exit(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + void __iomem *base = cio2->base; > + unsigned int i, maxloops = 1000; > + > + /* Disable CSI receiver and MIPI backend devices */ > + writel(0, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); > + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); > + > + /* Halt DMA */ > + writel(0, base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); > + do { > + if (readl(base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)) & > + CIO2_CDMAC0_DMA_HALTED) > + break; > + usleep_range(1000, 2000); > + } while (--maxloops); > + if (!maxloops) > + dev_err(&cio2->pci_dev->dev, > + "DMA %i can not be halted\n", CIO2_DMA_CHAN); > + > + for (i = 0; i < CIO2_NUM_PORTS; i++) { > + writel(readl(base + CIO2_REG_PXM_FRF_CFG(i)) | > + CIO2_PXM_FRF_CFG_ABORT, base + CIO2_REG_PXM_FRF_CFG(i)); > + writel(readl(base + CIO2_REG_PBM_FOPN_ABORT) | > + CIO2_PBM_FOPN_ABORT(i), base + CIO2_REG_PBM_FOPN_ABORT); > + } > +} > + > +static void cio2_buffer_done(struct cio2_device *cio2, unsigned int dma_chan) > +{ > + struct device *dev = &cio2->pci_dev->dev; > + struct cio2_queue *q = cio2->cur_queue; > + int buffers_found = 0; > + > + if (dma_chan >= CIO2_QUEUES) { > + dev_err(dev, "bad DMA channel %i\n", dma_chan); > + return; > + } > + > + /* Find out which buffer(s) are ready */ > + do { > + struct cio2_fbpt_entry *const entry = > + &q->fbpt[q->bufs_first * CIO2_MAX_LOPS]; > + struct cio2_buffer *b; > + u64 ns = ktime_get_ns(); You could get ns just once outside the loop. > + > + if (entry->first_entry.ctrl & CIO2_FBPT_CTRL_VALID) > + break; > + > + b = q->bufs[q->bufs_first]; > + if (b) { > + q->bufs[q->bufs_first] = NULL; > + atomic_dec(&q->bufs_queued); > + > + b->vbb.vb2_buf.timestamp = ns; > + b->vbb.field = V4L2_FIELD_NONE; > + b->vbb.sequence = entry[0].first_entry.frame_num; > + vb2_buffer_done(&b->vbb.vb2_buf, VB2_BUF_STATE_DONE); > + } > + cio2_fbpt_entry_init_dummy(cio2, entry); > + q->bufs_first = (q->bufs_first + 1) % CIO2_MAX_BUFFERS; > + buffers_found++; > + } while (1); > + > + if (buffers_found == 0) > + dev_warn(&cio2->pci_dev->dev, > + "no ready buffers found on DMA channel %u\n", > + dma_chan); > +} > + > +static void cio2_queue_event_sof(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + struct v4l2_event event = { > + .type = V4L2_EVENT_FRAME_SYNC, > + .u.frame_sync.frame_sequence = > + atomic_inc_return(&q->frame_sequence) - 1, > + }; > + > + v4l2_event_queue(q->subdev.devnode, &event); > +} > + > +static const char *const cio2_irq_errs[] = { > + "single packet header error corrected", > + "multiple packet header errors detected", > + "payload checksum (CRC) error", > + "fifo overflow", > + "reserved short packet data type detected", > + "reserved long packet data type detected", > + "incomplete long packet detected", > + "frame sync error", > + "line sync error", > + "DPHY start of transmission error", > + "DPHY synchronization error", > + "escape mode error", > + "escape mode trigger event", > + "escape mode ultra-low power state for data lane(s)", > + "escape mode ultra-low power state exit for clock lane", > + "inter-frame short packet discarded", > + "inter-frame long packet discarded", > + "non-matching Long Packet stalled", > +}; > + > +static const char *const cio2_port_errs[] = { > + "ECC recoverable", > + "DPHY not recoverable", > + "ECC not recoverable", > + "CRC error", > + "INTERFRAMEDATA", > + "PKT2SHORT", > + "PKT2LONG", > +}; > + > +static irqreturn_t cio2_irq(int irq, void *cio2_ptr) > +{ > + struct cio2_device *cio2 = cio2_ptr; > + void __iomem *const base = cio2->base; > + struct device *dev = &cio2->pci_dev->dev; > + u32 int_status, int_clear; > + > + int_clear = int_status = readl(base + CIO2_REG_INT_STS); > + if (!int_status) > + return IRQ_NONE; > + > + if (int_status & CIO2_INT_IOOE) { > + /* > + * Interrupt on Output Error: > + * 1) SRAM is full and FS received, or > + * 2) An invalid bit detected by DMA. > + */ > + u32 oe_status, oe_clear; > + > + oe_clear = readl(base + CIO2_REG_INT_STS_EXT_OE); > + oe_status = oe_clear; > + > + if (oe_status & CIO2_INT_EXT_OE_DMAOE_MASK) { > + dev_err(dev, "DMA output error: 0x%x\n", > + (oe_status & CIO2_INT_EXT_OE_DMAOE_MASK) > + >> CIO2_INT_EXT_OE_DMAOE_SHIFT); > + oe_status &= ~CIO2_INT_EXT_OE_DMAOE_MASK; > + } > + if (oe_status & CIO2_INT_EXT_OE_OES_MASK) { > + dev_err(dev, "DMA output error on CSI2 buses: 0x%x\n", > + (oe_status & CIO2_INT_EXT_OE_OES_MASK) > + >> CIO2_INT_EXT_OE_OES_SHIFT); > + oe_status &= ~CIO2_INT_EXT_OE_OES_MASK; > + } > + writel(oe_clear, base + CIO2_REG_INT_STS_EXT_OE); > + if (oe_status) > + dev_warn(dev, "unknown interrupt 0x%x on OE\n", > + oe_status); > + int_status &= ~CIO2_INT_IOOE; > + } > + > + if (int_status & CIO2_INT_IOC_MASK) { > + /* DMA IO done -- frame ready */ > + u32 clr = 0; > + unsigned int d; > + > + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) > + if (int_status & CIO2_INT_IOC(d)) { > + clr |= CIO2_INT_IOC(d); > + dev_dbg(dev, "DMA %i done\n", d); > + cio2_buffer_done(cio2, d); > + } > + int_status &= ~clr; > + } > + > + if (int_status & CIO2_INT_IOS_IOLN_MASK) { > + /* DMA IO starts or reached specified line */ > + u32 clr = 0; > + unsigned int d; > + > + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) > + if (int_status & CIO2_INT_IOS_IOLN(d)) { > + clr |= CIO2_INT_IOS_IOLN(d); > + if (d == CIO2_DMA_CHAN) > + cio2_queue_event_sof(cio2, > + cio2->cur_queue); > + dev_dbg(dev, > + "DMA %i started or reached line\n", d); > + } > + int_status &= ~clr; > + } > + > + if (int_status & (CIO2_INT_IOIE | CIO2_INT_IOIRQ)) { > + /* CSI2 receiver (error) interrupt */ > + u32 ie_status, ie_clear; > + unsigned int port; > + > + ie_clear = readl(base + CIO2_REG_INT_STS_EXT_IE); > + ie_status = ie_clear; > + > + for (port = 0; port < CIO2_NUM_PORTS; port++) { > + u32 port_status = (ie_status >> (port * 8)) & 0xff; > + u32 err_mask = BIT_MASK(ARRAY_SIZE(cio2_port_errs)) - 1; > + void __iomem *const csi_rx_base = > + base + CIO2_REG_PIPE_BASE(port); > + unsigned int i; > + > + while (port_status & err_mask) { > + i = ffs(port_status) - 1; > + dev_err(dev, "port %i error %s\n", > + port, cio2_port_errs[i]); > + ie_status &= ~BIT(port * 8 + i); > + port_status &= ~BIT(i); > + } > + > + if (ie_status & CIO2_INT_EXT_IE_IRQ(port)) { > + u32 csi2_status, csi2_clear; > + > + csi2_status = readl(csi_rx_base + > + CIO2_REG_IRQCTRL_STATUS); > + csi2_clear = csi2_status; > + err_mask = > + BIT_MASK(ARRAY_SIZE(cio2_irq_errs)) - 1; > + > + while (csi2_status & err_mask) { > + i = ffs(csi2_status) - 1; > + dev_err(dev, > + "CSI-2 receiver port %i: %s\n", > + port, cio2_irq_errs[i]); > + csi2_status &= ~BIT(i); > + } > + > + writel(csi2_clear, > + csi_rx_base + CIO2_REG_IRQCTRL_CLEAR); > + if (csi2_status) > + dev_warn(dev, > + "unknown CSI2 error 0x%x on port %i\n", > + csi2_status, port); > + > + ie_status &= ~CIO2_INT_EXT_IE_IRQ(port); > + } > + } > + > + writel(ie_clear, base + CIO2_REG_INT_STS_EXT_IE); > + if (ie_status) > + dev_warn(dev, "unknown interrupt 0x%x on IE\n", > + ie_status); > + > + int_status &= ~(CIO2_INT_IOIE | CIO2_INT_IOIRQ); > + } > + > + writel(int_clear, base + CIO2_REG_INT_STS); > + if (int_status) > + dev_warn(dev, "unknown interrupt 0x%x on INT\n", int_status); > + > + return IRQ_HANDLED; > +} > + > +/**************** Videobuf2 interface ****************/ > + > +static void cio2_vb2_return_all_buffers(struct cio2_queue *q) > +{ > + unsigned int i; > + > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > + if (q->bufs[i]) { > + atomic_dec(&q->bufs_queued); > + vb2_buffer_done(&q->bufs[i]->vbb.vb2_buf, > + VB2_BUF_STATE_ERROR); > + } > + } > +} > + > +static int cio2_vb2_queue_setup(struct vb2_queue *vq, > + unsigned int *num_buffers, > + unsigned int *num_planes, > + unsigned int sizes[], > + struct device *alloc_devs[]) > +{ > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > + u32 width = q->subdev_fmt.width; > + u32 height = q->subdev_fmt.height; > + u32 pixelformat = q->format.pixelformat; > + unsigned int i, szimage; > + int r = 0; > + > + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { > + if (pixelformat == cio2_csi2_fmts[i]) > + break; > + } > + > + alloc_devs[0] = &cio2->pci_dev->dev; > + szimage = cio2_bytesperline(width) * height; > + > + *num_planes = 1; > + sizes[0] = szimage; > + > + *num_buffers = clamp_val(*num_buffers, 1, CIO2_MAX_BUFFERS); > + > + /* Initialize buffer queue */ > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > + q->bufs[i] = NULL; > + cio2_fbpt_entry_init_dummy(cio2, &q->fbpt[i * CIO2_MAX_LOPS]); > + } > + atomic_set(&q->bufs_queued, 0); > + q->bufs_first = 0; > + q->bufs_next = 0; > + q->format.sizeimage = szimage; > + > + return r; > +} > + > +/* Called after each buffer is allocated */ > +static int cio2_vb2_buf_init(struct vb2_buffer *vb) > +{ > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > + struct device *dev = &cio2->pci_dev->dev; > + struct cio2_buffer *b = > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > + unsigned int length = vb->planes[0].length; > + unsigned int page_entry = CIO2_PAGE_SIZE / sizeof(u32); > + int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, CIO2_PAGE_SIZE) + 1, > + page_entry); unsigned int? > + struct sg_table *sg; > + struct sg_page_iter sg_iter; > + unsigned int i, j; > + > + if (lops <= 0 || lops > CIO2_MAX_LOPS) { > + dev_err(dev, "%s: bad buffer size (%i)\n", __func__, length); > + return -ENOSPC; /* Should never happen */ > + } > + > + /* Allocate LOP table */ > + for (i = 0; i < lops; i++) { > + b->lop[i] = dma_alloc_coherent(dev, CIO2_PAGE_SIZE, > + &b->lop_bus_addr[i], GFP_KERNEL); > + if (!b->lop[i]) > + goto fail; > + } > + > + /* Fill LOP */ > + sg = vb2_dma_sg_plane_desc(vb, 0); > + if (!sg) > + return -ENOMEM; > + > + i = j = 0; > + for_each_sg_page(sg->sgl, &sg_iter, sg->nents, 0) { > + b->lop[i][j] = sg_page_iter_dma_address(&sg_iter) >> PAGE_SHIFT; > + j++; > + if (j == page_entry) { > + i++; > + j = 0; > + } > + } > + > + b->lop[i][j] = cio2->dummy_page_bus_addr >> PAGE_SHIFT; > + return 0; > +fail: > + for (; i >= 0; i--) > + dma_free_coherent(dev, CIO2_PAGE_SIZE, > + b->lop[i], b->lop_bus_addr[i]); > + return -ENOMEM; > +} > + > +/* Transfer buffer ownership to cio2 */ > +static void cio2_vb2_buf_queue(struct vb2_buffer *vb) > +{ > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > + struct cio2_queue *q = > + container_of(vb->vb2_queue, struct cio2_queue, vbq); > + struct cio2_buffer *b = > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > + struct cio2_fbpt_entry *entry; > + unsigned int i, next = q->bufs_next; > + int bufs_queued = atomic_inc_return(&q->bufs_queued); > + > + if (vb2_is_streaming(&q->vbq)) { > + u32 fbpt_rp = > + (readl(cio2->base + CIO2_REG_CDMARI(CIO2_DMA_CHAN)) > + >> CIO2_CDMARI_FBPT_RP_SHIFT) > + & CIO2_CDMARI_FBPT_RP_MASK; > + > + /* > + * fbpt_rp is the fbpt entry that the dma is currently working > + * on, but since it could jump to next entry at any time, > + * assume that we might already be there. > + */ > + fbpt_rp = (fbpt_rp + 1) % CIO2_MAX_BUFFERS; > + > + if (bufs_queued <= 1) > + next = fbpt_rp + 1; /* Buffers were drained */ > + else if (fbpt_rp == next) > + next++; > + next %= CIO2_MAX_BUFFERS; > + } > + > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > + /* > + * We have allocated CIO2_MAX_BUFFERS circularly for the > + * hw, the user has requested N buffer queue. The driver > + * ensures N <= CIO2_MAX_BUFFERS and guarantees that whenever > + * user queues a buffer, there necessarily is a free buffer. > + */ > + if (!q->bufs[next]) > + break; > + > + dev_dbg(&cio2->pci_dev->dev, > + "entry %i was already full!\n", next); > + next = (next + 1) % CIO2_MAX_BUFFERS; > + } > + /* This should not happen, just in case */ > + if (i == CIO2_MAX_BUFFERS) { > + dev_err(&cio2->pci_dev->dev, > + "error: all cio2 entries were full!\n"); > + vb2_buffer_done(vb, VB2_BUF_STATE_ERROR); > + return; > + } > + > + q->bufs[next] = b; > + entry = &q->fbpt[next * CIO2_MAX_LOPS]; > + cio2_fbpt_entry_init_buf(cio2, b, entry); > + q->bufs_next = (next + 1) % CIO2_MAX_BUFFERS; > + > + vb2_set_plane_payload(vb, 0, q->format.sizeimage); > +} > + > +/* Called when each buffer is freed */ > +static void cio2_vb2_buf_cleanup(struct vb2_buffer *vb) > +{ > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > + struct cio2_buffer *b = > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > + unsigned int i, length = vb->planes[0].length; > + unsigned int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, CIO2_PAGE_SIZE), > + CIO2_PAGE_SIZE / sizeof(u32)); > + > + /* Free LOP table */ > + for (i = 0; i < lops; i++) > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > + b->lop[i], b->lop_bus_addr[i]); > +} > + > +static int cio2_vb2_start_streaming(struct vb2_queue *vq, unsigned int count) > +{ > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > + int r; > + > + cio2->cur_queue = q; > + atomic_set(&q->frame_sequence, 0); > + > + r = pm_runtime_get_sync(&cio2->pci_dev->dev); > + if (r < 0) { > + dev_info(&cio2->pci_dev->dev, > + "failed to set power %d\n", r); > + pm_runtime_put(&cio2->pci_dev->dev); > + return r; > + } > + > + r = media_pipeline_start(&q->vdev.entity, &q->pipe); > + if (r) > + goto fail_pipeline; > + > + r = cio2_hw_init(cio2, q); > + if (r) > + goto fail_hw; > + > + /* Start streaming on CSI2 receiver */ > + r = v4l2_subdev_call(&q->subdev, video, s_stream, 1); You don't have s_stream() op defined, do you? You can drop this call then. > + if (r && r != -ENOIOCTLCMD) > + goto fail_csi2_subdev; > + > + /* Start streaming on sensor */ > + r = v4l2_subdev_call(q->sensor, video, s_stream, 1); > + if (r) > + goto fail_sensor_subdev; > + > + return 0; > + > +fail_sensor_subdev: > + v4l2_subdev_call(&q->subdev, video, s_stream, 0); Ditto. > +fail_csi2_subdev: > + cio2_hw_exit(cio2, q); > +fail_hw: > + media_pipeline_stop(&q->vdev.entity); > +fail_pipeline: > + dev_dbg(&cio2->pci_dev->dev, "failed to start streaming (%d)\n", r); > + cio2_vb2_return_all_buffers(q); > + > + return r; > +} > + > +static void cio2_vb2_stop_streaming(struct vb2_queue *vq) > +{ > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > + int r; > + > + if (v4l2_subdev_call(q->sensor, video, s_stream, 0)) > + dev_err(&cio2->pci_dev->dev, > + "failed to stop sensor streaming\n"); > + > + r = v4l2_subdev_call(&q->subdev, video, s_stream, 0); Here, too. > + if (r && r != -ENOIOCTLCMD) > + dev_err(&cio2->pci_dev->dev, "failed to stop CSI2 streaming\n"); > + > + cio2_hw_exit(cio2, q); > + cio2_vb2_return_all_buffers(q); > + media_pipeline_stop(&q->vdev.entity); > + pm_runtime_put(&cio2->pci_dev->dev); > +} > + > +static const struct vb2_ops cio2_vb2_ops = { > + .buf_init = cio2_vb2_buf_init, > + .buf_queue = cio2_vb2_buf_queue, > + .buf_cleanup = cio2_vb2_buf_cleanup, > + .queue_setup = cio2_vb2_queue_setup, > + .start_streaming = cio2_vb2_start_streaming, > + .stop_streaming = cio2_vb2_stop_streaming, > + .wait_prepare = vb2_ops_wait_prepare, > + .wait_finish = vb2_ops_wait_finish, > +}; > + > +/**************** V4L2 interface ****************/ > + > +static int cio2_v4l2_querycap(struct file *file, void *fh, > + struct v4l2_capability *cap) > +{ > + struct cio2_device *cio2 = video_drvdata(file); > + struct cio2_queue *q = file_to_cio2_queue(file); > + > + strlcpy(cap->driver, CIO2_NAME, sizeof(cap->driver)); > + strlcpy(cap->card, CIO2_DEVICE_NAME, sizeof(cap->card)); > + snprintf(cap->bus_info, sizeof(cap->bus_info), > + "PCI:%s", pci_name(cio2->pci_dev)); > + cap->capabilities = q->vdev.device_caps | V4L2_CAP_DEVICE_CAPS; > + return 0; > +} > + > +static int cio2_v4l2_enum_fmt(struct file *file, void *fh, > + struct v4l2_fmtdesc *f) > +{ > + if (f->index >= ARRAY_SIZE(cio2_csi2_fmts)) > + return -EINVAL; > + > + f->pixelformat = cio2_csi2_fmts[f->index]; > + > + return 0; > +} > + > +/* Propagate forward always the format from the CIO2 subdev */ > +static int cio2_v4l2_g_fmt(struct file *file, void *fh, struct v4l2_format *f) > +{ > + struct cio2_queue *q = file_to_cio2_queue(file); > + > + f->fmt.pix.width = q->subdev_fmt.width; > + f->fmt.pix.height = q->subdev_fmt.height; > + f->fmt.pix.pixelformat = q->format.pixelformat; > + f->fmt.pix.field = V4L2_FIELD_NONE; > + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); > + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; > + f->fmt.pix.colorspace = V4L2_COLORSPACE_RAW; > + > + return 0; > +} > + > +static int cio2_v4l2_try_fmt(struct file *file, void *fh, struct v4l2_format *f) > +{ > + u32 pixelformat = f->fmt.pix.pixelformat; > + unsigned int i; > + > + cio2_v4l2_g_fmt(file, fh, f); > + > + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { > + if (pixelformat == cio2_csi2_fmts[i]) > + break; > + } > + > + /* Use SRGGB10 as default if not found */ > + if (i >= ARRAY_SIZE(cio2_csi2_fmts)) > + pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; > + > + f->fmt.pix.pixelformat = pixelformat; > + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); > + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; > + > + return 0; > +} > + > +static int cio2_v4l2_s_fmt(struct file *file, void *fh, struct v4l2_format *f) > +{ > + struct cio2_queue *q = file_to_cio2_queue(file); > + > + cio2_v4l2_try_fmt(file, fh, f); > + q->format = f->fmt.pix; > + > + return 0; > +} > + > +static const struct v4l2_file_operations cio2_v4l2_fops = { > + .owner = THIS_MODULE, > + .unlocked_ioctl = video_ioctl2, > + .open = v4l2_fh_open, > + .release = vb2_fop_release, > + .poll = vb2_fop_poll, > + .mmap = vb2_fop_mmap, > +}; > + > +static const struct v4l2_ioctl_ops cio2_v4l2_ioctl_ops = { > + .vidioc_querycap = cio2_v4l2_querycap, > + .vidioc_enum_fmt_vid_cap = cio2_v4l2_enum_fmt, > + .vidioc_g_fmt_vid_cap = cio2_v4l2_g_fmt, > + .vidioc_s_fmt_vid_cap = cio2_v4l2_s_fmt, > + .vidioc_try_fmt_vid_cap = cio2_v4l2_try_fmt, > + .vidioc_reqbufs = vb2_ioctl_reqbufs, > + .vidioc_create_bufs = vb2_ioctl_create_bufs, > + .vidioc_prepare_buf = vb2_ioctl_prepare_buf, > + .vidioc_querybuf = vb2_ioctl_querybuf, > + .vidioc_qbuf = vb2_ioctl_qbuf, > + .vidioc_dqbuf = vb2_ioctl_dqbuf, > + .vidioc_streamon = vb2_ioctl_streamon, > + .vidioc_streamoff = vb2_ioctl_streamoff, > + .vidioc_expbuf = vb2_ioctl_expbuf, > +}; > + > +static int cio2_subdev_subscribe_event(struct v4l2_subdev *sd, > + struct v4l2_fh *fh, > + struct v4l2_event_subscription *sub) > +{ > + if (sub->type != V4L2_EVENT_FRAME_SYNC) > + return -EINVAL; > + > + /* Line number. For now only zero accepted. */ > + if (sub->id != 0) > + return -EINVAL; > + > + return v4l2_event_subscribe(fh, sub, 0, NULL); > +} > + > +/* > + * cio2_subdev_get_fmt - Handle get format by pads subdev method > + * @sd : pointer to v4l2 subdev structure > + * @cfg: V4L2 subdev pad config > + * @fmt: pointer to v4l2 subdev format structure > + * return -EINVAL or zero on success > + */ > +static int cio2_subdev_get_fmt(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_format *fmt) > +{ > + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); > + > + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) > + fmt->format = *v4l2_subdev_get_try_format(sd, cfg, fmt->pad); > + else /* Retrieve the current format */ > + fmt->format = q->subdev_fmt; > + > + return 0; > +} > + > +/* > + * cio2_subdev_set_fmt - Handle set format by pads subdev method > + * @sd : pointer to v4l2 subdev structure > + * @cfg: V4L2 subdev pad config > + * @fmt: pointer to v4l2 subdev format structure > + * return -EINVAL or zero on success > + */ > +static int cio2_subdev_set_fmt(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_format *fmt) > +{ > + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); > + > + /* > + * Only allow setting sink pad format; > + * source always propagates from sink > + */ > + if (fmt->pad == CIO2_PAD_SOURCE) > + return cio2_subdev_get_fmt(sd, cfg, fmt); > + > + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > + *v4l2_subdev_get_try_format(sd, cfg, fmt->pad) = fmt->format; > + } else { > + /* It's the sink, allow changing frame size */ > + q->subdev_fmt.width = fmt->format.width; > + q->subdev_fmt.height = fmt->format.height; > + q->subdev_fmt.code = fmt->format.code; > + fmt->format = q->subdev_fmt; > + } > + > + return 0; > +} > + > +static int cio2_subdev_enum_mbus_code(struct v4l2_subdev *sd, > + struct v4l2_subdev_pad_config *cfg, > + struct v4l2_subdev_mbus_code_enum *code) > +{ > + static const u32 codes[] = { > + MEDIA_BUS_FMT_SRGGB10_1X10, > + MEDIA_BUS_FMT_SBGGR10_1X10, > + MEDIA_BUS_FMT_SGBRG10_1X10, > + MEDIA_BUS_FMT_SGRBG10_1X10, > + }; > + > + if (code->index >= ARRAY_SIZE(codes)) > + return -EINVAL; > + > + code->code = codes[code->index]; > + > + return 0; > +} > + > +static int cio2_link_validate_get_format(struct media_pad *pad, > + struct v4l2_subdev_format *fmt) > +{ > + if (pad->entity->obj_type == MEDIA_ENTITY_TYPE_V4L2_SUBDEV) { > + struct v4l2_subdev *sd = > + media_entity_to_v4l2_subdev(pad->entity); > + if (sd) { > + fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE; > + fmt->pad = pad->index; > + return v4l2_subdev_call(sd, pad, get_fmt, NULL, fmt); > + } > + } > + > + return -EINVAL; > +} > + > +static int cio2_video_link_validate(struct media_link *link) > +{ > + struct video_device *vd; > + struct cio2_queue *q; > + struct media_pad *pad; > + struct v4l2_subdev_format fmt = { 0 }; > + struct cio2_device *cio2; > + int i, rval; > + > + static const struct { This would better be declared as first, not last. > + u32 mbuscode; > + u32 pixfmt; > + } mbus2pixfmt[] = { > + { MEDIA_BUS_FMT_SBGGR10_1X10, V4L2_PIX_FMT_IPU3_SBGGR10 }, > + { MEDIA_BUS_FMT_SGBRG10_1X10, V4L2_PIX_FMT_IPU3_SGBRG10 }, > + { MEDIA_BUS_FMT_SGRBG10_1X10, V4L2_PIX_FMT_IPU3_SGRBG10 }, > + { MEDIA_BUS_FMT_SRGGB10_1X10, V4L2_PIX_FMT_IPU3_SRGGB10 }, > + }; > + > + vd = container_of(link->sink->entity, struct video_device, entity); > + q = container_of(vd, struct cio2_queue, vdev); > + cio2 = video_get_drvdata(vd); I think you could well do the assignments in the declaration. > + pad = media_entity_remote_pad(link->sink->entity->pads); > + if (!pad) { > + dev_info(&cio2->pci_dev->dev, > + "video node %s pad not connected\n", vd->name); > + return -ENOTCONN; > + } > + > + rval = cio2_link_validate_get_format(link->source, &fmt); > + if (rval) > + return rval; > + > + if (fmt.format.width != q->format.width || > + fmt.format.height != q->format.height) { > + dev_info(&cio2->pci_dev->dev, > + "Wrong width or height %ux%u (%ux%u expected)\n", > + q->format.width, q->format.height, > + fmt.format.width, fmt.format.height); > + return -EINVAL; > + } > + > + for (i = 0; i < ARRAY_SIZE(mbus2pixfmt); i++) { > + if (mbus2pixfmt[i].mbuscode == fmt.format.code && > + mbus2pixfmt[i].pixfmt == q->format.pixelformat) { > + return 0; > + } > + } > + > + return -EINVAL; > +} > + > +static const struct v4l2_subdev_core_ops cio2_subdev_core_ops = { > + .subscribe_event = cio2_subdev_subscribe_event, > + .unsubscribe_event = v4l2_event_subdev_unsubscribe, > +}; > + > +static const struct v4l2_subdev_video_ops cio2_subdev_video_ops = {}; No need to have video ops struct if no ops are defined in it. > + > +static const struct v4l2_subdev_pad_ops cio2_subdev_pad_ops = { > + .link_validate = v4l2_subdev_link_validate_default, > + .get_fmt = cio2_subdev_get_fmt, > + .set_fmt = cio2_subdev_set_fmt, > + .enum_mbus_code = cio2_subdev_enum_mbus_code, > +}; > + > +static const struct v4l2_subdev_ops cio2_subdev_ops = { > + .core = &cio2_subdev_core_ops, > + .video = &cio2_subdev_video_ops, > + .pad = &cio2_subdev_pad_ops, > +}; > + > +/******* V4L2 sub-device asynchronous registration callbacks***********/ > + > +struct sensor_async_subdev { > + struct v4l2_async_subdev asd; > + struct v4l2_fwnode_endpoint vfwn_endpt; > +}; > + > +static struct cio2_queue *cio2_find_queue_by_sensor_node(struct cio2_queue *q, > + struct fwnode_handle *fwnode) > +{ > + int i; unsigned int? > + > + for (i = 0; i < CIO2_QUEUES; i++) { > + if (q[i].sensor->fwnode == fwnode) > + return &q[i]; > + } > + > + return NULL; > +} > + > +/* The .bound() notifier callback when a match is found */ > +static int cio2_notifier_bound(struct v4l2_async_notifier *notifier, > + struct v4l2_subdev *sd, > + struct v4l2_async_subdev *asd) > +{ > + struct cio2_device *cio2 = container_of(notifier, > + struct cio2_device, notifier); > + struct sensor_async_subdev *s_asd = container_of(asd, > + struct sensor_async_subdev, asd); > + struct cio2_queue *q; > + struct device *dev; > + int i; > + > + dev = &cio2->pci_dev->dev; > + > + /* Find first free slot for the subdev */ > + for (i = 0; i < CIO2_QUEUES; i++) > + if (!cio2->queue[i].sensor) > + break; > + > + if (i >= CIO2_QUEUES) { > + dev_err(dev, "too many subdevs\n"); You could just use &cio2->pci_dev->dev here. Alternatively please assign dev in variable declaration. > + return -ENOSPC; > + } > + q = &cio2->queue[i]; > + > + q->csi2.port = s_asd->vfwn_endpt.base.port; > + q->csi2.num_of_lanes = s_asd->vfwn_endpt.bus.mipi_csi2.num_data_lanes; > + q->sensor = sd; > + q->csi_rx_base = cio2->base + CIO2_REG_PIPE_BASE(q->csi2.port); > + > + return 0; > +} > + > +/* The .unbind callback */ > +static void cio2_notifier_unbind(struct v4l2_async_notifier *notifier, > + struct v4l2_subdev *sd, > + struct v4l2_async_subdev *asd) > +{ > + struct cio2_device *cio2 = container_of(notifier, > + struct cio2_device, notifier); > + unsigned int i; > + > + /* Note: sd may here point to unallocated memory. Do not access. */ > + for (i = 0; i < CIO2_QUEUES; i++) { > + if (cio2->queue[i].sensor == sd) { > + cio2->queue[i].sensor = NULL; > + return; > + } > + } > +} > + > +/* .complete() is called after all subdevices have been located */ > +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) > +{ > + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, > + notifier); > + struct sensor_async_subdev *s_asd; > + struct fwnode_handle *fwn_remote, *fwn_endpt, *fwn_remote_endpt; > + struct cio2_queue *q; > + struct fwnode_endpoint remote_endpt; > + unsigned int i, pad; > + int ret; > + > + for (i = 0; i < notifier->num_subdevs; i++) { > + s_asd = container_of(cio2->notifier.subdevs[i], > + struct sensor_async_subdev, > + asd); > + > + fwn_remote = s_asd->asd.match.fwnode.fwnode; > + fwn_endpt = (struct fwnode_handle *) > + s_asd->vfwn_endpt.base.local_fwnode; Why do you need a cast? > + fwn_remote_endpt = fwnode_graph_get_remote_endpoint(fwn_endpt); > + if (!fwn_remote_endpt) { > + dev_err(&cio2->pci_dev->dev, > + "failed to get remote endpt\n"); > + return ret; > + } > + > + ret = fwnode_graph_parse_endpoint(fwn_remote_endpt, > + &remote_endpt); > + if (ret) { > + dev_err(&cio2->pci_dev->dev, > + "failed to parse remote endpt %d\n", ret); > + return ret; > + } You don't seem to be using remote_endpt for anything. Removing that makes fwn_remote_endpt unused as well. > + > + q = cio2_find_queue_by_sensor_node(cio2->queue, fwn_remote); > + if (!q) { > + dev_err(&cio2->pci_dev->dev, > + "failed to find cio2 queue %d\n", ret); > + return -ENXIO; > + } > + > + for (pad = 0; pad < q->sensor->entity.num_pads; pad++) > + if (q->sensor->entity.pads[pad].flags & > + MEDIA_PAD_FL_SOURCE) > + break; > + > + if (pad == q->sensor->entity.num_pads) { > + dev_err(&cio2->pci_dev->dev, > + "failed to src pad for %s\n", q->sensor->name); > + return -ENXIO; > + } > + > + ret = media_create_pad_link( > + &q->sensor->entity, pad, > + &q->subdev.entity, s_asd->vfwn_endpt.base.id, > + 0); > + if (ret) { > + dev_err(&cio2->pci_dev->dev, > + "failed to create link for %s\n", > + cio2->queue[i].sensor->name); > + return ret; > + } > + } > + > + return v4l2_device_register_subdev_nodes(&cio2->v4l2_dev); > +} > + > +static int cio2_notifier_init(struct cio2_device *cio2) > +{ > + struct device *dev; > + struct fwnode_handle *dev_fwn, *fwn, *fwn_remote; > + struct v4l2_async_subdev *asd; > + struct sensor_async_subdev *s_asd; > + int ret; > + > + dev = &cio2->pci_dev->dev; > + dev_fwn = dev_fwnode(dev); > + > + asd = devm_kzalloc(dev, sizeof(asd) * CIO2_QUEUES, GFP_KERNEL); > + if (!asd) > + return -ENOMEM; > + > + cio2->notifier.subdevs = (struct v4l2_async_subdev **)asd; > + cio2->notifier.num_subdevs = 0; > + cio2->notifier.bound = cio2_notifier_bound; > + cio2->notifier.unbind = cio2_notifier_unbind; > + cio2->notifier.complete = cio2_notifier_complete; > + > + fwn = NULL; You can assign fwn to NULL in variable declaration. > + while (cio2->notifier.num_subdevs < CIO2_QUEUES && > + (fwn = fwnode_graph_get_next_endpoint(dev_fwn, fwn))) { > + s_asd = devm_kzalloc(dev, sizeof(*s_asd), GFP_KERNEL); > + if (!asd) > + return -ENOMEM; > + > + fwn_remote = fwnode_graph_get_remote_port_parent(fwn); > + if (!fwn_remote) { > + dev_err(dev, "bad remote port parent\n"); > + return -ENOENT; > + } > + > + ret = v4l2_fwnode_endpoint_parse(fwn, &s_asd->vfwn_endpt); > + if (ret) { > + dev_err(dev, "endpoint parsing error : %d\n", ret); > + return ret; > + } > + > + if (s_asd->vfwn_endpt.bus_type != V4L2_MBUS_CSI2) { > + dev_warn(dev, "endpoint bus type error\n"); > + devm_kfree(dev, s_asd); > + continue; > + } > + > + s_asd->asd.match.fwnode.fwnode = fwn_remote; > + s_asd->asd.match_type = V4L2_ASYNC_MATCH_FWNODE; > + > + cio2->notifier.subdevs[cio2->notifier.num_subdevs++] = > + &s_asd->asd; > + } > + > + if (!cio2->notifier.num_subdevs) > + return 0; /* No endpoint */ > + > + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); > + if (ret) { > + cio2->notifier.num_subdevs = 0; No need to assign num_subdevs as 0. > + dev_err(dev, "failed to register async notifier : %d\n", ret); > + return ret; > + } > + > + return 0; > +} > + > +static void cio2_notifier_exit(struct cio2_device *cio2) > +{ > + if (cio2->notifier.num_subdevs > 0) > + v4l2_async_notifier_unregister(&cio2->notifier); > +} > + > +/**************** Queue initialization ****************/ > +static const struct media_entity_operations cio2_media_ops = { > + .link_validate = v4l2_subdev_link_validate, > +}; > + > +static const struct media_entity_operations cio2_video_entity_ops = { > + .link_validate = cio2_video_link_validate, > +}; > + > +int cio2_queue_init(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + static const u32 default_width = 1936; > + static const u32 default_height = 1096; > + static const u32 default_mbusfmt = MEDIA_BUS_FMT_SRGGB10_1X10; > + > + struct video_device *vdev = &q->vdev; > + struct vb2_queue *vbq = &q->vbq; > + struct v4l2_subdev *subdev = &q->subdev; > + struct v4l2_mbus_framefmt *fmt; > + int r; > + > + /* Initialize miscellaneous variables */ > + mutex_init(&q->lock); > + > + /* Initialize formats to default values */ > + fmt = &q->subdev_fmt; > + fmt->width = default_width; > + fmt->height = default_height; > + fmt->code = default_mbusfmt; > + fmt->field = V4L2_FIELD_NONE; > + fmt->colorspace = V4L2_COLORSPACE_RAW; > + fmt->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT; > + fmt->quantization = V4L2_QUANTIZATION_DEFAULT; > + fmt->xfer_func = V4L2_XFER_FUNC_DEFAULT; > + > + q->format.pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; > + > + /* Initialize fbpt */ > + r = cio2_fbpt_init(cio2, q); > + if (r) > + goto fail_fbpt; > + > + /* Initialize media entities */ > + r = media_entity_pads_init(&subdev->entity, CIO2_PADS, q->subdev_pads); > + if (r) { > + dev_err(&cio2->pci_dev->dev, > + "failed initialize subdev media entity (%d)\n", r); > + goto fail_subdev_media_entity; > + } > + q->subdev_pads[CIO2_PAD_SINK].flags = MEDIA_PAD_FL_SINK | > + MEDIA_PAD_FL_MUST_CONNECT; > + q->subdev_pads[CIO2_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE; > + subdev->entity.ops = &cio2_media_ops; > + r = media_entity_pads_init(&vdev->entity, 1, &q->vdev_pad); > + if (r) { > + dev_err(&cio2->pci_dev->dev, > + "failed initialize videodev media entity (%d)\n", r); > + goto fail_vdev_media_entity; > + } > + q->vdev_pad.flags = MEDIA_PAD_FL_SINK | MEDIA_PAD_FL_MUST_CONNECT; > + vdev->entity.ops = &cio2_video_entity_ops; > + > + /* Initialize subdev */ > + v4l2_subdev_init(subdev, &cio2_subdev_ops); > + subdev->flags = V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; > + subdev->owner = THIS_MODULE; > + snprintf(subdev->name, sizeof(subdev->name), > + CIO2_ENTITY_NAME ":%li", q - cio2->queue); > + v4l2_set_subdevdata(subdev, cio2); > + r = v4l2_device_register_subdev(&cio2->v4l2_dev, subdev); > + if (r) { > + dev_err(&cio2->pci_dev->dev, > + "failed initialize subdev (%d)\n", r); > + goto fail_subdev; > + } > + > + /* Initialize vbq */ > + vbq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; > + vbq->io_modes = VB2_USERPTR | VB2_MMAP | VB2_DMABUF; > + vbq->ops = &cio2_vb2_ops; > + vbq->mem_ops = &vb2_dma_sg_memops; > + vbq->buf_struct_size = sizeof(struct cio2_buffer); > + vbq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; > + vbq->min_buffers_needed = 1; > + vbq->drv_priv = cio2; > + vbq->lock = &q->lock; > + r = vb2_queue_init(vbq); > + if (r) { > + dev_err(&cio2->pci_dev->dev, > + "failed to initialize videobuf2 queue (%d)\n", r); > + goto fail_vbq; > + } > + > + /* Initialize vdev */ > + snprintf(vdev->name, sizeof(vdev->name), > + "%s:%li", CIO2_NAME, q - cio2->queue); > + vdev->release = video_device_release_empty; > + vdev->fops = &cio2_v4l2_fops; > + vdev->ioctl_ops = &cio2_v4l2_ioctl_ops; > + vdev->lock = &cio2->lock; > + vdev->v4l2_dev = &cio2->v4l2_dev; > + vdev->queue = &q->vbq; > + vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; > + video_set_drvdata(vdev, cio2); > + r = video_register_device(vdev, VFL_TYPE_GRABBER, -1); > + if (r) { > + dev_err(&cio2->pci_dev->dev, > + "failed to register video device (%d)\n", r); > + goto fail_vdev; > + } > + > + /* Create link from CIO2 subdev to output node */ > + r = media_create_pad_link( > + &subdev->entity, CIO2_PAD_SOURCE, &vdev->entity, 0, > + MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE); > + if (r) > + goto fail_link; > + > + return 0; > + > +fail_link: > + video_unregister_device(&q->vdev); > +fail_vdev: > + vb2_queue_release(vbq); > +fail_vbq: > + v4l2_device_unregister_subdev(subdev); > +fail_subdev: > + media_entity_cleanup(&vdev->entity); > +fail_vdev_media_entity: > + media_entity_cleanup(&subdev->entity); > +fail_subdev_media_entity: > + cio2_fbpt_exit(q, &cio2->pci_dev->dev); > +fail_fbpt: > + mutex_destroy(&q->lock); > + > + return r; > +} > + > +static void cio2_queue_exit(struct cio2_device *cio2, struct cio2_queue *q) > +{ > + video_unregister_device(&q->vdev); > + media_entity_cleanup(&q->vdev.entity); > + vb2_queue_release(&q->vbq); > + v4l2_device_unregister_subdev(&q->subdev); > + media_entity_cleanup(&q->subdev.entity); > + cio2_fbpt_exit(q, &cio2->pci_dev->dev); > + mutex_destroy(&q->lock); > +} > + > +/**************** PCI interface ****************/ > + > +static int cio2_pci_config_setup(struct pci_dev *dev) > +{ > + u16 pci_command; > + int r = pci_enable_msi(dev); > + > + if (r) { > + dev_err(&dev->dev, "failed to enable MSI (%d)\n", r); > + return r; > + } > + > + pci_read_config_word(dev, PCI_COMMAND, &pci_command); > + pci_command |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | > + PCI_COMMAND_INTX_DISABLE; > + pci_write_config_word(dev, PCI_COMMAND, pci_command); > + > + return 0; > +} > + > +static int cio2_pci_probe(struct pci_dev *pci_dev, > + const struct pci_device_id *id) > +{ > + struct cio2_device *cio2; > + phys_addr_t phys; > + void __iomem *const *iomap; > + int i = -1, r = -ENODEV; Is there a need to initialise i here? No? > + > + cio2 = devm_kzalloc(&pci_dev->dev, sizeof(*cio2), GFP_KERNEL); > + if (!cio2) > + return -ENOMEM; > + cio2->pci_dev = pci_dev; > + > + r = pcim_enable_device(pci_dev); > + if (r) { > + dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r); > + return r; > + } > + > + dev_info(&pci_dev->dev, "device 0x%x (rev: 0x%x)\n", > + pci_dev->device, pci_dev->revision); > + > + phys = pci_resource_start(pci_dev, CIO2_PCI_BAR); > + > + r = pcim_iomap_regions(pci_dev, 1 << CIO2_PCI_BAR, pci_name(pci_dev)); > + if (r) { > + dev_err(&pci_dev->dev, "failed to remap I/O memory (%d)\n", r); > + return -ENODEV; > + } > + > + iomap = pcim_iomap_table(pci_dev); > + if (!iomap) { > + dev_err(&pci_dev->dev, "failed to iomap table\n"); > + return -ENODEV; > + } > + > + cio2->base = iomap[CIO2_PCI_BAR]; > + > + pci_set_drvdata(pci_dev, cio2); > + > + pci_set_master(pci_dev); > + > + r = pci_set_dma_mask(pci_dev, CIO2_DMA_MASK); > + if (r) { > + dev_err(&pci_dev->dev, "failed to set DMA mask (%d)\n", r); > + return -ENODEV; > + } > + > + r = cio2_pci_config_setup(pci_dev); > + if (r) > + return -ENODEV; > + > + mutex_init(&cio2->lock); > + > + cio2->media_dev.dev = &cio2->pci_dev->dev; > + strlcpy(cio2->media_dev.model, CIO2_DEVICE_NAME, > + sizeof(cio2->media_dev.model)); > + snprintf(cio2->media_dev.bus_info, sizeof(cio2->media_dev.bus_info), > + "PCI:%s", pci_name(cio2->pci_dev)); > + cio2->media_dev.driver_version = LINUX_VERSION_CODE; > + cio2->media_dev.hw_revision = 0; > + > + media_device_init(&cio2->media_dev); > + r = media_device_register(&cio2->media_dev); > + if (r < 0) > + goto fail_mutex_destroy; > + > + cio2->v4l2_dev.mdev = &cio2->media_dev; > + r = v4l2_device_register(&pci_dev->dev, &cio2->v4l2_dev); > + if (r) { > + dev_err(&pci_dev->dev, > + "failed to register V4L2 device (%d)\n", r); > + goto fail_mutex_destroy; > + } > + > + for (i = 0; i < CIO2_QUEUES; i++) { > + r = cio2_queue_init(cio2, &cio2->queue[i]); > + if (r) > + goto fail; > + } > + > + r = cio2_fbpt_init_dummy(cio2); > + if (r) > + goto fail; > + > + /* Register notifier for subdevices we care */ > + r = cio2_notifier_init(cio2); > + if (r) > + goto fail; > + > + r = devm_request_irq(&pci_dev->dev, pci_dev->irq, cio2_irq, > + IRQF_SHARED, CIO2_NAME, cio2); > + if (r) { > + dev_err(&pci_dev->dev, "failed to request IRQ (%d)\n", r); > + goto fail; > + } > + > + pm_runtime_put_noidle(&pci_dev->dev); > + pm_runtime_allow(&pci_dev->dev); > + > + return 0; > + > +fail: > + cio2_notifier_exit(cio2); > + cio2_fbpt_exit_dummy(cio2); > + for (; i >= 0; i--) > + cio2_queue_exit(cio2, &cio2->queue[i]); > + v4l2_device_unregister(&cio2->v4l2_dev); > + media_device_unregister(&cio2->media_dev); > + media_device_cleanup(&cio2->media_dev); > +fail_mutex_destroy: > + mutex_destroy(&cio2->lock); > + > + return r; > +} > + > +static void cio2_pci_remove(struct pci_dev *pci_dev) > +{ > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > + unsigned int i; > + > + cio2_notifier_exit(cio2); > + cio2_fbpt_exit_dummy(cio2); > + for (i = 0; i < CIO2_QUEUES; i++) > + cio2_queue_exit(cio2, &cio2->queue[i]); > + v4l2_device_unregister(&cio2->v4l2_dev); > + media_device_unregister(&cio2->media_dev); > + media_device_cleanup(&cio2->media_dev); > + mutex_destroy(&cio2->lock); > +} > + > +static int cio2_runtime_suspend(struct device *dev) > +{ > + struct pci_dev *pci_dev = to_pci_dev(dev); > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > + void __iomem *const base = cio2->base; > + u16 pm; > + > + writel(CIO2_D0I3C_I3, base + CIO2_REG_D0I3C); > + dev_dbg(dev, "cio2 runtime suspend.\n"); > + > + pci_read_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, > + &pm); > + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << CIO2_PMCSR_D0D3_SHIFT; > + pm |= CIO2_PMCSR_D3; > + pci_write_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, > + pm); > + > + return 0; > +} > + > +static int cio2_runtime_resume(struct device *dev) > +{ > + struct pci_dev *pci_dev = to_pci_dev(dev); > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > + void __iomem *const base = cio2->base; > + u16 pm; > + > + writel(CIO2_D0I3C_RR, base + CIO2_REG_D0I3C); > + dev_dbg(dev, "cio2 runtime resume.\n"); > + > + pci_read_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, > + &pm); > + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << CIO2_PMCSR_D0D3_SHIFT; > + pci_write_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, > + pm); > + > + return 0; > +} > + > +static const struct dev_pm_ops cio2_pm_ops = { > + SET_RUNTIME_PM_OPS(&cio2_runtime_suspend, > + &cio2_runtime_resume, NULL) Fits on a single line. > +}; > + > +static const struct pci_device_id cio2_pci_id_table[] = { > + { PCI_DEVICE(PCI_VENDOR_ID_INTEL, CIO2_PCI_ID) }, > + { 0 } > +}; > + > +MODULE_DEVICE_TABLE(pci, cio2_pci_id_table); > + > +static struct pci_driver cio2_pci_driver = { > + .name = CIO2_NAME, > + .id_table = cio2_pci_id_table, > + .probe = cio2_pci_probe, > + .remove = cio2_pci_remove, > + .driver = { > + .pm = &cio2_pm_ops, > + }, > +}; > + > +module_pci_driver(cio2_pci_driver); > + > +MODULE_AUTHOR("Tuukka Toivonen <tuukka.toivonen@intel.com>"); > +MODULE_AUTHOR("Tianshu Qiu <tian.shu.qiu@intel.com>"); > +MODULE_AUTHOR("Jian Xu Zheng <jian.xu.zheng@intel.com>"); > +MODULE_AUTHOR("Yuning Pu <yuning.pu@intel.com>"); > +MODULE_AUTHOR("Yong Zhi <yong.zhi@intel.com>"); > +MODULE_LICENSE("GPL v2"); > +MODULE_DESCRIPTION("IPU3 CIO2 driver"); > diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h b/drivers/media/pci/intel/ipu3/ipu3-cio2.h > new file mode 100644 > index 0000000..e33d3fc > --- /dev/null > +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h > @@ -0,0 +1,442 @@ > +/* > + * Copyright (c) 2017 Intel Corporation. > + * > + * This program is free software; you can redistribute it and/or > + * modify it under the terms of the GNU General Public License version > + * 2 as published by the Free Software Foundation. > + * > + * This program is distributed in the hope that it will be useful, > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > + * GNU General Public License for more details. > + */ > + > +#ifndef __IPU3_CIO2_H > +#define __IPU3_CIO2_H > + > +#define CIO2_NAME "ipu3-cio2" > +#define CIO2_DEVICE_NAME "Intel IPU3 CIO2" > +#define CIO2_ENTITY_NAME "ipu3-csi2" > +#define CIO2_PCI_ID 0x9d32 > +#define CIO2_PCI_BAR 0 > +#define CIO2_DMA_MASK DMA_BIT_MASK(39) > +/* 1 for each sensor */ > +#define CIO2_QUEUES 2 > +/* 32MB = 8xFBPT_entry */ > +#define CIO2_MAX_LOPS 8 > +#define CIO2_MAX_BUFFERS (PAGE_SIZE / 16 / CIO2_MAX_LOPS) > + > +#define CIO2_PAD_SINK 0 > +#define CIO2_PAD_SOURCE 1 > +#define CIO2_PADS 2 > + > +#define CIO2_NUM_DMA_CHAN 20 > +#define CIO2_NUM_PORTS 4 /* DPHYs */ > + > +/* Register and bit field definitions */ > +#define CIO2_REG_PIPE_BASE(n) ((n) * 0x0400) /* n = 0..3 */ > +#define CIO2_REG_CSIRX_BASE 0x000 > +#define CIO2_REG_MIPIBE_BASE 0x100 > +#define CIO2_REG_PIXELGEN_BAS 0x200 > +#define CIO2_REG_IRQCTRL_BASE 0x300 > +#define CIO2_REG_GPREG_BASE 0x1000 > + > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_CSIRX_BASE */ > +#define CIO2_REG_CSIRX_ENABLE (CIO2_REG_CSIRX_BASE + 0x0) > +#define CIO2_REG_CSIRX_NOF_ENABLED_LANES (CIO2_REG_CSIRX_BASE + 0x4) > +#define CIO2_REG_CSIRX_SP_IF_CONFIG (CIO2_REG_CSIRX_BASE + 0x10) > +#define CIO2_REG_CSIRX_LP_IF_CONFIG (CIO2_REG_CSIRX_BASE + 0x14) > +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT 0x00 > +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT_VC_INACTIVE 0x01 > +#define CIO2_CSIRX_IF_CONFIG_PASS 0x02 > +#define CIO2_CSIRX_IF_CONFIG_FLAG_ERROR BIT(2) > +#define CIO2_REG_CSIRX_STATUS (CIO2_REG_CSIRX_BASE + 0x18) > +#define CIO2_REG_CSIRX_STATUS_DLANE_HS (CIO2_REG_CSIRX_BASE + 0x1c) > +#define CIO2_CSIRX_STATUS_DLANE_HS_MASK 0xff > +#define CIO2_REG_CSIRX_STATUS_DLANE_LP (CIO2_REG_CSIRX_BASE + 0x20) > +#define CIO2_CSIRX_STATUS_DLANE_LP_MASK 0xffffff > +/* Termination enable and settle in 0.0625ns units, lane=0..3 or -1 for clock */ > +#define CIO2_REG_CSIRX_DLY_CNT_TERMEN(lane) \ > + (CIO2_REG_CSIRX_BASE + 0x2c + 8*(lane)) > +#define CIO2_REG_CSIRX_DLY_CNT_SETTLE(lane) \ > + (CIO2_REG_CSIRX_BASE + 0x30 + 8*(lane)) > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_MIPIBE_BASE */ > +#define CIO2_REG_MIPIBE_ENABLE (CIO2_REG_MIPIBE_BASE + 0x0) > +#define CIO2_REG_MIPIBE_STATUS (CIO2_REG_MIPIBE_BASE + 0x4) > +#define CIO2_REG_MIPIBE_COMP_FORMAT(vc) \ > + (CIO2_REG_MIPIBE_BASE + 0x8 + 0x4*(vc)) > +#define CIO2_REG_MIPIBE_FORCE_RAW8 (CIO2_REG_MIPIBE_BASE + 0x20) > +#define CIO2_REG_MIPIBE_FORCE_RAW8_ENABLE BIT(0) > +#define CIO2_REG_MIPIBE_FORCE_RAW8_USE_TYPEID BIT(1) > +#define CIO2_REG_MIPIBE_FORCE_RAW8_TYPEID_SHIFT 2 > + > +#define CIO2_REG_MIPIBE_IRQ_STATUS (CIO2_REG_MIPIBE_BASE + 0x24) > +#define CIO2_REG_MIPIBE_IRQ_CLEAR (CIO2_REG_MIPIBE_BASE + 0x28) > +#define CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD (CIO2_REG_MIPIBE_BASE + 0x68) > +#define CIO2_MIPIBE_GLOBAL_LUT_DISREGARD 1 > +#define CIO2_REG_MIPIBE_PKT_STALL_STATUS (CIO2_REG_MIPIBE_BASE + 0x6c) > +#define CIO2_REG_MIPIBE_PARSE_GSP_THROUGH_LP_LUT_REG_IDX \ > + (CIO2_REG_MIPIBE_BASE + 0x70) > +#define CIO2_REG_MIPIBE_SP_LUT_ENTRY(vc) \ > + (CIO2_REG_MIPIBE_BASE + 0x74 + 4*(vc)) > +#define CIO2_REG_MIPIBE_LP_LUT_ENTRY(m) /* m = 0..15 */ \ > + (CIO2_REG_MIPIBE_BASE + 0x84 + 4*(m)) > +#define CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD 1 > +#define CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT 1 > +#define CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT 5 > +#define CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT 7 > + > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_IRQCTRL_BASE */ > +/* IRQ registers are 18-bit wide, see cio2_irq_error for bit definitions */ > +#define CIO2_REG_IRQCTRL_EDGE (CIO2_REG_IRQCTRL_BASE + 0x00) > +#define CIO2_REG_IRQCTRL_MASK (CIO2_REG_IRQCTRL_BASE + 0x04) > +#define CIO2_REG_IRQCTRL_STATUS (CIO2_REG_IRQCTRL_BASE + 0x08) > +#define CIO2_REG_IRQCTRL_CLEAR (CIO2_REG_IRQCTRL_BASE + 0x0c) > +#define CIO2_REG_IRQCTRL_ENABLE (CIO2_REG_IRQCTRL_BASE + 0x10) > +#define CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE (CIO2_REG_IRQCTRL_BASE + 0x14) > + > +#define CIO2_REG_GPREG_SRST (CIO2_REG_GPREG_BASE + 0x0) > +#define CIO2_GPREG_SRST_ALL 0xffff /* Reset all */ > +#define CIO2_REG_FB_HPLL_FREQ (CIO2_REG_GPREG_BASE + 0x08) > +#define CIO2_REG_ISCLK_RATIO (CIO2_REG_GPREG_BASE + 0xc) > + > +#define CIO2_REG_CGC 0x1400 > +#define CIO2_CGC_CSI2_TGE BIT(0) > +#define CIO2_CGC_PRIM_TGE BIT(1) > +#define CIO2_CGC_SIDE_TGE BIT(2) > +#define CIO2_CGC_XOSC_TGE BIT(3) > +#define CIO2_CGC_MPLL_SHUTDOWN_EN BIT(4) > +#define CIO2_CGC_D3I3_TGE BIT(5) > +#define CIO2_CGC_CSI2_INTERFRAME_TGE BIT(6) > +#define CIO2_CGC_CSI2_PORT_DCGE BIT(8) > +#define CIO2_CGC_CSI2_DCGE BIT(9) > +#define CIO2_CGC_SIDE_DCGE BIT(10) > +#define CIO2_CGC_PRIM_DCGE BIT(11) > +#define CIO2_CGC_ROSC_DCGE BIT(12) > +#define CIO2_CGC_XOSC_DCGE BIT(13) > +#define CIO2_CGC_FLIS_DCGE BIT(14) > +#define CIO2_CGC_CLKGATE_HOLDOFF_SHIFT 20 > +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT 24 > +#define CIO2_REG_D0I3C 0x1408 > +#define CIO2_D0I3C_I3 BIT(2) /* Set D0I3 */ > +#define CIO2_D0I3C_RR BIT(3) /* Restore? */ > +#define CIO2_REG_SWRESET 0x140c > +#define CIO2_SWRESET_SWRESET 1 > +#define CIO2_REG_SENSOR_ACTIVE 0x1410 > +#define CIO2_REG_INT_STS 0x1414 > +#define CIO2_REG_INT_STS_EXT_OE 0x1418 > +#define CIO2_INT_EXT_OE_DMAOE_SHIFT 0 > +#define CIO2_INT_EXT_OE_DMAOE_MASK 0x7ffff > +#define CIO2_INT_EXT_OE_OES_SHIFT 24 > +#define CIO2_INT_EXT_OE_OES_MASK (0xf << CIO2_INT_EXT_OE_OES_SHIFT) > +#define CIO2_REG_INT_EN 0x1420 > +#define CIO2_REG_INT_EN_IRQ (1 << 24) > +#define CIO2_REG_INT_EN_IOS(dma) (1 << (((dma) >> 1) + 12)) > +/* > + * Interrupt on completion bit, Eg. DMA 0-3 maps to bit 0-3, > + * DMA4 & DMA5 map to bit 4 ... DMA18 & DMA19 map to bit 11 Et cetera > + */ > +#define CIO2_INT_IOC(dma) (1 << ((dma) < 4 ? (dma) : ((dma) >> 1) + 2)) > +#define CIO2_INT_IOC_SHIFT 0 > +#define CIO2_INT_IOC_MASK (0x7ff << CIO2_INT_IOC_SHIFT) > +#define CIO2_INT_IOS_IOLN(dma) (1 << (((dma) >> 1) + 12)) > +#define CIO2_INT_IOS_IOLN_SHIFT 12 > +#define CIO2_INT_IOS_IOLN_MASK (0x3ff << CIO2_INT_IOS_IOLN_SHIFT) > +#define CIO2_INT_IOIE BIT(22) > +#define CIO2_INT_IOOE BIT(23) > +#define CIO2_INT_IOIRQ BIT(24) > +#define CIO2_REG_INT_EN_EXT_OE 0x1424 > +#define CIO2_REG_DMA_DBG 0x1448 > +#define CIO2_REG_DMA_DBG_DMA_INDEX_SHIFT 0 > +#define CIO2_REG_PBM_ARB_CTRL 0x1460 > +#define CIO2_PBM_ARB_CTRL_LANES_DIV 0 /* 4-4-2-2 lanes */ > +#define CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT 0 > +#define CIO2_PBM_ARB_CTRL_LE_EN BIT(7) > +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN 2 > +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT 8 > +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP 480 > +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT 16 > +#define CIO2_REG_PBM_WMCTRL1 0x1464 > +#define CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT 0 > +#define CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT 8 > +#define CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT 16 > +#define CIO2_PBM_WMCTRL1_TS_COUNT_DISABLE BIT(31) > +#define CIO2_PBM_WMCTRL1_MIN_2CK (4 << CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT) > +#define CIO2_PBM_WMCTRL1_MID1_2CK (16 << CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT) > +#define CIO2_PBM_WMCTRL1_MID2_2CK (21 << CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT) > +#define CIO2_REG_PBM_WMCTRL2 0x1468 > +#define CIO2_PBM_WMCTRL2_HWM_2CK 48 > +#define CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT 0 > +#define CIO2_PBM_WMCTRL2_LWM_2CK 22 > +#define CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT 8 > +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK 2 > +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT 16 > +#define CIO2_PBM_WMCTRL2_TRANSDYN 1 > +#define CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT 24 > +#define CIO2_PBM_WMCTRL2_DYNWMEN BIT(28) > +#define CIO2_PBM_WMCTRL2_OBFF_MEM_EN BIT(29) > +#define CIO2_PBM_WMCTRL2_OBFF_CPU_EN BIT(30) > +#define CIO2_PBM_WMCTRL2_DRAINNOW BIT(31) > +#define CIO2_REG_PBM_TS_COUNT 0x146c > +#define CIO2_REG_PBM_FOPN_ABORT 0x1474 > +/* below n = 0..3 */ > +#define CIO2_PBM_FOPN_ABORT(n) (0x1 << 8*(n)) > +#define CIO2_PBM_FOPN_FORCE_ABORT(n) (0x2 << 8*(n)) > +#define CIO2_PBM_FOPN_FRAMEOPEN(n) (0x8 << 8*(n)) > +#define CIO2_REG_LTRCTRL 0x1480 > +#define CIO2_LTRCTRL_LTRDYNEN BIT(16) > +#define CIO2_LTRCTRL_LTRSTABLETIME_SHIFT 8 > +#define CIO2_LTRCTRL_LTRSTABLETIME_MASK 0xff > +#define CIO2_LTRCTRL_LTRSEL1S3 BIT(7) > +#define CIO2_LTRCTRL_LTRSEL1S2 BIT(6) > +#define CIO2_LTRCTRL_LTRSEL1S1 BIT(5) > +#define CIO2_LTRCTRL_LTRSEL1S0 BIT(4) > +#define CIO2_LTRCTRL_LTRSEL2S3 BIT(3) > +#define CIO2_LTRCTRL_LTRSEL2S2 BIT(2) > +#define CIO2_LTRCTRL_LTRSEL2S1 BIT(1) > +#define CIO2_LTRCTRL_LTRSEL2S0 BIT(0) > +#define CIO2_REG_LTRVAL23 0x1484 > +#define CIO2_REG_LTRVAL01 0x1488 > +#define CIO2_LTRVAL02_VAL_SHIFT 0 > +#define CIO2_LTRVAL02_SCALE_SHIFT 10 > +#define CIO2_LTRVAL13_VAL_SHIFT 16 > +#define CIO2_LTRVAL13_SCALE_SHIFT 26 > + > +#define CIO2_REG_CDMABA(n) (0x1500 + 0x10*(n)) /* n = 0..19 */ > +#define CIO2_REG_CDMARI(n) (0x1504 + 0x10*(n)) > +#define CIO2_CDMARI_FBPT_RP_SHIFT 0 > +#define CIO2_CDMARI_FBPT_RP_MASK 0xff > +#define CIO2_REG_CDMAC0(n) (0x1508 + 0x10*(n)) > +#define CIO2_CDMAC0_FBPT_LEN_SHIFT 0 > +#define CIO2_CDMAC0_FBPT_WIDTH_SHIFT 8 > +#define CIO2_CDMAC0_FBPT_NS BIT(25) > +#define CIO2_CDMAC0_DMA_INTR_ON_FS BIT(26) > +#define CIO2_CDMAC0_DMA_INTR_ON_FE BIT(27) > +#define CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL BIT(28) > +#define CIO2_CDMAC0_FBPT_FIFO_FULL_FIX_DIS BIT(29) > +#define CIO2_CDMAC0_DMA_EN BIT(30) > +#define CIO2_CDMAC0_DMA_HALTED BIT(31) > +#define CIO2_REG_CDMAC1(n) (0x150c + 0x10*(n)) > +#define CIO2_CDMAC1_LINENUMINT_SHIFT 0 > +#define CIO2_CDMAC1_LINENUMUPDATE_SHIFT 16 > +/* n = 0..3 */ > +#define CIO2_REG_PXM_PXF_FMT_CFG0(n) (0x1700 + 0x30*(n)) > +#define CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT 0 > +#define CIO2_PXM_PXF_FMT_CFG_SID1_SHIFT 16 > +#define CIO2_PXM_PXF_FMT_CFG_PCK_64B (0 << 0) > +#define CIO2_PXM_PXF_FMT_CFG_PCK_32B (1 << 0) > +#define CIO2_PXM_PXF_FMT_CFG_BPP_08 (0 << 2) > +#define CIO2_PXM_PXF_FMT_CFG_BPP_10 (1 << 2) > +#define CIO2_PXM_PXF_FMT_CFG_BPP_12 (2 << 2) > +#define CIO2_PXM_PXF_FMT_CFG_BPP_14 (3 << 2) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_4PPC (0 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_RGBA (1 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_ARGB (2 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR2 (3 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR3 (4 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_NV16 (5 << 4) > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_AB (1 << 7) > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_CD (1 << 8) > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_AC (1 << 9) > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_BD (1 << 10) > +#define CIO2_REG_INT_STS_EXT_IE 0x17e4 > +#define CIO2_REG_INT_EN_EXT_IE 0x17e8 > +#define CIO2_INT_EXT_IE_ECC_RE(n) (0x01 << (8 * (n))) > +#define CIO2_INT_EXT_IE_DPHY_NR(n) (0x02 << (8 * (n))) > +#define CIO2_INT_EXT_IE_ECC_NR(n) (0x04 << (8 * (n))) > +#define CIO2_INT_EXT_IE_CRCERR(n) (0x08 << (8 * (n))) > +#define CIO2_INT_EXT_IE_INTERFRAMEDATA(n) (0x10 << (8 * (n))) > +#define CIO2_INT_EXT_IE_PKT2SHORT(n) (0x20 << (8 * (n))) > +#define CIO2_INT_EXT_IE_PKT2LONG(n) (0x40 << (8 * (n))) > +#define CIO2_INT_EXT_IE_IRQ(n) (0x80 << (8 * (n))) > +#define CIO2_REG_PXM_FRF_CFG(n) (0x1720 + 0x30*(n)) > +#define CIO2_PXM_FRF_CFG_FNSEL BIT(0) > +#define CIO2_PXM_FRF_CFG_FN_RST BIT(1) > +#define CIO2_PXM_FRF_CFG_ABORT BIT(2) > +#define CIO2_PXM_FRF_CFG_CRC_TH_SHIFT 3 > +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR BIT(8) > +#define CIO2_PXM_FRF_CFG_MSK_ECC_RE BIT(9) > +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE BIT(10) > +#define CIO2_PXM_FRF_CFG_EVEN_ODD_MODE_SHIFT 11 > +#define CIO2_PXM_FRF_CFG_MASK_CRC_THRES BIT(13) > +#define CIO2_PXM_FRF_CFG_MASK_CSI_ACCEPT BIT(14) > +#define CIO2_PXM_FRF_CFG_CIOHC_FS_MODE BIT(15) > +#define CIO2_PXM_FRF_CFG_CIOHC_FRST_FRM_SHIFT 16 > +#define CIO2_REG_PXM_SID2BID0(n) (0x1724 + 0x30*(n)) > +#define CIO2_FB_HPLL_FREQ 0x2 > +#define CIO2_ISCLK_RATIO 0xc > + > +#define CIO2_IRQCTRL_MASK 0x3ffff > + > +#define CIO2_INT_EN_EXT_OE_MASK 0x8f0fffff > + > +#define CIO2_CGC_CLKGATE_HOLDOFF 3 > +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF 5 > + > +#define CIO2_LTRVAL0_VAL 500 > +/* Value times 1024 ns */ > +#define CIO2_LTRVAL0_SCALE 2 > +#define CIO2_LTRVAL1_VAL 90 > +#define CIO2_LTRVAL1_SCALE 2 > +#define CIO2_LTRVAL2_VAL 90 > +#define CIO2_LTRVAL2_SCALE 2 > +#define CIO2_LTRVAL3_VAL 90 > +#define CIO2_LTRVAL3_SCALE 2 > + > +#define CIO2_PXM_FRF_CFG_CRC_TH 16 > + > +#define CIO2_INT_EN_EXT_IE_MASK 0xffffffff > + > +#define CIO2_DMA_CHAN 0 > + > +#define CIO2_CSIRX_DLY_CNT_CLANE_IDX -1 > + > +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A 0 > +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B 0 > +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A 95 > +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B -8 > + > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A 0 > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B 0 > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A 85 > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B -2 > + > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT 0x4 > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT 0x570 > + > +#define CIO2_PMCSR_OFFSET 4 > +#define CIO2_PMCSR_D0D3_SHIFT 2 > +#define CIO2_PMCSR_D3 0x3 > + > +struct cio2_csi2_timing { > + s32 clk_termen; > + s32 clk_settle; > + s32 dat_termen; > + s32 dat_settle; > +}; > + > +struct cio2_buffer { > + struct vb2_v4l2_buffer vbb; > + u32 *lop[CIO2_MAX_LOPS]; > + dma_addr_t lop_bus_addr[CIO2_MAX_LOPS]; > +}; > + > +struct csi2_bus_info { > + u32 port; > + u32 num_of_lanes; > +}; > + > +struct cio2_queue { > + /* mutex to be used by vb2_queue */ > + struct mutex lock; > + struct media_pipeline pipe; > + struct csi2_bus_info csi2; > + struct v4l2_subdev *sensor; > + void __iomem *csi_rx_base; > + > + /* Subdev, /dev/v4l-subdevX */ > + struct v4l2_subdev subdev; > + struct media_pad subdev_pads[CIO2_PADS]; > + struct v4l2_mbus_framefmt subdev_fmt; > + atomic_t frame_sequence; > + > + /* Video device, /dev/videoX */ > + struct video_device vdev; > + struct media_pad vdev_pad; > + struct v4l2_pix_format format; > + struct vb2_queue vbq; > + > + /* Buffer queue handling */ > + struct cio2_fbpt_entry *fbpt; /* Frame buffer pointer table */ > + dma_addr_t fbpt_bus_addr; > + struct cio2_buffer *bufs[CIO2_MAX_BUFFERS]; > + unsigned int bufs_first; /* Index of the first used entry */ > + unsigned int bufs_next; /* Index of the first unused entry */ > + atomic_t bufs_queued; > +}; > + > +struct cio2_device { > + struct pci_dev *pci_dev; > + void __iomem *base; > + struct v4l2_device v4l2_dev; > + struct cio2_queue queue[CIO2_QUEUES]; > + struct cio2_queue *cur_queue; > + /* mutex to be used by video_device */ > + struct mutex lock; > + > + struct v4l2_async_notifier notifier; > + struct media_device media_dev; > + > + /* > + * Safety net to catch DMA fetch ahead > + * when reaching the end of LOP > + */ > + void *dummy_page; > + /* DMA handle of dummy_page */ > + dma_addr_t dummy_page_bus_addr; > + /* single List of Pointers (LOP) page */ > + u32 *dummy_lop; > + /* DMA handle of dummy_lop */ > + dma_addr_t dummy_lop_bus_addr; > +}; > + > +/**************** Virtual channel ****************/ > +/* > + * This should come from sensor driver. No > + * driver interface nor requirement yet. > + */ > +#define SENSOR_VIR_CH_DFLT 0 > + > +/**************** FBPT operations ****************/ > +#define CIO2_FBPT_SIZE (CIO2_MAX_BUFFERS * CIO2_MAX_LOPS * \ > + sizeof(struct cio2_fbpt_entry)) > + > +#define CIO2_FBPT_SUBENTRY_UNIT 4 > +#define CIO2_PAGE_SIZE PAGE_SIZE > + > +/* > + * Frame Buffer Pointer Table(FBPT) entry > + * each entry describe an output buffer and consists of > + * several sub-entries > + */ > +struct __packed cio2_fbpt_entry { > + union { > + struct __packed { > + u32 ctrl; /* status ctrl */ > +#define CIO2_FBPT_CTRL_VALID BIT(0) > +#define CIO2_FBPT_CTRL_IOC BIT(1) > +#define CIO2_FBPT_CTRL_IOS BIT(2) > +#define CIO2_FBPT_CTRL_SUCCXFAIL BIT(3) > +#define CIO2_FBPT_CTRL_CMPLCODE_SHIFT 4 > + u16 cur_line_num; /* current line # written to DDR */ > + u16 frame_num; /* updated by DMA upon FE */ > + u32 first_page_offset; /* offset for 1st page in LOP */ > + } first_entry; > + /* Second entry per buffer */ > + struct __packed { > + u32 timestamp; > + u32 num_of_bytes; > + /* the number of bytes for write on last page */ > + u16 last_page_available_bytes; > + /* the number of pages allocated for this buf */ > + u16 num_of_pages; > + } second_entry; > + struct __packed { > + u64 __reserved1; > + u32 __reserved0; > + } other_entries; > + }; > + u32 lop_page_addr; /* Points to list of pointers (LOP) table */ > +}; > + > +static inline struct cio2_queue *file_to_cio2_queue(struct file *file) > +{ > + return container_of(video_devdata(file), struct cio2_queue, vdev); > +} > + > +static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue *vq) > +{ > + return container_of(vq, struct cio2_queue, vbq); > +} > + > +#endif
Hi, Sakari, Thanks for the time spent on code review, acks to all the comments, except two places: > +/* .complete() is called after all subdevices have been located */ > +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) > +{ > + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, > + notifier); > + struct sensor_async_subdev *s_asd; > + struct fwnode_handle *fwn_remote, *fwn_endpt, *fwn_remote_endpt; > + struct cio2_queue *q; > + struct fwnode_endpoint remote_endpt; > + unsigned int i, pad; > + int ret; > + > + for (i = 0; i < notifier->num_subdevs; i++) { > + s_asd = container_of(cio2->notifier.subdevs[i], > + struct sensor_async_subdev, > + asd); > + > + fwn_remote = s_asd->asd.match.fwnode.fwnode; > + fwn_endpt = (struct fwnode_handle *) > + s_asd->vfwn_endpt.base.local_fwnode; Why do you need a cast? [YZ] With a cast results in compilation warning: drivers/media/pci/ipu3/ipu3-cio2.c:1298:13: warning: assignment discards ‘const’ qualifier from pointer target type [-Wdiscarded-qualifiers] fwn_endpt = /*(struct fwnode_handle *)*/ > + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); > + if (ret) { > + cio2->notifier.num_subdevs = 0; No need to assign num_subdevs as 0. [YZ] _notifier_exit() will call _unregister() if this is not 0. Regards, Yong
Hi Yong, On Thu, Jul 13, 2017 at 8:20 AM, Zhi, Yong <yong.zhi@intel.com> wrote: > Hi, Sakari, > > Thanks for the time spent on code review, acks to all the comments, except two places: > >> +/* .complete() is called after all subdevices have been located */ >> +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) >> +{ >> + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, >> + notifier); >> + struct sensor_async_subdev *s_asd; >> + struct fwnode_handle *fwn_remote, *fwn_endpt, *fwn_remote_endpt; >> + struct cio2_queue *q; >> + struct fwnode_endpoint remote_endpt; >> + unsigned int i, pad; >> + int ret; >> + >> + for (i = 0; i < notifier->num_subdevs; i++) { >> + s_asd = container_of(cio2->notifier.subdevs[i], >> + struct sensor_async_subdev, >> + asd); >> + >> + fwn_remote = s_asd->asd.match.fwnode.fwnode; >> + fwn_endpt = (struct fwnode_handle *) >> + s_asd->vfwn_endpt.base.local_fwnode; > > Why do you need a cast? > > [YZ] With a cast results in compilation warning: (I think you mean "without".) > > drivers/media/pci/ipu3/ipu3-cio2.c:1298:13: warning: assignment discards ‘const’ qualifier from pointer target type [-Wdiscarded-qualifiers] > fwn_endpt = /*(struct fwnode_handle *)*/ This is a sign that the code is doing something wrong (in this case probably trying to write to a const pointer), so casting just silences the unfixed error. > >> + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); >> + if (ret) { >> + cio2->notifier.num_subdevs = 0; > > No need to assign num_subdevs as 0. > > [YZ] _notifier_exit() will call _unregister() if this is not 0. You shouldn't call _exit() if _init() failed. I noticed that many error paths in your code does this. Please fix it. Best regards, Tomasz
Hi Tomasz and Yong, On Thu, Jul 13, 2017 at 01:51:18PM +0900, Tomasz Figa wrote: > Hi Yong, > > On Thu, Jul 13, 2017 at 8:20 AM, Zhi, Yong <yong.zhi@intel.com> wrote: > > Hi, Sakari, > > > > Thanks for the time spent on code review, acks to all the comments, except two places: > > > >> +/* .complete() is called after all subdevices have been located */ > >> +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) > >> +{ > >> + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, > >> + notifier); > >> + struct sensor_async_subdev *s_asd; > >> + struct fwnode_handle *fwn_remote, *fwn_endpt, *fwn_remote_endpt; > >> + struct cio2_queue *q; > >> + struct fwnode_endpoint remote_endpt; > >> + unsigned int i, pad; > >> + int ret; > >> + > >> + for (i = 0; i < notifier->num_subdevs; i++) { > >> + s_asd = container_of(cio2->notifier.subdevs[i], > >> + struct sensor_async_subdev, > >> + asd); > >> + > >> + fwn_remote = s_asd->asd.match.fwnode.fwnode; > >> + fwn_endpt = (struct fwnode_handle *) > >> + s_asd->vfwn_endpt.base.local_fwnode; > > > > Why do you need a cast? > > > > [YZ] With a cast results in compilation warning: > > (I think you mean "without".) > > > > > drivers/media/pci/ipu3/ipu3-cio2.c:1298:13: warning: assignment discards ‘const’ qualifier from pointer target type [-Wdiscarded-qualifiers] > > fwn_endpt = /*(struct fwnode_handle *)*/ > > This is a sign that the code is doing something wrong (in this case > probably trying to write to a const pointer), so casting just silences > the unfixed error. Indeed. The right thing to do would be to make fwn_endpt const. In that case though I don't think that variable is really used for anything useful; the same goes for remote_endpt and fwn_remote_endpt. This looks like leftovers from development time. Could these be removed, or did I miss something? > > > > >> + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); > >> + if (ret) { > >> + cio2->notifier.num_subdevs = 0; > > > > No need to assign num_subdevs as 0. > > > > [YZ] _notifier_exit() will call _unregister() if this is not 0. > > You shouldn't call _exit() if _init() failed. I noticed that many > error paths in your code does this. Please fix it. In general most functions that initialise and clean up something are implemented so that the cleanup function can be called without calling the corresponding init function. This eases driver implementation by reducing complexity in error paths that are difficult to implement and test to begin with, so I don't see anything wrong with that, quite the contrary. I.e. in this case you should call v4l2_async_notifier_unregister() without checking the number of async sub-devices. There are exceptions to that though; not all the framework functions behave this way. Of kernel APIs, e.g. kmalloc() and kfree() do this --- you can pass a NULL pointer to kfree() and it does nothing.
On Thu, Jul 13, 2017 at 5:21 PM, Sakari Ailus <sakari.ailus@iki.fi> wrote: >> >> + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); >> >> + if (ret) { >> >> + cio2->notifier.num_subdevs = 0; >> > >> > No need to assign num_subdevs as 0. >> > >> > [YZ] _notifier_exit() will call _unregister() if this is not 0. >> >> You shouldn't call _exit() if _init() failed. I noticed that many >> error paths in your code does this. Please fix it. > > In general most functions that initialise and clean up something are > implemented so that the cleanup function can be called without calling the > corresponding init function. This eases driver implementation by reducing > complexity in error paths that are difficult to implement and test to begin > with, so I don't see anything wrong with that, quite the contrary. > > I.e. in this case you should call v4l2_async_notifier_unregister() without > checking the number of async sub-devices. > > There are exceptions to that though; not all the framework functions behave > this way. Of kernel APIs, e.g. kmalloc() and kfree() do this --- you can > pass a NULL pointer to kfree() and it does nothing. I'd argue that most of the cleanup paths I've seen in the kernel are the opposite. If you properly check for errors in your code, it's actually very unlikely that you need to call a cleanup function without the init function called... That said, I've seen the pattern you describe too, so probably either there is no strict rule or it's not strictly enforced. (Still, judging by https://www.kernel.org/doc/html/v4.10/process/coding-style.html#centralized-exiting-of-functions, which mentions "one err bugs" and suggests "to split it up into two error labels", the pattern I'm arguing for might be the recommended default.) Best regards, Tomasz
Hi Tomasz, On Thu, Jul 13, 2017 at 05:31:33PM +0900, Tomasz Figa wrote: > On Thu, Jul 13, 2017 at 5:21 PM, Sakari Ailus <sakari.ailus@iki.fi> wrote: > >> >> + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); > >> >> + if (ret) { > >> >> + cio2->notifier.num_subdevs = 0; > >> > > >> > No need to assign num_subdevs as 0. > >> > > >> > [YZ] _notifier_exit() will call _unregister() if this is not 0. > >> > >> You shouldn't call _exit() if _init() failed. I noticed that many > >> error paths in your code does this. Please fix it. > > > > In general most functions that initialise and clean up something are > > implemented so that the cleanup function can be called without calling the > > corresponding init function. This eases driver implementation by reducing > > complexity in error paths that are difficult to implement and test to begin > > with, so I don't see anything wrong with that, quite the contrary. > > > > I.e. in this case you should call v4l2_async_notifier_unregister() without > > checking the number of async sub-devices. > > > > There are exceptions to that though; not all the framework functions behave > > this way. Of kernel APIs, e.g. kmalloc() and kfree() do this --- you can > > pass a NULL pointer to kfree() and it does nothing. > > I'd argue that most of the cleanup paths I've seen in the kernel are > the opposite. If you properly check for errors in your code, it's > actually very unlikely that you need to call a cleanup function > without the init function called... That said, I've seen the pattern > you describe too, so probably either there is no strict rule or it's > not strictly enforced. (Still, judging by > https://www.kernel.org/doc/html/v4.10/process/coding-style.html#centralized-exiting-of-functions, > which mentions "one err bugs" and suggests "to split it up into two > error labels", the pattern I'm arguing for might be the recommended > default.) I don't really see a problem here; the another label in the example is needed to avoid referencing a NULL pointer. If there's a reason to add a label, then a label is just added. :-) You could check foo as well under a single label. I'd say that approach generally scales better: if you can handle a difference in error handling locally in error handling code, this is easier to maintain and easier to get right in complex error handling code (whereas the example is very simple); spreading that knowledge over much of the function has the opposite effect: it's easy to e.g. to go to a wrong label and there have been plenty of such bugs in the past. I think we're getting to fine details here. :-)
Hi, Sakari, Thanks for the review. > -----Original Message----- > From: linux-media-owner@vger.kernel.org [mailto:linux-media- > owner@vger.kernel.org] On Behalf Of Sakari Ailus > Sent: Tuesday, July 11, 2017 3:34 AM > To: Zhi, Yong <yong.zhi@intel.com> > Cc: linux-media@vger.kernel.org; sakari.ailus@linux.intel.com; > hans.verkuil@cisco.com; Zheng, Jian Xu <jian.xu.zheng@intel.com>; > tfiga@chromium.org; Mani, Rajmohan <rajmohan.mani@intel.com>; > Toivonen, Tuukka <tuukka.toivonen@intel.com>; Yang, Hyungwoo > <hyungwoo.yang@intel.com>; Vijaykumar, Ramya > <ramya.vijaykumar@intel.com> > Subject: Re: [PATCH v4 3/3] intel-ipu3: cio2: Add new MIPI-CSI2 driver > > Hi Yong, > > Thanks for the update! This looks pretty good in general, still some more > comments below. > > Do you happen to have a todo list for the changes that are still planned? > AFAIR we should have two items in the list at least --- > > 1. Extend the format example to include the DMA word boundary and > > 2. Separate formats on the sub-device and on the video node. > Will include above in v5 update. > On Mon, Jul 10, 2017 at 06:43:34PM -0500, Yong Zhi wrote: > > This patch adds CIO2 CSI-2 device driver for > > Intel's IPU3 camera sub-system support. > > > > Signed-off-by: Yong Zhi <yong.zhi@intel.com> > > Signed-off-by: Hyungwoo Yang <hyungwoo.yang@intel.com> > > Signed-off-by: Ramya Vijaykumar <ramya.vijaykumar@intel.com> > > --- > > drivers/media/pci/Kconfig | 2 + > > drivers/media/pci/Makefile | 3 +- > > drivers/media/pci/intel/Makefile | 5 + > > drivers/media/pci/intel/ipu3/Kconfig | 17 + > > drivers/media/pci/intel/ipu3/Makefile | 1 + > > drivers/media/pci/intel/ipu3/ipu3-cio2.c | 1873 > ++++++++++++++++++++++++++++++ > > drivers/media/pci/intel/ipu3/ipu3-cio2.h | 442 +++++++ > > 7 files changed, 2342 insertions(+), 1 deletion(-) > > create mode 100644 drivers/media/pci/intel/Makefile > > create mode 100644 drivers/media/pci/intel/ipu3/Kconfig > > create mode 100644 drivers/media/pci/intel/ipu3/Makefile > > create mode 100644 drivers/media/pci/intel/ipu3/ipu3-cio2.c > > create mode 100644 drivers/media/pci/intel/ipu3/ipu3-cio2.h > > > > diff --git a/drivers/media/pci/Kconfig b/drivers/media/pci/Kconfig > > index da28e68..5932e22 100644 > > --- a/drivers/media/pci/Kconfig > > +++ b/drivers/media/pci/Kconfig > > @@ -54,5 +54,7 @@ source "drivers/media/pci/smipcie/Kconfig" > > source "drivers/media/pci/netup_unidvb/Kconfig" > > endif > > > > +source "drivers/media/pci/intel/ipu3/Kconfig" > > + > > endif #MEDIA_PCI_SUPPORT > > endif #PCI > > diff --git a/drivers/media/pci/Makefile b/drivers/media/pci/Makefile > > index a7e8af0..d8f9843 100644 > > --- a/drivers/media/pci/Makefile > > +++ b/drivers/media/pci/Makefile > > @@ -13,7 +13,8 @@ obj-y += ttpci/ \ > > ddbridge/ \ > > saa7146/ \ > > smipcie/ \ > > - netup_unidvb/ > > + netup_unidvb/ \ > > + intel/ > > > > obj-$(CONFIG_VIDEO_IVTV) += ivtv/ > > obj-$(CONFIG_VIDEO_ZORAN) += zoran/ > > diff --git a/drivers/media/pci/intel/Makefile > b/drivers/media/pci/intel/Makefile > > new file mode 100644 > > index 0000000..745c8b2 > > --- /dev/null > > +++ b/drivers/media/pci/intel/Makefile > > @@ -0,0 +1,5 @@ > > +# > > +# Makefile for the IPU3 cio2 and ImGU drivers > > +# > > + > > +obj-y += ipu3/ > > diff --git a/drivers/media/pci/intel/ipu3/Kconfig > b/drivers/media/pci/intel/ipu3/Kconfig > > new file mode 100644 > > index 0000000..2a895d6 > > --- /dev/null > > +++ b/drivers/media/pci/intel/ipu3/Kconfig > > @@ -0,0 +1,17 @@ > > +config VIDEO_IPU3_CIO2 > > + tristate "Intel ipu3-cio2 driver" > > + depends on VIDEO_V4L2 && PCI > > + depends on MEDIA_CONTROLLER > > Could you also add VIDEO_V4L2_SUBDEV_API, please? Ack. > > > + depends on HAS_DMA > > + depends on ACPI > > + select V4L2_FWNODE > > + select VIDEOBUF2_DMA_SG > > + > > + ---help--- > > + This is the Intel IPU3 CIO2 CSI-2 receiver unit, found in Intel > > + Skylake and Kaby Lake SoCs and used for capturing images and > > + video from a camera sensor. > > + > > + Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2 > > + connected camera. > > + The module will be called ipu3-cio2. > > diff --git a/drivers/media/pci/intel/ipu3/Makefile > b/drivers/media/pci/intel/ipu3/Makefile > > new file mode 100644 > > index 0000000..20186e3 > > --- /dev/null > > +++ b/drivers/media/pci/intel/ipu3/Makefile > > @@ -0,0 +1 @@ > > +obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o > > diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.c > b/drivers/media/pci/intel/ipu3/ipu3-cio2.c > > new file mode 100644 > > index 0000000..8ecb17f > > --- /dev/null > > +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.c > > @@ -0,0 +1,1873 @@ > > +/* > > + * Copyright (c) 2017 Intel Corporation. > > + * > > + * This program is free software; you can redistribute it and/or > > + * modify it under the terms of the GNU General Public License version > > + * 2 as published by the Free Software Foundation. > > + * > > + * This program is distributed in the hope that it will be useful, > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > > + * GNU General Public License for more details. > > + * > > + * Based partially on Intel IPU4 driver written by > > + * Sakari Ailus <sakari.ailus@linux.intel.com> > > + * Samu Onkalo <samu.onkalo@intel.com> > > + * Jouni Högander <jouni.hogander@intel.com> > > + * Jouni Ukkonen <jouni.ukkonen@intel.com> > > + * Antti Laakso <antti.laakso@intel.com> > > + * et al. > > + * > > + */ > > + > > +#include <linux/delay.h> > > +#include <linux/interrupt.h> > > +#include <linux/module.h> > > +#include <linux/pci.h> > > +#include <linux/pm_runtime.h> > > +#include <linux/property.h> > > +#include <linux/vmalloc.h> > > +#include <media/v4l2-ctrls.h> > > +#include <media/v4l2-device.h> > > +#include <media/v4l2-event.h> > > +#include <media/v4l2-fwnode.h> > > +#include <media/v4l2-ioctl.h> > > +#include <media/videobuf2-dma-sg.h> > > + > > +#include "ipu3-cio2.h" > > + > > +/* > > + * These are raw formats used in Intel's third generation of > > + * Image Processing Unit known as IPU3. > > + * 10bit raw bayer packed, 32 bytes for every 25 pixels, > > + * last LSB 6 bits unused. > > + */ > > +static const u32 cio2_csi2_fmts[] = { > > + V4L2_PIX_FMT_IPU3_SRGGB10, > > + V4L2_PIX_FMT_IPU3_SGBRG10, > > + V4L2_PIX_FMT_IPU3_SGRBG10, > > + V4L2_PIX_FMT_IPU3_SBGGR10, > > +}; > > + > > +static inline u32 cio2_bytesperline(const unsigned int width) > > +{ > > + /* > > + * 64 bytes for every 50 pixels, the line length > > + * in bytes is multiple of 64 (line end alignment). > > + */ > > + return DIV_ROUND_UP(width, 50) * 64; > > +} > > + > > +/**************** FBPT operations ****************/ > > + > > +static void cio2_fbpt_exit_dummy(struct cio2_device *cio2) > > +{ > > + if (cio2->dummy_lop) { > > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > > + cio2->dummy_lop, cio2- > >dummy_lop_bus_addr); > > + cio2->dummy_lop = NULL; > > + } > > + if (cio2->dummy_page) { > > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > > + cio2->dummy_page, cio2- > >dummy_page_bus_addr); > > + cio2->dummy_page = NULL; > > + } > > +} > > + > > +static int cio2_fbpt_init_dummy(struct cio2_device *cio2) > > +{ > > + unsigned int i; > > + > > + cio2->dummy_page = dma_alloc_coherent(&cio2->pci_dev->dev, > > + CIO2_PAGE_SIZE, &cio2- > >dummy_page_bus_addr, > > + GFP_KERNEL); > > + cio2->dummy_lop = dma_alloc_coherent(&cio2->pci_dev->dev, > > + CIO2_PAGE_SIZE, &cio2- > >dummy_lop_bus_addr, > > + GFP_KERNEL); > > + if (!cio2->dummy_page || !cio2->dummy_lop) { > > + cio2_fbpt_exit_dummy(cio2); > > + return -ENOMEM; > > + } > > + /* > > + * List of Pointers(LOP) contains 1024x32b pointers to 4KB page each > > + * Initialize each entry to dummy_page bus base address. > > + */ > > + for (i = 0; i < CIO2_PAGE_SIZE / sizeof(*cio2->dummy_lop); i++) > > + cio2->dummy_lop[i] = cio2->dummy_page_bus_addr >> > PAGE_SHIFT; > > + > > + return 0; > > +} > > + > > +static void cio2_fbpt_entry_enable(struct cio2_device *cio2, > > + struct cio2_fbpt_entry > entry[CIO2_MAX_LOPS]) > > +{ > > + /* > > + * The CPU first initializes some fields in fbpt, then sets > > + * the VALID bit, this barrier is to ensure that the DMA(device) > > + * does not see the VALID bit enabled before other fields are > > + * initialized; otherwise it could lead to havoc. > > + */ > > + dma_wmb(); > > + > > + /* > > + * Request interrupts for start and completion > > + * Valid bit is applicable only to 1st entry > > + */ > > + entry[0].first_entry.ctrl = CIO2_FBPT_CTRL_VALID | > > + CIO2_FBPT_CTRL_IOC | CIO2_FBPT_CTRL_IOS; > > +} > > + > > +/* Initialize fpbt entries to point to dummy frame */ > > +static void cio2_fbpt_entry_init_dummy(struct cio2_device *cio2, > > + struct cio2_fbpt_entry > > + entry[CIO2_MAX_LOPS]) > > +{ > > + unsigned int i; > > + > > + entry[0].first_entry.first_page_offset = 0; > > + entry[1].second_entry.num_of_pages = > > + CIO2_PAGE_SIZE / sizeof(u32) * CIO2_MAX_LOPS; > > + entry[1].second_entry.last_page_available_bytes = CIO2_PAGE_SIZE - > 1; > > + > > + for (i = 0; i < CIO2_MAX_LOPS; i++) > > + entry[i].lop_page_addr = cio2->dummy_lop_bus_addr >> > PAGE_SHIFT; > > + > > + cio2_fbpt_entry_enable(cio2, entry); > > +} > > + > > +/* Initialize fpbt entries to point to a given buffer */ > > +static void cio2_fbpt_entry_init_buf(struct cio2_device *cio2, > > + struct cio2_buffer *b, > > + struct cio2_fbpt_entry > > + entry[CIO2_MAX_LOPS]) > > +{ > > + struct vb2_buffer *vb = &b->vbb.vb2_buf; > > + unsigned int length = vb->planes[0].length; > > + int remaining, i; > > + > > + entry[0].first_entry.first_page_offset = > > + offset_in_page(vb2_plane_vaddr(vb, 0)); > > + remaining = length + entry[0].first_entry.first_page_offset; > > + entry[1].second_entry.num_of_pages = > > + DIV_ROUND_UP(remaining, CIO2_PAGE_SIZE); > > + /* > > + * last_page_available_bytes has the offset of the last byte in the > > + * last page which is still accessible by DMA. DMA cannot access > > + * beyond this point. Valid range for this is from 0 to 4095. > > + * 0 indicates 1st byte in the page is DMA accessible. > > + * 4095 (CIO2_PAGE_SIZE - 1) means every single byte in the last page > > + * is available for DMA transfer. > > + */ > > + entry[1].second_entry.last_page_available_bytes = > > + (remaining & ~PAGE_MASK) ? > > + (remaining & ~PAGE_MASK) - 1 : > > + CIO2_PAGE_SIZE - 1; > > + /* Fill FBPT */ > > + remaining = length; > > + i = 0; > > + while (remaining > 0) { > > + entry->lop_page_addr = b->lop_bus_addr[i] >> PAGE_SHIFT; > > + remaining -= CIO2_PAGE_SIZE / sizeof(u32) * > CIO2_PAGE_SIZE; > > + entry++; > > + i++; > > + } > > + > > + /* > > + * The first not meaningful FBPT entry should point to a valid LOP > > + */ > > + entry->lop_page_addr = cio2->dummy_lop_bus_addr >> PAGE_SHIFT; > > + > > + cio2_fbpt_entry_enable(cio2, entry); > > +} > > + > > +static int cio2_fbpt_init(struct cio2_device *cio2, struct cio2_queue *q) > > +{ > > + struct device *dev = &cio2->pci_dev->dev; > > + > > + q->fbpt = dma_alloc_coherent(dev, CIO2_FBPT_SIZE, > > + &q->fbpt_bus_addr, GFP_KERNEL); > > This could be aligned better. Will update. > > > + if (!q->fbpt) > > + return -ENOMEM; > > + > > + memset(q->fbpt, 0, CIO2_FBPT_SIZE); > > + > > + return 0; > > +} > > + > > +static void cio2_fbpt_exit(struct cio2_queue *q, struct device *dev) > > +{ > > + dma_free_coherent(dev, CIO2_FBPT_SIZE, q->fbpt, q- > >fbpt_bus_addr); > > +} > > + > > +/**************** CSI2 hardware setup ****************/ > > + > > +/* > > + * The CSI2 receiver has several parameters affecting > > + * the receiver timings. These depend on the MIPI bus frequency > > + * F in Hz (sensor transmitter rate) as follows: > > + * register value = (A/1e9 + B * UI) / COUNT_ACC > > + * where > > + * UI = 1 / (2 * F) in seconds > > + * COUNT_ACC = counter accuracy in seconds > > + * For IPU3 COUNT_ACC = 0.0625 > > + * > > + * A and B are coefficients from the table below, > > + * depending whether the register minimum or maximum value is > > + * calculated. > > + * Minimum Maximum > > + * Clock lane A B A B > > + * reg_rx_csi_dly_cnt_termen_clane 0 0 38 0 > > + * reg_rx_csi_dly_cnt_settle_clane 95 -8 300 -16 > > + * Data lanes > > + * reg_rx_csi_dly_cnt_termen_dlane0 0 0 35 4 > > + * reg_rx_csi_dly_cnt_settle_dlane0 85 -2 145 -6 > > + * reg_rx_csi_dly_cnt_termen_dlane1 0 0 35 4 > > + * reg_rx_csi_dly_cnt_settle_dlane1 85 -2 145 -6 > > + * reg_rx_csi_dly_cnt_termen_dlane2 0 0 35 4 > > + * reg_rx_csi_dly_cnt_settle_dlane2 85 -2 145 -6 > > + * reg_rx_csi_dly_cnt_termen_dlane3 0 0 35 4 > > + * reg_rx_csi_dly_cnt_settle_dlane3 85 -2 145 -6 > > + * > > + * We use the minimum values of both A and B. > > + */ > > + > > +/* > > + * shift for keeping value range suitable for 32-bit integer arithmetics > > + */ > > +#define LIMIT_SHIFT 8 > > + > > +static int cio2_rx_timing(s32 a, s32 b, s64 freq, int def) > > +{ > > + const u32 accinv = 16; /* invert of counter resolution */ > > + const u32 uiinv = 500000000; /* 1/2 * 1/1e9 */ > > 1e9 / 2 ? Sure. > > > + int r; > > + > > + freq >>= LIMIT_SHIFT; > > + > > + if (WARN_ON(freq <= 0 || freq > S32_MAX)) > > + return def; > > + /* > > + * b could be 0, -2 or -8, so |accinv * b| is always > > + * less than (1 << ds) and thus |r| < 500000000. > > + */ > > + r = accinv * b * (uiinv >> LIMIT_SHIFT); > > + r = (s32) r / freq; > > Please cast freq to s32; r should b s32 to begin with. Ack. > > > + /* max value of a is 95 */ > > + r += accinv * a; > > + > > + return r; > > +}; > > + > > +/* Calculate the the delay value for termination enable of clock lane HS Rx > */ > > +static int cio2_csi2_calc_timing(struct cio2_device *cio2, struct cio2_queue > *q, > > + struct cio2_csi2_timing *timing) > > +{ > > + struct device *dev = &cio2->pci_dev->dev; > > + struct v4l2_querymenu qm = {.id = V4L2_CID_LINK_FREQ, }; > > + struct v4l2_ctrl *link_freq; > > + s64 freq; > > + int r; > > + > > + if (!q->sensor) > > + return -ENODEV; > > + > > + link_freq = v4l2_ctrl_find(q->sensor->ctrl_handler, > > + V4L2_CID_LINK_FREQ); > > Fits on previous line. Ack. > > > + if (!link_freq) { > > + dev_err(dev, "failed to find LINK_FREQ\n"); > > + return -EPIPE; > > + }; > > + > > + qm.index = v4l2_ctrl_g_ctrl(link_freq); > > + r = v4l2_querymenu(q->sensor->ctrl_handler, &qm); > > + if (r) { > > + dev_err(dev, "failed to get menu item\n"); > > + return r; > > + } > > + > > + if (!qm.value) { > > + dev_err(dev, "error invalid link_freq\n"); > > + return -EINVAL; > > + } > > + freq = qm.value; > > + > > + timing->clk_termen = > cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A, > > + CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B, > freq, > > + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); > > + timing->clk_settle = > cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A, > > + CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B, freq, > > + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); > > + timing->dat_termen = > cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A, > > + CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B, > freq, > > + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); > > + timing->dat_settle = > cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A, > > + CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B, freq, > > + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); > > + > > + dev_dbg(dev, "freq ct value is %d\n", timing->clk_termen); > > + dev_dbg(dev, "freq cs value is %d\n", timing->clk_settle); > > + dev_dbg(dev, "freq dt value is %d\n", timing->dat_termen); > > + dev_dbg(dev, "freq ds value is %d\n", timing->dat_settle); > > + > > + return 0; > > +}; > > + > > +static int cio2_hw_mbus_to_mipicode(__u32 code, u8 *mipicode) > > +{ > > + static const struct { > > + u32 mbuscode; > > + u8 mipicode; > > + } mbus2mipi[] = { > > + { MEDIA_BUS_FMT_SBGGR10_1X10, 0x2b }, > > + { MEDIA_BUS_FMT_SGBRG10_1X10, 0x2b }, > > + { MEDIA_BUS_FMT_SGRBG10_1X10, 0x2b }, > > + { MEDIA_BUS_FMT_SRGGB10_1X10, 0x2b }, > > + }; > > + unsigned int i; > > + > > + for (i = 0; i < ARRAY_SIZE(mbus2mipi); i++) > > + if (mbus2mipi[i].mbuscode == code) { > > + *mipicode = mbus2mipi[i].mipicode; > > + return 0; > > + } > > + > > + return -EINVAL; > > +} > > + > > +static int cio2_hw_init(struct cio2_device *cio2, struct cio2_queue *q) > > +{ > > + static const int NUM_VCS = 4; > > + static const int SID; /* Stream id */ > > + static const int ENTRY; > > + static const int FBPT_WIDTH = DIV_ROUND_UP(CIO2_MAX_LOPS, > > + CIO2_FBPT_SUBENTRY_UNIT); > > + const u32 num_buffers1 = CIO2_MAX_BUFFERS - 1; > > + void __iomem *const base = cio2->base; > > + u8 mipicode, lanes, csi2bus = q->csi2.port; > > + u8 sensor_vc = SENSOR_VIR_CH_DFLT; > > + struct cio2_csi2_timing timing; > > + int i, r; > > + > > + r = cio2_hw_mbus_to_mipicode(q->subdev_fmt.code, &mipicode); > > + if (r < 0) > > + return r; > > + > > + lanes = q->csi2.num_of_lanes; > > + > > + r = cio2_csi2_calc_timing(cio2, q, &timing); > > + if (r) > > + return r; > > + > > + writel(timing.clk_termen, q->csi_rx_base + > > + > CIO2_REG_CSIRX_DLY_CNT_TERMEN(CIO2_CSIRX_DLY_CNT_CLANE_I > DX)); > > + writel(timing.clk_settle, q->csi_rx_base + > > + > CIO2_REG_CSIRX_DLY_CNT_SETTLE(CIO2_CSIRX_DLY_CNT_CLANE_ID > X)); > > + > > + for (i = 0; i < lanes; i++) { > > + writel(timing.dat_termen, q->csi_rx_base + > > + CIO2_REG_CSIRX_DLY_CNT_TERMEN(i)); > > + writel(timing.dat_settle, q->csi_rx_base + > > + CIO2_REG_CSIRX_DLY_CNT_SETTLE(i)); > > + } > > + > > + writel(CIO2_PBM_WMCTRL1_MIN_2CK | > > + CIO2_PBM_WMCTRL1_MID1_2CK | > > + CIO2_PBM_WMCTRL1_MID2_2CK, base + > CIO2_REG_PBM_WMCTRL1); > > + writel(CIO2_PBM_WMCTRL2_HWM_2CK << > CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT | > > + CIO2_PBM_WMCTRL2_LWM_2CK << > CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT | > > + CIO2_PBM_WMCTRL2_OBFFWM_2CK << > > + CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT | > > + CIO2_PBM_WMCTRL2_TRANSDYN << > CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT | > > + CIO2_PBM_WMCTRL2_OBFF_MEM_EN, base + > CIO2_REG_PBM_WMCTRL2); > > + writel(CIO2_PBM_ARB_CTRL_LANES_DIV << > > + CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT | > > + CIO2_PBM_ARB_CTRL_LE_EN | > > + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN << > > + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT | > > + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP << > > + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT, > > + base + CIO2_REG_PBM_ARB_CTRL); > > + writel(CIO2_CSIRX_STATUS_DLANE_HS_MASK, > > + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_HS); > > + writel(CIO2_CSIRX_STATUS_DLANE_LP_MASK, > > + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_LP); > > + > > + writel(CIO2_FB_HPLL_FREQ, base + CIO2_REG_FB_HPLL_FREQ); > > + writel(CIO2_ISCLK_RATIO, base + CIO2_REG_ISCLK_RATIO); > > + > > + /* Configure MIPI backend */ > > + for (i = 0; i < NUM_VCS; i++) > > + writel(1, q->csi_rx_base + > CIO2_REG_MIPIBE_SP_LUT_ENTRY(i)); > > + > > + /* There are 16 short packet LUT entry */ > > + for (i = 0; i < 16; i++) > > + writel(CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD, > > + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(i)); > > + writel(CIO2_MIPIBE_GLOBAL_LUT_DISREGARD, > > + q->csi_rx_base + CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD); > > + > > + writel(CIO2_INT_EN_EXT_IE_MASK, base + > CIO2_REG_INT_EN_EXT_IE); > > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + > CIO2_REG_IRQCTRL_MASK); > > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + > CIO2_REG_IRQCTRL_ENABLE); > > + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_EDGE); > > + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE); > > + writel(CIO2_INT_EN_EXT_OE_MASK, base + > CIO2_REG_INT_EN_EXT_OE); > > + > > + writel(CIO2_REG_INT_EN_IRQ | CIO2_INT_IOC(CIO2_DMA_CHAN) | > > + CIO2_REG_INT_EN_IOS(CIO2_DMA_CHAN), > > + base + CIO2_REG_INT_EN); > > + > > + writel((CIO2_PXM_PXF_FMT_CFG_BPP_10 | > CIO2_PXM_PXF_FMT_CFG_PCK_64B) > > + << CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT, > > + base + CIO2_REG_PXM_PXF_FMT_CFG0(csi2bus)); > > + writel(SID << CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT | > > + sensor_vc << CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT | > > + mipicode << CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT, > > + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(ENTRY)); > > + writel(0, q->csi_rx_base + > CIO2_REG_MIPIBE_COMP_FORMAT(sensor_vc)); > > + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_FORCE_RAW8); > > + writel(0, base + CIO2_REG_PXM_SID2BID0(csi2bus)); > > + > > + writel(lanes, q->csi_rx_base + > CIO2_REG_CSIRX_NOF_ENABLED_LANES); > > + writel(CIO2_CGC_PRIM_TGE | > > + CIO2_CGC_SIDE_TGE | > > + CIO2_CGC_XOSC_TGE | > > + CIO2_CGC_D3I3_TGE | > > + CIO2_CGC_CSI2_INTERFRAME_TGE | > > + CIO2_CGC_CSI2_PORT_DCGE | > > + CIO2_CGC_SIDE_DCGE | > > + CIO2_CGC_PRIM_DCGE | > > + CIO2_CGC_ROSC_DCGE | > > + CIO2_CGC_XOSC_DCGE | > > + CIO2_CGC_CLKGATE_HOLDOFF << > CIO2_CGC_CLKGATE_HOLDOFF_SHIFT | > > + CIO2_CGC_CSI_CLKGATE_HOLDOFF > > + << CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT, base + > CIO2_REG_CGC); > > + writel(CIO2_LTRVAL0_VAL << CIO2_LTRVAL02_VAL_SHIFT | > > + CIO2_LTRVAL0_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | > > + CIO2_LTRVAL1_VAL << CIO2_LTRVAL13_VAL_SHIFT | > > + CIO2_LTRVAL1_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, > > + base + CIO2_REG_LTRVAL01); > > + writel(CIO2_LTRVAL2_VAL << CIO2_LTRVAL02_VAL_SHIFT | > > + CIO2_LTRVAL2_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | > > + CIO2_LTRVAL3_VAL << CIO2_LTRVAL13_VAL_SHIFT | > > + CIO2_LTRVAL3_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, > > + base + CIO2_REG_LTRVAL23); > > + > > + for (i = 0; i < CIO2_NUM_DMA_CHAN; i++) { > > + writel(0, base + CIO2_REG_CDMABA(i)); > > + writel(0, base + CIO2_REG_CDMAC0(i)); > > + writel(0, base + CIO2_REG_CDMAC1(i)); > > + } > > + > > + /* Enable DMA */ > > + writel(q->fbpt_bus_addr >> PAGE_SHIFT, > > + base + CIO2_REG_CDMABA(CIO2_DMA_CHAN)); > > + > > + writel(num_buffers1 << CIO2_CDMAC0_FBPT_LEN_SHIFT | > > + FBPT_WIDTH << CIO2_CDMAC0_FBPT_WIDTH_SHIFT | > > + CIO2_CDMAC0_DMA_INTR_ON_FE | > > + CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL | > > + CIO2_CDMAC0_DMA_EN | > > + CIO2_CDMAC0_DMA_INTR_ON_FS | > > + CIO2_CDMAC0_DMA_HALTED, base + > CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); > > + > > + writel(1 << CIO2_CDMAC1_LINENUMUPDATE_SHIFT, > > + base + CIO2_REG_CDMAC1(CIO2_DMA_CHAN)); > > + > > + writel(0, base + CIO2_REG_PBM_FOPN_ABORT); > > + > > + writel(CIO2_PXM_FRF_CFG_CRC_TH << > CIO2_PXM_FRF_CFG_CRC_TH_SHIFT | > > + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR | > > + CIO2_PXM_FRF_CFG_MSK_ECC_RE | > > + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE, > > + base + CIO2_REG_PXM_FRF_CFG(q->csi2.port)); > > + > > + /* Clear interrupts */ > > + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + > CIO2_REG_IRQCTRL_CLEAR); > > + writel(~0, base + CIO2_REG_INT_STS_EXT_OE); > > + writel(~0, base + CIO2_REG_INT_STS_EXT_IE); > > + writel(~0, base + CIO2_REG_INT_STS); > > + > > + /* Enable devices, starting from the last device in the pipe */ > > + writel(1, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); > > + writel(1, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); > > + > > + return 0; > > +} > > + > > +static void cio2_hw_exit(struct cio2_device *cio2, struct cio2_queue *q) > > +{ > > + void __iomem *base = cio2->base; > > + unsigned int i, maxloops = 1000; > > + > > + /* Disable CSI receiver and MIPI backend devices */ > > + writel(0, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); > > + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); > > + > > + /* Halt DMA */ > > + writel(0, base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); > > + do { > > + if (readl(base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)) & > > + CIO2_CDMAC0_DMA_HALTED) > > + break; > > + usleep_range(1000, 2000); > > + } while (--maxloops); > > + if (!maxloops) > > + dev_err(&cio2->pci_dev->dev, > > + "DMA %i can not be halted\n", CIO2_DMA_CHAN); > > + > > + for (i = 0; i < CIO2_NUM_PORTS; i++) { > > + writel(readl(base + CIO2_REG_PXM_FRF_CFG(i)) | > > + CIO2_PXM_FRF_CFG_ABORT, base + > CIO2_REG_PXM_FRF_CFG(i)); > > + writel(readl(base + CIO2_REG_PBM_FOPN_ABORT) | > > + CIO2_PBM_FOPN_ABORT(i), base + > CIO2_REG_PBM_FOPN_ABORT); > > + } > > +} > > + > > +static void cio2_buffer_done(struct cio2_device *cio2, unsigned int > dma_chan) > > +{ > > + struct device *dev = &cio2->pci_dev->dev; > > + struct cio2_queue *q = cio2->cur_queue; > > + int buffers_found = 0; > > + > > + if (dma_chan >= CIO2_QUEUES) { > > + dev_err(dev, "bad DMA channel %i\n", dma_chan); > > + return; > > + } > > + > > + /* Find out which buffer(s) are ready */ > > + do { > > + struct cio2_fbpt_entry *const entry = > > + &q->fbpt[q->bufs_first * CIO2_MAX_LOPS]; > > + struct cio2_buffer *b; > > + u64 ns = ktime_get_ns(); > > You could get ns just once outside the loop. OK. > > > + > > + if (entry->first_entry.ctrl & CIO2_FBPT_CTRL_VALID) > > + break; > > + > > + b = q->bufs[q->bufs_first]; > > + if (b) { > > + q->bufs[q->bufs_first] = NULL; > > + atomic_dec(&q->bufs_queued); > > + > > + b->vbb.vb2_buf.timestamp = ns; > > + b->vbb.field = V4L2_FIELD_NONE; > > + b->vbb.sequence = entry[0].first_entry.frame_num; > > + vb2_buffer_done(&b->vbb.vb2_buf, > VB2_BUF_STATE_DONE); > > + } > > + cio2_fbpt_entry_init_dummy(cio2, entry); > > + q->bufs_first = (q->bufs_first + 1) % CIO2_MAX_BUFFERS; > > + buffers_found++; > > + } while (1); > > + > > + if (buffers_found == 0) > > + dev_warn(&cio2->pci_dev->dev, > > + "no ready buffers found on DMA channel %u\n", > > + dma_chan); > > +} > > + > > +static void cio2_queue_event_sof(struct cio2_device *cio2, struct > cio2_queue *q) > > +{ > > + struct v4l2_event event = { > > + .type = V4L2_EVENT_FRAME_SYNC, > > + .u.frame_sync.frame_sequence = > > + atomic_inc_return(&q->frame_sequence) - 1, > > + }; > > + > > + v4l2_event_queue(q->subdev.devnode, &event); > > +} > > + > > +static const char *const cio2_irq_errs[] = { > > + "single packet header error corrected", > > + "multiple packet header errors detected", > > + "payload checksum (CRC) error", > > + "fifo overflow", > > + "reserved short packet data type detected", > > + "reserved long packet data type detected", > > + "incomplete long packet detected", > > + "frame sync error", > > + "line sync error", > > + "DPHY start of transmission error", > > + "DPHY synchronization error", > > + "escape mode error", > > + "escape mode trigger event", > > + "escape mode ultra-low power state for data lane(s)", > > + "escape mode ultra-low power state exit for clock lane", > > + "inter-frame short packet discarded", > > + "inter-frame long packet discarded", > > + "non-matching Long Packet stalled", > > +}; > > + > > +static const char *const cio2_port_errs[] = { > > + "ECC recoverable", > > + "DPHY not recoverable", > > + "ECC not recoverable", > > + "CRC error", > > + "INTERFRAMEDATA", > > + "PKT2SHORT", > > + "PKT2LONG", > > +}; > > + > > +static irqreturn_t cio2_irq(int irq, void *cio2_ptr) > > +{ > > + struct cio2_device *cio2 = cio2_ptr; > > + void __iomem *const base = cio2->base; > > + struct device *dev = &cio2->pci_dev->dev; > > + u32 int_status, int_clear; > > + > > + int_clear = int_status = readl(base + CIO2_REG_INT_STS); > > + if (!int_status) > > + return IRQ_NONE; > > + > > + if (int_status & CIO2_INT_IOOE) { > > + /* > > + * Interrupt on Output Error: > > + * 1) SRAM is full and FS received, or > > + * 2) An invalid bit detected by DMA. > > + */ > > + u32 oe_status, oe_clear; > > + > > + oe_clear = readl(base + CIO2_REG_INT_STS_EXT_OE); > > + oe_status = oe_clear; > > + > > + if (oe_status & CIO2_INT_EXT_OE_DMAOE_MASK) { > > + dev_err(dev, "DMA output error: 0x%x\n", > > + (oe_status & > CIO2_INT_EXT_OE_DMAOE_MASK) > > + >> CIO2_INT_EXT_OE_DMAOE_SHIFT); > > + oe_status &= ~CIO2_INT_EXT_OE_DMAOE_MASK; > > + } > > + if (oe_status & CIO2_INT_EXT_OE_OES_MASK) { > > + dev_err(dev, "DMA output error on CSI2 buses: > 0x%x\n", > > + (oe_status & CIO2_INT_EXT_OE_OES_MASK) > > + >> CIO2_INT_EXT_OE_OES_SHIFT); > > + oe_status &= ~CIO2_INT_EXT_OE_OES_MASK; > > + } > > + writel(oe_clear, base + CIO2_REG_INT_STS_EXT_OE); > > + if (oe_status) > > + dev_warn(dev, "unknown interrupt 0x%x on OE\n", > > + oe_status); > > + int_status &= ~CIO2_INT_IOOE; > > + } > > + > > + if (int_status & CIO2_INT_IOC_MASK) { > > + /* DMA IO done -- frame ready */ > > + u32 clr = 0; > > + unsigned int d; > > + > > + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) > > + if (int_status & CIO2_INT_IOC(d)) { > > + clr |= CIO2_INT_IOC(d); > > + dev_dbg(dev, "DMA %i done\n", d); > > + cio2_buffer_done(cio2, d); > > + } > > + int_status &= ~clr; > > + } > > + > > + if (int_status & CIO2_INT_IOS_IOLN_MASK) { > > + /* DMA IO starts or reached specified line */ > > + u32 clr = 0; > > + unsigned int d; > > + > > + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) > > + if (int_status & CIO2_INT_IOS_IOLN(d)) { > > + clr |= CIO2_INT_IOS_IOLN(d); > > + if (d == CIO2_DMA_CHAN) > > + cio2_queue_event_sof(cio2, > > + cio2->cur_queue); > > + dev_dbg(dev, > > + "DMA %i started or reached line\n", > d); > > + } > > + int_status &= ~clr; > > + } > > + > > + if (int_status & (CIO2_INT_IOIE | CIO2_INT_IOIRQ)) { > > + /* CSI2 receiver (error) interrupt */ > > + u32 ie_status, ie_clear; > > + unsigned int port; > > + > > + ie_clear = readl(base + CIO2_REG_INT_STS_EXT_IE); > > + ie_status = ie_clear; > > + > > + for (port = 0; port < CIO2_NUM_PORTS; port++) { > > + u32 port_status = (ie_status >> (port * 8)) & 0xff; > > + u32 err_mask = > BIT_MASK(ARRAY_SIZE(cio2_port_errs)) - 1; > > + void __iomem *const csi_rx_base = > > + base + > CIO2_REG_PIPE_BASE(port); > > + unsigned int i; > > + > > + while (port_status & err_mask) { > > + i = ffs(port_status) - 1; > > + dev_err(dev, "port %i error %s\n", > > + port, cio2_port_errs[i]); > > + ie_status &= ~BIT(port * 8 + i); > > + port_status &= ~BIT(i); > > + } > > + > > + if (ie_status & CIO2_INT_EXT_IE_IRQ(port)) { > > + u32 csi2_status, csi2_clear; > > + > > + csi2_status = readl(csi_rx_base + > > + CIO2_REG_IRQCTRL_STATUS); > > + csi2_clear = csi2_status; > > + err_mask = > > + BIT_MASK(ARRAY_SIZE(cio2_irq_errs)) > - 1; > > + > > + while (csi2_status & err_mask) { > > + i = ffs(csi2_status) - 1; > > + dev_err(dev, > > + "CSI-2 receiver port %i: %s\n", > > + port, cio2_irq_errs[i]); > > + csi2_status &= ~BIT(i); > > + } > > + > > + writel(csi2_clear, > > + csi_rx_base + CIO2_REG_IRQCTRL_CLEAR); > > + if (csi2_status) > > + dev_warn(dev, > > + "unknown CSI2 error 0x%x > on port %i\n", > > + csi2_status, port); > > + > > + ie_status &= ~CIO2_INT_EXT_IE_IRQ(port); > > + } > > + } > > + > > + writel(ie_clear, base + CIO2_REG_INT_STS_EXT_IE); > > + if (ie_status) > > + dev_warn(dev, "unknown interrupt 0x%x on IE\n", > > + ie_status); > > + > > + int_status &= ~(CIO2_INT_IOIE | CIO2_INT_IOIRQ); > > + } > > + > > + writel(int_clear, base + CIO2_REG_INT_STS); > > + if (int_status) > > + dev_warn(dev, "unknown interrupt 0x%x on INT\n", > int_status); > > + > > + return IRQ_HANDLED; > > +} > > + > > +/**************** Videobuf2 interface ****************/ > > + > > +static void cio2_vb2_return_all_buffers(struct cio2_queue *q) > > +{ > > + unsigned int i; > > + > > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > > + if (q->bufs[i]) { > > + atomic_dec(&q->bufs_queued); > > + vb2_buffer_done(&q->bufs[i]->vbb.vb2_buf, > > + VB2_BUF_STATE_ERROR); > > + } > > + } > > +} > > + > > +static int cio2_vb2_queue_setup(struct vb2_queue *vq, > > + unsigned int *num_buffers, > > + unsigned int *num_planes, > > + unsigned int sizes[], > > + struct device *alloc_devs[]) > > +{ > > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > > + u32 width = q->subdev_fmt.width; > > + u32 height = q->subdev_fmt.height; > > + u32 pixelformat = q->format.pixelformat; > > + unsigned int i, szimage; > > + int r = 0; > > + > > + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { > > + if (pixelformat == cio2_csi2_fmts[i]) > > + break; > > + } > > + > > + alloc_devs[0] = &cio2->pci_dev->dev; > > + szimage = cio2_bytesperline(width) * height; > > + > > + *num_planes = 1; > > + sizes[0] = szimage; > > + > > + *num_buffers = clamp_val(*num_buffers, 1, CIO2_MAX_BUFFERS); > > + > > + /* Initialize buffer queue */ > > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > > + q->bufs[i] = NULL; > > + cio2_fbpt_entry_init_dummy(cio2, &q->fbpt[i * > CIO2_MAX_LOPS]); > > + } > > + atomic_set(&q->bufs_queued, 0); > > + q->bufs_first = 0; > > + q->bufs_next = 0; > > + q->format.sizeimage = szimage; > > + > > + return r; > > +} > > + > > +/* Called after each buffer is allocated */ > > +static int cio2_vb2_buf_init(struct vb2_buffer *vb) > > +{ > > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > > + struct device *dev = &cio2->pci_dev->dev; > > + struct cio2_buffer *b = > > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > > + unsigned int length = vb->planes[0].length; > > + unsigned int page_entry = CIO2_PAGE_SIZE / sizeof(u32); > > + int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, CIO2_PAGE_SIZE) > + 1, > > + page_entry); > > unsigned int? Ack. > > > + struct sg_table *sg; > > + struct sg_page_iter sg_iter; > > + unsigned int i, j; > > + > > + if (lops <= 0 || lops > CIO2_MAX_LOPS) { > > + dev_err(dev, "%s: bad buffer size (%i)\n", __func__, length); > > + return -ENOSPC; /* Should never happen */ > > + } > > + > > + /* Allocate LOP table */ > > + for (i = 0; i < lops; i++) { > > + b->lop[i] = dma_alloc_coherent(dev, CIO2_PAGE_SIZE, > > + &b->lop_bus_addr[i], GFP_KERNEL); > > + if (!b->lop[i]) > > + goto fail; > > + } > > + > > + /* Fill LOP */ > > + sg = vb2_dma_sg_plane_desc(vb, 0); > > + if (!sg) > > + return -ENOMEM; > > + > > + i = j = 0; > > + for_each_sg_page(sg->sgl, &sg_iter, sg->nents, 0) { > > + b->lop[i][j] = sg_page_iter_dma_address(&sg_iter) >> > PAGE_SHIFT; > > + j++; > > + if (j == page_entry) { > > + i++; > > + j = 0; > > + } > > + } > > + > > + b->lop[i][j] = cio2->dummy_page_bus_addr >> PAGE_SHIFT; > > + return 0; > > +fail: > > + for (; i >= 0; i--) > > + dma_free_coherent(dev, CIO2_PAGE_SIZE, > > + b->lop[i], b->lop_bus_addr[i]); > > + return -ENOMEM; > > +} > > + > > +/* Transfer buffer ownership to cio2 */ > > +static void cio2_vb2_buf_queue(struct vb2_buffer *vb) > > +{ > > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > > + struct cio2_queue *q = > > + container_of(vb->vb2_queue, struct cio2_queue, vbq); > > + struct cio2_buffer *b = > > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > > + struct cio2_fbpt_entry *entry; > > + unsigned int i, next = q->bufs_next; > > + int bufs_queued = atomic_inc_return(&q->bufs_queued); > > + > > + if (vb2_is_streaming(&q->vbq)) { > > + u32 fbpt_rp = > > + (readl(cio2->base + > CIO2_REG_CDMARI(CIO2_DMA_CHAN)) > > + >> CIO2_CDMARI_FBPT_RP_SHIFT) > > + & CIO2_CDMARI_FBPT_RP_MASK; > > + > > + /* > > + * fbpt_rp is the fbpt entry that the dma is currently working > > + * on, but since it could jump to next entry at any time, > > + * assume that we might already be there. > > + */ > > + fbpt_rp = (fbpt_rp + 1) % CIO2_MAX_BUFFERS; > > + > > + if (bufs_queued <= 1) > > + next = fbpt_rp + 1; /* Buffers were drained */ > > + else if (fbpt_rp == next) > > + next++; > > + next %= CIO2_MAX_BUFFERS; > > + } > > + > > + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { > > + /* > > + * We have allocated CIO2_MAX_BUFFERS circularly for the > > + * hw, the user has requested N buffer queue. The driver > > + * ensures N <= CIO2_MAX_BUFFERS and guarantees that > whenever > > + * user queues a buffer, there necessarily is a free buffer. > > + */ > > + if (!q->bufs[next]) > > + break; > > + > > + dev_dbg(&cio2->pci_dev->dev, > > + "entry %i was already full!\n", next); > > + next = (next + 1) % CIO2_MAX_BUFFERS; > > + } > > + /* This should not happen, just in case */ > > + if (i == CIO2_MAX_BUFFERS) { > > + dev_err(&cio2->pci_dev->dev, > > + "error: all cio2 entries were full!\n"); > > + vb2_buffer_done(vb, VB2_BUF_STATE_ERROR); > > + return; > > + } > > + > > + q->bufs[next] = b; > > + entry = &q->fbpt[next * CIO2_MAX_LOPS]; > > + cio2_fbpt_entry_init_buf(cio2, b, entry); > > + q->bufs_next = (next + 1) % CIO2_MAX_BUFFERS; > > + > > + vb2_set_plane_payload(vb, 0, q->format.sizeimage); > > +} > > + > > +/* Called when each buffer is freed */ > > +static void cio2_vb2_buf_cleanup(struct vb2_buffer *vb) > > +{ > > + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); > > + struct cio2_buffer *b = > > + container_of(vb, struct cio2_buffer, vbb.vb2_buf); > > + unsigned int i, length = vb->planes[0].length; > > + unsigned int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, > CIO2_PAGE_SIZE), > > + CIO2_PAGE_SIZE / sizeof(u32)); > > + > > + /* Free LOP table */ > > + for (i = 0; i < lops; i++) > > + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, > > + b->lop[i], b->lop_bus_addr[i]); > > +} > > + > > +static int cio2_vb2_start_streaming(struct vb2_queue *vq, unsigned int > count) > > +{ > > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > > + int r; > > + > > + cio2->cur_queue = q; > > + atomic_set(&q->frame_sequence, 0); > > + > > + r = pm_runtime_get_sync(&cio2->pci_dev->dev); > > + if (r < 0) { > > + dev_info(&cio2->pci_dev->dev, > > + "failed to set power %d\n", r); > > + pm_runtime_put(&cio2->pci_dev->dev); > > + return r; > > + } > > + > > + r = media_pipeline_start(&q->vdev.entity, &q->pipe); > > + if (r) > > + goto fail_pipeline; > > + > > + r = cio2_hw_init(cio2, q); > > + if (r) > > + goto fail_hw; > > + > > + /* Start streaming on CSI2 receiver */ > > + r = v4l2_subdev_call(&q->subdev, video, s_stream, 1); > > You don't have s_stream() op defined, do you? You can drop this call then. Thanks for noticing this, will remove this and other empty implementations. > > > + if (r && r != -ENOIOCTLCMD) > > + goto fail_csi2_subdev; > > + > > + /* Start streaming on sensor */ > > + r = v4l2_subdev_call(q->sensor, video, s_stream, 1); > > + if (r) > > + goto fail_sensor_subdev; > > + > > + return 0; > > + > > +fail_sensor_subdev: > > + v4l2_subdev_call(&q->subdev, video, s_stream, 0); > > Ditto. > > > +fail_csi2_subdev: > > + cio2_hw_exit(cio2, q); > > +fail_hw: > > + media_pipeline_stop(&q->vdev.entity); > > +fail_pipeline: > > + dev_dbg(&cio2->pci_dev->dev, "failed to start streaming (%d)\n", r); > > + cio2_vb2_return_all_buffers(q); > > + > > + return r; > > +} > > + > > +static void cio2_vb2_stop_streaming(struct vb2_queue *vq) > > +{ > > + struct cio2_queue *q = vb2q_to_cio2_queue(vq); > > + struct cio2_device *cio2 = vb2_get_drv_priv(vq); > > + int r; > > + > > + if (v4l2_subdev_call(q->sensor, video, s_stream, 0)) > > + dev_err(&cio2->pci_dev->dev, > > + "failed to stop sensor streaming\n"); > > + > > + r = v4l2_subdev_call(&q->subdev, video, s_stream, 0); > > Here, too. > > > + if (r && r != -ENOIOCTLCMD) > > + dev_err(&cio2->pci_dev->dev, "failed to stop CSI2 > streaming\n"); > > + > > + cio2_hw_exit(cio2, q); > > + cio2_vb2_return_all_buffers(q); > > + media_pipeline_stop(&q->vdev.entity); > > + pm_runtime_put(&cio2->pci_dev->dev); > > +} > > + > > +static const struct vb2_ops cio2_vb2_ops = { > > + .buf_init = cio2_vb2_buf_init, > > + .buf_queue = cio2_vb2_buf_queue, > > + .buf_cleanup = cio2_vb2_buf_cleanup, > > + .queue_setup = cio2_vb2_queue_setup, > > + .start_streaming = cio2_vb2_start_streaming, > > + .stop_streaming = cio2_vb2_stop_streaming, > > + .wait_prepare = vb2_ops_wait_prepare, > > + .wait_finish = vb2_ops_wait_finish, > > +}; > > + > > +/**************** V4L2 interface ****************/ > > + > > +static int cio2_v4l2_querycap(struct file *file, void *fh, > > + struct v4l2_capability *cap) > > +{ > > + struct cio2_device *cio2 = video_drvdata(file); > > + struct cio2_queue *q = file_to_cio2_queue(file); > > + > > + strlcpy(cap->driver, CIO2_NAME, sizeof(cap->driver)); > > + strlcpy(cap->card, CIO2_DEVICE_NAME, sizeof(cap->card)); > > + snprintf(cap->bus_info, sizeof(cap->bus_info), > > + "PCI:%s", pci_name(cio2->pci_dev)); > > + cap->capabilities = q->vdev.device_caps | V4L2_CAP_DEVICE_CAPS; > > + return 0; > > +} > > + > > +static int cio2_v4l2_enum_fmt(struct file *file, void *fh, > > + struct v4l2_fmtdesc *f) > > +{ > > + if (f->index >= ARRAY_SIZE(cio2_csi2_fmts)) > > + return -EINVAL; > > + > > + f->pixelformat = cio2_csi2_fmts[f->index]; > > + > > + return 0; > > +} > > + > > +/* Propagate forward always the format from the CIO2 subdev */ > > +static int cio2_v4l2_g_fmt(struct file *file, void *fh, struct v4l2_format *f) > > +{ > > + struct cio2_queue *q = file_to_cio2_queue(file); > > + > > + f->fmt.pix.width = q->subdev_fmt.width; > > + f->fmt.pix.height = q->subdev_fmt.height; > > + f->fmt.pix.pixelformat = q->format.pixelformat; > > + f->fmt.pix.field = V4L2_FIELD_NONE; > > + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); > > + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; > > + f->fmt.pix.colorspace = V4L2_COLORSPACE_RAW; > > + > > + return 0; > > +} > > + > > +static int cio2_v4l2_try_fmt(struct file *file, void *fh, struct v4l2_format *f) > > +{ > > + u32 pixelformat = f->fmt.pix.pixelformat; > > + unsigned int i; > > + > > + cio2_v4l2_g_fmt(file, fh, f); > > + > > + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { > > + if (pixelformat == cio2_csi2_fmts[i]) > > + break; > > + } > > + > > + /* Use SRGGB10 as default if not found */ > > + if (i >= ARRAY_SIZE(cio2_csi2_fmts)) > > + pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; > > + > > + f->fmt.pix.pixelformat = pixelformat; > > + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); > > + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; > > + > > + return 0; > > +} > > + > > +static int cio2_v4l2_s_fmt(struct file *file, void *fh, struct v4l2_format *f) > > +{ > > + struct cio2_queue *q = file_to_cio2_queue(file); > > + > > + cio2_v4l2_try_fmt(file, fh, f); > > + q->format = f->fmt.pix; > > + > > + return 0; > > +} > > + > > +static const struct v4l2_file_operations cio2_v4l2_fops = { > > + .owner = THIS_MODULE, > > + .unlocked_ioctl = video_ioctl2, > > + .open = v4l2_fh_open, > > + .release = vb2_fop_release, > > + .poll = vb2_fop_poll, > > + .mmap = vb2_fop_mmap, > > +}; > > + > > +static const struct v4l2_ioctl_ops cio2_v4l2_ioctl_ops = { > > + .vidioc_querycap = cio2_v4l2_querycap, > > + .vidioc_enum_fmt_vid_cap = cio2_v4l2_enum_fmt, > > + .vidioc_g_fmt_vid_cap = cio2_v4l2_g_fmt, > > + .vidioc_s_fmt_vid_cap = cio2_v4l2_s_fmt, > > + .vidioc_try_fmt_vid_cap = cio2_v4l2_try_fmt, > > + .vidioc_reqbufs = vb2_ioctl_reqbufs, > > + .vidioc_create_bufs = vb2_ioctl_create_bufs, > > + .vidioc_prepare_buf = vb2_ioctl_prepare_buf, > > + .vidioc_querybuf = vb2_ioctl_querybuf, > > + .vidioc_qbuf = vb2_ioctl_qbuf, > > + .vidioc_dqbuf = vb2_ioctl_dqbuf, > > + .vidioc_streamon = vb2_ioctl_streamon, > > + .vidioc_streamoff = vb2_ioctl_streamoff, > > + .vidioc_expbuf = vb2_ioctl_expbuf, > > +}; > > + > > +static int cio2_subdev_subscribe_event(struct v4l2_subdev *sd, > > + struct v4l2_fh *fh, > > + struct v4l2_event_subscription *sub) > > +{ > > + if (sub->type != V4L2_EVENT_FRAME_SYNC) > > + return -EINVAL; > > + > > + /* Line number. For now only zero accepted. */ > > + if (sub->id != 0) > > + return -EINVAL; > > + > > + return v4l2_event_subscribe(fh, sub, 0, NULL); > > +} > > + > > +/* > > + * cio2_subdev_get_fmt - Handle get format by pads subdev method > > + * @sd : pointer to v4l2 subdev structure > > + * @cfg: V4L2 subdev pad config > > + * @fmt: pointer to v4l2 subdev format structure > > + * return -EINVAL or zero on success > > + */ > > +static int cio2_subdev_get_fmt(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_format *fmt) > > +{ > > + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); > > + > > + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) > > + fmt->format = *v4l2_subdev_get_try_format(sd, cfg, fmt- > >pad); > > + else /* Retrieve the current format */ > > + fmt->format = q->subdev_fmt; > > + > > + return 0; > > +} > > + > > +/* > > + * cio2_subdev_set_fmt - Handle set format by pads subdev method > > + * @sd : pointer to v4l2 subdev structure > > + * @cfg: V4L2 subdev pad config > > + * @fmt: pointer to v4l2 subdev format structure > > + * return -EINVAL or zero on success > > + */ > > +static int cio2_subdev_set_fmt(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_format *fmt) > > +{ > > + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); > > + > > + /* > > + * Only allow setting sink pad format; > > + * source always propagates from sink > > + */ > > + if (fmt->pad == CIO2_PAD_SOURCE) > > + return cio2_subdev_get_fmt(sd, cfg, fmt); > > + > > + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { > > + *v4l2_subdev_get_try_format(sd, cfg, fmt->pad) = fmt- > >format; > > + } else { > > + /* It's the sink, allow changing frame size */ > > + q->subdev_fmt.width = fmt->format.width; > > + q->subdev_fmt.height = fmt->format.height; > > + q->subdev_fmt.code = fmt->format.code; > > + fmt->format = q->subdev_fmt; > > + } > > + > > + return 0; > > +} > > + > > +static int cio2_subdev_enum_mbus_code(struct v4l2_subdev *sd, > > + struct v4l2_subdev_pad_config *cfg, > > + struct v4l2_subdev_mbus_code_enum > *code) > > +{ > > + static const u32 codes[] = { > > + MEDIA_BUS_FMT_SRGGB10_1X10, > > + MEDIA_BUS_FMT_SBGGR10_1X10, > > + MEDIA_BUS_FMT_SGBRG10_1X10, > > + MEDIA_BUS_FMT_SGRBG10_1X10, > > + }; > > + > > + if (code->index >= ARRAY_SIZE(codes)) > > + return -EINVAL; > > + > > + code->code = codes[code->index]; > > + > > + return 0; > > +} > > + > > +static int cio2_link_validate_get_format(struct media_pad *pad, > > + struct v4l2_subdev_format *fmt) > > +{ > > + if (pad->entity->obj_type == MEDIA_ENTITY_TYPE_V4L2_SUBDEV) { > > + struct v4l2_subdev *sd = > > + media_entity_to_v4l2_subdev(pad->entity); > > + if (sd) { > > + fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE; > > + fmt->pad = pad->index; > > + return v4l2_subdev_call(sd, pad, get_fmt, NULL, fmt); > > + } > > + } > > + > > + return -EINVAL; > > +} > > + > > +static int cio2_video_link_validate(struct media_link *link) > > +{ > > + struct video_device *vd; > > + struct cio2_queue *q; > > + struct media_pad *pad; > > + struct v4l2_subdev_format fmt = { 0 }; > > + struct cio2_device *cio2; > > + int i, rval; > > + > > + static const struct { > > This would better be declared as first, not last. Ack. > > > + u32 mbuscode; > > + u32 pixfmt; > > + } mbus2pixfmt[] = { > > + { MEDIA_BUS_FMT_SBGGR10_1X10, > V4L2_PIX_FMT_IPU3_SBGGR10 }, > > + { MEDIA_BUS_FMT_SGBRG10_1X10, > V4L2_PIX_FMT_IPU3_SGBRG10 }, > > + { MEDIA_BUS_FMT_SGRBG10_1X10, > V4L2_PIX_FMT_IPU3_SGRBG10 }, > > + { MEDIA_BUS_FMT_SRGGB10_1X10, > V4L2_PIX_FMT_IPU3_SRGGB10 }, > > + }; > > + > > + vd = container_of(link->sink->entity, struct video_device, entity); > > + q = container_of(vd, struct cio2_queue, vdev); > > + cio2 = video_get_drvdata(vd); > > I think you could well do the assignments in the declaration. Ack. > > > + pad = media_entity_remote_pad(link->sink->entity->pads); > > + if (!pad) { > > + dev_info(&cio2->pci_dev->dev, > > + "video node %s pad not connected\n", vd->name); > > + return -ENOTCONN; > > + } > > + > > + rval = cio2_link_validate_get_format(link->source, &fmt); > > + if (rval) > > + return rval; > > + > > + if (fmt.format.width != q->format.width || > > + fmt.format.height != q->format.height) { > > + dev_info(&cio2->pci_dev->dev, > > + "Wrong width or height %ux%u (%ux%u expected)\n", > > + q->format.width, q->format.height, > > + fmt.format.width, fmt.format.height); > > + return -EINVAL; > > + } > > + > > + for (i = 0; i < ARRAY_SIZE(mbus2pixfmt); i++) { > > + if (mbus2pixfmt[i].mbuscode == fmt.format.code && > > + mbus2pixfmt[i].pixfmt == q->format.pixelformat) { > > + return 0; > > + } > > + } > > + > > + return -EINVAL; > > +} > > + > > +static const struct v4l2_subdev_core_ops cio2_subdev_core_ops = { > > + .subscribe_event = cio2_subdev_subscribe_event, > > + .unsubscribe_event = v4l2_event_subdev_unsubscribe, > > +}; > > + > > +static const struct v4l2_subdev_video_ops cio2_subdev_video_ops = {}; > > No need to have video ops struct if no ops are defined in it. > > > + > > +static const struct v4l2_subdev_pad_ops cio2_subdev_pad_ops = { > > + .link_validate = v4l2_subdev_link_validate_default, > > + .get_fmt = cio2_subdev_get_fmt, > > + .set_fmt = cio2_subdev_set_fmt, > > + .enum_mbus_code = cio2_subdev_enum_mbus_code, > > +}; > > + > > +static const struct v4l2_subdev_ops cio2_subdev_ops = { > > + .core = &cio2_subdev_core_ops, > > + .video = &cio2_subdev_video_ops, > > + .pad = &cio2_subdev_pad_ops, > > +}; > > + > > +/******* V4L2 sub-device asynchronous registration > callbacks***********/ > > + > > +struct sensor_async_subdev { > > + struct v4l2_async_subdev asd; > > + struct v4l2_fwnode_endpoint vfwn_endpt; > > +}; > > + > > +static struct cio2_queue *cio2_find_queue_by_sensor_node(struct > cio2_queue *q, > > + struct fwnode_handle > *fwnode) > > +{ > > + int i; > > unsigned int? > > > + > > + for (i = 0; i < CIO2_QUEUES; i++) { > > + if (q[i].sensor->fwnode == fwnode) > > + return &q[i]; > > + } > > + > > + return NULL; > > +} > > + > > +/* The .bound() notifier callback when a match is found */ > > +static int cio2_notifier_bound(struct v4l2_async_notifier *notifier, > > + struct v4l2_subdev *sd, > > + struct v4l2_async_subdev *asd) > > +{ > > + struct cio2_device *cio2 = container_of(notifier, > > + struct cio2_device, notifier); > > + struct sensor_async_subdev *s_asd = container_of(asd, > > + struct sensor_async_subdev, asd); > > + struct cio2_queue *q; > > + struct device *dev; > > + int i; > > + > > + dev = &cio2->pci_dev->dev; > > + > > + /* Find first free slot for the subdev */ > > + for (i = 0; i < CIO2_QUEUES; i++) > > + if (!cio2->queue[i].sensor) > > + break; > > + > > + if (i >= CIO2_QUEUES) { > > + dev_err(dev, "too many subdevs\n"); > > You could just use &cio2->pci_dev->dev here. Alternatively please assign > dev in variable declaration. Will update. > > > + return -ENOSPC; > > + } > > + q = &cio2->queue[i]; > > + > > + q->csi2.port = s_asd->vfwn_endpt.base.port; > > + q->csi2.num_of_lanes = s_asd- > >vfwn_endpt.bus.mipi_csi2.num_data_lanes; > > + q->sensor = sd; > > + q->csi_rx_base = cio2->base + CIO2_REG_PIPE_BASE(q->csi2.port); > > + > > + return 0; > > +} > > + > > +/* The .unbind callback */ > > +static void cio2_notifier_unbind(struct v4l2_async_notifier *notifier, > > + struct v4l2_subdev *sd, > > + struct v4l2_async_subdev *asd) > > +{ > > + struct cio2_device *cio2 = container_of(notifier, > > + struct cio2_device, notifier); > > + unsigned int i; > > + > > + /* Note: sd may here point to unallocated memory. Do not access. */ > > + for (i = 0; i < CIO2_QUEUES; i++) { > > + if (cio2->queue[i].sensor == sd) { > > + cio2->queue[i].sensor = NULL; > > + return; > > + } > > + } > > +} > > + > > +/* .complete() is called after all subdevices have been located */ > > +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) > > +{ > > + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, > > + notifier); > > + struct sensor_async_subdev *s_asd; > > + struct fwnode_handle *fwn_remote, *fwn_endpt, > *fwn_remote_endpt; > > + struct cio2_queue *q; > > + struct fwnode_endpoint remote_endpt; > > + unsigned int i, pad; > > + int ret; > > + > > + for (i = 0; i < notifier->num_subdevs; i++) { > > + s_asd = container_of(cio2->notifier.subdevs[i], > > + struct sensor_async_subdev, > > + asd); > > + > > + fwn_remote = s_asd->asd.match.fwnode.fwnode; > > + fwn_endpt = (struct fwnode_handle *) > > + s_asd- > >vfwn_endpt.base.local_fwnode; > > Why do you need a cast? Agreed, this and the following session of fw binding related code will be updated and simplified. > > > + fwn_remote_endpt = > fwnode_graph_get_remote_endpoint(fwn_endpt); > > + if (!fwn_remote_endpt) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to get remote endpt\n"); > > + return ret; > > + } > > + > > + ret = fwnode_graph_parse_endpoint(fwn_remote_endpt, > > + &remote_endpt); > > + if (ret) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to parse remote endpt %d\n", ret); > > + return ret; > > + } > > You don't seem to be using remote_endpt for anything. Removing that > makes > fwn_remote_endpt unused as well. > > > + > > + q = cio2_find_queue_by_sensor_node(cio2->queue, > fwn_remote); > > + if (!q) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to find cio2 queue %d\n", ret); > > + return -ENXIO; > > + } > > + > > + for (pad = 0; pad < q->sensor->entity.num_pads; pad++) > > + if (q->sensor->entity.pads[pad].flags & > > + MEDIA_PAD_FL_SOURCE) > > + break; > > + > > + if (pad == q->sensor->entity.num_pads) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to src pad for %s\n", q->sensor- > >name); > > + return -ENXIO; > > + } > > + > > + ret = media_create_pad_link( > > + &q->sensor->entity, pad, > > + &q->subdev.entity, s_asd- > >vfwn_endpt.base.id, > > + 0); > > + if (ret) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to create link for %s\n", > > + cio2->queue[i].sensor->name); > > + return ret; > > + } > > + } > > + > > + return v4l2_device_register_subdev_nodes(&cio2->v4l2_dev); > > +} > > + > > +static int cio2_notifier_init(struct cio2_device *cio2) > > +{ > > + struct device *dev; > > + struct fwnode_handle *dev_fwn, *fwn, *fwn_remote; > > + struct v4l2_async_subdev *asd; > > + struct sensor_async_subdev *s_asd; > > + int ret; > > + > > + dev = &cio2->pci_dev->dev; > > + dev_fwn = dev_fwnode(dev); > > + > > + asd = devm_kzalloc(dev, sizeof(asd) * CIO2_QUEUES, GFP_KERNEL); > > + if (!asd) > > + return -ENOMEM; > > + > > + cio2->notifier.subdevs = (struct v4l2_async_subdev **)asd; > > + cio2->notifier.num_subdevs = 0; > > + cio2->notifier.bound = cio2_notifier_bound; > > + cio2->notifier.unbind = cio2_notifier_unbind; > > + cio2->notifier.complete = cio2_notifier_complete; > > + > > + fwn = NULL; > > You can assign fwn to NULL in variable declaration. > > > + while (cio2->notifier.num_subdevs < CIO2_QUEUES && > > + (fwn = fwnode_graph_get_next_endpoint(dev_fwn, > fwn))) { > > + s_asd = devm_kzalloc(dev, sizeof(*s_asd), GFP_KERNEL); > > + if (!asd) > > + return -ENOMEM; > > + > > + fwn_remote = fwnode_graph_get_remote_port_parent(fwn); > > + if (!fwn_remote) { > > + dev_err(dev, "bad remote port parent\n"); > > + return -ENOENT; > > + } > > + > > + ret = v4l2_fwnode_endpoint_parse(fwn, &s_asd- > >vfwn_endpt); > > + if (ret) { > > + dev_err(dev, "endpoint parsing error : %d\n", ret); > > + return ret; > > + } > > + > > + if (s_asd->vfwn_endpt.bus_type != V4L2_MBUS_CSI2) { > > + dev_warn(dev, "endpoint bus type error\n"); > > + devm_kfree(dev, s_asd); > > + continue; > > + } > > + > > + s_asd->asd.match.fwnode.fwnode = fwn_remote; > > + s_asd->asd.match_type = V4L2_ASYNC_MATCH_FWNODE; > > + > > + cio2->notifier.subdevs[cio2->notifier.num_subdevs++] = > > + &s_asd->asd; > > + } > > + > > + if (!cio2->notifier.num_subdevs) > > + return 0; /* No endpoint */ > > + > > + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); > > + if (ret) { > > + cio2->notifier.num_subdevs = 0; > > No need to assign num_subdevs as 0. > > > + dev_err(dev, "failed to register async notifier : %d\n", ret); > > + return ret; > > + } > > + > > + return 0; > > +} > > + > > +static void cio2_notifier_exit(struct cio2_device *cio2) > > +{ > > + if (cio2->notifier.num_subdevs > 0) > > + v4l2_async_notifier_unregister(&cio2->notifier); > > +} > > + > > +/**************** Queue initialization ****************/ > > +static const struct media_entity_operations cio2_media_ops = { > > + .link_validate = v4l2_subdev_link_validate, > > +}; > > + > > +static const struct media_entity_operations cio2_video_entity_ops = { > > + .link_validate = cio2_video_link_validate, > > +}; > > + > > +int cio2_queue_init(struct cio2_device *cio2, struct cio2_queue *q) > > +{ > > + static const u32 default_width = 1936; > > + static const u32 default_height = 1096; > > + static const u32 default_mbusfmt = > MEDIA_BUS_FMT_SRGGB10_1X10; > > + > > + struct video_device *vdev = &q->vdev; > > + struct vb2_queue *vbq = &q->vbq; > > + struct v4l2_subdev *subdev = &q->subdev; > > + struct v4l2_mbus_framefmt *fmt; > > + int r; > > + > > + /* Initialize miscellaneous variables */ > > + mutex_init(&q->lock); > > + > > + /* Initialize formats to default values */ > > + fmt = &q->subdev_fmt; > > + fmt->width = default_width; > > + fmt->height = default_height; > > + fmt->code = default_mbusfmt; > > + fmt->field = V4L2_FIELD_NONE; > > + fmt->colorspace = V4L2_COLORSPACE_RAW; > > + fmt->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT; > > + fmt->quantization = V4L2_QUANTIZATION_DEFAULT; > > + fmt->xfer_func = V4L2_XFER_FUNC_DEFAULT; > > + > > + q->format.pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; > > + > > + /* Initialize fbpt */ > > + r = cio2_fbpt_init(cio2, q); > > + if (r) > > + goto fail_fbpt; > > + > > + /* Initialize media entities */ > > + r = media_entity_pads_init(&subdev->entity, CIO2_PADS, q- > >subdev_pads); > > + if (r) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed initialize subdev media entity (%d)\n", r); > > + goto fail_subdev_media_entity; > > + } > > + q->subdev_pads[CIO2_PAD_SINK].flags = MEDIA_PAD_FL_SINK | > > + MEDIA_PAD_FL_MUST_CONNECT; > > + q->subdev_pads[CIO2_PAD_SOURCE].flags = > MEDIA_PAD_FL_SOURCE; > > + subdev->entity.ops = &cio2_media_ops; > > + r = media_entity_pads_init(&vdev->entity, 1, &q->vdev_pad); > > + if (r) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed initialize videodev media entity (%d)\n", r); > > + goto fail_vdev_media_entity; > > + } > > + q->vdev_pad.flags = MEDIA_PAD_FL_SINK | > MEDIA_PAD_FL_MUST_CONNECT; > > + vdev->entity.ops = &cio2_video_entity_ops; > > + > > + /* Initialize subdev */ > > + v4l2_subdev_init(subdev, &cio2_subdev_ops); > > + subdev->flags = V4L2_SUBDEV_FL_HAS_DEVNODE | > V4L2_SUBDEV_FL_HAS_EVENTS; > > + subdev->owner = THIS_MODULE; > > + snprintf(subdev->name, sizeof(subdev->name), > > + CIO2_ENTITY_NAME ":%li", q - cio2->queue); > > + v4l2_set_subdevdata(subdev, cio2); > > + r = v4l2_device_register_subdev(&cio2->v4l2_dev, subdev); > > + if (r) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed initialize subdev (%d)\n", r); > > + goto fail_subdev; > > + } > > + > > + /* Initialize vbq */ > > + vbq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; > > + vbq->io_modes = VB2_USERPTR | VB2_MMAP | VB2_DMABUF; > > + vbq->ops = &cio2_vb2_ops; > > + vbq->mem_ops = &vb2_dma_sg_memops; > > + vbq->buf_struct_size = sizeof(struct cio2_buffer); > > + vbq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; > > + vbq->min_buffers_needed = 1; > > + vbq->drv_priv = cio2; > > + vbq->lock = &q->lock; > > + r = vb2_queue_init(vbq); > > + if (r) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to initialize videobuf2 queue (%d)\n", r); > > + goto fail_vbq; > > + } > > + > > + /* Initialize vdev */ > > + snprintf(vdev->name, sizeof(vdev->name), > > + "%s:%li", CIO2_NAME, q - cio2->queue); > > + vdev->release = video_device_release_empty; > > + vdev->fops = &cio2_v4l2_fops; > > + vdev->ioctl_ops = &cio2_v4l2_ioctl_ops; > > + vdev->lock = &cio2->lock; > > + vdev->v4l2_dev = &cio2->v4l2_dev; > > + vdev->queue = &q->vbq; > > + vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | > V4L2_CAP_STREAMING; > > + video_set_drvdata(vdev, cio2); > > + r = video_register_device(vdev, VFL_TYPE_GRABBER, -1); > > + if (r) { > > + dev_err(&cio2->pci_dev->dev, > > + "failed to register video device (%d)\n", r); > > + goto fail_vdev; > > + } > > + > > + /* Create link from CIO2 subdev to output node */ > > + r = media_create_pad_link( > > + &subdev->entity, CIO2_PAD_SOURCE, &vdev->entity, 0, > > + MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE); > > + if (r) > > + goto fail_link; > > + > > + return 0; > > + > > +fail_link: > > + video_unregister_device(&q->vdev); > > +fail_vdev: > > + vb2_queue_release(vbq); > > +fail_vbq: > > + v4l2_device_unregister_subdev(subdev); > > +fail_subdev: > > + media_entity_cleanup(&vdev->entity); > > +fail_vdev_media_entity: > > + media_entity_cleanup(&subdev->entity); > > +fail_subdev_media_entity: > > + cio2_fbpt_exit(q, &cio2->pci_dev->dev); > > +fail_fbpt: > > + mutex_destroy(&q->lock); > > + > > + return r; > > +} > > + > > +static void cio2_queue_exit(struct cio2_device *cio2, struct cio2_queue *q) > > +{ > > + video_unregister_device(&q->vdev); > > + media_entity_cleanup(&q->vdev.entity); > > + vb2_queue_release(&q->vbq); > > + v4l2_device_unregister_subdev(&q->subdev); > > + media_entity_cleanup(&q->subdev.entity); > > + cio2_fbpt_exit(q, &cio2->pci_dev->dev); > > + mutex_destroy(&q->lock); > > +} > > + > > +/**************** PCI interface ****************/ > > + > > +static int cio2_pci_config_setup(struct pci_dev *dev) > > +{ > > + u16 pci_command; > > + int r = pci_enable_msi(dev); > > + > > + if (r) { > > + dev_err(&dev->dev, "failed to enable MSI (%d)\n", r); > > + return r; > > + } > > + > > + pci_read_config_word(dev, PCI_COMMAND, &pci_command); > > + pci_command |= PCI_COMMAND_MEMORY | > PCI_COMMAND_MASTER | > > + PCI_COMMAND_INTX_DISABLE; > > + pci_write_config_word(dev, PCI_COMMAND, pci_command); > > + > > + return 0; > > +} > > + > > +static int cio2_pci_probe(struct pci_dev *pci_dev, > > + const struct pci_device_id *id) > > +{ > > + struct cio2_device *cio2; > > + phys_addr_t phys; > > + void __iomem *const *iomap; > > + int i = -1, r = -ENODEV; > > Is there a need to initialise i here? No? Ack. > > > + > > + cio2 = devm_kzalloc(&pci_dev->dev, sizeof(*cio2), GFP_KERNEL); > > + if (!cio2) > > + return -ENOMEM; > > + cio2->pci_dev = pci_dev; > > + > > + r = pcim_enable_device(pci_dev); > > + if (r) { > > + dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r); > > + return r; > > + } > > + > > + dev_info(&pci_dev->dev, "device 0x%x (rev: 0x%x)\n", > > + pci_dev->device, pci_dev->revision); > > + > > + phys = pci_resource_start(pci_dev, CIO2_PCI_BAR); > > + > > + r = pcim_iomap_regions(pci_dev, 1 << CIO2_PCI_BAR, > pci_name(pci_dev)); > > + if (r) { > > + dev_err(&pci_dev->dev, "failed to remap I/O memory > (%d)\n", r); > > + return -ENODEV; > > + } > > + > > + iomap = pcim_iomap_table(pci_dev); > > + if (!iomap) { > > + dev_err(&pci_dev->dev, "failed to iomap table\n"); > > + return -ENODEV; > > + } > > + > > + cio2->base = iomap[CIO2_PCI_BAR]; > > + > > + pci_set_drvdata(pci_dev, cio2); > > + > > + pci_set_master(pci_dev); > > + > > + r = pci_set_dma_mask(pci_dev, CIO2_DMA_MASK); > > + if (r) { > > + dev_err(&pci_dev->dev, "failed to set DMA mask (%d)\n", r); > > + return -ENODEV; > > + } > > + > > + r = cio2_pci_config_setup(pci_dev); > > + if (r) > > + return -ENODEV; > > + > > + mutex_init(&cio2->lock); > > + > > + cio2->media_dev.dev = &cio2->pci_dev->dev; > > + strlcpy(cio2->media_dev.model, CIO2_DEVICE_NAME, > > + sizeof(cio2->media_dev.model)); > > + snprintf(cio2->media_dev.bus_info, sizeof(cio2- > >media_dev.bus_info), > > + "PCI:%s", pci_name(cio2->pci_dev)); > > + cio2->media_dev.driver_version = LINUX_VERSION_CODE; > > + cio2->media_dev.hw_revision = 0; > > + > > + media_device_init(&cio2->media_dev); > > + r = media_device_register(&cio2->media_dev); > > + if (r < 0) > > + goto fail_mutex_destroy; > > + > > + cio2->v4l2_dev.mdev = &cio2->media_dev; > > + r = v4l2_device_register(&pci_dev->dev, &cio2->v4l2_dev); > > + if (r) { > > + dev_err(&pci_dev->dev, > > + "failed to register V4L2 device (%d)\n", r); > > + goto fail_mutex_destroy; > > + } > > + > > + for (i = 0; i < CIO2_QUEUES; i++) { > > + r = cio2_queue_init(cio2, &cio2->queue[i]); > > + if (r) > > + goto fail; > > + } > > + > > + r = cio2_fbpt_init_dummy(cio2); > > + if (r) > > + goto fail; > > + > > + /* Register notifier for subdevices we care */ > > + r = cio2_notifier_init(cio2); > > + if (r) > > + goto fail; > > + > > + r = devm_request_irq(&pci_dev->dev, pci_dev->irq, cio2_irq, > > + IRQF_SHARED, CIO2_NAME, cio2); > > + if (r) { > > + dev_err(&pci_dev->dev, "failed to request IRQ (%d)\n", r); > > + goto fail; > > + } > > + > > + pm_runtime_put_noidle(&pci_dev->dev); > > + pm_runtime_allow(&pci_dev->dev); > > + > > + return 0; > > + > > +fail: > > + cio2_notifier_exit(cio2); > > + cio2_fbpt_exit_dummy(cio2); > > + for (; i >= 0; i--) > > + cio2_queue_exit(cio2, &cio2->queue[i]); > > + v4l2_device_unregister(&cio2->v4l2_dev); > > + media_device_unregister(&cio2->media_dev); > > + media_device_cleanup(&cio2->media_dev); > > +fail_mutex_destroy: > > + mutex_destroy(&cio2->lock); > > + > > + return r; > > +} > > + > > +static void cio2_pci_remove(struct pci_dev *pci_dev) > > +{ > > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > > + unsigned int i; > > + > > + cio2_notifier_exit(cio2); > > + cio2_fbpt_exit_dummy(cio2); > > + for (i = 0; i < CIO2_QUEUES; i++) > > + cio2_queue_exit(cio2, &cio2->queue[i]); > > + v4l2_device_unregister(&cio2->v4l2_dev); > > + media_device_unregister(&cio2->media_dev); > > + media_device_cleanup(&cio2->media_dev); > > + mutex_destroy(&cio2->lock); > > +} > > + > > +static int cio2_runtime_suspend(struct device *dev) > > +{ > > + struct pci_dev *pci_dev = to_pci_dev(dev); > > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > > + void __iomem *const base = cio2->base; > > + u16 pm; > > + > > + writel(CIO2_D0I3C_I3, base + CIO2_REG_D0I3C); > > + dev_dbg(dev, "cio2 runtime suspend.\n"); > > + > > + pci_read_config_word(pci_dev, pci_dev->pm_cap + > CIO2_PMCSR_OFFSET, > > + &pm); > > + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << > CIO2_PMCSR_D0D3_SHIFT; > > + pm |= CIO2_PMCSR_D3; > > + pci_write_config_word(pci_dev, pci_dev->pm_cap + > CIO2_PMCSR_OFFSET, > > + pm); > > + > > + return 0; > > +} > > + > > +static int cio2_runtime_resume(struct device *dev) > > +{ > > + struct pci_dev *pci_dev = to_pci_dev(dev); > > + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); > > + void __iomem *const base = cio2->base; > > + u16 pm; > > + > > + writel(CIO2_D0I3C_RR, base + CIO2_REG_D0I3C); > > + dev_dbg(dev, "cio2 runtime resume.\n"); > > + > > + pci_read_config_word(pci_dev, pci_dev->pm_cap + > CIO2_PMCSR_OFFSET, > > + &pm); > > + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << > CIO2_PMCSR_D0D3_SHIFT; > > + pci_write_config_word(pci_dev, pci_dev->pm_cap + > CIO2_PMCSR_OFFSET, > > + pm); > > + > > + return 0; > > +} > > + > > +static const struct dev_pm_ops cio2_pm_ops = { > > + SET_RUNTIME_PM_OPS(&cio2_runtime_suspend, > > + &cio2_runtime_resume, NULL) > > Fits on a single line. Ack. > > > +}; > > + > > +static const struct pci_device_id cio2_pci_id_table[] = { > > + { PCI_DEVICE(PCI_VENDOR_ID_INTEL, CIO2_PCI_ID) }, > > + { 0 } > > +}; > > + > > +MODULE_DEVICE_TABLE(pci, cio2_pci_id_table); > > + > > +static struct pci_driver cio2_pci_driver = { > > + .name = CIO2_NAME, > > + .id_table = cio2_pci_id_table, > > + .probe = cio2_pci_probe, > > + .remove = cio2_pci_remove, > > + .driver = { > > + .pm = &cio2_pm_ops, > > + }, > > +}; > > + > > +module_pci_driver(cio2_pci_driver); > > + > > +MODULE_AUTHOR("Tuukka Toivonen <tuukka.toivonen@intel.com>"); > > +MODULE_AUTHOR("Tianshu Qiu <tian.shu.qiu@intel.com>"); > > +MODULE_AUTHOR("Jian Xu Zheng <jian.xu.zheng@intel.com>"); > > +MODULE_AUTHOR("Yuning Pu <yuning.pu@intel.com>"); > > +MODULE_AUTHOR("Yong Zhi <yong.zhi@intel.com>"); > > +MODULE_LICENSE("GPL v2"); > > +MODULE_DESCRIPTION("IPU3 CIO2 driver"); > > diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h > b/drivers/media/pci/intel/ipu3/ipu3-cio2.h > > new file mode 100644 > > index 0000000..e33d3fc > > --- /dev/null > > +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h > > @@ -0,0 +1,442 @@ > > +/* > > + * Copyright (c) 2017 Intel Corporation. > > + * > > + * This program is free software; you can redistribute it and/or > > + * modify it under the terms of the GNU General Public License version > > + * 2 as published by the Free Software Foundation. > > + * > > + * This program is distributed in the hope that it will be useful, > > + * but WITHOUT ANY WARRANTY; without even the implied warranty of > > + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the > > + * GNU General Public License for more details. > > + */ > > + > > +#ifndef __IPU3_CIO2_H > > +#define __IPU3_CIO2_H > > + > > +#define CIO2_NAME "ipu3-cio2" > > +#define CIO2_DEVICE_NAME "Intel IPU3 > CIO2" > > +#define CIO2_ENTITY_NAME "ipu3-csi2" > > +#define CIO2_PCI_ID 0x9d32 > > +#define CIO2_PCI_BAR 0 > > +#define CIO2_DMA_MASK > DMA_BIT_MASK(39) > > +/* 1 for each sensor */ > > +#define CIO2_QUEUES 2 > > +/* 32MB = 8xFBPT_entry */ > > +#define CIO2_MAX_LOPS 8 > > +#define CIO2_MAX_BUFFERS (PAGE_SIZE / 16 / > CIO2_MAX_LOPS) > > + > > +#define CIO2_PAD_SINK 0 > > +#define CIO2_PAD_SOURCE 1 > > +#define CIO2_PADS 2 > > + > > +#define CIO2_NUM_DMA_CHAN 20 > > +#define CIO2_NUM_PORTS 4 /* DPHYs */ > > + > > +/* Register and bit field definitions */ > > +#define CIO2_REG_PIPE_BASE(n) ((n) * 0x0400) /* n = > 0..3 */ > > +#define CIO2_REG_CSIRX_BASE 0x000 > > +#define CIO2_REG_MIPIBE_BASE 0x100 > > +#define CIO2_REG_PIXELGEN_BAS 0x200 > > +#define CIO2_REG_IRQCTRL_BASE 0x300 > > +#define CIO2_REG_GPREG_BASE 0x1000 > > + > > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_CSIRX_BASE */ > > +#define CIO2_REG_CSIRX_ENABLE > (CIO2_REG_CSIRX_BASE + 0x0) > > +#define CIO2_REG_CSIRX_NOF_ENABLED_LANES > (CIO2_REG_CSIRX_BASE + 0x4) > > +#define CIO2_REG_CSIRX_SP_IF_CONFIG > (CIO2_REG_CSIRX_BASE + 0x10) > > +#define CIO2_REG_CSIRX_LP_IF_CONFIG > (CIO2_REG_CSIRX_BASE + 0x14) > > +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT 0x00 > > +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT_VC_INACTIVE 0x01 > > +#define CIO2_CSIRX_IF_CONFIG_PASS 0x02 > > +#define CIO2_CSIRX_IF_CONFIG_FLAG_ERROR BIT(2) > > +#define CIO2_REG_CSIRX_STATUS > (CIO2_REG_CSIRX_BASE + 0x18) > > +#define CIO2_REG_CSIRX_STATUS_DLANE_HS > (CIO2_REG_CSIRX_BASE + 0x1c) > > +#define CIO2_CSIRX_STATUS_DLANE_HS_MASK 0xff > > +#define CIO2_REG_CSIRX_STATUS_DLANE_LP > (CIO2_REG_CSIRX_BASE + 0x20) > > +#define CIO2_CSIRX_STATUS_DLANE_LP_MASK > 0xffffff > > +/* Termination enable and settle in 0.0625ns units, lane=0..3 or -1 for > clock */ > > +#define CIO2_REG_CSIRX_DLY_CNT_TERMEN(lane) \ > > + (CIO2_REG_CSIRX_BASE + 0x2c + 8*(lane)) > > +#define CIO2_REG_CSIRX_DLY_CNT_SETTLE(lane) \ > > + (CIO2_REG_CSIRX_BASE + 0x30 + 8*(lane)) > > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_MIPIBE_BASE */ > > +#define CIO2_REG_MIPIBE_ENABLE (CIO2_REG_MIPIBE_BASE + > 0x0) > > +#define CIO2_REG_MIPIBE_STATUS (CIO2_REG_MIPIBE_BASE + > 0x4) > > +#define CIO2_REG_MIPIBE_COMP_FORMAT(vc) \ > > + (CIO2_REG_MIPIBE_BASE + 0x8 + 0x4*(vc)) > > +#define CIO2_REG_MIPIBE_FORCE_RAW8 (CIO2_REG_MIPIBE_BASE + > 0x20) > > +#define CIO2_REG_MIPIBE_FORCE_RAW8_ENABLE BIT(0) > > +#define CIO2_REG_MIPIBE_FORCE_RAW8_USE_TYPEID BIT(1) > > +#define CIO2_REG_MIPIBE_FORCE_RAW8_TYPEID_SHIFT 2 > > + > > +#define CIO2_REG_MIPIBE_IRQ_STATUS (CIO2_REG_MIPIBE_BASE + > 0x24) > > +#define CIO2_REG_MIPIBE_IRQ_CLEAR (CIO2_REG_MIPIBE_BASE + > 0x28) > > +#define CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD > (CIO2_REG_MIPIBE_BASE + 0x68) > > +#define CIO2_MIPIBE_GLOBAL_LUT_DISREGARD 1 > > +#define CIO2_REG_MIPIBE_PKT_STALL_STATUS (CIO2_REG_MIPIBE_BASE > + 0x6c) > > +#define CIO2_REG_MIPIBE_PARSE_GSP_THROUGH_LP_LUT_REG_IDX \ > > + (CIO2_REG_MIPIBE_BASE + 0x70) > > +#define CIO2_REG_MIPIBE_SP_LUT_ENTRY(vc) \ > > + (CIO2_REG_MIPIBE_BASE + 0x74 + 4*(vc)) > > +#define CIO2_REG_MIPIBE_LP_LUT_ENTRY(m) /* m = 0..15 */ \ > > + (CIO2_REG_MIPIBE_BASE + 0x84 + > 4*(m)) > > +#define CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD 1 > > +#define CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT 1 > > +#define CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT 5 > > +#define CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT 7 > > + > > +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_IRQCTRL_BASE > */ > > +/* IRQ registers are 18-bit wide, see cio2_irq_error for bit definitions */ > > +#define CIO2_REG_IRQCTRL_EDGE (CIO2_REG_IRQCTRL_BASE + > 0x00) > > +#define CIO2_REG_IRQCTRL_MASK (CIO2_REG_IRQCTRL_BASE + > 0x04) > > +#define CIO2_REG_IRQCTRL_STATUS > (CIO2_REG_IRQCTRL_BASE + 0x08) > > +#define CIO2_REG_IRQCTRL_CLEAR (CIO2_REG_IRQCTRL_BASE + > 0x0c) > > +#define CIO2_REG_IRQCTRL_ENABLE > (CIO2_REG_IRQCTRL_BASE + 0x10) > > +#define CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE > (CIO2_REG_IRQCTRL_BASE + 0x14) > > + > > +#define CIO2_REG_GPREG_SRST (CIO2_REG_GPREG_BASE + > 0x0) > > +#define CIO2_GPREG_SRST_ALL 0xffff /* > Reset all */ > > +#define CIO2_REG_FB_HPLL_FREQ (CIO2_REG_GPREG_BASE + > 0x08) > > +#define CIO2_REG_ISCLK_RATIO (CIO2_REG_GPREG_BASE + > 0xc) > > + > > +#define CIO2_REG_CGC 0x1400 > > +#define CIO2_CGC_CSI2_TGE BIT(0) > > +#define CIO2_CGC_PRIM_TGE BIT(1) > > +#define CIO2_CGC_SIDE_TGE BIT(2) > > +#define CIO2_CGC_XOSC_TGE BIT(3) > > +#define CIO2_CGC_MPLL_SHUTDOWN_EN BIT(4) > > +#define CIO2_CGC_D3I3_TGE BIT(5) > > +#define CIO2_CGC_CSI2_INTERFRAME_TGE BIT(6) > > +#define CIO2_CGC_CSI2_PORT_DCGE BIT(8) > > +#define CIO2_CGC_CSI2_DCGE BIT(9) > > +#define CIO2_CGC_SIDE_DCGE BIT(10) > > +#define CIO2_CGC_PRIM_DCGE BIT(11) > > +#define CIO2_CGC_ROSC_DCGE BIT(12) > > +#define CIO2_CGC_XOSC_DCGE BIT(13) > > +#define CIO2_CGC_FLIS_DCGE BIT(14) > > +#define CIO2_CGC_CLKGATE_HOLDOFF_SHIFT 20 > > +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT 24 > > +#define CIO2_REG_D0I3C 0x1408 > > +#define CIO2_D0I3C_I3 BIT(2) /* Set > D0I3 */ > > +#define CIO2_D0I3C_RR BIT(3) /* > Restore? */ > > +#define CIO2_REG_SWRESET 0x140c > > +#define CIO2_SWRESET_SWRESET 1 > > +#define CIO2_REG_SENSOR_ACTIVE 0x1410 > > +#define CIO2_REG_INT_STS 0x1414 > > +#define CIO2_REG_INT_STS_EXT_OE 0x1418 > > +#define CIO2_INT_EXT_OE_DMAOE_SHIFT 0 > > +#define CIO2_INT_EXT_OE_DMAOE_MASK 0x7ffff > > +#define CIO2_INT_EXT_OE_OES_SHIFT 24 > > +#define CIO2_INT_EXT_OE_OES_MASK (0xf << > CIO2_INT_EXT_OE_OES_SHIFT) > > +#define CIO2_REG_INT_EN 0x1420 > > +#define CIO2_REG_INT_EN_IRQ (1 << 24) > > +#define CIO2_REG_INT_EN_IOS(dma) (1 << (((dma) >> 1) + 12)) > > +/* > > + * Interrupt on completion bit, Eg. DMA 0-3 maps to bit 0-3, > > + * DMA4 & DMA5 map to bit 4 ... DMA18 & DMA19 map to bit 11 Et cetera > > + */ > > +#define CIO2_INT_IOC(dma) (1 << ((dma) < 4 ? (dma) : ((dma) >> 1) + 2)) > > +#define CIO2_INT_IOC_SHIFT 0 > > +#define CIO2_INT_IOC_MASK (0x7ff << > CIO2_INT_IOC_SHIFT) > > +#define CIO2_INT_IOS_IOLN(dma) (1 << (((dma) >> 1) + 12)) > > +#define CIO2_INT_IOS_IOLN_SHIFT 12 > > +#define CIO2_INT_IOS_IOLN_MASK (0x3ff << > CIO2_INT_IOS_IOLN_SHIFT) > > +#define CIO2_INT_IOIE BIT(22) > > +#define CIO2_INT_IOOE BIT(23) > > +#define CIO2_INT_IOIRQ BIT(24) > > +#define CIO2_REG_INT_EN_EXT_OE 0x1424 > > +#define CIO2_REG_DMA_DBG 0x1448 > > +#define CIO2_REG_DMA_DBG_DMA_INDEX_SHIFT 0 > > +#define CIO2_REG_PBM_ARB_CTRL 0x1460 > > +#define CIO2_PBM_ARB_CTRL_LANES_DIV 0 /* 4-4-2-2 > lanes */ > > +#define CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT 0 > > +#define CIO2_PBM_ARB_CTRL_LE_EN BIT(7) > > +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN 2 > > +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT 8 > > +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP 480 > > +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT 16 > > +#define CIO2_REG_PBM_WMCTRL1 0x1464 > > +#define CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT 0 > > +#define CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT 8 > > +#define CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT 16 > > +#define CIO2_PBM_WMCTRL1_TS_COUNT_DISABLE BIT(31) > > +#define CIO2_PBM_WMCTRL1_MIN_2CK (4 << > CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT) > > +#define CIO2_PBM_WMCTRL1_MID1_2CK (16 << > CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT) > > +#define CIO2_PBM_WMCTRL1_MID2_2CK (21 << > CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT) > > +#define CIO2_REG_PBM_WMCTRL2 0x1468 > > +#define CIO2_PBM_WMCTRL2_HWM_2CK 48 > > +#define CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT 0 > > +#define CIO2_PBM_WMCTRL2_LWM_2CK 22 > > +#define CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT 8 > > +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK 2 > > +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT 16 > > +#define CIO2_PBM_WMCTRL2_TRANSDYN 1 > > +#define CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT 24 > > +#define CIO2_PBM_WMCTRL2_DYNWMEN BIT(28) > > +#define CIO2_PBM_WMCTRL2_OBFF_MEM_EN > BIT(29) > > +#define CIO2_PBM_WMCTRL2_OBFF_CPU_EN > BIT(30) > > +#define CIO2_PBM_WMCTRL2_DRAINNOW BIT(31) > > +#define CIO2_REG_PBM_TS_COUNT 0x146c > > +#define CIO2_REG_PBM_FOPN_ABORT > 0x1474 > > +/* below n = 0..3 */ > > +#define CIO2_PBM_FOPN_ABORT(n) (0x1 > << 8*(n)) > > +#define CIO2_PBM_FOPN_FORCE_ABORT(n) (0x2 << 8*(n)) > > +#define CIO2_PBM_FOPN_FRAMEOPEN(n) (0x8 << 8*(n)) > > +#define CIO2_REG_LTRCTRL 0x1480 > > +#define CIO2_LTRCTRL_LTRDYNEN BIT(16) > > +#define CIO2_LTRCTRL_LTRSTABLETIME_SHIFT 8 > > +#define CIO2_LTRCTRL_LTRSTABLETIME_MASK 0xff > > +#define CIO2_LTRCTRL_LTRSEL1S3 BIT(7) > > +#define CIO2_LTRCTRL_LTRSEL1S2 BIT(6) > > +#define CIO2_LTRCTRL_LTRSEL1S1 BIT(5) > > +#define CIO2_LTRCTRL_LTRSEL1S0 BIT(4) > > +#define CIO2_LTRCTRL_LTRSEL2S3 BIT(3) > > +#define CIO2_LTRCTRL_LTRSEL2S2 BIT(2) > > +#define CIO2_LTRCTRL_LTRSEL2S1 BIT(1) > > +#define CIO2_LTRCTRL_LTRSEL2S0 BIT(0) > > +#define CIO2_REG_LTRVAL23 0x1484 > > +#define CIO2_REG_LTRVAL01 0x1488 > > +#define CIO2_LTRVAL02_VAL_SHIFT 0 > > +#define CIO2_LTRVAL02_SCALE_SHIFT 10 > > +#define CIO2_LTRVAL13_VAL_SHIFT 16 > > +#define CIO2_LTRVAL13_SCALE_SHIFT 26 > > + > > +#define CIO2_REG_CDMABA(n) (0x1500 + 0x10*(n)) /* n = > 0..19 */ > > +#define CIO2_REG_CDMARI(n) (0x1504 + 0x10*(n)) > > +#define CIO2_CDMARI_FBPT_RP_SHIFT 0 > > +#define CIO2_CDMARI_FBPT_RP_MASK 0xff > > +#define CIO2_REG_CDMAC0(n) (0x1508 + 0x10*(n)) > > +#define CIO2_CDMAC0_FBPT_LEN_SHIFT 0 > > +#define CIO2_CDMAC0_FBPT_WIDTH_SHIFT 8 > > +#define CIO2_CDMAC0_FBPT_NS BIT(25) > > +#define CIO2_CDMAC0_DMA_INTR_ON_FS BIT(26) > > +#define CIO2_CDMAC0_DMA_INTR_ON_FE BIT(27) > > +#define CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL BIT(28) > > +#define CIO2_CDMAC0_FBPT_FIFO_FULL_FIX_DIS BIT(29) > > +#define CIO2_CDMAC0_DMA_EN BIT(30) > > +#define CIO2_CDMAC0_DMA_HALTED > BIT(31) > > +#define CIO2_REG_CDMAC1(n) (0x150c + 0x10*(n)) > > +#define CIO2_CDMAC1_LINENUMINT_SHIFT 0 > > +#define CIO2_CDMAC1_LINENUMUPDATE_SHIFT 16 > > +/* n = 0..3 */ > > +#define CIO2_REG_PXM_PXF_FMT_CFG0(n) (0x1700 + 0x30*(n)) > > +#define CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT 0 > > +#define CIO2_PXM_PXF_FMT_CFG_SID1_SHIFT 16 > > +#define CIO2_PXM_PXF_FMT_CFG_PCK_64B (0 << 0) > > +#define CIO2_PXM_PXF_FMT_CFG_PCK_32B (1 << 0) > > +#define CIO2_PXM_PXF_FMT_CFG_BPP_08 (0 << 2) > > +#define CIO2_PXM_PXF_FMT_CFG_BPP_10 (1 << 2) > > +#define CIO2_PXM_PXF_FMT_CFG_BPP_12 (2 << 2) > > +#define CIO2_PXM_PXF_FMT_CFG_BPP_14 (3 << 2) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_4PPC (0 << > 4) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_RGBA (1 << > 4) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_ARGB (2 << > 4) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR2 (3 << 4) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR3 (4 << 4) > > +#define CIO2_PXM_PXF_FMT_CFG_SPEC_NV16 (5 << > 4) > > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_AB (1 << > 7) > > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_CD (1 << > 8) > > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_AC (1 << > 9) > > +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_BD (1 << > 10) > > +#define CIO2_REG_INT_STS_EXT_IE 0x17e4 > > +#define CIO2_REG_INT_EN_EXT_IE 0x17e8 > > +#define CIO2_INT_EXT_IE_ECC_RE(n) (0x01 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_DPHY_NR(n) (0x02 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_ECC_NR(n) (0x04 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_CRCERR(n) (0x08 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_INTERFRAMEDATA(n) (0x10 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_PKT2SHORT(n) (0x20 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_PKT2LONG(n) (0x40 << (8 * > (n))) > > +#define CIO2_INT_EXT_IE_IRQ(n) (0x80 << (8 * > (n))) > > +#define CIO2_REG_PXM_FRF_CFG(n) > (0x1720 + 0x30*(n)) > > +#define CIO2_PXM_FRF_CFG_FNSEL BIT(0) > > +#define CIO2_PXM_FRF_CFG_FN_RST BIT(1) > > +#define CIO2_PXM_FRF_CFG_ABORT BIT(2) > > +#define CIO2_PXM_FRF_CFG_CRC_TH_SHIFT 3 > > +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR BIT(8) > > +#define CIO2_PXM_FRF_CFG_MSK_ECC_RE BIT(9) > > +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE BIT(10) > > +#define CIO2_PXM_FRF_CFG_EVEN_ODD_MODE_SHIFT 11 > > +#define CIO2_PXM_FRF_CFG_MASK_CRC_THRES > BIT(13) > > +#define CIO2_PXM_FRF_CFG_MASK_CSI_ACCEPT BIT(14) > > +#define CIO2_PXM_FRF_CFG_CIOHC_FS_MODE > BIT(15) > > +#define CIO2_PXM_FRF_CFG_CIOHC_FRST_FRM_SHIFT 16 > > +#define CIO2_REG_PXM_SID2BID0(n) (0x1724 + > 0x30*(n)) > > +#define CIO2_FB_HPLL_FREQ 0x2 > > +#define CIO2_ISCLK_RATIO 0xc > > + > > +#define CIO2_IRQCTRL_MASK 0x3ffff > > + > > +#define CIO2_INT_EN_EXT_OE_MASK > 0x8f0fffff > > + > > +#define CIO2_CGC_CLKGATE_HOLDOFF 3 > > +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF 5 > > + > > +#define CIO2_LTRVAL0_VAL 500 > > +/* Value times 1024 ns */ > > +#define CIO2_LTRVAL0_SCALE 2 > > +#define CIO2_LTRVAL1_VAL 90 > > +#define CIO2_LTRVAL1_SCALE 2 > > +#define CIO2_LTRVAL2_VAL 90 > > +#define CIO2_LTRVAL2_SCALE 2 > > +#define CIO2_LTRVAL3_VAL 90 > > +#define CIO2_LTRVAL3_SCALE 2 > > + > > +#define CIO2_PXM_FRF_CFG_CRC_TH 16 > > + > > +#define CIO2_INT_EN_EXT_IE_MASK > 0xffffffff > > + > > +#define CIO2_DMA_CHAN 0 > > + > > +#define CIO2_CSIRX_DLY_CNT_CLANE_IDX -1 > > + > > +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A 0 > > +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B 0 > > +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A 95 > > +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B -8 > > + > > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A 0 > > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B 0 > > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A 85 > > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B -2 > > + > > +#define CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT 0x4 > > +#define CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT 0x570 > > + > > +#define CIO2_PMCSR_OFFSET 4 > > +#define CIO2_PMCSR_D0D3_SHIFT 2 > > +#define CIO2_PMCSR_D3 0x3 > > + > > +struct cio2_csi2_timing { > > + s32 clk_termen; > > + s32 clk_settle; > > + s32 dat_termen; > > + s32 dat_settle; > > +}; > > + > > +struct cio2_buffer { > > + struct vb2_v4l2_buffer vbb; > > + u32 *lop[CIO2_MAX_LOPS]; > > + dma_addr_t lop_bus_addr[CIO2_MAX_LOPS]; > > +}; > > + > > +struct csi2_bus_info { > > + u32 port; > > + u32 num_of_lanes; > > +}; > > + > > +struct cio2_queue { > > + /* mutex to be used by vb2_queue */ > > + struct mutex lock; > > + struct media_pipeline pipe; > > + struct csi2_bus_info csi2; > > + struct v4l2_subdev *sensor; > > + void __iomem *csi_rx_base; > > + > > + /* Subdev, /dev/v4l-subdevX */ > > + struct v4l2_subdev subdev; > > + struct media_pad subdev_pads[CIO2_PADS]; > > + struct v4l2_mbus_framefmt subdev_fmt; > > + atomic_t frame_sequence; > > + > > + /* Video device, /dev/videoX */ > > + struct video_device vdev; > > + struct media_pad vdev_pad; > > + struct v4l2_pix_format format; > > + struct vb2_queue vbq; > > + > > + /* Buffer queue handling */ > > + struct cio2_fbpt_entry *fbpt; /* Frame buffer pointer table */ > > + dma_addr_t fbpt_bus_addr; > > + struct cio2_buffer *bufs[CIO2_MAX_BUFFERS]; > > + unsigned int bufs_first; /* Index of the first used entry */ > > + unsigned int bufs_next; /* Index of the first unused entry */ > > + atomic_t bufs_queued; > > +}; > > + > > +struct cio2_device { > > + struct pci_dev *pci_dev; > > + void __iomem *base; > > + struct v4l2_device v4l2_dev; > > + struct cio2_queue queue[CIO2_QUEUES]; > > + struct cio2_queue *cur_queue; > > + /* mutex to be used by video_device */ > > + struct mutex lock; > > + > > + struct v4l2_async_notifier notifier; > > + struct media_device media_dev; > > + > > + /* > > + * Safety net to catch DMA fetch ahead > > + * when reaching the end of LOP > > + */ > > + void *dummy_page; > > + /* DMA handle of dummy_page */ > > + dma_addr_t dummy_page_bus_addr; > > + /* single List of Pointers (LOP) page */ > > + u32 *dummy_lop; > > + /* DMA handle of dummy_lop */ > > + dma_addr_t dummy_lop_bus_addr; > > +}; > > + > > +/**************** Virtual channel ****************/ > > +/* > > + * This should come from sensor driver. No > > + * driver interface nor requirement yet. > > + */ > > +#define SENSOR_VIR_CH_DFLT 0 > > + > > +/**************** FBPT operations ****************/ > > +#define CIO2_FBPT_SIZE (CIO2_MAX_BUFFERS * > CIO2_MAX_LOPS * \ > > + sizeof(struct cio2_fbpt_entry)) > > + > > +#define CIO2_FBPT_SUBENTRY_UNIT 4 > > +#define CIO2_PAGE_SIZE PAGE_SIZE > > + > > +/* > > + * Frame Buffer Pointer Table(FBPT) entry > > + * each entry describe an output buffer and consists of > > + * several sub-entries > > + */ > > +struct __packed cio2_fbpt_entry { > > + union { > > + struct __packed { > > + u32 ctrl; /* status ctrl */ > > +#define CIO2_FBPT_CTRL_VALID BIT(0) > > +#define CIO2_FBPT_CTRL_IOC BIT(1) > > +#define CIO2_FBPT_CTRL_IOS BIT(2) > > +#define CIO2_FBPT_CTRL_SUCCXFAIL BIT(3) > > +#define CIO2_FBPT_CTRL_CMPLCODE_SHIFT 4 > > + u16 cur_line_num; /* current line # written to DDR */ > > + u16 frame_num; /* updated by DMA upon FE */ > > + u32 first_page_offset; /* offset for 1st page in LOP */ > > + } first_entry; > > + /* Second entry per buffer */ > > + struct __packed { > > + u32 timestamp; > > + u32 num_of_bytes; > > + /* the number of bytes for write on last page */ > > + u16 last_page_available_bytes; > > + /* the number of pages allocated for this buf */ > > + u16 num_of_pages; > > + } second_entry; > > + struct __packed { > > + u64 __reserved1; > > + u32 __reserved0; > > + } other_entries; > > + }; > > + u32 lop_page_addr; /* Points to list of pointers (LOP) table */ > > +}; > > + > > +static inline struct cio2_queue *file_to_cio2_queue(struct file *file) > > +{ > > + return container_of(video_devdata(file), struct cio2_queue, vdev); > > +} > > + > > +static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue > *vq) > > +{ > > + return container_of(vq, struct cio2_queue, vbq); > > +} > > + > > +#endif > > -- > Kind regards, > > Sakari Ailus > e-mail: sakari.ailus@iki.fi XMPP: sailus@retiisi.org.uk
diff --git a/drivers/media/pci/Kconfig b/drivers/media/pci/Kconfig index da28e68..5932e22 100644 --- a/drivers/media/pci/Kconfig +++ b/drivers/media/pci/Kconfig @@ -54,5 +54,7 @@ source "drivers/media/pci/smipcie/Kconfig" source "drivers/media/pci/netup_unidvb/Kconfig" endif +source "drivers/media/pci/intel/ipu3/Kconfig" + endif #MEDIA_PCI_SUPPORT endif #PCI diff --git a/drivers/media/pci/Makefile b/drivers/media/pci/Makefile index a7e8af0..d8f9843 100644 --- a/drivers/media/pci/Makefile +++ b/drivers/media/pci/Makefile @@ -13,7 +13,8 @@ obj-y += ttpci/ \ ddbridge/ \ saa7146/ \ smipcie/ \ - netup_unidvb/ + netup_unidvb/ \ + intel/ obj-$(CONFIG_VIDEO_IVTV) += ivtv/ obj-$(CONFIG_VIDEO_ZORAN) += zoran/ diff --git a/drivers/media/pci/intel/Makefile b/drivers/media/pci/intel/Makefile new file mode 100644 index 0000000..745c8b2 --- /dev/null +++ b/drivers/media/pci/intel/Makefile @@ -0,0 +1,5 @@ +# +# Makefile for the IPU3 cio2 and ImGU drivers +# + +obj-y += ipu3/ diff --git a/drivers/media/pci/intel/ipu3/Kconfig b/drivers/media/pci/intel/ipu3/Kconfig new file mode 100644 index 0000000..2a895d6 --- /dev/null +++ b/drivers/media/pci/intel/ipu3/Kconfig @@ -0,0 +1,17 @@ +config VIDEO_IPU3_CIO2 + tristate "Intel ipu3-cio2 driver" + depends on VIDEO_V4L2 && PCI + depends on MEDIA_CONTROLLER + depends on HAS_DMA + depends on ACPI + select V4L2_FWNODE + select VIDEOBUF2_DMA_SG + + ---help--- + This is the Intel IPU3 CIO2 CSI-2 receiver unit, found in Intel + Skylake and Kaby Lake SoCs and used for capturing images and + video from a camera sensor. + + Say Y or M here if you have a Skylake/Kaby Lake SoC with MIPI CSI-2 + connected camera. + The module will be called ipu3-cio2. diff --git a/drivers/media/pci/intel/ipu3/Makefile b/drivers/media/pci/intel/ipu3/Makefile new file mode 100644 index 0000000..20186e3 --- /dev/null +++ b/drivers/media/pci/intel/ipu3/Makefile @@ -0,0 +1 @@ +obj-$(CONFIG_VIDEO_IPU3_CIO2) += ipu3-cio2.o diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.c b/drivers/media/pci/intel/ipu3/ipu3-cio2.c new file mode 100644 index 0000000..8ecb17f --- /dev/null +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.c @@ -0,0 +1,1873 @@ +/* + * Copyright (c) 2017 Intel Corporation. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License version + * 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * Based partially on Intel IPU4 driver written by + * Sakari Ailus <sakari.ailus@linux.intel.com> + * Samu Onkalo <samu.onkalo@intel.com> + * Jouni Högander <jouni.hogander@intel.com> + * Jouni Ukkonen <jouni.ukkonen@intel.com> + * Antti Laakso <antti.laakso@intel.com> + * et al. + * + */ + +#include <linux/delay.h> +#include <linux/interrupt.h> +#include <linux/module.h> +#include <linux/pci.h> +#include <linux/pm_runtime.h> +#include <linux/property.h> +#include <linux/vmalloc.h> +#include <media/v4l2-ctrls.h> +#include <media/v4l2-device.h> +#include <media/v4l2-event.h> +#include <media/v4l2-fwnode.h> +#include <media/v4l2-ioctl.h> +#include <media/videobuf2-dma-sg.h> + +#include "ipu3-cio2.h" + +/* + * These are raw formats used in Intel's third generation of + * Image Processing Unit known as IPU3. + * 10bit raw bayer packed, 32 bytes for every 25 pixels, + * last LSB 6 bits unused. + */ +static const u32 cio2_csi2_fmts[] = { + V4L2_PIX_FMT_IPU3_SRGGB10, + V4L2_PIX_FMT_IPU3_SGBRG10, + V4L2_PIX_FMT_IPU3_SGRBG10, + V4L2_PIX_FMT_IPU3_SBGGR10, +}; + +static inline u32 cio2_bytesperline(const unsigned int width) +{ + /* + * 64 bytes for every 50 pixels, the line length + * in bytes is multiple of 64 (line end alignment). + */ + return DIV_ROUND_UP(width, 50) * 64; +} + +/**************** FBPT operations ****************/ + +static void cio2_fbpt_exit_dummy(struct cio2_device *cio2) +{ + if (cio2->dummy_lop) { + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, + cio2->dummy_lop, cio2->dummy_lop_bus_addr); + cio2->dummy_lop = NULL; + } + if (cio2->dummy_page) { + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, + cio2->dummy_page, cio2->dummy_page_bus_addr); + cio2->dummy_page = NULL; + } +} + +static int cio2_fbpt_init_dummy(struct cio2_device *cio2) +{ + unsigned int i; + + cio2->dummy_page = dma_alloc_coherent(&cio2->pci_dev->dev, + CIO2_PAGE_SIZE, &cio2->dummy_page_bus_addr, + GFP_KERNEL); + cio2->dummy_lop = dma_alloc_coherent(&cio2->pci_dev->dev, + CIO2_PAGE_SIZE, &cio2->dummy_lop_bus_addr, + GFP_KERNEL); + if (!cio2->dummy_page || !cio2->dummy_lop) { + cio2_fbpt_exit_dummy(cio2); + return -ENOMEM; + } + /* + * List of Pointers(LOP) contains 1024x32b pointers to 4KB page each + * Initialize each entry to dummy_page bus base address. + */ + for (i = 0; i < CIO2_PAGE_SIZE / sizeof(*cio2->dummy_lop); i++) + cio2->dummy_lop[i] = cio2->dummy_page_bus_addr >> PAGE_SHIFT; + + return 0; +} + +static void cio2_fbpt_entry_enable(struct cio2_device *cio2, + struct cio2_fbpt_entry entry[CIO2_MAX_LOPS]) +{ + /* + * The CPU first initializes some fields in fbpt, then sets + * the VALID bit, this barrier is to ensure that the DMA(device) + * does not see the VALID bit enabled before other fields are + * initialized; otherwise it could lead to havoc. + */ + dma_wmb(); + + /* + * Request interrupts for start and completion + * Valid bit is applicable only to 1st entry + */ + entry[0].first_entry.ctrl = CIO2_FBPT_CTRL_VALID | + CIO2_FBPT_CTRL_IOC | CIO2_FBPT_CTRL_IOS; +} + +/* Initialize fpbt entries to point to dummy frame */ +static void cio2_fbpt_entry_init_dummy(struct cio2_device *cio2, + struct cio2_fbpt_entry + entry[CIO2_MAX_LOPS]) +{ + unsigned int i; + + entry[0].first_entry.first_page_offset = 0; + entry[1].second_entry.num_of_pages = + CIO2_PAGE_SIZE / sizeof(u32) * CIO2_MAX_LOPS; + entry[1].second_entry.last_page_available_bytes = CIO2_PAGE_SIZE - 1; + + for (i = 0; i < CIO2_MAX_LOPS; i++) + entry[i].lop_page_addr = cio2->dummy_lop_bus_addr >> PAGE_SHIFT; + + cio2_fbpt_entry_enable(cio2, entry); +} + +/* Initialize fpbt entries to point to a given buffer */ +static void cio2_fbpt_entry_init_buf(struct cio2_device *cio2, + struct cio2_buffer *b, + struct cio2_fbpt_entry + entry[CIO2_MAX_LOPS]) +{ + struct vb2_buffer *vb = &b->vbb.vb2_buf; + unsigned int length = vb->planes[0].length; + int remaining, i; + + entry[0].first_entry.first_page_offset = + offset_in_page(vb2_plane_vaddr(vb, 0)); + remaining = length + entry[0].first_entry.first_page_offset; + entry[1].second_entry.num_of_pages = + DIV_ROUND_UP(remaining, CIO2_PAGE_SIZE); + /* + * last_page_available_bytes has the offset of the last byte in the + * last page which is still accessible by DMA. DMA cannot access + * beyond this point. Valid range for this is from 0 to 4095. + * 0 indicates 1st byte in the page is DMA accessible. + * 4095 (CIO2_PAGE_SIZE - 1) means every single byte in the last page + * is available for DMA transfer. + */ + entry[1].second_entry.last_page_available_bytes = + (remaining & ~PAGE_MASK) ? + (remaining & ~PAGE_MASK) - 1 : + CIO2_PAGE_SIZE - 1; + /* Fill FBPT */ + remaining = length; + i = 0; + while (remaining > 0) { + entry->lop_page_addr = b->lop_bus_addr[i] >> PAGE_SHIFT; + remaining -= CIO2_PAGE_SIZE / sizeof(u32) * CIO2_PAGE_SIZE; + entry++; + i++; + } + + /* + * The first not meaningful FBPT entry should point to a valid LOP + */ + entry->lop_page_addr = cio2->dummy_lop_bus_addr >> PAGE_SHIFT; + + cio2_fbpt_entry_enable(cio2, entry); +} + +static int cio2_fbpt_init(struct cio2_device *cio2, struct cio2_queue *q) +{ + struct device *dev = &cio2->pci_dev->dev; + + q->fbpt = dma_alloc_coherent(dev, CIO2_FBPT_SIZE, + &q->fbpt_bus_addr, GFP_KERNEL); + if (!q->fbpt) + return -ENOMEM; + + memset(q->fbpt, 0, CIO2_FBPT_SIZE); + + return 0; +} + +static void cio2_fbpt_exit(struct cio2_queue *q, struct device *dev) +{ + dma_free_coherent(dev, CIO2_FBPT_SIZE, q->fbpt, q->fbpt_bus_addr); +} + +/**************** CSI2 hardware setup ****************/ + +/* + * The CSI2 receiver has several parameters affecting + * the receiver timings. These depend on the MIPI bus frequency + * F in Hz (sensor transmitter rate) as follows: + * register value = (A/1e9 + B * UI) / COUNT_ACC + * where + * UI = 1 / (2 * F) in seconds + * COUNT_ACC = counter accuracy in seconds + * For IPU3 COUNT_ACC = 0.0625 + * + * A and B are coefficients from the table below, + * depending whether the register minimum or maximum value is + * calculated. + * Minimum Maximum + * Clock lane A B A B + * reg_rx_csi_dly_cnt_termen_clane 0 0 38 0 + * reg_rx_csi_dly_cnt_settle_clane 95 -8 300 -16 + * Data lanes + * reg_rx_csi_dly_cnt_termen_dlane0 0 0 35 4 + * reg_rx_csi_dly_cnt_settle_dlane0 85 -2 145 -6 + * reg_rx_csi_dly_cnt_termen_dlane1 0 0 35 4 + * reg_rx_csi_dly_cnt_settle_dlane1 85 -2 145 -6 + * reg_rx_csi_dly_cnt_termen_dlane2 0 0 35 4 + * reg_rx_csi_dly_cnt_settle_dlane2 85 -2 145 -6 + * reg_rx_csi_dly_cnt_termen_dlane3 0 0 35 4 + * reg_rx_csi_dly_cnt_settle_dlane3 85 -2 145 -6 + * + * We use the minimum values of both A and B. + */ + +/* + * shift for keeping value range suitable for 32-bit integer arithmetics + */ +#define LIMIT_SHIFT 8 + +static int cio2_rx_timing(s32 a, s32 b, s64 freq, int def) +{ + const u32 accinv = 16; /* invert of counter resolution */ + const u32 uiinv = 500000000; /* 1/2 * 1/1e9 */ + int r; + + freq >>= LIMIT_SHIFT; + + if (WARN_ON(freq <= 0 || freq > S32_MAX)) + return def; + /* + * b could be 0, -2 or -8, so |accinv * b| is always + * less than (1 << ds) and thus |r| < 500000000. + */ + r = accinv * b * (uiinv >> LIMIT_SHIFT); + r = (s32) r / freq; + /* max value of a is 95 */ + r += accinv * a; + + return r; +}; + +/* Calculate the the delay value for termination enable of clock lane HS Rx */ +static int cio2_csi2_calc_timing(struct cio2_device *cio2, struct cio2_queue *q, + struct cio2_csi2_timing *timing) +{ + struct device *dev = &cio2->pci_dev->dev; + struct v4l2_querymenu qm = {.id = V4L2_CID_LINK_FREQ, }; + struct v4l2_ctrl *link_freq; + s64 freq; + int r; + + if (!q->sensor) + return -ENODEV; + + link_freq = v4l2_ctrl_find(q->sensor->ctrl_handler, + V4L2_CID_LINK_FREQ); + if (!link_freq) { + dev_err(dev, "failed to find LINK_FREQ\n"); + return -EPIPE; + }; + + qm.index = v4l2_ctrl_g_ctrl(link_freq); + r = v4l2_querymenu(q->sensor->ctrl_handler, &qm); + if (r) { + dev_err(dev, "failed to get menu item\n"); + return r; + } + + if (!qm.value) { + dev_err(dev, "error invalid link_freq\n"); + return -EINVAL; + } + freq = qm.value; + + timing->clk_termen = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A, + CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B, freq, + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); + timing->clk_settle = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A, + CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B, freq, + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); + timing->dat_termen = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A, + CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B, freq, + CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT); + timing->dat_settle = cio2_rx_timing(CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A, + CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B, freq, + CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT); + + dev_dbg(dev, "freq ct value is %d\n", timing->clk_termen); + dev_dbg(dev, "freq cs value is %d\n", timing->clk_settle); + dev_dbg(dev, "freq dt value is %d\n", timing->dat_termen); + dev_dbg(dev, "freq ds value is %d\n", timing->dat_settle); + + return 0; +}; + +static int cio2_hw_mbus_to_mipicode(__u32 code, u8 *mipicode) +{ + static const struct { + u32 mbuscode; + u8 mipicode; + } mbus2mipi[] = { + { MEDIA_BUS_FMT_SBGGR10_1X10, 0x2b }, + { MEDIA_BUS_FMT_SGBRG10_1X10, 0x2b }, + { MEDIA_BUS_FMT_SGRBG10_1X10, 0x2b }, + { MEDIA_BUS_FMT_SRGGB10_1X10, 0x2b }, + }; + unsigned int i; + + for (i = 0; i < ARRAY_SIZE(mbus2mipi); i++) + if (mbus2mipi[i].mbuscode == code) { + *mipicode = mbus2mipi[i].mipicode; + return 0; + } + + return -EINVAL; +} + +static int cio2_hw_init(struct cio2_device *cio2, struct cio2_queue *q) +{ + static const int NUM_VCS = 4; + static const int SID; /* Stream id */ + static const int ENTRY; + static const int FBPT_WIDTH = DIV_ROUND_UP(CIO2_MAX_LOPS, + CIO2_FBPT_SUBENTRY_UNIT); + const u32 num_buffers1 = CIO2_MAX_BUFFERS - 1; + void __iomem *const base = cio2->base; + u8 mipicode, lanes, csi2bus = q->csi2.port; + u8 sensor_vc = SENSOR_VIR_CH_DFLT; + struct cio2_csi2_timing timing; + int i, r; + + r = cio2_hw_mbus_to_mipicode(q->subdev_fmt.code, &mipicode); + if (r < 0) + return r; + + lanes = q->csi2.num_of_lanes; + + r = cio2_csi2_calc_timing(cio2, q, &timing); + if (r) + return r; + + writel(timing.clk_termen, q->csi_rx_base + + CIO2_REG_CSIRX_DLY_CNT_TERMEN(CIO2_CSIRX_DLY_CNT_CLANE_IDX)); + writel(timing.clk_settle, q->csi_rx_base + + CIO2_REG_CSIRX_DLY_CNT_SETTLE(CIO2_CSIRX_DLY_CNT_CLANE_IDX)); + + for (i = 0; i < lanes; i++) { + writel(timing.dat_termen, q->csi_rx_base + + CIO2_REG_CSIRX_DLY_CNT_TERMEN(i)); + writel(timing.dat_settle, q->csi_rx_base + + CIO2_REG_CSIRX_DLY_CNT_SETTLE(i)); + } + + writel(CIO2_PBM_WMCTRL1_MIN_2CK | + CIO2_PBM_WMCTRL1_MID1_2CK | + CIO2_PBM_WMCTRL1_MID2_2CK, base + CIO2_REG_PBM_WMCTRL1); + writel(CIO2_PBM_WMCTRL2_HWM_2CK << CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT | + CIO2_PBM_WMCTRL2_LWM_2CK << CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT | + CIO2_PBM_WMCTRL2_OBFFWM_2CK << + CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT | + CIO2_PBM_WMCTRL2_TRANSDYN << CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT | + CIO2_PBM_WMCTRL2_OBFF_MEM_EN, base + CIO2_REG_PBM_WMCTRL2); + writel(CIO2_PBM_ARB_CTRL_LANES_DIV << + CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT | + CIO2_PBM_ARB_CTRL_LE_EN | + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN << + CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT | + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP << + CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT, + base + CIO2_REG_PBM_ARB_CTRL); + writel(CIO2_CSIRX_STATUS_DLANE_HS_MASK, + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_HS); + writel(CIO2_CSIRX_STATUS_DLANE_LP_MASK, + q->csi_rx_base + CIO2_REG_CSIRX_STATUS_DLANE_LP); + + writel(CIO2_FB_HPLL_FREQ, base + CIO2_REG_FB_HPLL_FREQ); + writel(CIO2_ISCLK_RATIO, base + CIO2_REG_ISCLK_RATIO); + + /* Configure MIPI backend */ + for (i = 0; i < NUM_VCS; i++) + writel(1, q->csi_rx_base + CIO2_REG_MIPIBE_SP_LUT_ENTRY(i)); + + /* There are 16 short packet LUT entry */ + for (i = 0; i < 16; i++) + writel(CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD, + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(i)); + writel(CIO2_MIPIBE_GLOBAL_LUT_DISREGARD, + q->csi_rx_base + CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD); + + writel(CIO2_INT_EN_EXT_IE_MASK, base + CIO2_REG_INT_EN_EXT_IE); + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_MASK); + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_ENABLE); + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_EDGE); + writel(0, q->csi_rx_base + CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE); + writel(CIO2_INT_EN_EXT_OE_MASK, base + CIO2_REG_INT_EN_EXT_OE); + + writel(CIO2_REG_INT_EN_IRQ | CIO2_INT_IOC(CIO2_DMA_CHAN) | + CIO2_REG_INT_EN_IOS(CIO2_DMA_CHAN), + base + CIO2_REG_INT_EN); + + writel((CIO2_PXM_PXF_FMT_CFG_BPP_10 | CIO2_PXM_PXF_FMT_CFG_PCK_64B) + << CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT, + base + CIO2_REG_PXM_PXF_FMT_CFG0(csi2bus)); + writel(SID << CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT | + sensor_vc << CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT | + mipicode << CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT, + q->csi_rx_base + CIO2_REG_MIPIBE_LP_LUT_ENTRY(ENTRY)); + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_COMP_FORMAT(sensor_vc)); + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_FORCE_RAW8); + writel(0, base + CIO2_REG_PXM_SID2BID0(csi2bus)); + + writel(lanes, q->csi_rx_base + CIO2_REG_CSIRX_NOF_ENABLED_LANES); + writel(CIO2_CGC_PRIM_TGE | + CIO2_CGC_SIDE_TGE | + CIO2_CGC_XOSC_TGE | + CIO2_CGC_D3I3_TGE | + CIO2_CGC_CSI2_INTERFRAME_TGE | + CIO2_CGC_CSI2_PORT_DCGE | + CIO2_CGC_SIDE_DCGE | + CIO2_CGC_PRIM_DCGE | + CIO2_CGC_ROSC_DCGE | + CIO2_CGC_XOSC_DCGE | + CIO2_CGC_CLKGATE_HOLDOFF << CIO2_CGC_CLKGATE_HOLDOFF_SHIFT | + CIO2_CGC_CSI_CLKGATE_HOLDOFF + << CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT, base + CIO2_REG_CGC); + writel(CIO2_LTRVAL0_VAL << CIO2_LTRVAL02_VAL_SHIFT | + CIO2_LTRVAL0_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | + CIO2_LTRVAL1_VAL << CIO2_LTRVAL13_VAL_SHIFT | + CIO2_LTRVAL1_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, + base + CIO2_REG_LTRVAL01); + writel(CIO2_LTRVAL2_VAL << CIO2_LTRVAL02_VAL_SHIFT | + CIO2_LTRVAL2_SCALE << CIO2_LTRVAL02_SCALE_SHIFT | + CIO2_LTRVAL3_VAL << CIO2_LTRVAL13_VAL_SHIFT | + CIO2_LTRVAL3_SCALE << CIO2_LTRVAL13_SCALE_SHIFT, + base + CIO2_REG_LTRVAL23); + + for (i = 0; i < CIO2_NUM_DMA_CHAN; i++) { + writel(0, base + CIO2_REG_CDMABA(i)); + writel(0, base + CIO2_REG_CDMAC0(i)); + writel(0, base + CIO2_REG_CDMAC1(i)); + } + + /* Enable DMA */ + writel(q->fbpt_bus_addr >> PAGE_SHIFT, + base + CIO2_REG_CDMABA(CIO2_DMA_CHAN)); + + writel(num_buffers1 << CIO2_CDMAC0_FBPT_LEN_SHIFT | + FBPT_WIDTH << CIO2_CDMAC0_FBPT_WIDTH_SHIFT | + CIO2_CDMAC0_DMA_INTR_ON_FE | + CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL | + CIO2_CDMAC0_DMA_EN | + CIO2_CDMAC0_DMA_INTR_ON_FS | + CIO2_CDMAC0_DMA_HALTED, base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); + + writel(1 << CIO2_CDMAC1_LINENUMUPDATE_SHIFT, + base + CIO2_REG_CDMAC1(CIO2_DMA_CHAN)); + + writel(0, base + CIO2_REG_PBM_FOPN_ABORT); + + writel(CIO2_PXM_FRF_CFG_CRC_TH << CIO2_PXM_FRF_CFG_CRC_TH_SHIFT | + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR | + CIO2_PXM_FRF_CFG_MSK_ECC_RE | + CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE, + base + CIO2_REG_PXM_FRF_CFG(q->csi2.port)); + + /* Clear interrupts */ + writel(CIO2_IRQCTRL_MASK, q->csi_rx_base + CIO2_REG_IRQCTRL_CLEAR); + writel(~0, base + CIO2_REG_INT_STS_EXT_OE); + writel(~0, base + CIO2_REG_INT_STS_EXT_IE); + writel(~0, base + CIO2_REG_INT_STS); + + /* Enable devices, starting from the last device in the pipe */ + writel(1, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); + writel(1, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); + + return 0; +} + +static void cio2_hw_exit(struct cio2_device *cio2, struct cio2_queue *q) +{ + void __iomem *base = cio2->base; + unsigned int i, maxloops = 1000; + + /* Disable CSI receiver and MIPI backend devices */ + writel(0, q->csi_rx_base + CIO2_REG_CSIRX_ENABLE); + writel(0, q->csi_rx_base + CIO2_REG_MIPIBE_ENABLE); + + /* Halt DMA */ + writel(0, base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)); + do { + if (readl(base + CIO2_REG_CDMAC0(CIO2_DMA_CHAN)) & + CIO2_CDMAC0_DMA_HALTED) + break; + usleep_range(1000, 2000); + } while (--maxloops); + if (!maxloops) + dev_err(&cio2->pci_dev->dev, + "DMA %i can not be halted\n", CIO2_DMA_CHAN); + + for (i = 0; i < CIO2_NUM_PORTS; i++) { + writel(readl(base + CIO2_REG_PXM_FRF_CFG(i)) | + CIO2_PXM_FRF_CFG_ABORT, base + CIO2_REG_PXM_FRF_CFG(i)); + writel(readl(base + CIO2_REG_PBM_FOPN_ABORT) | + CIO2_PBM_FOPN_ABORT(i), base + CIO2_REG_PBM_FOPN_ABORT); + } +} + +static void cio2_buffer_done(struct cio2_device *cio2, unsigned int dma_chan) +{ + struct device *dev = &cio2->pci_dev->dev; + struct cio2_queue *q = cio2->cur_queue; + int buffers_found = 0; + + if (dma_chan >= CIO2_QUEUES) { + dev_err(dev, "bad DMA channel %i\n", dma_chan); + return; + } + + /* Find out which buffer(s) are ready */ + do { + struct cio2_fbpt_entry *const entry = + &q->fbpt[q->bufs_first * CIO2_MAX_LOPS]; + struct cio2_buffer *b; + u64 ns = ktime_get_ns(); + + if (entry->first_entry.ctrl & CIO2_FBPT_CTRL_VALID) + break; + + b = q->bufs[q->bufs_first]; + if (b) { + q->bufs[q->bufs_first] = NULL; + atomic_dec(&q->bufs_queued); + + b->vbb.vb2_buf.timestamp = ns; + b->vbb.field = V4L2_FIELD_NONE; + b->vbb.sequence = entry[0].first_entry.frame_num; + vb2_buffer_done(&b->vbb.vb2_buf, VB2_BUF_STATE_DONE); + } + cio2_fbpt_entry_init_dummy(cio2, entry); + q->bufs_first = (q->bufs_first + 1) % CIO2_MAX_BUFFERS; + buffers_found++; + } while (1); + + if (buffers_found == 0) + dev_warn(&cio2->pci_dev->dev, + "no ready buffers found on DMA channel %u\n", + dma_chan); +} + +static void cio2_queue_event_sof(struct cio2_device *cio2, struct cio2_queue *q) +{ + struct v4l2_event event = { + .type = V4L2_EVENT_FRAME_SYNC, + .u.frame_sync.frame_sequence = + atomic_inc_return(&q->frame_sequence) - 1, + }; + + v4l2_event_queue(q->subdev.devnode, &event); +} + +static const char *const cio2_irq_errs[] = { + "single packet header error corrected", + "multiple packet header errors detected", + "payload checksum (CRC) error", + "fifo overflow", + "reserved short packet data type detected", + "reserved long packet data type detected", + "incomplete long packet detected", + "frame sync error", + "line sync error", + "DPHY start of transmission error", + "DPHY synchronization error", + "escape mode error", + "escape mode trigger event", + "escape mode ultra-low power state for data lane(s)", + "escape mode ultra-low power state exit for clock lane", + "inter-frame short packet discarded", + "inter-frame long packet discarded", + "non-matching Long Packet stalled", +}; + +static const char *const cio2_port_errs[] = { + "ECC recoverable", + "DPHY not recoverable", + "ECC not recoverable", + "CRC error", + "INTERFRAMEDATA", + "PKT2SHORT", + "PKT2LONG", +}; + +static irqreturn_t cio2_irq(int irq, void *cio2_ptr) +{ + struct cio2_device *cio2 = cio2_ptr; + void __iomem *const base = cio2->base; + struct device *dev = &cio2->pci_dev->dev; + u32 int_status, int_clear; + + int_clear = int_status = readl(base + CIO2_REG_INT_STS); + if (!int_status) + return IRQ_NONE; + + if (int_status & CIO2_INT_IOOE) { + /* + * Interrupt on Output Error: + * 1) SRAM is full and FS received, or + * 2) An invalid bit detected by DMA. + */ + u32 oe_status, oe_clear; + + oe_clear = readl(base + CIO2_REG_INT_STS_EXT_OE); + oe_status = oe_clear; + + if (oe_status & CIO2_INT_EXT_OE_DMAOE_MASK) { + dev_err(dev, "DMA output error: 0x%x\n", + (oe_status & CIO2_INT_EXT_OE_DMAOE_MASK) + >> CIO2_INT_EXT_OE_DMAOE_SHIFT); + oe_status &= ~CIO2_INT_EXT_OE_DMAOE_MASK; + } + if (oe_status & CIO2_INT_EXT_OE_OES_MASK) { + dev_err(dev, "DMA output error on CSI2 buses: 0x%x\n", + (oe_status & CIO2_INT_EXT_OE_OES_MASK) + >> CIO2_INT_EXT_OE_OES_SHIFT); + oe_status &= ~CIO2_INT_EXT_OE_OES_MASK; + } + writel(oe_clear, base + CIO2_REG_INT_STS_EXT_OE); + if (oe_status) + dev_warn(dev, "unknown interrupt 0x%x on OE\n", + oe_status); + int_status &= ~CIO2_INT_IOOE; + } + + if (int_status & CIO2_INT_IOC_MASK) { + /* DMA IO done -- frame ready */ + u32 clr = 0; + unsigned int d; + + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) + if (int_status & CIO2_INT_IOC(d)) { + clr |= CIO2_INT_IOC(d); + dev_dbg(dev, "DMA %i done\n", d); + cio2_buffer_done(cio2, d); + } + int_status &= ~clr; + } + + if (int_status & CIO2_INT_IOS_IOLN_MASK) { + /* DMA IO starts or reached specified line */ + u32 clr = 0; + unsigned int d; + + for (d = 0; d < CIO2_NUM_DMA_CHAN; d++) + if (int_status & CIO2_INT_IOS_IOLN(d)) { + clr |= CIO2_INT_IOS_IOLN(d); + if (d == CIO2_DMA_CHAN) + cio2_queue_event_sof(cio2, + cio2->cur_queue); + dev_dbg(dev, + "DMA %i started or reached line\n", d); + } + int_status &= ~clr; + } + + if (int_status & (CIO2_INT_IOIE | CIO2_INT_IOIRQ)) { + /* CSI2 receiver (error) interrupt */ + u32 ie_status, ie_clear; + unsigned int port; + + ie_clear = readl(base + CIO2_REG_INT_STS_EXT_IE); + ie_status = ie_clear; + + for (port = 0; port < CIO2_NUM_PORTS; port++) { + u32 port_status = (ie_status >> (port * 8)) & 0xff; + u32 err_mask = BIT_MASK(ARRAY_SIZE(cio2_port_errs)) - 1; + void __iomem *const csi_rx_base = + base + CIO2_REG_PIPE_BASE(port); + unsigned int i; + + while (port_status & err_mask) { + i = ffs(port_status) - 1; + dev_err(dev, "port %i error %s\n", + port, cio2_port_errs[i]); + ie_status &= ~BIT(port * 8 + i); + port_status &= ~BIT(i); + } + + if (ie_status & CIO2_INT_EXT_IE_IRQ(port)) { + u32 csi2_status, csi2_clear; + + csi2_status = readl(csi_rx_base + + CIO2_REG_IRQCTRL_STATUS); + csi2_clear = csi2_status; + err_mask = + BIT_MASK(ARRAY_SIZE(cio2_irq_errs)) - 1; + + while (csi2_status & err_mask) { + i = ffs(csi2_status) - 1; + dev_err(dev, + "CSI-2 receiver port %i: %s\n", + port, cio2_irq_errs[i]); + csi2_status &= ~BIT(i); + } + + writel(csi2_clear, + csi_rx_base + CIO2_REG_IRQCTRL_CLEAR); + if (csi2_status) + dev_warn(dev, + "unknown CSI2 error 0x%x on port %i\n", + csi2_status, port); + + ie_status &= ~CIO2_INT_EXT_IE_IRQ(port); + } + } + + writel(ie_clear, base + CIO2_REG_INT_STS_EXT_IE); + if (ie_status) + dev_warn(dev, "unknown interrupt 0x%x on IE\n", + ie_status); + + int_status &= ~(CIO2_INT_IOIE | CIO2_INT_IOIRQ); + } + + writel(int_clear, base + CIO2_REG_INT_STS); + if (int_status) + dev_warn(dev, "unknown interrupt 0x%x on INT\n", int_status); + + return IRQ_HANDLED; +} + +/**************** Videobuf2 interface ****************/ + +static void cio2_vb2_return_all_buffers(struct cio2_queue *q) +{ + unsigned int i; + + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { + if (q->bufs[i]) { + atomic_dec(&q->bufs_queued); + vb2_buffer_done(&q->bufs[i]->vbb.vb2_buf, + VB2_BUF_STATE_ERROR); + } + } +} + +static int cio2_vb2_queue_setup(struct vb2_queue *vq, + unsigned int *num_buffers, + unsigned int *num_planes, + unsigned int sizes[], + struct device *alloc_devs[]) +{ + struct cio2_device *cio2 = vb2_get_drv_priv(vq); + struct cio2_queue *q = vb2q_to_cio2_queue(vq); + u32 width = q->subdev_fmt.width; + u32 height = q->subdev_fmt.height; + u32 pixelformat = q->format.pixelformat; + unsigned int i, szimage; + int r = 0; + + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { + if (pixelformat == cio2_csi2_fmts[i]) + break; + } + + alloc_devs[0] = &cio2->pci_dev->dev; + szimage = cio2_bytesperline(width) * height; + + *num_planes = 1; + sizes[0] = szimage; + + *num_buffers = clamp_val(*num_buffers, 1, CIO2_MAX_BUFFERS); + + /* Initialize buffer queue */ + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { + q->bufs[i] = NULL; + cio2_fbpt_entry_init_dummy(cio2, &q->fbpt[i * CIO2_MAX_LOPS]); + } + atomic_set(&q->bufs_queued, 0); + q->bufs_first = 0; + q->bufs_next = 0; + q->format.sizeimage = szimage; + + return r; +} + +/* Called after each buffer is allocated */ +static int cio2_vb2_buf_init(struct vb2_buffer *vb) +{ + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); + struct device *dev = &cio2->pci_dev->dev; + struct cio2_buffer *b = + container_of(vb, struct cio2_buffer, vbb.vb2_buf); + unsigned int length = vb->planes[0].length; + unsigned int page_entry = CIO2_PAGE_SIZE / sizeof(u32); + int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, CIO2_PAGE_SIZE) + 1, + page_entry); + struct sg_table *sg; + struct sg_page_iter sg_iter; + unsigned int i, j; + + if (lops <= 0 || lops > CIO2_MAX_LOPS) { + dev_err(dev, "%s: bad buffer size (%i)\n", __func__, length); + return -ENOSPC; /* Should never happen */ + } + + /* Allocate LOP table */ + for (i = 0; i < lops; i++) { + b->lop[i] = dma_alloc_coherent(dev, CIO2_PAGE_SIZE, + &b->lop_bus_addr[i], GFP_KERNEL); + if (!b->lop[i]) + goto fail; + } + + /* Fill LOP */ + sg = vb2_dma_sg_plane_desc(vb, 0); + if (!sg) + return -ENOMEM; + + i = j = 0; + for_each_sg_page(sg->sgl, &sg_iter, sg->nents, 0) { + b->lop[i][j] = sg_page_iter_dma_address(&sg_iter) >> PAGE_SHIFT; + j++; + if (j == page_entry) { + i++; + j = 0; + } + } + + b->lop[i][j] = cio2->dummy_page_bus_addr >> PAGE_SHIFT; + return 0; +fail: + for (; i >= 0; i--) + dma_free_coherent(dev, CIO2_PAGE_SIZE, + b->lop[i], b->lop_bus_addr[i]); + return -ENOMEM; +} + +/* Transfer buffer ownership to cio2 */ +static void cio2_vb2_buf_queue(struct vb2_buffer *vb) +{ + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); + struct cio2_queue *q = + container_of(vb->vb2_queue, struct cio2_queue, vbq); + struct cio2_buffer *b = + container_of(vb, struct cio2_buffer, vbb.vb2_buf); + struct cio2_fbpt_entry *entry; + unsigned int i, next = q->bufs_next; + int bufs_queued = atomic_inc_return(&q->bufs_queued); + + if (vb2_is_streaming(&q->vbq)) { + u32 fbpt_rp = + (readl(cio2->base + CIO2_REG_CDMARI(CIO2_DMA_CHAN)) + >> CIO2_CDMARI_FBPT_RP_SHIFT) + & CIO2_CDMARI_FBPT_RP_MASK; + + /* + * fbpt_rp is the fbpt entry that the dma is currently working + * on, but since it could jump to next entry at any time, + * assume that we might already be there. + */ + fbpt_rp = (fbpt_rp + 1) % CIO2_MAX_BUFFERS; + + if (bufs_queued <= 1) + next = fbpt_rp + 1; /* Buffers were drained */ + else if (fbpt_rp == next) + next++; + next %= CIO2_MAX_BUFFERS; + } + + for (i = 0; i < CIO2_MAX_BUFFERS; i++) { + /* + * We have allocated CIO2_MAX_BUFFERS circularly for the + * hw, the user has requested N buffer queue. The driver + * ensures N <= CIO2_MAX_BUFFERS and guarantees that whenever + * user queues a buffer, there necessarily is a free buffer. + */ + if (!q->bufs[next]) + break; + + dev_dbg(&cio2->pci_dev->dev, + "entry %i was already full!\n", next); + next = (next + 1) % CIO2_MAX_BUFFERS; + } + /* This should not happen, just in case */ + if (i == CIO2_MAX_BUFFERS) { + dev_err(&cio2->pci_dev->dev, + "error: all cio2 entries were full!\n"); + vb2_buffer_done(vb, VB2_BUF_STATE_ERROR); + return; + } + + q->bufs[next] = b; + entry = &q->fbpt[next * CIO2_MAX_LOPS]; + cio2_fbpt_entry_init_buf(cio2, b, entry); + q->bufs_next = (next + 1) % CIO2_MAX_BUFFERS; + + vb2_set_plane_payload(vb, 0, q->format.sizeimage); +} + +/* Called when each buffer is freed */ +static void cio2_vb2_buf_cleanup(struct vb2_buffer *vb) +{ + struct cio2_device *cio2 = vb2_get_drv_priv(vb->vb2_queue); + struct cio2_buffer *b = + container_of(vb, struct cio2_buffer, vbb.vb2_buf); + unsigned int i, length = vb->planes[0].length; + unsigned int lops = DIV_ROUND_UP(DIV_ROUND_UP(length, CIO2_PAGE_SIZE), + CIO2_PAGE_SIZE / sizeof(u32)); + + /* Free LOP table */ + for (i = 0; i < lops; i++) + dma_free_coherent(&cio2->pci_dev->dev, CIO2_PAGE_SIZE, + b->lop[i], b->lop_bus_addr[i]); +} + +static int cio2_vb2_start_streaming(struct vb2_queue *vq, unsigned int count) +{ + struct cio2_queue *q = vb2q_to_cio2_queue(vq); + struct cio2_device *cio2 = vb2_get_drv_priv(vq); + int r; + + cio2->cur_queue = q; + atomic_set(&q->frame_sequence, 0); + + r = pm_runtime_get_sync(&cio2->pci_dev->dev); + if (r < 0) { + dev_info(&cio2->pci_dev->dev, + "failed to set power %d\n", r); + pm_runtime_put(&cio2->pci_dev->dev); + return r; + } + + r = media_pipeline_start(&q->vdev.entity, &q->pipe); + if (r) + goto fail_pipeline; + + r = cio2_hw_init(cio2, q); + if (r) + goto fail_hw; + + /* Start streaming on CSI2 receiver */ + r = v4l2_subdev_call(&q->subdev, video, s_stream, 1); + if (r && r != -ENOIOCTLCMD) + goto fail_csi2_subdev; + + /* Start streaming on sensor */ + r = v4l2_subdev_call(q->sensor, video, s_stream, 1); + if (r) + goto fail_sensor_subdev; + + return 0; + +fail_sensor_subdev: + v4l2_subdev_call(&q->subdev, video, s_stream, 0); +fail_csi2_subdev: + cio2_hw_exit(cio2, q); +fail_hw: + media_pipeline_stop(&q->vdev.entity); +fail_pipeline: + dev_dbg(&cio2->pci_dev->dev, "failed to start streaming (%d)\n", r); + cio2_vb2_return_all_buffers(q); + + return r; +} + +static void cio2_vb2_stop_streaming(struct vb2_queue *vq) +{ + struct cio2_queue *q = vb2q_to_cio2_queue(vq); + struct cio2_device *cio2 = vb2_get_drv_priv(vq); + int r; + + if (v4l2_subdev_call(q->sensor, video, s_stream, 0)) + dev_err(&cio2->pci_dev->dev, + "failed to stop sensor streaming\n"); + + r = v4l2_subdev_call(&q->subdev, video, s_stream, 0); + if (r && r != -ENOIOCTLCMD) + dev_err(&cio2->pci_dev->dev, "failed to stop CSI2 streaming\n"); + + cio2_hw_exit(cio2, q); + cio2_vb2_return_all_buffers(q); + media_pipeline_stop(&q->vdev.entity); + pm_runtime_put(&cio2->pci_dev->dev); +} + +static const struct vb2_ops cio2_vb2_ops = { + .buf_init = cio2_vb2_buf_init, + .buf_queue = cio2_vb2_buf_queue, + .buf_cleanup = cio2_vb2_buf_cleanup, + .queue_setup = cio2_vb2_queue_setup, + .start_streaming = cio2_vb2_start_streaming, + .stop_streaming = cio2_vb2_stop_streaming, + .wait_prepare = vb2_ops_wait_prepare, + .wait_finish = vb2_ops_wait_finish, +}; + +/**************** V4L2 interface ****************/ + +static int cio2_v4l2_querycap(struct file *file, void *fh, + struct v4l2_capability *cap) +{ + struct cio2_device *cio2 = video_drvdata(file); + struct cio2_queue *q = file_to_cio2_queue(file); + + strlcpy(cap->driver, CIO2_NAME, sizeof(cap->driver)); + strlcpy(cap->card, CIO2_DEVICE_NAME, sizeof(cap->card)); + snprintf(cap->bus_info, sizeof(cap->bus_info), + "PCI:%s", pci_name(cio2->pci_dev)); + cap->capabilities = q->vdev.device_caps | V4L2_CAP_DEVICE_CAPS; + return 0; +} + +static int cio2_v4l2_enum_fmt(struct file *file, void *fh, + struct v4l2_fmtdesc *f) +{ + if (f->index >= ARRAY_SIZE(cio2_csi2_fmts)) + return -EINVAL; + + f->pixelformat = cio2_csi2_fmts[f->index]; + + return 0; +} + +/* Propagate forward always the format from the CIO2 subdev */ +static int cio2_v4l2_g_fmt(struct file *file, void *fh, struct v4l2_format *f) +{ + struct cio2_queue *q = file_to_cio2_queue(file); + + f->fmt.pix.width = q->subdev_fmt.width; + f->fmt.pix.height = q->subdev_fmt.height; + f->fmt.pix.pixelformat = q->format.pixelformat; + f->fmt.pix.field = V4L2_FIELD_NONE; + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; + f->fmt.pix.colorspace = V4L2_COLORSPACE_RAW; + + return 0; +} + +static int cio2_v4l2_try_fmt(struct file *file, void *fh, struct v4l2_format *f) +{ + u32 pixelformat = f->fmt.pix.pixelformat; + unsigned int i; + + cio2_v4l2_g_fmt(file, fh, f); + + for (i = 0; i < ARRAY_SIZE(cio2_csi2_fmts); i++) { + if (pixelformat == cio2_csi2_fmts[i]) + break; + } + + /* Use SRGGB10 as default if not found */ + if (i >= ARRAY_SIZE(cio2_csi2_fmts)) + pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; + + f->fmt.pix.pixelformat = pixelformat; + f->fmt.pix.bytesperline = cio2_bytesperline(f->fmt.pix.width); + f->fmt.pix.sizeimage = f->fmt.pix.bytesperline * f->fmt.pix.height; + + return 0; +} + +static int cio2_v4l2_s_fmt(struct file *file, void *fh, struct v4l2_format *f) +{ + struct cio2_queue *q = file_to_cio2_queue(file); + + cio2_v4l2_try_fmt(file, fh, f); + q->format = f->fmt.pix; + + return 0; +} + +static const struct v4l2_file_operations cio2_v4l2_fops = { + .owner = THIS_MODULE, + .unlocked_ioctl = video_ioctl2, + .open = v4l2_fh_open, + .release = vb2_fop_release, + .poll = vb2_fop_poll, + .mmap = vb2_fop_mmap, +}; + +static const struct v4l2_ioctl_ops cio2_v4l2_ioctl_ops = { + .vidioc_querycap = cio2_v4l2_querycap, + .vidioc_enum_fmt_vid_cap = cio2_v4l2_enum_fmt, + .vidioc_g_fmt_vid_cap = cio2_v4l2_g_fmt, + .vidioc_s_fmt_vid_cap = cio2_v4l2_s_fmt, + .vidioc_try_fmt_vid_cap = cio2_v4l2_try_fmt, + .vidioc_reqbufs = vb2_ioctl_reqbufs, + .vidioc_create_bufs = vb2_ioctl_create_bufs, + .vidioc_prepare_buf = vb2_ioctl_prepare_buf, + .vidioc_querybuf = vb2_ioctl_querybuf, + .vidioc_qbuf = vb2_ioctl_qbuf, + .vidioc_dqbuf = vb2_ioctl_dqbuf, + .vidioc_streamon = vb2_ioctl_streamon, + .vidioc_streamoff = vb2_ioctl_streamoff, + .vidioc_expbuf = vb2_ioctl_expbuf, +}; + +static int cio2_subdev_subscribe_event(struct v4l2_subdev *sd, + struct v4l2_fh *fh, + struct v4l2_event_subscription *sub) +{ + if (sub->type != V4L2_EVENT_FRAME_SYNC) + return -EINVAL; + + /* Line number. For now only zero accepted. */ + if (sub->id != 0) + return -EINVAL; + + return v4l2_event_subscribe(fh, sub, 0, NULL); +} + +/* + * cio2_subdev_get_fmt - Handle get format by pads subdev method + * @sd : pointer to v4l2 subdev structure + * @cfg: V4L2 subdev pad config + * @fmt: pointer to v4l2 subdev format structure + * return -EINVAL or zero on success + */ +static int cio2_subdev_get_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *fmt) +{ + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); + + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) + fmt->format = *v4l2_subdev_get_try_format(sd, cfg, fmt->pad); + else /* Retrieve the current format */ + fmt->format = q->subdev_fmt; + + return 0; +} + +/* + * cio2_subdev_set_fmt - Handle set format by pads subdev method + * @sd : pointer to v4l2 subdev structure + * @cfg: V4L2 subdev pad config + * @fmt: pointer to v4l2 subdev format structure + * return -EINVAL or zero on success + */ +static int cio2_subdev_set_fmt(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_format *fmt) +{ + struct cio2_queue *q = container_of(sd, struct cio2_queue, subdev); + + /* + * Only allow setting sink pad format; + * source always propagates from sink + */ + if (fmt->pad == CIO2_PAD_SOURCE) + return cio2_subdev_get_fmt(sd, cfg, fmt); + + if (fmt->which == V4L2_SUBDEV_FORMAT_TRY) { + *v4l2_subdev_get_try_format(sd, cfg, fmt->pad) = fmt->format; + } else { + /* It's the sink, allow changing frame size */ + q->subdev_fmt.width = fmt->format.width; + q->subdev_fmt.height = fmt->format.height; + q->subdev_fmt.code = fmt->format.code; + fmt->format = q->subdev_fmt; + } + + return 0; +} + +static int cio2_subdev_enum_mbus_code(struct v4l2_subdev *sd, + struct v4l2_subdev_pad_config *cfg, + struct v4l2_subdev_mbus_code_enum *code) +{ + static const u32 codes[] = { + MEDIA_BUS_FMT_SRGGB10_1X10, + MEDIA_BUS_FMT_SBGGR10_1X10, + MEDIA_BUS_FMT_SGBRG10_1X10, + MEDIA_BUS_FMT_SGRBG10_1X10, + }; + + if (code->index >= ARRAY_SIZE(codes)) + return -EINVAL; + + code->code = codes[code->index]; + + return 0; +} + +static int cio2_link_validate_get_format(struct media_pad *pad, + struct v4l2_subdev_format *fmt) +{ + if (pad->entity->obj_type == MEDIA_ENTITY_TYPE_V4L2_SUBDEV) { + struct v4l2_subdev *sd = + media_entity_to_v4l2_subdev(pad->entity); + if (sd) { + fmt->which = V4L2_SUBDEV_FORMAT_ACTIVE; + fmt->pad = pad->index; + return v4l2_subdev_call(sd, pad, get_fmt, NULL, fmt); + } + } + + return -EINVAL; +} + +static int cio2_video_link_validate(struct media_link *link) +{ + struct video_device *vd; + struct cio2_queue *q; + struct media_pad *pad; + struct v4l2_subdev_format fmt = { 0 }; + struct cio2_device *cio2; + int i, rval; + + static const struct { + u32 mbuscode; + u32 pixfmt; + } mbus2pixfmt[] = { + { MEDIA_BUS_FMT_SBGGR10_1X10, V4L2_PIX_FMT_IPU3_SBGGR10 }, + { MEDIA_BUS_FMT_SGBRG10_1X10, V4L2_PIX_FMT_IPU3_SGBRG10 }, + { MEDIA_BUS_FMT_SGRBG10_1X10, V4L2_PIX_FMT_IPU3_SGRBG10 }, + { MEDIA_BUS_FMT_SRGGB10_1X10, V4L2_PIX_FMT_IPU3_SRGGB10 }, + }; + + vd = container_of(link->sink->entity, struct video_device, entity); + q = container_of(vd, struct cio2_queue, vdev); + cio2 = video_get_drvdata(vd); + pad = media_entity_remote_pad(link->sink->entity->pads); + if (!pad) { + dev_info(&cio2->pci_dev->dev, + "video node %s pad not connected\n", vd->name); + return -ENOTCONN; + } + + rval = cio2_link_validate_get_format(link->source, &fmt); + if (rval) + return rval; + + if (fmt.format.width != q->format.width || + fmt.format.height != q->format.height) { + dev_info(&cio2->pci_dev->dev, + "Wrong width or height %ux%u (%ux%u expected)\n", + q->format.width, q->format.height, + fmt.format.width, fmt.format.height); + return -EINVAL; + } + + for (i = 0; i < ARRAY_SIZE(mbus2pixfmt); i++) { + if (mbus2pixfmt[i].mbuscode == fmt.format.code && + mbus2pixfmt[i].pixfmt == q->format.pixelformat) { + return 0; + } + } + + return -EINVAL; +} + +static const struct v4l2_subdev_core_ops cio2_subdev_core_ops = { + .subscribe_event = cio2_subdev_subscribe_event, + .unsubscribe_event = v4l2_event_subdev_unsubscribe, +}; + +static const struct v4l2_subdev_video_ops cio2_subdev_video_ops = {}; + +static const struct v4l2_subdev_pad_ops cio2_subdev_pad_ops = { + .link_validate = v4l2_subdev_link_validate_default, + .get_fmt = cio2_subdev_get_fmt, + .set_fmt = cio2_subdev_set_fmt, + .enum_mbus_code = cio2_subdev_enum_mbus_code, +}; + +static const struct v4l2_subdev_ops cio2_subdev_ops = { + .core = &cio2_subdev_core_ops, + .video = &cio2_subdev_video_ops, + .pad = &cio2_subdev_pad_ops, +}; + +/******* V4L2 sub-device asynchronous registration callbacks***********/ + +struct sensor_async_subdev { + struct v4l2_async_subdev asd; + struct v4l2_fwnode_endpoint vfwn_endpt; +}; + +static struct cio2_queue *cio2_find_queue_by_sensor_node(struct cio2_queue *q, + struct fwnode_handle *fwnode) +{ + int i; + + for (i = 0; i < CIO2_QUEUES; i++) { + if (q[i].sensor->fwnode == fwnode) + return &q[i]; + } + + return NULL; +} + +/* The .bound() notifier callback when a match is found */ +static int cio2_notifier_bound(struct v4l2_async_notifier *notifier, + struct v4l2_subdev *sd, + struct v4l2_async_subdev *asd) +{ + struct cio2_device *cio2 = container_of(notifier, + struct cio2_device, notifier); + struct sensor_async_subdev *s_asd = container_of(asd, + struct sensor_async_subdev, asd); + struct cio2_queue *q; + struct device *dev; + int i; + + dev = &cio2->pci_dev->dev; + + /* Find first free slot for the subdev */ + for (i = 0; i < CIO2_QUEUES; i++) + if (!cio2->queue[i].sensor) + break; + + if (i >= CIO2_QUEUES) { + dev_err(dev, "too many subdevs\n"); + return -ENOSPC; + } + q = &cio2->queue[i]; + + q->csi2.port = s_asd->vfwn_endpt.base.port; + q->csi2.num_of_lanes = s_asd->vfwn_endpt.bus.mipi_csi2.num_data_lanes; + q->sensor = sd; + q->csi_rx_base = cio2->base + CIO2_REG_PIPE_BASE(q->csi2.port); + + return 0; +} + +/* The .unbind callback */ +static void cio2_notifier_unbind(struct v4l2_async_notifier *notifier, + struct v4l2_subdev *sd, + struct v4l2_async_subdev *asd) +{ + struct cio2_device *cio2 = container_of(notifier, + struct cio2_device, notifier); + unsigned int i; + + /* Note: sd may here point to unallocated memory. Do not access. */ + for (i = 0; i < CIO2_QUEUES; i++) { + if (cio2->queue[i].sensor == sd) { + cio2->queue[i].sensor = NULL; + return; + } + } +} + +/* .complete() is called after all subdevices have been located */ +static int cio2_notifier_complete(struct v4l2_async_notifier *notifier) +{ + struct cio2_device *cio2 = container_of(notifier, struct cio2_device, + notifier); + struct sensor_async_subdev *s_asd; + struct fwnode_handle *fwn_remote, *fwn_endpt, *fwn_remote_endpt; + struct cio2_queue *q; + struct fwnode_endpoint remote_endpt; + unsigned int i, pad; + int ret; + + for (i = 0; i < notifier->num_subdevs; i++) { + s_asd = container_of(cio2->notifier.subdevs[i], + struct sensor_async_subdev, + asd); + + fwn_remote = s_asd->asd.match.fwnode.fwnode; + fwn_endpt = (struct fwnode_handle *) + s_asd->vfwn_endpt.base.local_fwnode; + fwn_remote_endpt = fwnode_graph_get_remote_endpoint(fwn_endpt); + if (!fwn_remote_endpt) { + dev_err(&cio2->pci_dev->dev, + "failed to get remote endpt\n"); + return ret; + } + + ret = fwnode_graph_parse_endpoint(fwn_remote_endpt, + &remote_endpt); + if (ret) { + dev_err(&cio2->pci_dev->dev, + "failed to parse remote endpt %d\n", ret); + return ret; + } + + q = cio2_find_queue_by_sensor_node(cio2->queue, fwn_remote); + if (!q) { + dev_err(&cio2->pci_dev->dev, + "failed to find cio2 queue %d\n", ret); + return -ENXIO; + } + + for (pad = 0; pad < q->sensor->entity.num_pads; pad++) + if (q->sensor->entity.pads[pad].flags & + MEDIA_PAD_FL_SOURCE) + break; + + if (pad == q->sensor->entity.num_pads) { + dev_err(&cio2->pci_dev->dev, + "failed to src pad for %s\n", q->sensor->name); + return -ENXIO; + } + + ret = media_create_pad_link( + &q->sensor->entity, pad, + &q->subdev.entity, s_asd->vfwn_endpt.base.id, + 0); + if (ret) { + dev_err(&cio2->pci_dev->dev, + "failed to create link for %s\n", + cio2->queue[i].sensor->name); + return ret; + } + } + + return v4l2_device_register_subdev_nodes(&cio2->v4l2_dev); +} + +static int cio2_notifier_init(struct cio2_device *cio2) +{ + struct device *dev; + struct fwnode_handle *dev_fwn, *fwn, *fwn_remote; + struct v4l2_async_subdev *asd; + struct sensor_async_subdev *s_asd; + int ret; + + dev = &cio2->pci_dev->dev; + dev_fwn = dev_fwnode(dev); + + asd = devm_kzalloc(dev, sizeof(asd) * CIO2_QUEUES, GFP_KERNEL); + if (!asd) + return -ENOMEM; + + cio2->notifier.subdevs = (struct v4l2_async_subdev **)asd; + cio2->notifier.num_subdevs = 0; + cio2->notifier.bound = cio2_notifier_bound; + cio2->notifier.unbind = cio2_notifier_unbind; + cio2->notifier.complete = cio2_notifier_complete; + + fwn = NULL; + while (cio2->notifier.num_subdevs < CIO2_QUEUES && + (fwn = fwnode_graph_get_next_endpoint(dev_fwn, fwn))) { + s_asd = devm_kzalloc(dev, sizeof(*s_asd), GFP_KERNEL); + if (!asd) + return -ENOMEM; + + fwn_remote = fwnode_graph_get_remote_port_parent(fwn); + if (!fwn_remote) { + dev_err(dev, "bad remote port parent\n"); + return -ENOENT; + } + + ret = v4l2_fwnode_endpoint_parse(fwn, &s_asd->vfwn_endpt); + if (ret) { + dev_err(dev, "endpoint parsing error : %d\n", ret); + return ret; + } + + if (s_asd->vfwn_endpt.bus_type != V4L2_MBUS_CSI2) { + dev_warn(dev, "endpoint bus type error\n"); + devm_kfree(dev, s_asd); + continue; + } + + s_asd->asd.match.fwnode.fwnode = fwn_remote; + s_asd->asd.match_type = V4L2_ASYNC_MATCH_FWNODE; + + cio2->notifier.subdevs[cio2->notifier.num_subdevs++] = + &s_asd->asd; + } + + if (!cio2->notifier.num_subdevs) + return 0; /* No endpoint */ + + ret = v4l2_async_notifier_register(&cio2->v4l2_dev, &cio2->notifier); + if (ret) { + cio2->notifier.num_subdevs = 0; + dev_err(dev, "failed to register async notifier : %d\n", ret); + return ret; + } + + return 0; +} + +static void cio2_notifier_exit(struct cio2_device *cio2) +{ + if (cio2->notifier.num_subdevs > 0) + v4l2_async_notifier_unregister(&cio2->notifier); +} + +/**************** Queue initialization ****************/ +static const struct media_entity_operations cio2_media_ops = { + .link_validate = v4l2_subdev_link_validate, +}; + +static const struct media_entity_operations cio2_video_entity_ops = { + .link_validate = cio2_video_link_validate, +}; + +int cio2_queue_init(struct cio2_device *cio2, struct cio2_queue *q) +{ + static const u32 default_width = 1936; + static const u32 default_height = 1096; + static const u32 default_mbusfmt = MEDIA_BUS_FMT_SRGGB10_1X10; + + struct video_device *vdev = &q->vdev; + struct vb2_queue *vbq = &q->vbq; + struct v4l2_subdev *subdev = &q->subdev; + struct v4l2_mbus_framefmt *fmt; + int r; + + /* Initialize miscellaneous variables */ + mutex_init(&q->lock); + + /* Initialize formats to default values */ + fmt = &q->subdev_fmt; + fmt->width = default_width; + fmt->height = default_height; + fmt->code = default_mbusfmt; + fmt->field = V4L2_FIELD_NONE; + fmt->colorspace = V4L2_COLORSPACE_RAW; + fmt->ycbcr_enc = V4L2_YCBCR_ENC_DEFAULT; + fmt->quantization = V4L2_QUANTIZATION_DEFAULT; + fmt->xfer_func = V4L2_XFER_FUNC_DEFAULT; + + q->format.pixelformat = V4L2_PIX_FMT_IPU3_SRGGB10; + + /* Initialize fbpt */ + r = cio2_fbpt_init(cio2, q); + if (r) + goto fail_fbpt; + + /* Initialize media entities */ + r = media_entity_pads_init(&subdev->entity, CIO2_PADS, q->subdev_pads); + if (r) { + dev_err(&cio2->pci_dev->dev, + "failed initialize subdev media entity (%d)\n", r); + goto fail_subdev_media_entity; + } + q->subdev_pads[CIO2_PAD_SINK].flags = MEDIA_PAD_FL_SINK | + MEDIA_PAD_FL_MUST_CONNECT; + q->subdev_pads[CIO2_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE; + subdev->entity.ops = &cio2_media_ops; + r = media_entity_pads_init(&vdev->entity, 1, &q->vdev_pad); + if (r) { + dev_err(&cio2->pci_dev->dev, + "failed initialize videodev media entity (%d)\n", r); + goto fail_vdev_media_entity; + } + q->vdev_pad.flags = MEDIA_PAD_FL_SINK | MEDIA_PAD_FL_MUST_CONNECT; + vdev->entity.ops = &cio2_video_entity_ops; + + /* Initialize subdev */ + v4l2_subdev_init(subdev, &cio2_subdev_ops); + subdev->flags = V4L2_SUBDEV_FL_HAS_DEVNODE | V4L2_SUBDEV_FL_HAS_EVENTS; + subdev->owner = THIS_MODULE; + snprintf(subdev->name, sizeof(subdev->name), + CIO2_ENTITY_NAME ":%li", q - cio2->queue); + v4l2_set_subdevdata(subdev, cio2); + r = v4l2_device_register_subdev(&cio2->v4l2_dev, subdev); + if (r) { + dev_err(&cio2->pci_dev->dev, + "failed initialize subdev (%d)\n", r); + goto fail_subdev; + } + + /* Initialize vbq */ + vbq->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; + vbq->io_modes = VB2_USERPTR | VB2_MMAP | VB2_DMABUF; + vbq->ops = &cio2_vb2_ops; + vbq->mem_ops = &vb2_dma_sg_memops; + vbq->buf_struct_size = sizeof(struct cio2_buffer); + vbq->timestamp_flags = V4L2_BUF_FLAG_TIMESTAMP_MONOTONIC; + vbq->min_buffers_needed = 1; + vbq->drv_priv = cio2; + vbq->lock = &q->lock; + r = vb2_queue_init(vbq); + if (r) { + dev_err(&cio2->pci_dev->dev, + "failed to initialize videobuf2 queue (%d)\n", r); + goto fail_vbq; + } + + /* Initialize vdev */ + snprintf(vdev->name, sizeof(vdev->name), + "%s:%li", CIO2_NAME, q - cio2->queue); + vdev->release = video_device_release_empty; + vdev->fops = &cio2_v4l2_fops; + vdev->ioctl_ops = &cio2_v4l2_ioctl_ops; + vdev->lock = &cio2->lock; + vdev->v4l2_dev = &cio2->v4l2_dev; + vdev->queue = &q->vbq; + vdev->device_caps = V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_STREAMING; + video_set_drvdata(vdev, cio2); + r = video_register_device(vdev, VFL_TYPE_GRABBER, -1); + if (r) { + dev_err(&cio2->pci_dev->dev, + "failed to register video device (%d)\n", r); + goto fail_vdev; + } + + /* Create link from CIO2 subdev to output node */ + r = media_create_pad_link( + &subdev->entity, CIO2_PAD_SOURCE, &vdev->entity, 0, + MEDIA_LNK_FL_ENABLED | MEDIA_LNK_FL_IMMUTABLE); + if (r) + goto fail_link; + + return 0; + +fail_link: + video_unregister_device(&q->vdev); +fail_vdev: + vb2_queue_release(vbq); +fail_vbq: + v4l2_device_unregister_subdev(subdev); +fail_subdev: + media_entity_cleanup(&vdev->entity); +fail_vdev_media_entity: + media_entity_cleanup(&subdev->entity); +fail_subdev_media_entity: + cio2_fbpt_exit(q, &cio2->pci_dev->dev); +fail_fbpt: + mutex_destroy(&q->lock); + + return r; +} + +static void cio2_queue_exit(struct cio2_device *cio2, struct cio2_queue *q) +{ + video_unregister_device(&q->vdev); + media_entity_cleanup(&q->vdev.entity); + vb2_queue_release(&q->vbq); + v4l2_device_unregister_subdev(&q->subdev); + media_entity_cleanup(&q->subdev.entity); + cio2_fbpt_exit(q, &cio2->pci_dev->dev); + mutex_destroy(&q->lock); +} + +/**************** PCI interface ****************/ + +static int cio2_pci_config_setup(struct pci_dev *dev) +{ + u16 pci_command; + int r = pci_enable_msi(dev); + + if (r) { + dev_err(&dev->dev, "failed to enable MSI (%d)\n", r); + return r; + } + + pci_read_config_word(dev, PCI_COMMAND, &pci_command); + pci_command |= PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER | + PCI_COMMAND_INTX_DISABLE; + pci_write_config_word(dev, PCI_COMMAND, pci_command); + + return 0; +} + +static int cio2_pci_probe(struct pci_dev *pci_dev, + const struct pci_device_id *id) +{ + struct cio2_device *cio2; + phys_addr_t phys; + void __iomem *const *iomap; + int i = -1, r = -ENODEV; + + cio2 = devm_kzalloc(&pci_dev->dev, sizeof(*cio2), GFP_KERNEL); + if (!cio2) + return -ENOMEM; + cio2->pci_dev = pci_dev; + + r = pcim_enable_device(pci_dev); + if (r) { + dev_err(&pci_dev->dev, "failed to enable device (%d)\n", r); + return r; + } + + dev_info(&pci_dev->dev, "device 0x%x (rev: 0x%x)\n", + pci_dev->device, pci_dev->revision); + + phys = pci_resource_start(pci_dev, CIO2_PCI_BAR); + + r = pcim_iomap_regions(pci_dev, 1 << CIO2_PCI_BAR, pci_name(pci_dev)); + if (r) { + dev_err(&pci_dev->dev, "failed to remap I/O memory (%d)\n", r); + return -ENODEV; + } + + iomap = pcim_iomap_table(pci_dev); + if (!iomap) { + dev_err(&pci_dev->dev, "failed to iomap table\n"); + return -ENODEV; + } + + cio2->base = iomap[CIO2_PCI_BAR]; + + pci_set_drvdata(pci_dev, cio2); + + pci_set_master(pci_dev); + + r = pci_set_dma_mask(pci_dev, CIO2_DMA_MASK); + if (r) { + dev_err(&pci_dev->dev, "failed to set DMA mask (%d)\n", r); + return -ENODEV; + } + + r = cio2_pci_config_setup(pci_dev); + if (r) + return -ENODEV; + + mutex_init(&cio2->lock); + + cio2->media_dev.dev = &cio2->pci_dev->dev; + strlcpy(cio2->media_dev.model, CIO2_DEVICE_NAME, + sizeof(cio2->media_dev.model)); + snprintf(cio2->media_dev.bus_info, sizeof(cio2->media_dev.bus_info), + "PCI:%s", pci_name(cio2->pci_dev)); + cio2->media_dev.driver_version = LINUX_VERSION_CODE; + cio2->media_dev.hw_revision = 0; + + media_device_init(&cio2->media_dev); + r = media_device_register(&cio2->media_dev); + if (r < 0) + goto fail_mutex_destroy; + + cio2->v4l2_dev.mdev = &cio2->media_dev; + r = v4l2_device_register(&pci_dev->dev, &cio2->v4l2_dev); + if (r) { + dev_err(&pci_dev->dev, + "failed to register V4L2 device (%d)\n", r); + goto fail_mutex_destroy; + } + + for (i = 0; i < CIO2_QUEUES; i++) { + r = cio2_queue_init(cio2, &cio2->queue[i]); + if (r) + goto fail; + } + + r = cio2_fbpt_init_dummy(cio2); + if (r) + goto fail; + + /* Register notifier for subdevices we care */ + r = cio2_notifier_init(cio2); + if (r) + goto fail; + + r = devm_request_irq(&pci_dev->dev, pci_dev->irq, cio2_irq, + IRQF_SHARED, CIO2_NAME, cio2); + if (r) { + dev_err(&pci_dev->dev, "failed to request IRQ (%d)\n", r); + goto fail; + } + + pm_runtime_put_noidle(&pci_dev->dev); + pm_runtime_allow(&pci_dev->dev); + + return 0; + +fail: + cio2_notifier_exit(cio2); + cio2_fbpt_exit_dummy(cio2); + for (; i >= 0; i--) + cio2_queue_exit(cio2, &cio2->queue[i]); + v4l2_device_unregister(&cio2->v4l2_dev); + media_device_unregister(&cio2->media_dev); + media_device_cleanup(&cio2->media_dev); +fail_mutex_destroy: + mutex_destroy(&cio2->lock); + + return r; +} + +static void cio2_pci_remove(struct pci_dev *pci_dev) +{ + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); + unsigned int i; + + cio2_notifier_exit(cio2); + cio2_fbpt_exit_dummy(cio2); + for (i = 0; i < CIO2_QUEUES; i++) + cio2_queue_exit(cio2, &cio2->queue[i]); + v4l2_device_unregister(&cio2->v4l2_dev); + media_device_unregister(&cio2->media_dev); + media_device_cleanup(&cio2->media_dev); + mutex_destroy(&cio2->lock); +} + +static int cio2_runtime_suspend(struct device *dev) +{ + struct pci_dev *pci_dev = to_pci_dev(dev); + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); + void __iomem *const base = cio2->base; + u16 pm; + + writel(CIO2_D0I3C_I3, base + CIO2_REG_D0I3C); + dev_dbg(dev, "cio2 runtime suspend.\n"); + + pci_read_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, + &pm); + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << CIO2_PMCSR_D0D3_SHIFT; + pm |= CIO2_PMCSR_D3; + pci_write_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, + pm); + + return 0; +} + +static int cio2_runtime_resume(struct device *dev) +{ + struct pci_dev *pci_dev = to_pci_dev(dev); + struct cio2_device *cio2 = pci_get_drvdata(pci_dev); + void __iomem *const base = cio2->base; + u16 pm; + + writel(CIO2_D0I3C_RR, base + CIO2_REG_D0I3C); + dev_dbg(dev, "cio2 runtime resume.\n"); + + pci_read_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, + &pm); + pm = (pm >> CIO2_PMCSR_D0D3_SHIFT) << CIO2_PMCSR_D0D3_SHIFT; + pci_write_config_word(pci_dev, pci_dev->pm_cap + CIO2_PMCSR_OFFSET, + pm); + + return 0; +} + +static const struct dev_pm_ops cio2_pm_ops = { + SET_RUNTIME_PM_OPS(&cio2_runtime_suspend, + &cio2_runtime_resume, NULL) +}; + +static const struct pci_device_id cio2_pci_id_table[] = { + { PCI_DEVICE(PCI_VENDOR_ID_INTEL, CIO2_PCI_ID) }, + { 0 } +}; + +MODULE_DEVICE_TABLE(pci, cio2_pci_id_table); + +static struct pci_driver cio2_pci_driver = { + .name = CIO2_NAME, + .id_table = cio2_pci_id_table, + .probe = cio2_pci_probe, + .remove = cio2_pci_remove, + .driver = { + .pm = &cio2_pm_ops, + }, +}; + +module_pci_driver(cio2_pci_driver); + +MODULE_AUTHOR("Tuukka Toivonen <tuukka.toivonen@intel.com>"); +MODULE_AUTHOR("Tianshu Qiu <tian.shu.qiu@intel.com>"); +MODULE_AUTHOR("Jian Xu Zheng <jian.xu.zheng@intel.com>"); +MODULE_AUTHOR("Yuning Pu <yuning.pu@intel.com>"); +MODULE_AUTHOR("Yong Zhi <yong.zhi@intel.com>"); +MODULE_LICENSE("GPL v2"); +MODULE_DESCRIPTION("IPU3 CIO2 driver"); diff --git a/drivers/media/pci/intel/ipu3/ipu3-cio2.h b/drivers/media/pci/intel/ipu3/ipu3-cio2.h new file mode 100644 index 0000000..e33d3fc --- /dev/null +++ b/drivers/media/pci/intel/ipu3/ipu3-cio2.h @@ -0,0 +1,442 @@ +/* + * Copyright (c) 2017 Intel Corporation. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License version + * 2 as published by the Free Software Foundation. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + */ + +#ifndef __IPU3_CIO2_H +#define __IPU3_CIO2_H + +#define CIO2_NAME "ipu3-cio2" +#define CIO2_DEVICE_NAME "Intel IPU3 CIO2" +#define CIO2_ENTITY_NAME "ipu3-csi2" +#define CIO2_PCI_ID 0x9d32 +#define CIO2_PCI_BAR 0 +#define CIO2_DMA_MASK DMA_BIT_MASK(39) +/* 1 for each sensor */ +#define CIO2_QUEUES 2 +/* 32MB = 8xFBPT_entry */ +#define CIO2_MAX_LOPS 8 +#define CIO2_MAX_BUFFERS (PAGE_SIZE / 16 / CIO2_MAX_LOPS) + +#define CIO2_PAD_SINK 0 +#define CIO2_PAD_SOURCE 1 +#define CIO2_PADS 2 + +#define CIO2_NUM_DMA_CHAN 20 +#define CIO2_NUM_PORTS 4 /* DPHYs */ + +/* Register and bit field definitions */ +#define CIO2_REG_PIPE_BASE(n) ((n) * 0x0400) /* n = 0..3 */ +#define CIO2_REG_CSIRX_BASE 0x000 +#define CIO2_REG_MIPIBE_BASE 0x100 +#define CIO2_REG_PIXELGEN_BAS 0x200 +#define CIO2_REG_IRQCTRL_BASE 0x300 +#define CIO2_REG_GPREG_BASE 0x1000 + +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_CSIRX_BASE */ +#define CIO2_REG_CSIRX_ENABLE (CIO2_REG_CSIRX_BASE + 0x0) +#define CIO2_REG_CSIRX_NOF_ENABLED_LANES (CIO2_REG_CSIRX_BASE + 0x4) +#define CIO2_REG_CSIRX_SP_IF_CONFIG (CIO2_REG_CSIRX_BASE + 0x10) +#define CIO2_REG_CSIRX_LP_IF_CONFIG (CIO2_REG_CSIRX_BASE + 0x14) +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT 0x00 +#define CIO2_CSIRX_IF_CONFIG_FILTEROUT_VC_INACTIVE 0x01 +#define CIO2_CSIRX_IF_CONFIG_PASS 0x02 +#define CIO2_CSIRX_IF_CONFIG_FLAG_ERROR BIT(2) +#define CIO2_REG_CSIRX_STATUS (CIO2_REG_CSIRX_BASE + 0x18) +#define CIO2_REG_CSIRX_STATUS_DLANE_HS (CIO2_REG_CSIRX_BASE + 0x1c) +#define CIO2_CSIRX_STATUS_DLANE_HS_MASK 0xff +#define CIO2_REG_CSIRX_STATUS_DLANE_LP (CIO2_REG_CSIRX_BASE + 0x20) +#define CIO2_CSIRX_STATUS_DLANE_LP_MASK 0xffffff +/* Termination enable and settle in 0.0625ns units, lane=0..3 or -1 for clock */ +#define CIO2_REG_CSIRX_DLY_CNT_TERMEN(lane) \ + (CIO2_REG_CSIRX_BASE + 0x2c + 8*(lane)) +#define CIO2_REG_CSIRX_DLY_CNT_SETTLE(lane) \ + (CIO2_REG_CSIRX_BASE + 0x30 + 8*(lane)) +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_MIPIBE_BASE */ +#define CIO2_REG_MIPIBE_ENABLE (CIO2_REG_MIPIBE_BASE + 0x0) +#define CIO2_REG_MIPIBE_STATUS (CIO2_REG_MIPIBE_BASE + 0x4) +#define CIO2_REG_MIPIBE_COMP_FORMAT(vc) \ + (CIO2_REG_MIPIBE_BASE + 0x8 + 0x4*(vc)) +#define CIO2_REG_MIPIBE_FORCE_RAW8 (CIO2_REG_MIPIBE_BASE + 0x20) +#define CIO2_REG_MIPIBE_FORCE_RAW8_ENABLE BIT(0) +#define CIO2_REG_MIPIBE_FORCE_RAW8_USE_TYPEID BIT(1) +#define CIO2_REG_MIPIBE_FORCE_RAW8_TYPEID_SHIFT 2 + +#define CIO2_REG_MIPIBE_IRQ_STATUS (CIO2_REG_MIPIBE_BASE + 0x24) +#define CIO2_REG_MIPIBE_IRQ_CLEAR (CIO2_REG_MIPIBE_BASE + 0x28) +#define CIO2_REG_MIPIBE_GLOBAL_LUT_DISREGARD (CIO2_REG_MIPIBE_BASE + 0x68) +#define CIO2_MIPIBE_GLOBAL_LUT_DISREGARD 1 +#define CIO2_REG_MIPIBE_PKT_STALL_STATUS (CIO2_REG_MIPIBE_BASE + 0x6c) +#define CIO2_REG_MIPIBE_PARSE_GSP_THROUGH_LP_LUT_REG_IDX \ + (CIO2_REG_MIPIBE_BASE + 0x70) +#define CIO2_REG_MIPIBE_SP_LUT_ENTRY(vc) \ + (CIO2_REG_MIPIBE_BASE + 0x74 + 4*(vc)) +#define CIO2_REG_MIPIBE_LP_LUT_ENTRY(m) /* m = 0..15 */ \ + (CIO2_REG_MIPIBE_BASE + 0x84 + 4*(m)) +#define CIO2_MIPIBE_LP_LUT_ENTRY_DISREGARD 1 +#define CIO2_MIPIBE_LP_LUT_ENTRY_SID_SHIFT 1 +#define CIO2_MIPIBE_LP_LUT_ENTRY_VC_SHIFT 5 +#define CIO2_MIPIBE_LP_LUT_ENTRY_FORMAT_TYPE_SHIFT 7 + +/* base register: CIO2_REG_PIPE_BASE(pipe) * CIO2_REG_IRQCTRL_BASE */ +/* IRQ registers are 18-bit wide, see cio2_irq_error for bit definitions */ +#define CIO2_REG_IRQCTRL_EDGE (CIO2_REG_IRQCTRL_BASE + 0x00) +#define CIO2_REG_IRQCTRL_MASK (CIO2_REG_IRQCTRL_BASE + 0x04) +#define CIO2_REG_IRQCTRL_STATUS (CIO2_REG_IRQCTRL_BASE + 0x08) +#define CIO2_REG_IRQCTRL_CLEAR (CIO2_REG_IRQCTRL_BASE + 0x0c) +#define CIO2_REG_IRQCTRL_ENABLE (CIO2_REG_IRQCTRL_BASE + 0x10) +#define CIO2_REG_IRQCTRL_LEVEL_NOT_PULSE (CIO2_REG_IRQCTRL_BASE + 0x14) + +#define CIO2_REG_GPREG_SRST (CIO2_REG_GPREG_BASE + 0x0) +#define CIO2_GPREG_SRST_ALL 0xffff /* Reset all */ +#define CIO2_REG_FB_HPLL_FREQ (CIO2_REG_GPREG_BASE + 0x08) +#define CIO2_REG_ISCLK_RATIO (CIO2_REG_GPREG_BASE + 0xc) + +#define CIO2_REG_CGC 0x1400 +#define CIO2_CGC_CSI2_TGE BIT(0) +#define CIO2_CGC_PRIM_TGE BIT(1) +#define CIO2_CGC_SIDE_TGE BIT(2) +#define CIO2_CGC_XOSC_TGE BIT(3) +#define CIO2_CGC_MPLL_SHUTDOWN_EN BIT(4) +#define CIO2_CGC_D3I3_TGE BIT(5) +#define CIO2_CGC_CSI2_INTERFRAME_TGE BIT(6) +#define CIO2_CGC_CSI2_PORT_DCGE BIT(8) +#define CIO2_CGC_CSI2_DCGE BIT(9) +#define CIO2_CGC_SIDE_DCGE BIT(10) +#define CIO2_CGC_PRIM_DCGE BIT(11) +#define CIO2_CGC_ROSC_DCGE BIT(12) +#define CIO2_CGC_XOSC_DCGE BIT(13) +#define CIO2_CGC_FLIS_DCGE BIT(14) +#define CIO2_CGC_CLKGATE_HOLDOFF_SHIFT 20 +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF_SHIFT 24 +#define CIO2_REG_D0I3C 0x1408 +#define CIO2_D0I3C_I3 BIT(2) /* Set D0I3 */ +#define CIO2_D0I3C_RR BIT(3) /* Restore? */ +#define CIO2_REG_SWRESET 0x140c +#define CIO2_SWRESET_SWRESET 1 +#define CIO2_REG_SENSOR_ACTIVE 0x1410 +#define CIO2_REG_INT_STS 0x1414 +#define CIO2_REG_INT_STS_EXT_OE 0x1418 +#define CIO2_INT_EXT_OE_DMAOE_SHIFT 0 +#define CIO2_INT_EXT_OE_DMAOE_MASK 0x7ffff +#define CIO2_INT_EXT_OE_OES_SHIFT 24 +#define CIO2_INT_EXT_OE_OES_MASK (0xf << CIO2_INT_EXT_OE_OES_SHIFT) +#define CIO2_REG_INT_EN 0x1420 +#define CIO2_REG_INT_EN_IRQ (1 << 24) +#define CIO2_REG_INT_EN_IOS(dma) (1 << (((dma) >> 1) + 12)) +/* + * Interrupt on completion bit, Eg. DMA 0-3 maps to bit 0-3, + * DMA4 & DMA5 map to bit 4 ... DMA18 & DMA19 map to bit 11 Et cetera + */ +#define CIO2_INT_IOC(dma) (1 << ((dma) < 4 ? (dma) : ((dma) >> 1) + 2)) +#define CIO2_INT_IOC_SHIFT 0 +#define CIO2_INT_IOC_MASK (0x7ff << CIO2_INT_IOC_SHIFT) +#define CIO2_INT_IOS_IOLN(dma) (1 << (((dma) >> 1) + 12)) +#define CIO2_INT_IOS_IOLN_SHIFT 12 +#define CIO2_INT_IOS_IOLN_MASK (0x3ff << CIO2_INT_IOS_IOLN_SHIFT) +#define CIO2_INT_IOIE BIT(22) +#define CIO2_INT_IOOE BIT(23) +#define CIO2_INT_IOIRQ BIT(24) +#define CIO2_REG_INT_EN_EXT_OE 0x1424 +#define CIO2_REG_DMA_DBG 0x1448 +#define CIO2_REG_DMA_DBG_DMA_INDEX_SHIFT 0 +#define CIO2_REG_PBM_ARB_CTRL 0x1460 +#define CIO2_PBM_ARB_CTRL_LANES_DIV 0 /* 4-4-2-2 lanes */ +#define CIO2_PBM_ARB_CTRL_LANES_DIV_SHIFT 0 +#define CIO2_PBM_ARB_CTRL_LE_EN BIT(7) +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN 2 +#define CIO2_PBM_ARB_CTRL_PLL_POST_SHTDN_SHIFT 8 +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP 480 +#define CIO2_PBM_ARB_CTRL_PLL_AHD_WK_UP_SHIFT 16 +#define CIO2_REG_PBM_WMCTRL1 0x1464 +#define CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT 0 +#define CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT 8 +#define CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT 16 +#define CIO2_PBM_WMCTRL1_TS_COUNT_DISABLE BIT(31) +#define CIO2_PBM_WMCTRL1_MIN_2CK (4 << CIO2_PBM_WMCTRL1_MIN_2CK_SHIFT) +#define CIO2_PBM_WMCTRL1_MID1_2CK (16 << CIO2_PBM_WMCTRL1_MID1_2CK_SHIFT) +#define CIO2_PBM_WMCTRL1_MID2_2CK (21 << CIO2_PBM_WMCTRL1_MID2_2CK_SHIFT) +#define CIO2_REG_PBM_WMCTRL2 0x1468 +#define CIO2_PBM_WMCTRL2_HWM_2CK 48 +#define CIO2_PBM_WMCTRL2_HWM_2CK_SHIFT 0 +#define CIO2_PBM_WMCTRL2_LWM_2CK 22 +#define CIO2_PBM_WMCTRL2_LWM_2CK_SHIFT 8 +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK 2 +#define CIO2_PBM_WMCTRL2_OBFFWM_2CK_SHIFT 16 +#define CIO2_PBM_WMCTRL2_TRANSDYN 1 +#define CIO2_PBM_WMCTRL2_TRANSDYN_SHIFT 24 +#define CIO2_PBM_WMCTRL2_DYNWMEN BIT(28) +#define CIO2_PBM_WMCTRL2_OBFF_MEM_EN BIT(29) +#define CIO2_PBM_WMCTRL2_OBFF_CPU_EN BIT(30) +#define CIO2_PBM_WMCTRL2_DRAINNOW BIT(31) +#define CIO2_REG_PBM_TS_COUNT 0x146c +#define CIO2_REG_PBM_FOPN_ABORT 0x1474 +/* below n = 0..3 */ +#define CIO2_PBM_FOPN_ABORT(n) (0x1 << 8*(n)) +#define CIO2_PBM_FOPN_FORCE_ABORT(n) (0x2 << 8*(n)) +#define CIO2_PBM_FOPN_FRAMEOPEN(n) (0x8 << 8*(n)) +#define CIO2_REG_LTRCTRL 0x1480 +#define CIO2_LTRCTRL_LTRDYNEN BIT(16) +#define CIO2_LTRCTRL_LTRSTABLETIME_SHIFT 8 +#define CIO2_LTRCTRL_LTRSTABLETIME_MASK 0xff +#define CIO2_LTRCTRL_LTRSEL1S3 BIT(7) +#define CIO2_LTRCTRL_LTRSEL1S2 BIT(6) +#define CIO2_LTRCTRL_LTRSEL1S1 BIT(5) +#define CIO2_LTRCTRL_LTRSEL1S0 BIT(4) +#define CIO2_LTRCTRL_LTRSEL2S3 BIT(3) +#define CIO2_LTRCTRL_LTRSEL2S2 BIT(2) +#define CIO2_LTRCTRL_LTRSEL2S1 BIT(1) +#define CIO2_LTRCTRL_LTRSEL2S0 BIT(0) +#define CIO2_REG_LTRVAL23 0x1484 +#define CIO2_REG_LTRVAL01 0x1488 +#define CIO2_LTRVAL02_VAL_SHIFT 0 +#define CIO2_LTRVAL02_SCALE_SHIFT 10 +#define CIO2_LTRVAL13_VAL_SHIFT 16 +#define CIO2_LTRVAL13_SCALE_SHIFT 26 + +#define CIO2_REG_CDMABA(n) (0x1500 + 0x10*(n)) /* n = 0..19 */ +#define CIO2_REG_CDMARI(n) (0x1504 + 0x10*(n)) +#define CIO2_CDMARI_FBPT_RP_SHIFT 0 +#define CIO2_CDMARI_FBPT_RP_MASK 0xff +#define CIO2_REG_CDMAC0(n) (0x1508 + 0x10*(n)) +#define CIO2_CDMAC0_FBPT_LEN_SHIFT 0 +#define CIO2_CDMAC0_FBPT_WIDTH_SHIFT 8 +#define CIO2_CDMAC0_FBPT_NS BIT(25) +#define CIO2_CDMAC0_DMA_INTR_ON_FS BIT(26) +#define CIO2_CDMAC0_DMA_INTR_ON_FE BIT(27) +#define CIO2_CDMAC0_FBPT_UPDATE_FIFO_FULL BIT(28) +#define CIO2_CDMAC0_FBPT_FIFO_FULL_FIX_DIS BIT(29) +#define CIO2_CDMAC0_DMA_EN BIT(30) +#define CIO2_CDMAC0_DMA_HALTED BIT(31) +#define CIO2_REG_CDMAC1(n) (0x150c + 0x10*(n)) +#define CIO2_CDMAC1_LINENUMINT_SHIFT 0 +#define CIO2_CDMAC1_LINENUMUPDATE_SHIFT 16 +/* n = 0..3 */ +#define CIO2_REG_PXM_PXF_FMT_CFG0(n) (0x1700 + 0x30*(n)) +#define CIO2_PXM_PXF_FMT_CFG_SID0_SHIFT 0 +#define CIO2_PXM_PXF_FMT_CFG_SID1_SHIFT 16 +#define CIO2_PXM_PXF_FMT_CFG_PCK_64B (0 << 0) +#define CIO2_PXM_PXF_FMT_CFG_PCK_32B (1 << 0) +#define CIO2_PXM_PXF_FMT_CFG_BPP_08 (0 << 2) +#define CIO2_PXM_PXF_FMT_CFG_BPP_10 (1 << 2) +#define CIO2_PXM_PXF_FMT_CFG_BPP_12 (2 << 2) +#define CIO2_PXM_PXF_FMT_CFG_BPP_14 (3 << 2) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_4PPC (0 << 4) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_RGBA (1 << 4) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_3PPC_ARGB (2 << 4) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR2 (3 << 4) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_PLANAR3 (4 << 4) +#define CIO2_PXM_PXF_FMT_CFG_SPEC_NV16 (5 << 4) +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_AB (1 << 7) +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_1ST_CD (1 << 8) +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_AC (1 << 9) +#define CIO2_PXM_PXF_FMT_CFG_PSWAP4_2ND_BD (1 << 10) +#define CIO2_REG_INT_STS_EXT_IE 0x17e4 +#define CIO2_REG_INT_EN_EXT_IE 0x17e8 +#define CIO2_INT_EXT_IE_ECC_RE(n) (0x01 << (8 * (n))) +#define CIO2_INT_EXT_IE_DPHY_NR(n) (0x02 << (8 * (n))) +#define CIO2_INT_EXT_IE_ECC_NR(n) (0x04 << (8 * (n))) +#define CIO2_INT_EXT_IE_CRCERR(n) (0x08 << (8 * (n))) +#define CIO2_INT_EXT_IE_INTERFRAMEDATA(n) (0x10 << (8 * (n))) +#define CIO2_INT_EXT_IE_PKT2SHORT(n) (0x20 << (8 * (n))) +#define CIO2_INT_EXT_IE_PKT2LONG(n) (0x40 << (8 * (n))) +#define CIO2_INT_EXT_IE_IRQ(n) (0x80 << (8 * (n))) +#define CIO2_REG_PXM_FRF_CFG(n) (0x1720 + 0x30*(n)) +#define CIO2_PXM_FRF_CFG_FNSEL BIT(0) +#define CIO2_PXM_FRF_CFG_FN_RST BIT(1) +#define CIO2_PXM_FRF_CFG_ABORT BIT(2) +#define CIO2_PXM_FRF_CFG_CRC_TH_SHIFT 3 +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NR BIT(8) +#define CIO2_PXM_FRF_CFG_MSK_ECC_RE BIT(9) +#define CIO2_PXM_FRF_CFG_MSK_ECC_DPHY_NE BIT(10) +#define CIO2_PXM_FRF_CFG_EVEN_ODD_MODE_SHIFT 11 +#define CIO2_PXM_FRF_CFG_MASK_CRC_THRES BIT(13) +#define CIO2_PXM_FRF_CFG_MASK_CSI_ACCEPT BIT(14) +#define CIO2_PXM_FRF_CFG_CIOHC_FS_MODE BIT(15) +#define CIO2_PXM_FRF_CFG_CIOHC_FRST_FRM_SHIFT 16 +#define CIO2_REG_PXM_SID2BID0(n) (0x1724 + 0x30*(n)) +#define CIO2_FB_HPLL_FREQ 0x2 +#define CIO2_ISCLK_RATIO 0xc + +#define CIO2_IRQCTRL_MASK 0x3ffff + +#define CIO2_INT_EN_EXT_OE_MASK 0x8f0fffff + +#define CIO2_CGC_CLKGATE_HOLDOFF 3 +#define CIO2_CGC_CSI_CLKGATE_HOLDOFF 5 + +#define CIO2_LTRVAL0_VAL 500 +/* Value times 1024 ns */ +#define CIO2_LTRVAL0_SCALE 2 +#define CIO2_LTRVAL1_VAL 90 +#define CIO2_LTRVAL1_SCALE 2 +#define CIO2_LTRVAL2_VAL 90 +#define CIO2_LTRVAL2_SCALE 2 +#define CIO2_LTRVAL3_VAL 90 +#define CIO2_LTRVAL3_SCALE 2 + +#define CIO2_PXM_FRF_CFG_CRC_TH 16 + +#define CIO2_INT_EN_EXT_IE_MASK 0xffffffff + +#define CIO2_DMA_CHAN 0 + +#define CIO2_CSIRX_DLY_CNT_CLANE_IDX -1 + +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_A 0 +#define CIO2_CSIRX_DLY_CNT_TERMEN_CLANE_B 0 +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_A 95 +#define CIO2_CSIRX_DLY_CNT_SETTLE_CLANE_B -8 + +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_A 0 +#define CIO2_CSIRX_DLY_CNT_TERMEN_DLANE_B 0 +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_A 85 +#define CIO2_CSIRX_DLY_CNT_SETTLE_DLANE_B -2 + +#define CIO2_CSIRX_DLY_CNT_TERMEN_DEFAULT 0x4 +#define CIO2_CSIRX_DLY_CNT_SETTLE_DEFAULT 0x570 + +#define CIO2_PMCSR_OFFSET 4 +#define CIO2_PMCSR_D0D3_SHIFT 2 +#define CIO2_PMCSR_D3 0x3 + +struct cio2_csi2_timing { + s32 clk_termen; + s32 clk_settle; + s32 dat_termen; + s32 dat_settle; +}; + +struct cio2_buffer { + struct vb2_v4l2_buffer vbb; + u32 *lop[CIO2_MAX_LOPS]; + dma_addr_t lop_bus_addr[CIO2_MAX_LOPS]; +}; + +struct csi2_bus_info { + u32 port; + u32 num_of_lanes; +}; + +struct cio2_queue { + /* mutex to be used by vb2_queue */ + struct mutex lock; + struct media_pipeline pipe; + struct csi2_bus_info csi2; + struct v4l2_subdev *sensor; + void __iomem *csi_rx_base; + + /* Subdev, /dev/v4l-subdevX */ + struct v4l2_subdev subdev; + struct media_pad subdev_pads[CIO2_PADS]; + struct v4l2_mbus_framefmt subdev_fmt; + atomic_t frame_sequence; + + /* Video device, /dev/videoX */ + struct video_device vdev; + struct media_pad vdev_pad; + struct v4l2_pix_format format; + struct vb2_queue vbq; + + /* Buffer queue handling */ + struct cio2_fbpt_entry *fbpt; /* Frame buffer pointer table */ + dma_addr_t fbpt_bus_addr; + struct cio2_buffer *bufs[CIO2_MAX_BUFFERS]; + unsigned int bufs_first; /* Index of the first used entry */ + unsigned int bufs_next; /* Index of the first unused entry */ + atomic_t bufs_queued; +}; + +struct cio2_device { + struct pci_dev *pci_dev; + void __iomem *base; + struct v4l2_device v4l2_dev; + struct cio2_queue queue[CIO2_QUEUES]; + struct cio2_queue *cur_queue; + /* mutex to be used by video_device */ + struct mutex lock; + + struct v4l2_async_notifier notifier; + struct media_device media_dev; + + /* + * Safety net to catch DMA fetch ahead + * when reaching the end of LOP + */ + void *dummy_page; + /* DMA handle of dummy_page */ + dma_addr_t dummy_page_bus_addr; + /* single List of Pointers (LOP) page */ + u32 *dummy_lop; + /* DMA handle of dummy_lop */ + dma_addr_t dummy_lop_bus_addr; +}; + +/**************** Virtual channel ****************/ +/* + * This should come from sensor driver. No + * driver interface nor requirement yet. + */ +#define SENSOR_VIR_CH_DFLT 0 + +/**************** FBPT operations ****************/ +#define CIO2_FBPT_SIZE (CIO2_MAX_BUFFERS * CIO2_MAX_LOPS * \ + sizeof(struct cio2_fbpt_entry)) + +#define CIO2_FBPT_SUBENTRY_UNIT 4 +#define CIO2_PAGE_SIZE PAGE_SIZE + +/* + * Frame Buffer Pointer Table(FBPT) entry + * each entry describe an output buffer and consists of + * several sub-entries + */ +struct __packed cio2_fbpt_entry { + union { + struct __packed { + u32 ctrl; /* status ctrl */ +#define CIO2_FBPT_CTRL_VALID BIT(0) +#define CIO2_FBPT_CTRL_IOC BIT(1) +#define CIO2_FBPT_CTRL_IOS BIT(2) +#define CIO2_FBPT_CTRL_SUCCXFAIL BIT(3) +#define CIO2_FBPT_CTRL_CMPLCODE_SHIFT 4 + u16 cur_line_num; /* current line # written to DDR */ + u16 frame_num; /* updated by DMA upon FE */ + u32 first_page_offset; /* offset for 1st page in LOP */ + } first_entry; + /* Second entry per buffer */ + struct __packed { + u32 timestamp; + u32 num_of_bytes; + /* the number of bytes for write on last page */ + u16 last_page_available_bytes; + /* the number of pages allocated for this buf */ + u16 num_of_pages; + } second_entry; + struct __packed { + u64 __reserved1; + u32 __reserved0; + } other_entries; + }; + u32 lop_page_addr; /* Points to list of pointers (LOP) table */ +}; + +static inline struct cio2_queue *file_to_cio2_queue(struct file *file) +{ + return container_of(video_devdata(file), struct cio2_queue, vdev); +} + +static inline struct cio2_queue *vb2q_to_cio2_queue(struct vb2_queue *vq) +{ + return container_of(vq, struct cio2_queue, vbq); +} + +#endif