1b873663bSTodor Tomov // SPDX-License-Identifier: GPL-2.0 2ec6859b2STodor Tomov /* 3ec6859b2STodor Tomov * camss-ispif.c 4ec6859b2STodor Tomov * 5ec6859b2STodor Tomov * Qualcomm MSM Camera Subsystem - ISPIF (ISP Interface) Module 6ec6859b2STodor Tomov * 7ec6859b2STodor Tomov * Copyright (c) 2013-2015, The Linux Foundation. All rights reserved. 8ec6859b2STodor Tomov * Copyright (C) 2015-2018 Linaro Ltd. 9ec6859b2STodor Tomov */ 10ec6859b2STodor Tomov #include <linux/clk.h> 11ec6859b2STodor Tomov #include <linux/completion.h> 12ec6859b2STodor Tomov #include <linux/interrupt.h> 133799eca5SArnd Bergmann #include <linux/io.h> 14ec6859b2STodor Tomov #include <linux/iopoll.h> 15ec6859b2STodor Tomov #include <linux/kernel.h> 16ec6859b2STodor Tomov #include <linux/mutex.h> 17ec6859b2STodor Tomov #include <linux/platform_device.h> 1802afa816STodor Tomov #include <linux/pm_runtime.h> 19ec6859b2STodor Tomov #include <media/media-entity.h> 20ec6859b2STodor Tomov #include <media/v4l2-device.h> 21ec6859b2STodor Tomov #include <media/v4l2-subdev.h> 22ec6859b2STodor Tomov 23ec6859b2STodor Tomov #include "camss-ispif.h" 24ec6859b2STodor Tomov #include "camss.h" 25ec6859b2STodor Tomov 26ec6859b2STodor Tomov #define MSM_ISPIF_NAME "msm_ispif" 27ec6859b2STodor Tomov 28ec6859b2STodor Tomov #define ISPIF_RST_CMD_0 0x008 29864ed874SAngeloGioacchino Del Regno #define ISPIF_RST_CMD_1 0x00c 30ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_STROBED_RST_EN (1 << 0) 31ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_MISC_LOGIC_RST (1 << 1) 32ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_SW_REG_RST (1 << 2) 33ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_PIX_INTF_0_CSID_RST (1 << 3) 34ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_PIX_INTF_0_VFE_RST (1 << 4) 35ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_PIX_INTF_1_CSID_RST (1 << 5) 36ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_PIX_INTF_1_VFE_RST (1 << 6) 37ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_0_CSID_RST (1 << 7) 38ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_0_VFE_RST (1 << 8) 39ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_1_CSID_RST (1 << 9) 40ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_1_VFE_RST (1 << 10) 41ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_2_CSID_RST (1 << 11) 42ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_INTF_2_VFE_RST (1 << 12) 43ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_PIX_OUTPUT_0_MISR_RST (1 << 16) 44ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_OUTPUT_0_MISR_RST (1 << 17) 45ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_OUTPUT_1_MISR_RST (1 << 18) 46ec6859b2STodor Tomov #define ISPIF_RST_CMD_0_RDI_OUTPUT_2_MISR_RST (1 << 19) 47ec6859b2STodor Tomov #define ISPIF_IRQ_GLOBAL_CLEAR_CMD 0x01c 48ec6859b2STodor Tomov #define ISPIF_VFE_m_CTRL_0(m) (0x200 + 0x200 * (m)) 49ec6859b2STodor Tomov #define ISPIF_VFE_m_CTRL_0_PIX0_LINE_BUF_EN (1 << 6) 50ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_0(m) (0x208 + 0x200 * (m)) 51ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_0_PIX0_ENABLE 0x00001249 52ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_0_PIX0_MASK 0x00001fff 53ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_0_RDI0_ENABLE 0x02492000 54ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_0_RDI0_MASK 0x03ffe000 55ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_1(m) (0x20c + 0x200 * (m)) 56ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_1_PIX1_ENABLE 0x00001249 57ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_1_PIX1_MASK 0x00001fff 58ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_1_RDI1_ENABLE 0x02492000 59ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_1_RDI1_MASK 0x03ffe000 60ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_2(m) (0x210 + 0x200 * (m)) 61ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_2_RDI2_ENABLE 0x00001249 62ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_MASK_2_RDI2_MASK 0x00001fff 63ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_0(m) (0x21c + 0x200 * (m)) 64ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW (1 << 12) 65ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_0_RDI0_OVERFLOW (1 << 25) 66ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_1(m) (0x220 + 0x200 * (m)) 67ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_1_PIX1_OVERFLOW (1 << 12) 68ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_1_RDI1_OVERFLOW (1 << 25) 69ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_2(m) (0x224 + 0x200 * (m)) 70ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_STATUS_2_RDI2_OVERFLOW (1 << 12) 71ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_CLEAR_0(m) (0x230 + 0x200 * (m)) 72ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_CLEAR_1(m) (0x234 + 0x200 * (m)) 73ec6859b2STodor Tomov #define ISPIF_VFE_m_IRQ_CLEAR_2(m) (0x238 + 0x200 * (m)) 74ec6859b2STodor Tomov #define ISPIF_VFE_m_INTF_INPUT_SEL(m) (0x244 + 0x200 * (m)) 75ec6859b2STodor Tomov #define ISPIF_VFE_m_INTF_CMD_0(m) (0x248 + 0x200 * (m)) 76ec6859b2STodor Tomov #define ISPIF_VFE_m_INTF_CMD_1(m) (0x24c + 0x200 * (m)) 77ec6859b2STodor Tomov #define ISPIF_VFE_m_PIX_INTF_n_CID_MASK(m, n) \ 78ec6859b2STodor Tomov (0x254 + 0x200 * (m) + 0x4 * (n)) 79ec6859b2STodor Tomov #define ISPIF_VFE_m_RDI_INTF_n_CID_MASK(m, n) \ 80ec6859b2STodor Tomov (0x264 + 0x200 * (m) + 0x4 * (n)) 815019d7c8STodor Tomov /* PACK_CFG registers are 8x96 only */ 825019d7c8STodor Tomov #define ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0(m, n) \ 835019d7c8STodor Tomov (0x270 + 0x200 * (m) + 0x4 * (n)) 845019d7c8STodor Tomov #define ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_1(m, n) \ 855019d7c8STodor Tomov (0x27c + 0x200 * (m) + 0x4 * (n)) 865019d7c8STodor Tomov #define ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0_CID_c_PLAIN(c) \ 875019d7c8STodor Tomov (1 << ((cid % 8) * 4)) 88ec6859b2STodor Tomov #define ISPIF_VFE_m_PIX_INTF_n_STATUS(m, n) \ 89ec6859b2STodor Tomov (0x2c0 + 0x200 * (m) + 0x4 * (n)) 90ec6859b2STodor Tomov #define ISPIF_VFE_m_RDI_INTF_n_STATUS(m, n) \ 91ec6859b2STodor Tomov (0x2d0 + 0x200 * (m) + 0x4 * (n)) 92ec6859b2STodor Tomov 93ec6859b2STodor Tomov #define CSI_PIX_CLK_MUX_SEL 0x000 94ec6859b2STodor Tomov #define CSI_RDI_CLK_MUX_SEL 0x008 95ec6859b2STodor Tomov 96ec6859b2STodor Tomov #define ISPIF_TIMEOUT_SLEEP_US 1000 97ec6859b2STodor Tomov #define ISPIF_TIMEOUT_ALL_US 1000000 98ec6859b2STodor Tomov #define ISPIF_RESET_TIMEOUT_MS 500 99ec6859b2STodor Tomov 100ec6859b2STodor Tomov enum ispif_intf_cmd { 101ec6859b2STodor Tomov CMD_DISABLE_FRAME_BOUNDARY = 0x0, 102ec6859b2STodor Tomov CMD_ENABLE_FRAME_BOUNDARY = 0x1, 103ec6859b2STodor Tomov CMD_DISABLE_IMMEDIATELY = 0x2, 104ec6859b2STodor Tomov CMD_ALL_DISABLE_IMMEDIATELY = 0xaaaaaaaa, 105ec6859b2STodor Tomov CMD_ALL_NO_CHANGE = 0xffffffff, 106ec6859b2STodor Tomov }; 107ec6859b2STodor Tomov 108cba3819dSTodor Tomov static const u32 ispif_formats_8x16[] = { 109cba3819dSTodor Tomov MEDIA_BUS_FMT_UYVY8_2X8, 110cba3819dSTodor Tomov MEDIA_BUS_FMT_VYUY8_2X8, 111cba3819dSTodor Tomov MEDIA_BUS_FMT_YUYV8_2X8, 112cba3819dSTodor Tomov MEDIA_BUS_FMT_YVYU8_2X8, 113cba3819dSTodor Tomov MEDIA_BUS_FMT_SBGGR8_1X8, 114cba3819dSTodor Tomov MEDIA_BUS_FMT_SGBRG8_1X8, 115cba3819dSTodor Tomov MEDIA_BUS_FMT_SGRBG8_1X8, 116cba3819dSTodor Tomov MEDIA_BUS_FMT_SRGGB8_1X8, 117cba3819dSTodor Tomov MEDIA_BUS_FMT_SBGGR10_1X10, 118cba3819dSTodor Tomov MEDIA_BUS_FMT_SGBRG10_1X10, 119cba3819dSTodor Tomov MEDIA_BUS_FMT_SGRBG10_1X10, 120cba3819dSTodor Tomov MEDIA_BUS_FMT_SRGGB10_1X10, 121cba3819dSTodor Tomov MEDIA_BUS_FMT_SBGGR12_1X12, 122cba3819dSTodor Tomov MEDIA_BUS_FMT_SGBRG12_1X12, 123cba3819dSTodor Tomov MEDIA_BUS_FMT_SGRBG12_1X12, 124cba3819dSTodor Tomov MEDIA_BUS_FMT_SRGGB12_1X12, 125cc8fe073STodor Tomov MEDIA_BUS_FMT_Y10_1X10, 126cba3819dSTodor Tomov }; 127cba3819dSTodor Tomov 128cba3819dSTodor Tomov static const u32 ispif_formats_8x96[] = { 129ec6859b2STodor Tomov MEDIA_BUS_FMT_UYVY8_2X8, 130ec6859b2STodor Tomov MEDIA_BUS_FMT_VYUY8_2X8, 131ec6859b2STodor Tomov MEDIA_BUS_FMT_YUYV8_2X8, 132ec6859b2STodor Tomov MEDIA_BUS_FMT_YVYU8_2X8, 133ec6859b2STodor Tomov MEDIA_BUS_FMT_SBGGR8_1X8, 134ec6859b2STodor Tomov MEDIA_BUS_FMT_SGBRG8_1X8, 135ec6859b2STodor Tomov MEDIA_BUS_FMT_SGRBG8_1X8, 136ec6859b2STodor Tomov MEDIA_BUS_FMT_SRGGB8_1X8, 137ec6859b2STodor Tomov MEDIA_BUS_FMT_SBGGR10_1X10, 138ec6859b2STodor Tomov MEDIA_BUS_FMT_SGBRG10_1X10, 139ec6859b2STodor Tomov MEDIA_BUS_FMT_SGRBG10_1X10, 140ec6859b2STodor Tomov MEDIA_BUS_FMT_SRGGB10_1X10, 1415019d7c8STodor Tomov MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE, 142ec6859b2STodor Tomov MEDIA_BUS_FMT_SBGGR12_1X12, 143ec6859b2STodor Tomov MEDIA_BUS_FMT_SGBRG12_1X12, 144ec6859b2STodor Tomov MEDIA_BUS_FMT_SGRBG12_1X12, 145ec6859b2STodor Tomov MEDIA_BUS_FMT_SRGGB12_1X12, 146f476fb56STodor Tomov MEDIA_BUS_FMT_SBGGR14_1X14, 147f476fb56STodor Tomov MEDIA_BUS_FMT_SGBRG14_1X14, 148f476fb56STodor Tomov MEDIA_BUS_FMT_SGRBG14_1X14, 149f476fb56STodor Tomov MEDIA_BUS_FMT_SRGGB14_1X14, 150cc8fe073STodor Tomov MEDIA_BUS_FMT_Y10_1X10, 151cc8fe073STodor Tomov MEDIA_BUS_FMT_Y10_2X8_PADHI_LE, 152ec6859b2STodor Tomov }; 153ec6859b2STodor Tomov 154ec6859b2STodor Tomov /* 155e08c7f86STodor Tomov * ispif_isr_8x96 - ISPIF module interrupt handler for 8x96 156ec6859b2STodor Tomov * @irq: Interrupt line 157ec6859b2STodor Tomov * @dev: ISPIF device 158ec6859b2STodor Tomov * 159ec6859b2STodor Tomov * Return IRQ_HANDLED on success 160ec6859b2STodor Tomov */ 161e08c7f86STodor Tomov static irqreturn_t ispif_isr_8x96(int irq, void *dev) 162e08c7f86STodor Tomov { 163e08c7f86STodor Tomov struct ispif_device *ispif = dev; 1649d95baf9SRobert Foss struct camss *camss = ispif->camss; 165e08c7f86STodor Tomov u32 value0, value1, value2, value3, value4, value5; 166e08c7f86STodor Tomov 167e08c7f86STodor Tomov value0 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_0(0)); 168e08c7f86STodor Tomov value1 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_1(0)); 169e08c7f86STodor Tomov value2 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_2(0)); 170e08c7f86STodor Tomov value3 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_0(1)); 171e08c7f86STodor Tomov value4 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_1(1)); 172e08c7f86STodor Tomov value5 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_2(1)); 173e08c7f86STodor Tomov 174e08c7f86STodor Tomov writel_relaxed(value0, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_0(0)); 175e08c7f86STodor Tomov writel_relaxed(value1, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_1(0)); 176e08c7f86STodor Tomov writel_relaxed(value2, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_2(0)); 177e08c7f86STodor Tomov writel_relaxed(value3, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_0(1)); 178e08c7f86STodor Tomov writel_relaxed(value4, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_1(1)); 179e08c7f86STodor Tomov writel_relaxed(value5, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_2(1)); 180e08c7f86STodor Tomov 181e08c7f86STodor Tomov writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD); 182e08c7f86STodor Tomov 183e08c7f86STodor Tomov if ((value0 >> 27) & 0x1) 184864ed874SAngeloGioacchino Del Regno complete(&ispif->reset_complete[0]); 185864ed874SAngeloGioacchino Del Regno 186864ed874SAngeloGioacchino Del Regno if ((value3 >> 27) & 0x1) 187864ed874SAngeloGioacchino Del Regno complete(&ispif->reset_complete[1]); 188e08c7f86STodor Tomov 189e08c7f86STodor Tomov if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW)) 1909d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 pix0 overflow\n"); 191e08c7f86STodor Tomov 192e08c7f86STodor Tomov if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_RDI0_OVERFLOW)) 1939d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi0 overflow\n"); 194e08c7f86STodor Tomov 195e08c7f86STodor Tomov if (unlikely(value1 & ISPIF_VFE_m_IRQ_STATUS_1_PIX1_OVERFLOW)) 1969d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 pix1 overflow\n"); 197e08c7f86STodor Tomov 198e08c7f86STodor Tomov if (unlikely(value1 & ISPIF_VFE_m_IRQ_STATUS_1_RDI1_OVERFLOW)) 1999d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi1 overflow\n"); 200e08c7f86STodor Tomov 201e08c7f86STodor Tomov if (unlikely(value2 & ISPIF_VFE_m_IRQ_STATUS_2_RDI2_OVERFLOW)) 2029d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi2 overflow\n"); 203e08c7f86STodor Tomov 204e08c7f86STodor Tomov if (unlikely(value3 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW)) 2059d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE1 pix0 overflow\n"); 206e08c7f86STodor Tomov 207e08c7f86STodor Tomov if (unlikely(value3 & ISPIF_VFE_m_IRQ_STATUS_0_RDI0_OVERFLOW)) 2089d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE1 rdi0 overflow\n"); 209e08c7f86STodor Tomov 210e08c7f86STodor Tomov if (unlikely(value4 & ISPIF_VFE_m_IRQ_STATUS_1_PIX1_OVERFLOW)) 2119d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE1 pix1 overflow\n"); 212e08c7f86STodor Tomov 213e08c7f86STodor Tomov if (unlikely(value4 & ISPIF_VFE_m_IRQ_STATUS_1_RDI1_OVERFLOW)) 2149d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE1 rdi1 overflow\n"); 215e08c7f86STodor Tomov 216e08c7f86STodor Tomov if (unlikely(value5 & ISPIF_VFE_m_IRQ_STATUS_2_RDI2_OVERFLOW)) 2179d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE1 rdi2 overflow\n"); 218e08c7f86STodor Tomov 219e08c7f86STodor Tomov return IRQ_HANDLED; 220e08c7f86STodor Tomov } 221e08c7f86STodor Tomov 222e08c7f86STodor Tomov /* 223e08c7f86STodor Tomov * ispif_isr_8x16 - ISPIF module interrupt handler for 8x16 224e08c7f86STodor Tomov * @irq: Interrupt line 225e08c7f86STodor Tomov * @dev: ISPIF device 226e08c7f86STodor Tomov * 227e08c7f86STodor Tomov * Return IRQ_HANDLED on success 228e08c7f86STodor Tomov */ 229e08c7f86STodor Tomov static irqreturn_t ispif_isr_8x16(int irq, void *dev) 230ec6859b2STodor Tomov { 231ec6859b2STodor Tomov struct ispif_device *ispif = dev; 2329d95baf9SRobert Foss struct camss *camss = ispif->camss; 233ec6859b2STodor Tomov u32 value0, value1, value2; 234ec6859b2STodor Tomov 235ec6859b2STodor Tomov value0 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_0(0)); 236ec6859b2STodor Tomov value1 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_1(0)); 237ec6859b2STodor Tomov value2 = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_STATUS_2(0)); 238ec6859b2STodor Tomov 239ec6859b2STodor Tomov writel_relaxed(value0, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_0(0)); 240ec6859b2STodor Tomov writel_relaxed(value1, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_1(0)); 241ec6859b2STodor Tomov writel_relaxed(value2, ispif->base + ISPIF_VFE_m_IRQ_CLEAR_2(0)); 242ec6859b2STodor Tomov 243ec6859b2STodor Tomov writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD); 244ec6859b2STodor Tomov 245ec6859b2STodor Tomov if ((value0 >> 27) & 0x1) 246864ed874SAngeloGioacchino Del Regno complete(&ispif->reset_complete[0]); 247ec6859b2STodor Tomov 248ec6859b2STodor Tomov if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_PIX0_OVERFLOW)) 2499d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 pix0 overflow\n"); 250ec6859b2STodor Tomov 251ec6859b2STodor Tomov if (unlikely(value0 & ISPIF_VFE_m_IRQ_STATUS_0_RDI0_OVERFLOW)) 2529d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi0 overflow\n"); 253ec6859b2STodor Tomov 254ec6859b2STodor Tomov if (unlikely(value1 & ISPIF_VFE_m_IRQ_STATUS_1_PIX1_OVERFLOW)) 2559d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 pix1 overflow\n"); 256ec6859b2STodor Tomov 257ec6859b2STodor Tomov if (unlikely(value1 & ISPIF_VFE_m_IRQ_STATUS_1_RDI1_OVERFLOW)) 2589d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi1 overflow\n"); 259ec6859b2STodor Tomov 260ec6859b2STodor Tomov if (unlikely(value2 & ISPIF_VFE_m_IRQ_STATUS_2_RDI2_OVERFLOW)) 2619d95baf9SRobert Foss dev_err_ratelimited(camss->dev, "VFE0 rdi2 overflow\n"); 262ec6859b2STodor Tomov 263ec6859b2STodor Tomov return IRQ_HANDLED; 264ec6859b2STodor Tomov } 265ec6859b2STodor Tomov 266864ed874SAngeloGioacchino Del Regno static int ispif_vfe_reset(struct ispif_device *ispif, u8 vfe_id) 267ec6859b2STodor Tomov { 2689d95baf9SRobert Foss struct camss *camss = ispif->camss; 2699d95baf9SRobert Foss 270ec6859b2STodor Tomov unsigned long time; 271ec6859b2STodor Tomov u32 val; 272ec6859b2STodor Tomov 2739d95baf9SRobert Foss if (vfe_id > (camss->vfe_num - 1)) { 2749d95baf9SRobert Foss dev_err(camss->dev, 275864ed874SAngeloGioacchino Del Regno "Error: asked reset for invalid VFE%d\n", vfe_id); 276864ed874SAngeloGioacchino Del Regno return -ENOENT; 277864ed874SAngeloGioacchino Del Regno } 27802afa816STodor Tomov 279864ed874SAngeloGioacchino Del Regno reinit_completion(&ispif->reset_complete[vfe_id]); 280ec6859b2STodor Tomov 281ec6859b2STodor Tomov val = ISPIF_RST_CMD_0_STROBED_RST_EN | 282ec6859b2STodor Tomov ISPIF_RST_CMD_0_MISC_LOGIC_RST | 283ec6859b2STodor Tomov ISPIF_RST_CMD_0_SW_REG_RST | 284ec6859b2STodor Tomov ISPIF_RST_CMD_0_PIX_INTF_0_CSID_RST | 285ec6859b2STodor Tomov ISPIF_RST_CMD_0_PIX_INTF_0_VFE_RST | 286ec6859b2STodor Tomov ISPIF_RST_CMD_0_PIX_INTF_1_CSID_RST | 287ec6859b2STodor Tomov ISPIF_RST_CMD_0_PIX_INTF_1_VFE_RST | 288ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_0_CSID_RST | 289ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_0_VFE_RST | 290ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_1_CSID_RST | 291ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_1_VFE_RST | 292ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_2_CSID_RST | 293ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_INTF_2_VFE_RST | 294ec6859b2STodor Tomov ISPIF_RST_CMD_0_PIX_OUTPUT_0_MISR_RST | 295ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_OUTPUT_0_MISR_RST | 296ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_OUTPUT_1_MISR_RST | 297ec6859b2STodor Tomov ISPIF_RST_CMD_0_RDI_OUTPUT_2_MISR_RST; 298ec6859b2STodor Tomov 299864ed874SAngeloGioacchino Del Regno if (vfe_id == 1) 300864ed874SAngeloGioacchino Del Regno writel_relaxed(val, ispif->base + ISPIF_RST_CMD_1); 301864ed874SAngeloGioacchino Del Regno else 302ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_RST_CMD_0); 303ec6859b2STodor Tomov 304864ed874SAngeloGioacchino Del Regno time = wait_for_completion_timeout(&ispif->reset_complete[vfe_id], 305ec6859b2STodor Tomov msecs_to_jiffies(ISPIF_RESET_TIMEOUT_MS)); 306ec6859b2STodor Tomov if (!time) { 3079d95baf9SRobert Foss dev_err(camss->dev, 308864ed874SAngeloGioacchino Del Regno "ISPIF for VFE%d reset timeout\n", vfe_id); 309864ed874SAngeloGioacchino Del Regno return -EIO; 310ec6859b2STodor Tomov } 311ec6859b2STodor Tomov 312864ed874SAngeloGioacchino Del Regno return 0; 313864ed874SAngeloGioacchino Del Regno } 314864ed874SAngeloGioacchino Del Regno 315864ed874SAngeloGioacchino Del Regno /* 316864ed874SAngeloGioacchino Del Regno * ispif_reset - Trigger reset on ISPIF module and wait to complete 317864ed874SAngeloGioacchino Del Regno * @ispif: ISPIF device 318864ed874SAngeloGioacchino Del Regno * 319864ed874SAngeloGioacchino Del Regno * Return 0 on success or a negative error code otherwise 320864ed874SAngeloGioacchino Del Regno */ 321864ed874SAngeloGioacchino Del Regno static int ispif_reset(struct ispif_device *ispif, u8 vfe_id) 322864ed874SAngeloGioacchino Del Regno { 3239d95baf9SRobert Foss struct camss *camss = ispif->camss; 324864ed874SAngeloGioacchino Del Regno int ret; 325864ed874SAngeloGioacchino Del Regno 3269d95baf9SRobert Foss ret = camss_pm_domain_on(camss, PM_DOMAIN_VFE0); 327864ed874SAngeloGioacchino Del Regno if (ret < 0) 328864ed874SAngeloGioacchino Del Regno return ret; 329864ed874SAngeloGioacchino Del Regno 3309d95baf9SRobert Foss ret = camss_pm_domain_on(camss, PM_DOMAIN_VFE1); 331864ed874SAngeloGioacchino Del Regno if (ret < 0) 332864ed874SAngeloGioacchino Del Regno return ret; 333864ed874SAngeloGioacchino Del Regno 334864ed874SAngeloGioacchino Del Regno ret = camss_enable_clocks(ispif->nclocks_for_reset, 335864ed874SAngeloGioacchino Del Regno ispif->clock_for_reset, 3369d95baf9SRobert Foss camss->dev); 337864ed874SAngeloGioacchino Del Regno if (ret < 0) 338864ed874SAngeloGioacchino Del Regno return ret; 339864ed874SAngeloGioacchino Del Regno 340864ed874SAngeloGioacchino Del Regno ret = ispif_vfe_reset(ispif, vfe_id); 341864ed874SAngeloGioacchino Del Regno if (ret) 3429d95baf9SRobert Foss dev_dbg(camss->dev, "ISPIF Reset failed\n"); 343864ed874SAngeloGioacchino Del Regno 344ec6859b2STodor Tomov camss_disable_clocks(ispif->nclocks_for_reset, ispif->clock_for_reset); 345ec6859b2STodor Tomov 3469d95baf9SRobert Foss camss_pm_domain_off(camss, PM_DOMAIN_VFE0); 3479d95baf9SRobert Foss camss_pm_domain_off(camss, PM_DOMAIN_VFE1); 34802afa816STodor Tomov 34902afa816STodor Tomov return ret; 350ec6859b2STodor Tomov } 351ec6859b2STodor Tomov 352ec6859b2STodor Tomov /* 353ec6859b2STodor Tomov * ispif_set_power - Power on/off ISPIF module 354ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 355ec6859b2STodor Tomov * @on: Requested power state 356ec6859b2STodor Tomov * 357ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 358ec6859b2STodor Tomov */ 359ec6859b2STodor Tomov static int ispif_set_power(struct v4l2_subdev *sd, int on) 360ec6859b2STodor Tomov { 361ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 3629c3e59deSTodor Tomov struct ispif_device *ispif = line->ispif; 3639d95baf9SRobert Foss struct device *dev = ispif->camss->dev; 364ec6859b2STodor Tomov int ret = 0; 365ec6859b2STodor Tomov 366ec6859b2STodor Tomov mutex_lock(&ispif->power_lock); 367ec6859b2STodor Tomov 368ec6859b2STodor Tomov if (on) { 369ec6859b2STodor Tomov if (ispif->power_count) { 370ec6859b2STodor Tomov /* Power is already on */ 371ec6859b2STodor Tomov ispif->power_count++; 372ec6859b2STodor Tomov goto exit; 373ec6859b2STodor Tomov } 374ec6859b2STodor Tomov 37509dfb36cSMauro Carvalho Chehab ret = pm_runtime_resume_and_get(dev); 37609dfb36cSMauro Carvalho Chehab if (ret < 0) 377ec6859b2STodor Tomov goto exit; 378ec6859b2STodor Tomov 37902afa816STodor Tomov ret = camss_enable_clocks(ispif->nclocks, ispif->clock, dev); 38002afa816STodor Tomov if (ret < 0) { 38102afa816STodor Tomov pm_runtime_put_sync(dev); 38202afa816STodor Tomov goto exit; 38302afa816STodor Tomov } 38402afa816STodor Tomov 385864ed874SAngeloGioacchino Del Regno ret = ispif_reset(ispif, line->vfe_id); 386ec6859b2STodor Tomov if (ret < 0) { 38702afa816STodor Tomov pm_runtime_put_sync(dev); 388ec6859b2STodor Tomov camss_disable_clocks(ispif->nclocks, ispif->clock); 389ec6859b2STodor Tomov goto exit; 390ec6859b2STodor Tomov } 391ec6859b2STodor Tomov 392ec6859b2STodor Tomov ispif->intf_cmd[line->vfe_id].cmd_0 = CMD_ALL_NO_CHANGE; 393ec6859b2STodor Tomov ispif->intf_cmd[line->vfe_id].cmd_1 = CMD_ALL_NO_CHANGE; 394ec6859b2STodor Tomov 395ec6859b2STodor Tomov ispif->power_count++; 396ec6859b2STodor Tomov } else { 397ec6859b2STodor Tomov if (ispif->power_count == 0) { 398ec6859b2STodor Tomov dev_err(dev, "ispif power off on power_count == 0\n"); 399ec6859b2STodor Tomov goto exit; 400ec6859b2STodor Tomov } else if (ispif->power_count == 1) { 401ec6859b2STodor Tomov camss_disable_clocks(ispif->nclocks, ispif->clock); 40202afa816STodor Tomov pm_runtime_put_sync(dev); 403ec6859b2STodor Tomov } 404ec6859b2STodor Tomov 405ec6859b2STodor Tomov ispif->power_count--; 406ec6859b2STodor Tomov } 407ec6859b2STodor Tomov 408ec6859b2STodor Tomov exit: 409ec6859b2STodor Tomov mutex_unlock(&ispif->power_lock); 410ec6859b2STodor Tomov 411ec6859b2STodor Tomov return ret; 412ec6859b2STodor Tomov } 413ec6859b2STodor Tomov 414ec6859b2STodor Tomov /* 415ec6859b2STodor Tomov * ispif_select_clk_mux - Select clock for PIX/RDI interface 416ec6859b2STodor Tomov * @ispif: ISPIF device 417ec6859b2STodor Tomov * @intf: VFE interface 418ec6859b2STodor Tomov * @csid: CSID HW module id 419ec6859b2STodor Tomov * @vfe: VFE HW module id 420ec6859b2STodor Tomov * @enable: enable or disable the selected clock 421ec6859b2STodor Tomov */ 422ec6859b2STodor Tomov static void ispif_select_clk_mux(struct ispif_device *ispif, 423ec6859b2STodor Tomov enum ispif_intf intf, u8 csid, 424ec6859b2STodor Tomov u8 vfe, u8 enable) 425ec6859b2STodor Tomov { 426ec6859b2STodor Tomov u32 val; 427ec6859b2STodor Tomov 428ec6859b2STodor Tomov switch (intf) { 429ec6859b2STodor Tomov case PIX0: 430ec6859b2STodor Tomov val = readl_relaxed(ispif->base_clk_mux + CSI_PIX_CLK_MUX_SEL); 431ec6859b2STodor Tomov val &= ~(0xf << (vfe * 8)); 432ec6859b2STodor Tomov if (enable) 433ec6859b2STodor Tomov val |= (csid << (vfe * 8)); 434ec6859b2STodor Tomov writel_relaxed(val, ispif->base_clk_mux + CSI_PIX_CLK_MUX_SEL); 435ec6859b2STodor Tomov break; 436ec6859b2STodor Tomov 437ec6859b2STodor Tomov case RDI0: 438ec6859b2STodor Tomov val = readl_relaxed(ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 439ec6859b2STodor Tomov val &= ~(0xf << (vfe * 12)); 440ec6859b2STodor Tomov if (enable) 441ec6859b2STodor Tomov val |= (csid << (vfe * 12)); 442ec6859b2STodor Tomov writel_relaxed(val, ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 443ec6859b2STodor Tomov break; 444ec6859b2STodor Tomov 445ec6859b2STodor Tomov case PIX1: 446ec6859b2STodor Tomov val = readl_relaxed(ispif->base_clk_mux + CSI_PIX_CLK_MUX_SEL); 447ec6859b2STodor Tomov val &= ~(0xf << (4 + (vfe * 8))); 448ec6859b2STodor Tomov if (enable) 449ec6859b2STodor Tomov val |= (csid << (4 + (vfe * 8))); 450ec6859b2STodor Tomov writel_relaxed(val, ispif->base_clk_mux + CSI_PIX_CLK_MUX_SEL); 451ec6859b2STodor Tomov break; 452ec6859b2STodor Tomov 453ec6859b2STodor Tomov case RDI1: 454ec6859b2STodor Tomov val = readl_relaxed(ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 455ec6859b2STodor Tomov val &= ~(0xf << (4 + (vfe * 12))); 456ec6859b2STodor Tomov if (enable) 457ec6859b2STodor Tomov val |= (csid << (4 + (vfe * 12))); 458ec6859b2STodor Tomov writel_relaxed(val, ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 459ec6859b2STodor Tomov break; 460ec6859b2STodor Tomov 461ec6859b2STodor Tomov case RDI2: 462ec6859b2STodor Tomov val = readl_relaxed(ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 463ec6859b2STodor Tomov val &= ~(0xf << (8 + (vfe * 12))); 464ec6859b2STodor Tomov if (enable) 465ec6859b2STodor Tomov val |= (csid << (8 + (vfe * 12))); 466ec6859b2STodor Tomov writel_relaxed(val, ispif->base_clk_mux + CSI_RDI_CLK_MUX_SEL); 467ec6859b2STodor Tomov break; 468ec6859b2STodor Tomov } 469ec6859b2STodor Tomov 470ec6859b2STodor Tomov mb(); 471ec6859b2STodor Tomov } 472ec6859b2STodor Tomov 473ec6859b2STodor Tomov /* 474ec6859b2STodor Tomov * ispif_validate_intf_status - Validate current status of PIX/RDI interface 475ec6859b2STodor Tomov * @ispif: ISPIF device 476ec6859b2STodor Tomov * @intf: VFE interface 477ec6859b2STodor Tomov * @vfe: VFE HW module id 478ec6859b2STodor Tomov * 479ec6859b2STodor Tomov * Return 0 when interface is idle or -EBUSY otherwise 480ec6859b2STodor Tomov */ 481ec6859b2STodor Tomov static int ispif_validate_intf_status(struct ispif_device *ispif, 482ec6859b2STodor Tomov enum ispif_intf intf, u8 vfe) 483ec6859b2STodor Tomov { 484ec6859b2STodor Tomov int ret = 0; 485ec6859b2STodor Tomov u32 val = 0; 486ec6859b2STodor Tomov 487ec6859b2STodor Tomov switch (intf) { 488ec6859b2STodor Tomov case PIX0: 489ec6859b2STodor Tomov val = readl_relaxed(ispif->base + 490ec6859b2STodor Tomov ISPIF_VFE_m_PIX_INTF_n_STATUS(vfe, 0)); 491ec6859b2STodor Tomov break; 492ec6859b2STodor Tomov case RDI0: 493ec6859b2STodor Tomov val = readl_relaxed(ispif->base + 494ec6859b2STodor Tomov ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 0)); 495ec6859b2STodor Tomov break; 496ec6859b2STodor Tomov case PIX1: 497ec6859b2STodor Tomov val = readl_relaxed(ispif->base + 498ec6859b2STodor Tomov ISPIF_VFE_m_PIX_INTF_n_STATUS(vfe, 1)); 499ec6859b2STodor Tomov break; 500ec6859b2STodor Tomov case RDI1: 501ec6859b2STodor Tomov val = readl_relaxed(ispif->base + 502ec6859b2STodor Tomov ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 1)); 503ec6859b2STodor Tomov break; 504ec6859b2STodor Tomov case RDI2: 505ec6859b2STodor Tomov val = readl_relaxed(ispif->base + 506ec6859b2STodor Tomov ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 2)); 507ec6859b2STodor Tomov break; 508ec6859b2STodor Tomov } 509ec6859b2STodor Tomov 510ec6859b2STodor Tomov if ((val & 0xf) != 0xf) { 5119d95baf9SRobert Foss dev_err(ispif->camss->dev, "%s: ispif is busy: 0x%x\n", 512ec6859b2STodor Tomov __func__, val); 513ec6859b2STodor Tomov ret = -EBUSY; 514ec6859b2STodor Tomov } 515ec6859b2STodor Tomov 516ec6859b2STodor Tomov return ret; 517ec6859b2STodor Tomov } 518ec6859b2STodor Tomov 519ec6859b2STodor Tomov /* 520ec6859b2STodor Tomov * ispif_wait_for_stop - Wait for PIX/RDI interface to stop 521ec6859b2STodor Tomov * @ispif: ISPIF device 522ec6859b2STodor Tomov * @intf: VFE interface 523ec6859b2STodor Tomov * @vfe: VFE HW module id 524ec6859b2STodor Tomov * 525ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 526ec6859b2STodor Tomov */ 527ec6859b2STodor Tomov static int ispif_wait_for_stop(struct ispif_device *ispif, 528ec6859b2STodor Tomov enum ispif_intf intf, u8 vfe) 529ec6859b2STodor Tomov { 530ec6859b2STodor Tomov u32 addr = 0; 531ec6859b2STodor Tomov u32 stop_flag = 0; 532ec6859b2STodor Tomov int ret; 533ec6859b2STodor Tomov 534ec6859b2STodor Tomov switch (intf) { 535ec6859b2STodor Tomov case PIX0: 536ec6859b2STodor Tomov addr = ISPIF_VFE_m_PIX_INTF_n_STATUS(vfe, 0); 537ec6859b2STodor Tomov break; 538ec6859b2STodor Tomov case RDI0: 539ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 0); 540ec6859b2STodor Tomov break; 541ec6859b2STodor Tomov case PIX1: 542ec6859b2STodor Tomov addr = ISPIF_VFE_m_PIX_INTF_n_STATUS(vfe, 1); 543ec6859b2STodor Tomov break; 544ec6859b2STodor Tomov case RDI1: 545ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 1); 546ec6859b2STodor Tomov break; 547ec6859b2STodor Tomov case RDI2: 548ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_STATUS(vfe, 2); 549ec6859b2STodor Tomov break; 550ec6859b2STodor Tomov } 551ec6859b2STodor Tomov 552ec6859b2STodor Tomov ret = readl_poll_timeout(ispif->base + addr, 553ec6859b2STodor Tomov stop_flag, 554ec6859b2STodor Tomov (stop_flag & 0xf) == 0xf, 555ec6859b2STodor Tomov ISPIF_TIMEOUT_SLEEP_US, 556ec6859b2STodor Tomov ISPIF_TIMEOUT_ALL_US); 557ec6859b2STodor Tomov if (ret < 0) 5589d95baf9SRobert Foss dev_err(ispif->camss->dev, "%s: ispif stop timeout\n", 559ec6859b2STodor Tomov __func__); 560ec6859b2STodor Tomov 561ec6859b2STodor Tomov return ret; 562ec6859b2STodor Tomov } 563ec6859b2STodor Tomov 564ec6859b2STodor Tomov /* 565ec6859b2STodor Tomov * ispif_select_csid - Select CSID HW module for input from 566ec6859b2STodor Tomov * @ispif: ISPIF device 567ec6859b2STodor Tomov * @intf: VFE interface 568ec6859b2STodor Tomov * @csid: CSID HW module id 569ec6859b2STodor Tomov * @vfe: VFE HW module id 570ec6859b2STodor Tomov * @enable: enable or disable the selected input 571ec6859b2STodor Tomov */ 572ec6859b2STodor Tomov static void ispif_select_csid(struct ispif_device *ispif, enum ispif_intf intf, 573ec6859b2STodor Tomov u8 csid, u8 vfe, u8 enable) 574ec6859b2STodor Tomov { 575ec6859b2STodor Tomov u32 val; 576ec6859b2STodor Tomov 577ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_INTF_INPUT_SEL(vfe)); 578ec6859b2STodor Tomov switch (intf) { 579ec6859b2STodor Tomov case PIX0: 580ec6859b2STodor Tomov val &= ~(BIT(1) | BIT(0)); 581ec6859b2STodor Tomov if (enable) 582ec6859b2STodor Tomov val |= csid; 583ec6859b2STodor Tomov break; 584ec6859b2STodor Tomov case RDI0: 585ec6859b2STodor Tomov val &= ~(BIT(5) | BIT(4)); 586ec6859b2STodor Tomov if (enable) 587ec6859b2STodor Tomov val |= (csid << 4); 588ec6859b2STodor Tomov break; 589ec6859b2STodor Tomov case PIX1: 590ec6859b2STodor Tomov val &= ~(BIT(9) | BIT(8)); 591ec6859b2STodor Tomov if (enable) 592ec6859b2STodor Tomov val |= (csid << 8); 593ec6859b2STodor Tomov break; 594ec6859b2STodor Tomov case RDI1: 595ec6859b2STodor Tomov val &= ~(BIT(13) | BIT(12)); 596ec6859b2STodor Tomov if (enable) 597ec6859b2STodor Tomov val |= (csid << 12); 598ec6859b2STodor Tomov break; 599ec6859b2STodor Tomov case RDI2: 600ec6859b2STodor Tomov val &= ~(BIT(21) | BIT(20)); 601ec6859b2STodor Tomov if (enable) 602ec6859b2STodor Tomov val |= (csid << 20); 603ec6859b2STodor Tomov break; 604ec6859b2STodor Tomov } 605ec6859b2STodor Tomov 606ec6859b2STodor Tomov writel(val, ispif->base + ISPIF_VFE_m_INTF_INPUT_SEL(vfe)); 607ec6859b2STodor Tomov } 608ec6859b2STodor Tomov 609ec6859b2STodor Tomov /* 610ec6859b2STodor Tomov * ispif_select_cid - Enable/disable desired CID 611ec6859b2STodor Tomov * @ispif: ISPIF device 612ec6859b2STodor Tomov * @intf: VFE interface 613ec6859b2STodor Tomov * @cid: desired CID to enable/disable 614ec6859b2STodor Tomov * @vfe: VFE HW module id 615ec6859b2STodor Tomov * @enable: enable or disable the desired CID 616ec6859b2STodor Tomov */ 617ec6859b2STodor Tomov static void ispif_select_cid(struct ispif_device *ispif, enum ispif_intf intf, 618ec6859b2STodor Tomov u8 cid, u8 vfe, u8 enable) 619ec6859b2STodor Tomov { 620ec6859b2STodor Tomov u32 cid_mask = 1 << cid; 621ec6859b2STodor Tomov u32 addr = 0; 622ec6859b2STodor Tomov u32 val; 623ec6859b2STodor Tomov 624ec6859b2STodor Tomov switch (intf) { 625ec6859b2STodor Tomov case PIX0: 626ec6859b2STodor Tomov addr = ISPIF_VFE_m_PIX_INTF_n_CID_MASK(vfe, 0); 627ec6859b2STodor Tomov break; 628ec6859b2STodor Tomov case RDI0: 629ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_CID_MASK(vfe, 0); 630ec6859b2STodor Tomov break; 631ec6859b2STodor Tomov case PIX1: 632ec6859b2STodor Tomov addr = ISPIF_VFE_m_PIX_INTF_n_CID_MASK(vfe, 1); 633ec6859b2STodor Tomov break; 634ec6859b2STodor Tomov case RDI1: 635ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_CID_MASK(vfe, 1); 636ec6859b2STodor Tomov break; 637ec6859b2STodor Tomov case RDI2: 638ec6859b2STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_CID_MASK(vfe, 2); 639ec6859b2STodor Tomov break; 640ec6859b2STodor Tomov } 641ec6859b2STodor Tomov 642ec6859b2STodor Tomov val = readl_relaxed(ispif->base + addr); 643ec6859b2STodor Tomov if (enable) 644ec6859b2STodor Tomov val |= cid_mask; 645ec6859b2STodor Tomov else 646ec6859b2STodor Tomov val &= ~cid_mask; 647ec6859b2STodor Tomov 648ec6859b2STodor Tomov writel(val, ispif->base + addr); 649ec6859b2STodor Tomov } 650ec6859b2STodor Tomov 651ec6859b2STodor Tomov /* 652ec6859b2STodor Tomov * ispif_config_irq - Enable/disable interrupts for PIX/RDI interface 653ec6859b2STodor Tomov * @ispif: ISPIF device 654ec6859b2STodor Tomov * @intf: VFE interface 655ec6859b2STodor Tomov * @vfe: VFE HW module id 656ec6859b2STodor Tomov * @enable: enable or disable 657ec6859b2STodor Tomov */ 658ec6859b2STodor Tomov static void ispif_config_irq(struct ispif_device *ispif, enum ispif_intf intf, 659ec6859b2STodor Tomov u8 vfe, u8 enable) 660ec6859b2STodor Tomov { 661ec6859b2STodor Tomov u32 val; 662ec6859b2STodor Tomov 663ec6859b2STodor Tomov switch (intf) { 664ec6859b2STodor Tomov case PIX0: 665ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_MASK_0(vfe)); 666ec6859b2STodor Tomov val &= ~ISPIF_VFE_m_IRQ_MASK_0_PIX0_MASK; 667ec6859b2STodor Tomov if (enable) 668ec6859b2STodor Tomov val |= ISPIF_VFE_m_IRQ_MASK_0_PIX0_ENABLE; 669ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_VFE_m_IRQ_MASK_0(vfe)); 670ec6859b2STodor Tomov writel_relaxed(ISPIF_VFE_m_IRQ_MASK_0_PIX0_ENABLE, 671ec6859b2STodor Tomov ispif->base + ISPIF_VFE_m_IRQ_CLEAR_0(vfe)); 672ec6859b2STodor Tomov break; 673ec6859b2STodor Tomov case RDI0: 674ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_MASK_0(vfe)); 675ec6859b2STodor Tomov val &= ~ISPIF_VFE_m_IRQ_MASK_0_RDI0_MASK; 676ec6859b2STodor Tomov if (enable) 677ec6859b2STodor Tomov val |= ISPIF_VFE_m_IRQ_MASK_0_RDI0_ENABLE; 678ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_VFE_m_IRQ_MASK_0(vfe)); 679ec6859b2STodor Tomov writel_relaxed(ISPIF_VFE_m_IRQ_MASK_0_RDI0_ENABLE, 680ec6859b2STodor Tomov ispif->base + ISPIF_VFE_m_IRQ_CLEAR_0(vfe)); 681ec6859b2STodor Tomov break; 682ec6859b2STodor Tomov case PIX1: 683ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_MASK_1(vfe)); 684ec6859b2STodor Tomov val &= ~ISPIF_VFE_m_IRQ_MASK_1_PIX1_MASK; 685ec6859b2STodor Tomov if (enable) 686ec6859b2STodor Tomov val |= ISPIF_VFE_m_IRQ_MASK_1_PIX1_ENABLE; 687ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_VFE_m_IRQ_MASK_1(vfe)); 688ec6859b2STodor Tomov writel_relaxed(ISPIF_VFE_m_IRQ_MASK_1_PIX1_ENABLE, 689ec6859b2STodor Tomov ispif->base + ISPIF_VFE_m_IRQ_CLEAR_1(vfe)); 690ec6859b2STodor Tomov break; 691ec6859b2STodor Tomov case RDI1: 692ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_MASK_1(vfe)); 693ec6859b2STodor Tomov val &= ~ISPIF_VFE_m_IRQ_MASK_1_RDI1_MASK; 694ec6859b2STodor Tomov if (enable) 695ec6859b2STodor Tomov val |= ISPIF_VFE_m_IRQ_MASK_1_RDI1_ENABLE; 696ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_VFE_m_IRQ_MASK_1(vfe)); 697ec6859b2STodor Tomov writel_relaxed(ISPIF_VFE_m_IRQ_MASK_1_RDI1_ENABLE, 698ec6859b2STodor Tomov ispif->base + ISPIF_VFE_m_IRQ_CLEAR_1(vfe)); 699ec6859b2STodor Tomov break; 700ec6859b2STodor Tomov case RDI2: 701ec6859b2STodor Tomov val = readl_relaxed(ispif->base + ISPIF_VFE_m_IRQ_MASK_2(vfe)); 702ec6859b2STodor Tomov val &= ~ISPIF_VFE_m_IRQ_MASK_2_RDI2_MASK; 703ec6859b2STodor Tomov if (enable) 704ec6859b2STodor Tomov val |= ISPIF_VFE_m_IRQ_MASK_2_RDI2_ENABLE; 705ec6859b2STodor Tomov writel_relaxed(val, ispif->base + ISPIF_VFE_m_IRQ_MASK_2(vfe)); 706ec6859b2STodor Tomov writel_relaxed(ISPIF_VFE_m_IRQ_MASK_2_RDI2_ENABLE, 707ec6859b2STodor Tomov ispif->base + ISPIF_VFE_m_IRQ_CLEAR_2(vfe)); 708ec6859b2STodor Tomov break; 709ec6859b2STodor Tomov } 710ec6859b2STodor Tomov 711ec6859b2STodor Tomov writel(0x1, ispif->base + ISPIF_IRQ_GLOBAL_CLEAR_CMD); 712ec6859b2STodor Tomov } 713ec6859b2STodor Tomov 714ec6859b2STodor Tomov /* 7155019d7c8STodor Tomov * ispif_config_pack - Config packing for PRDI mode 7165019d7c8STodor Tomov * @ispif: ISPIF device 7175019d7c8STodor Tomov * @code: media bus format code 7185019d7c8STodor Tomov * @intf: VFE interface 7195019d7c8STodor Tomov * @cid: desired CID to handle 7205019d7c8STodor Tomov * @vfe: VFE HW module id 7215019d7c8STodor Tomov * @enable: enable or disable 7225019d7c8STodor Tomov */ 7235019d7c8STodor Tomov static void ispif_config_pack(struct ispif_device *ispif, u32 code, 7245019d7c8STodor Tomov enum ispif_intf intf, u8 cid, u8 vfe, u8 enable) 7255019d7c8STodor Tomov { 7265019d7c8STodor Tomov u32 addr, val; 7275019d7c8STodor Tomov 728cc8fe073STodor Tomov if (code != MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_LE && 729cc8fe073STodor Tomov code != MEDIA_BUS_FMT_Y10_2X8_PADHI_LE) 7305019d7c8STodor Tomov return; 7315019d7c8STodor Tomov 7325019d7c8STodor Tomov switch (intf) { 7335019d7c8STodor Tomov case RDI0: 7345019d7c8STodor Tomov if (cid < 8) 7355019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0(vfe, 0); 7365019d7c8STodor Tomov else 7375019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_1(vfe, 0); 7385019d7c8STodor Tomov break; 7395019d7c8STodor Tomov case RDI1: 7405019d7c8STodor Tomov if (cid < 8) 7415019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0(vfe, 1); 7425019d7c8STodor Tomov else 7435019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_1(vfe, 1); 7445019d7c8STodor Tomov break; 7455019d7c8STodor Tomov case RDI2: 7465019d7c8STodor Tomov if (cid < 8) 7475019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0(vfe, 2); 7485019d7c8STodor Tomov else 7495019d7c8STodor Tomov addr = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_1(vfe, 2); 7505019d7c8STodor Tomov break; 7515019d7c8STodor Tomov default: 7525019d7c8STodor Tomov return; 7535019d7c8STodor Tomov } 7545019d7c8STodor Tomov 7555019d7c8STodor Tomov if (enable) 7565019d7c8STodor Tomov val = ISPIF_VFE_m_RDI_INTF_n_PACK_CFG_0_CID_c_PLAIN(cid); 7575019d7c8STodor Tomov else 7585019d7c8STodor Tomov val = 0; 7595019d7c8STodor Tomov 7605019d7c8STodor Tomov writel_relaxed(val, ispif->base + addr); 7615019d7c8STodor Tomov } 7625019d7c8STodor Tomov 7635019d7c8STodor Tomov /* 764ec6859b2STodor Tomov * ispif_set_intf_cmd - Set command to enable/disable interface 765ec6859b2STodor Tomov * @ispif: ISPIF device 766ec6859b2STodor Tomov * @cmd: interface command 767ec6859b2STodor Tomov * @intf: VFE interface 768ec6859b2STodor Tomov * @vfe: VFE HW module id 769ec6859b2STodor Tomov * @vc: virtual channel 770ec6859b2STodor Tomov */ 771ec6859b2STodor Tomov static void ispif_set_intf_cmd(struct ispif_device *ispif, u8 cmd, 772ec6859b2STodor Tomov enum ispif_intf intf, u8 vfe, u8 vc) 773ec6859b2STodor Tomov { 774ec6859b2STodor Tomov u32 *val; 775ec6859b2STodor Tomov 776ec6859b2STodor Tomov if (intf == RDI2) { 777ec6859b2STodor Tomov val = &ispif->intf_cmd[vfe].cmd_1; 778ec6859b2STodor Tomov *val &= ~(0x3 << (vc * 2 + 8)); 779ec6859b2STodor Tomov *val |= (cmd << (vc * 2 + 8)); 780ec6859b2STodor Tomov wmb(); 781ec6859b2STodor Tomov writel_relaxed(*val, ispif->base + ISPIF_VFE_m_INTF_CMD_1(vfe)); 782ec6859b2STodor Tomov wmb(); 783ec6859b2STodor Tomov } else { 784ec6859b2STodor Tomov val = &ispif->intf_cmd[vfe].cmd_0; 785ec6859b2STodor Tomov *val &= ~(0x3 << (vc * 2 + intf * 8)); 786ec6859b2STodor Tomov *val |= (cmd << (vc * 2 + intf * 8)); 787ec6859b2STodor Tomov wmb(); 788ec6859b2STodor Tomov writel_relaxed(*val, ispif->base + ISPIF_VFE_m_INTF_CMD_0(vfe)); 789ec6859b2STodor Tomov wmb(); 790ec6859b2STodor Tomov } 791ec6859b2STodor Tomov } 792ec6859b2STodor Tomov 793ec6859b2STodor Tomov /* 794ec6859b2STodor Tomov * ispif_set_stream - Enable/disable streaming on ISPIF module 795ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 796ec6859b2STodor Tomov * @enable: Requested streaming state 797ec6859b2STodor Tomov * 798ec6859b2STodor Tomov * Main configuration of ISPIF module is also done here. 799ec6859b2STodor Tomov * 800ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 801ec6859b2STodor Tomov */ 802ec6859b2STodor Tomov static int ispif_set_stream(struct v4l2_subdev *sd, int enable) 803ec6859b2STodor Tomov { 804ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 8059c3e59deSTodor Tomov struct ispif_device *ispif = line->ispif; 8069d95baf9SRobert Foss struct camss *camss = ispif->camss; 807ec6859b2STodor Tomov enum ispif_intf intf = line->interface; 808ec6859b2STodor Tomov u8 csid = line->csid_id; 809ec6859b2STodor Tomov u8 vfe = line->vfe_id; 810ec6859b2STodor Tomov u8 vc = 0; /* Virtual Channel 0 */ 811ec6859b2STodor Tomov u8 cid = vc * 4; /* id of Virtual Channel and Data Type set */ 812ec6859b2STodor Tomov int ret; 813ec6859b2STodor Tomov 814ec6859b2STodor Tomov if (enable) { 815ec6859b2STodor Tomov if (!media_entity_remote_pad(&line->pads[MSM_ISPIF_PAD_SINK])) 816ec6859b2STodor Tomov return -ENOLINK; 817ec6859b2STodor Tomov 818ec6859b2STodor Tomov /* Config */ 819ec6859b2STodor Tomov 820ec6859b2STodor Tomov mutex_lock(&ispif->config_lock); 821ec6859b2STodor Tomov ispif_select_clk_mux(ispif, intf, csid, vfe, 1); 822ec6859b2STodor Tomov 823ec6859b2STodor Tomov ret = ispif_validate_intf_status(ispif, intf, vfe); 824ec6859b2STodor Tomov if (ret < 0) { 825ec6859b2STodor Tomov mutex_unlock(&ispif->config_lock); 826ec6859b2STodor Tomov return ret; 827ec6859b2STodor Tomov } 828ec6859b2STodor Tomov 829ec6859b2STodor Tomov ispif_select_csid(ispif, intf, csid, vfe, 1); 830ec6859b2STodor Tomov ispif_select_cid(ispif, intf, cid, vfe, 1); 831ec6859b2STodor Tomov ispif_config_irq(ispif, intf, vfe, 1); 8329d95baf9SRobert Foss if (camss->version == CAMSS_8x96 || 8339d95baf9SRobert Foss camss->version == CAMSS_660) 8345019d7c8STodor Tomov ispif_config_pack(ispif, 8355019d7c8STodor Tomov line->fmt[MSM_ISPIF_PAD_SINK].code, 8365019d7c8STodor Tomov intf, cid, vfe, 1); 837ec6859b2STodor Tomov ispif_set_intf_cmd(ispif, CMD_ENABLE_FRAME_BOUNDARY, 838ec6859b2STodor Tomov intf, vfe, vc); 839ec6859b2STodor Tomov } else { 840ec6859b2STodor Tomov mutex_lock(&ispif->config_lock); 841ec6859b2STodor Tomov ispif_set_intf_cmd(ispif, CMD_DISABLE_FRAME_BOUNDARY, 842ec6859b2STodor Tomov intf, vfe, vc); 843ec6859b2STodor Tomov mutex_unlock(&ispif->config_lock); 844ec6859b2STodor Tomov 845ec6859b2STodor Tomov ret = ispif_wait_for_stop(ispif, intf, vfe); 846ec6859b2STodor Tomov if (ret < 0) 847ec6859b2STodor Tomov return ret; 848ec6859b2STodor Tomov 849ec6859b2STodor Tomov mutex_lock(&ispif->config_lock); 8509d95baf9SRobert Foss if (camss->version == CAMSS_8x96 || 8519d95baf9SRobert Foss camss->version == CAMSS_660) 8525019d7c8STodor Tomov ispif_config_pack(ispif, 8535019d7c8STodor Tomov line->fmt[MSM_ISPIF_PAD_SINK].code, 8545019d7c8STodor Tomov intf, cid, vfe, 0); 855ec6859b2STodor Tomov ispif_config_irq(ispif, intf, vfe, 0); 856ec6859b2STodor Tomov ispif_select_cid(ispif, intf, cid, vfe, 0); 857ec6859b2STodor Tomov ispif_select_csid(ispif, intf, csid, vfe, 0); 858ec6859b2STodor Tomov ispif_select_clk_mux(ispif, intf, csid, vfe, 0); 859ec6859b2STodor Tomov } 860ec6859b2STodor Tomov 861ec6859b2STodor Tomov mutex_unlock(&ispif->config_lock); 862ec6859b2STodor Tomov 863ec6859b2STodor Tomov return 0; 864ec6859b2STodor Tomov } 865ec6859b2STodor Tomov 866ec6859b2STodor Tomov /* 867ec6859b2STodor Tomov * __ispif_get_format - Get pointer to format structure 868ec6859b2STodor Tomov * @ispif: ISPIF line 869ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 870ec6859b2STodor Tomov * @pad: pad from which format is requested 871ec6859b2STodor Tomov * @which: TRY or ACTIVE format 872ec6859b2STodor Tomov * 873ec6859b2STodor Tomov * Return pointer to TRY or ACTIVE format structure 874ec6859b2STodor Tomov */ 875ec6859b2STodor Tomov static struct v4l2_mbus_framefmt * 876ec6859b2STodor Tomov __ispif_get_format(struct ispif_line *line, 8770d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 878ec6859b2STodor Tomov unsigned int pad, 879ec6859b2STodor Tomov enum v4l2_subdev_format_whence which) 880ec6859b2STodor Tomov { 881ec6859b2STodor Tomov if (which == V4L2_SUBDEV_FORMAT_TRY) 8820d346d2aSTomi Valkeinen return v4l2_subdev_get_try_format(&line->subdev, sd_state, 8830d346d2aSTomi Valkeinen pad); 884ec6859b2STodor Tomov 885ec6859b2STodor Tomov return &line->fmt[pad]; 886ec6859b2STodor Tomov } 887ec6859b2STodor Tomov 888ec6859b2STodor Tomov /* 889ec6859b2STodor Tomov * ispif_try_format - Handle try format by pad subdev method 890ec6859b2STodor Tomov * @ispif: ISPIF line 891ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 892ec6859b2STodor Tomov * @pad: pad on which format is requested 893ec6859b2STodor Tomov * @fmt: pointer to v4l2 format structure 894ec6859b2STodor Tomov * @which: wanted subdev format 895ec6859b2STodor Tomov */ 896ec6859b2STodor Tomov static void ispif_try_format(struct ispif_line *line, 8970d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 898ec6859b2STodor Tomov unsigned int pad, 899ec6859b2STodor Tomov struct v4l2_mbus_framefmt *fmt, 900ec6859b2STodor Tomov enum v4l2_subdev_format_whence which) 901ec6859b2STodor Tomov { 902ec6859b2STodor Tomov unsigned int i; 903ec6859b2STodor Tomov 904ec6859b2STodor Tomov switch (pad) { 905ec6859b2STodor Tomov case MSM_ISPIF_PAD_SINK: 906ec6859b2STodor Tomov /* Set format on sink pad */ 907ec6859b2STodor Tomov 908cba3819dSTodor Tomov for (i = 0; i < line->nformats; i++) 909cba3819dSTodor Tomov if (fmt->code == line->formats[i]) 910ec6859b2STodor Tomov break; 911ec6859b2STodor Tomov 912ec6859b2STodor Tomov /* If not found, use UYVY as default */ 913cba3819dSTodor Tomov if (i >= line->nformats) 914ec6859b2STodor Tomov fmt->code = MEDIA_BUS_FMT_UYVY8_2X8; 915ec6859b2STodor Tomov 916ec6859b2STodor Tomov fmt->width = clamp_t(u32, fmt->width, 1, 8191); 917ec6859b2STodor Tomov fmt->height = clamp_t(u32, fmt->height, 1, 8191); 918ec6859b2STodor Tomov 919ec6859b2STodor Tomov fmt->field = V4L2_FIELD_NONE; 920ec6859b2STodor Tomov fmt->colorspace = V4L2_COLORSPACE_SRGB; 921ec6859b2STodor Tomov 922ec6859b2STodor Tomov break; 923ec6859b2STodor Tomov 924ec6859b2STodor Tomov case MSM_ISPIF_PAD_SRC: 925ec6859b2STodor Tomov /* Set and return a format same as sink pad */ 926ec6859b2STodor Tomov 9270d346d2aSTomi Valkeinen *fmt = *__ispif_get_format(line, sd_state, MSM_ISPIF_PAD_SINK, 928ec6859b2STodor Tomov which); 929ec6859b2STodor Tomov 930ec6859b2STodor Tomov break; 931ec6859b2STodor Tomov } 932ec6859b2STodor Tomov 933ec6859b2STodor Tomov fmt->colorspace = V4L2_COLORSPACE_SRGB; 934ec6859b2STodor Tomov } 935ec6859b2STodor Tomov 936ec6859b2STodor Tomov /* 937ec6859b2STodor Tomov * ispif_enum_mbus_code - Handle pixel format enumeration 938ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 939ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 940ec6859b2STodor Tomov * @code: pointer to v4l2_subdev_mbus_code_enum structure 941ec6859b2STodor Tomov * return -EINVAL or zero on success 942ec6859b2STodor Tomov */ 943ec6859b2STodor Tomov static int ispif_enum_mbus_code(struct v4l2_subdev *sd, 9440d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 945ec6859b2STodor Tomov struct v4l2_subdev_mbus_code_enum *code) 946ec6859b2STodor Tomov { 947ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 948ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format; 949ec6859b2STodor Tomov 950ec6859b2STodor Tomov if (code->pad == MSM_ISPIF_PAD_SINK) { 951cba3819dSTodor Tomov if (code->index >= line->nformats) 952ec6859b2STodor Tomov return -EINVAL; 953ec6859b2STodor Tomov 954cba3819dSTodor Tomov code->code = line->formats[code->index]; 955ec6859b2STodor Tomov } else { 956ec6859b2STodor Tomov if (code->index > 0) 957ec6859b2STodor Tomov return -EINVAL; 958ec6859b2STodor Tomov 9590d346d2aSTomi Valkeinen format = __ispif_get_format(line, sd_state, 9600d346d2aSTomi Valkeinen MSM_ISPIF_PAD_SINK, 961ec6859b2STodor Tomov code->which); 962ec6859b2STodor Tomov 963ec6859b2STodor Tomov code->code = format->code; 964ec6859b2STodor Tomov } 965ec6859b2STodor Tomov 966ec6859b2STodor Tomov return 0; 967ec6859b2STodor Tomov } 968ec6859b2STodor Tomov 969ec6859b2STodor Tomov /* 970ec6859b2STodor Tomov * ispif_enum_frame_size - Handle frame size enumeration 971ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 972ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 973ec6859b2STodor Tomov * @fse: pointer to v4l2_subdev_frame_size_enum structure 974ec6859b2STodor Tomov * return -EINVAL or zero on success 975ec6859b2STodor Tomov */ 976ec6859b2STodor Tomov static int ispif_enum_frame_size(struct v4l2_subdev *sd, 9770d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 978ec6859b2STodor Tomov struct v4l2_subdev_frame_size_enum *fse) 979ec6859b2STodor Tomov { 980ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 981ec6859b2STodor Tomov struct v4l2_mbus_framefmt format; 982ec6859b2STodor Tomov 983ec6859b2STodor Tomov if (fse->index != 0) 984ec6859b2STodor Tomov return -EINVAL; 985ec6859b2STodor Tomov 986ec6859b2STodor Tomov format.code = fse->code; 987ec6859b2STodor Tomov format.width = 1; 988ec6859b2STodor Tomov format.height = 1; 9890d346d2aSTomi Valkeinen ispif_try_format(line, sd_state, fse->pad, &format, fse->which); 990ec6859b2STodor Tomov fse->min_width = format.width; 991ec6859b2STodor Tomov fse->min_height = format.height; 992ec6859b2STodor Tomov 993ec6859b2STodor Tomov if (format.code != fse->code) 994ec6859b2STodor Tomov return -EINVAL; 995ec6859b2STodor Tomov 996ec6859b2STodor Tomov format.code = fse->code; 997ec6859b2STodor Tomov format.width = -1; 998ec6859b2STodor Tomov format.height = -1; 9990d346d2aSTomi Valkeinen ispif_try_format(line, sd_state, fse->pad, &format, fse->which); 1000ec6859b2STodor Tomov fse->max_width = format.width; 1001ec6859b2STodor Tomov fse->max_height = format.height; 1002ec6859b2STodor Tomov 1003ec6859b2STodor Tomov return 0; 1004ec6859b2STodor Tomov } 1005ec6859b2STodor Tomov 1006ec6859b2STodor Tomov /* 1007ec6859b2STodor Tomov * ispif_get_format - Handle get format by pads subdev method 1008ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 1009ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 1010ec6859b2STodor Tomov * @fmt: pointer to v4l2 subdev format structure 1011ec6859b2STodor Tomov * 1012ec6859b2STodor Tomov * Return -EINVAL or zero on success 1013ec6859b2STodor Tomov */ 1014ec6859b2STodor Tomov static int ispif_get_format(struct v4l2_subdev *sd, 10150d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 1016ec6859b2STodor Tomov struct v4l2_subdev_format *fmt) 1017ec6859b2STodor Tomov { 1018ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 1019ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format; 1020ec6859b2STodor Tomov 10210d346d2aSTomi Valkeinen format = __ispif_get_format(line, sd_state, fmt->pad, fmt->which); 1022ec6859b2STodor Tomov if (format == NULL) 1023ec6859b2STodor Tomov return -EINVAL; 1024ec6859b2STodor Tomov 1025ec6859b2STodor Tomov fmt->format = *format; 1026ec6859b2STodor Tomov 1027ec6859b2STodor Tomov return 0; 1028ec6859b2STodor Tomov } 1029ec6859b2STodor Tomov 1030ec6859b2STodor Tomov /* 1031ec6859b2STodor Tomov * ispif_set_format - Handle set format by pads subdev method 1032ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 1033ec6859b2STodor Tomov * @cfg: V4L2 subdev pad configuration 1034ec6859b2STodor Tomov * @fmt: pointer to v4l2 subdev format structure 1035ec6859b2STodor Tomov * 1036ec6859b2STodor Tomov * Return -EINVAL or zero on success 1037ec6859b2STodor Tomov */ 1038ec6859b2STodor Tomov static int ispif_set_format(struct v4l2_subdev *sd, 10390d346d2aSTomi Valkeinen struct v4l2_subdev_state *sd_state, 1040ec6859b2STodor Tomov struct v4l2_subdev_format *fmt) 1041ec6859b2STodor Tomov { 1042ec6859b2STodor Tomov struct ispif_line *line = v4l2_get_subdevdata(sd); 1043ec6859b2STodor Tomov struct v4l2_mbus_framefmt *format; 1044ec6859b2STodor Tomov 10450d346d2aSTomi Valkeinen format = __ispif_get_format(line, sd_state, fmt->pad, fmt->which); 1046ec6859b2STodor Tomov if (format == NULL) 1047ec6859b2STodor Tomov return -EINVAL; 1048ec6859b2STodor Tomov 10490d346d2aSTomi Valkeinen ispif_try_format(line, sd_state, fmt->pad, &fmt->format, fmt->which); 1050ec6859b2STodor Tomov *format = fmt->format; 1051ec6859b2STodor Tomov 1052ec6859b2STodor Tomov /* Propagate the format from sink to source */ 1053ec6859b2STodor Tomov if (fmt->pad == MSM_ISPIF_PAD_SINK) { 10540d346d2aSTomi Valkeinen format = __ispif_get_format(line, sd_state, MSM_ISPIF_PAD_SRC, 1055ec6859b2STodor Tomov fmt->which); 1056ec6859b2STodor Tomov 1057ec6859b2STodor Tomov *format = fmt->format; 10580d346d2aSTomi Valkeinen ispif_try_format(line, sd_state, MSM_ISPIF_PAD_SRC, format, 1059ec6859b2STodor Tomov fmt->which); 1060ec6859b2STodor Tomov } 1061ec6859b2STodor Tomov 1062ec6859b2STodor Tomov return 0; 1063ec6859b2STodor Tomov } 1064ec6859b2STodor Tomov 1065ec6859b2STodor Tomov /* 1066ec6859b2STodor Tomov * ispif_init_formats - Initialize formats on all pads 1067ec6859b2STodor Tomov * @sd: ISPIF V4L2 subdevice 1068ec6859b2STodor Tomov * @fh: V4L2 subdev file handle 1069ec6859b2STodor Tomov * 1070ec6859b2STodor Tomov * Initialize all pad formats with default values. 1071ec6859b2STodor Tomov * 1072ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 1073ec6859b2STodor Tomov */ 1074ec6859b2STodor Tomov static int ispif_init_formats(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh) 1075ec6859b2STodor Tomov { 1076ec6859b2STodor Tomov struct v4l2_subdev_format format = { 1077ec6859b2STodor Tomov .pad = MSM_ISPIF_PAD_SINK, 1078ec6859b2STodor Tomov .which = fh ? V4L2_SUBDEV_FORMAT_TRY : 1079ec6859b2STodor Tomov V4L2_SUBDEV_FORMAT_ACTIVE, 1080ec6859b2STodor Tomov .format = { 1081ec6859b2STodor Tomov .code = MEDIA_BUS_FMT_UYVY8_2X8, 1082ec6859b2STodor Tomov .width = 1920, 1083ec6859b2STodor Tomov .height = 1080 1084ec6859b2STodor Tomov } 1085ec6859b2STodor Tomov }; 1086ec6859b2STodor Tomov 10870d346d2aSTomi Valkeinen return ispif_set_format(sd, fh ? fh->state : NULL, &format); 1088ec6859b2STodor Tomov } 1089ec6859b2STodor Tomov 1090ec6859b2STodor Tomov /* 1091ec6859b2STodor Tomov * msm_ispif_subdev_init - Initialize ISPIF device structure and resources 1092ec6859b2STodor Tomov * @ispif: ISPIF device 1093ec6859b2STodor Tomov * @res: ISPIF module resources table 1094ec6859b2STodor Tomov * 1095ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 1096ec6859b2STodor Tomov */ 10979d95baf9SRobert Foss int msm_ispif_subdev_init(struct camss *camss, 1098ec6859b2STodor Tomov const struct resources_ispif *res) 1099ec6859b2STodor Tomov { 11009d95baf9SRobert Foss struct device *dev = camss->dev; 11019d95baf9SRobert Foss struct ispif_device *ispif = camss->ispif; 1102ec6859b2STodor Tomov struct platform_device *pdev = to_platform_device(dev); 1103ec6859b2STodor Tomov int i; 1104ec6859b2STodor Tomov int ret; 1105ec6859b2STodor Tomov 11069d95baf9SRobert Foss if (!camss->ispif) 11079d95baf9SRobert Foss return 0; 11089d95baf9SRobert Foss 11099d95baf9SRobert Foss ispif->camss = camss; 11109d95baf9SRobert Foss 11119c3e59deSTodor Tomov /* Number of ISPIF lines - same as number of CSID hardware modules */ 11129d95baf9SRobert Foss if (camss->version == CAMSS_8x16) 11139c3e59deSTodor Tomov ispif->line_num = 2; 11149d95baf9SRobert Foss else if (camss->version == CAMSS_8x96 || 11159d95baf9SRobert Foss camss->version == CAMSS_660) 11169c3e59deSTodor Tomov ispif->line_num = 4; 11179c3e59deSTodor Tomov else 11189c3e59deSTodor Tomov return -EINVAL; 11199c3e59deSTodor Tomov 11209d95baf9SRobert Foss ispif->line = devm_kcalloc(dev, ispif->line_num, 11219d95baf9SRobert Foss sizeof(*ispif->line), GFP_KERNEL); 11229c3e59deSTodor Tomov if (!ispif->line) 11239c3e59deSTodor Tomov return -ENOMEM; 11249c3e59deSTodor Tomov 11259c3e59deSTodor Tomov for (i = 0; i < ispif->line_num; i++) { 11269c3e59deSTodor Tomov ispif->line[i].ispif = ispif; 11279c3e59deSTodor Tomov ispif->line[i].id = i; 1128cba3819dSTodor Tomov 11299d95baf9SRobert Foss if (camss->version == CAMSS_8x16) { 1130cba3819dSTodor Tomov ispif->line[i].formats = ispif_formats_8x16; 1131cba3819dSTodor Tomov ispif->line[i].nformats = 1132cba3819dSTodor Tomov ARRAY_SIZE(ispif_formats_8x16); 11339d95baf9SRobert Foss } else if (camss->version == CAMSS_8x96 || 11349d95baf9SRobert Foss camss->version == CAMSS_660) { 1135cba3819dSTodor Tomov ispif->line[i].formats = ispif_formats_8x96; 1136cba3819dSTodor Tomov ispif->line[i].nformats = 1137cba3819dSTodor Tomov ARRAY_SIZE(ispif_formats_8x96); 1138cba3819dSTodor Tomov } else { 1139cba3819dSTodor Tomov return -EINVAL; 1140cba3819dSTodor Tomov } 11419c3e59deSTodor Tomov } 11429c3e59deSTodor Tomov 1143ec6859b2STodor Tomov /* Memory */ 1144ec6859b2STodor Tomov 1145414e0a64Sdingsenjie ispif->base = devm_platform_ioremap_resource_byname(pdev, res->reg[0]); 1146a24bbbf2SYang Yingliang if (IS_ERR(ispif->base)) 1147ec6859b2STodor Tomov return PTR_ERR(ispif->base); 1148ec6859b2STodor Tomov 1149414e0a64Sdingsenjie ispif->base_clk_mux = devm_platform_ioremap_resource_byname(pdev, res->reg[1]); 1150a24bbbf2SYang Yingliang if (IS_ERR(ispif->base_clk_mux)) 1151ec6859b2STodor Tomov return PTR_ERR(ispif->base_clk_mux); 1152ec6859b2STodor Tomov 1153ec6859b2STodor Tomov /* Interrupt */ 1154ec6859b2STodor Tomov 1155*b416be3aSLad Prabhakar ret = platform_get_irq_byname(pdev, res->interrupt); 1156*b416be3aSLad Prabhakar if (ret < 0) 1157*b416be3aSLad Prabhakar return ret; 1158ec6859b2STodor Tomov 1159*b416be3aSLad Prabhakar ispif->irq = ret; 1160ec6859b2STodor Tomov snprintf(ispif->irq_name, sizeof(ispif->irq_name), "%s_%s", 1161ec6859b2STodor Tomov dev_name(dev), MSM_ISPIF_NAME); 11629d95baf9SRobert Foss if (camss->version == CAMSS_8x16) 1163e08c7f86STodor Tomov ret = devm_request_irq(dev, ispif->irq, ispif_isr_8x16, 1164ec6859b2STodor Tomov IRQF_TRIGGER_RISING, ispif->irq_name, ispif); 11659d95baf9SRobert Foss else if (camss->version == CAMSS_8x96 || 11669d95baf9SRobert Foss camss->version == CAMSS_660) 1167e08c7f86STodor Tomov ret = devm_request_irq(dev, ispif->irq, ispif_isr_8x96, 1168e08c7f86STodor Tomov IRQF_TRIGGER_RISING, ispif->irq_name, ispif); 1169e08c7f86STodor Tomov else 1170e08c7f86STodor Tomov ret = -EINVAL; 11719d95baf9SRobert Foss 1172ec6859b2STodor Tomov if (ret < 0) { 1173ec6859b2STodor Tomov dev_err(dev, "request_irq failed: %d\n", ret); 1174ec6859b2STodor Tomov return ret; 1175ec6859b2STodor Tomov } 1176ec6859b2STodor Tomov 1177ec6859b2STodor Tomov /* Clocks */ 1178ec6859b2STodor Tomov 1179ec6859b2STodor Tomov ispif->nclocks = 0; 1180ec6859b2STodor Tomov while (res->clock[ispif->nclocks]) 1181ec6859b2STodor Tomov ispif->nclocks++; 1182ec6859b2STodor Tomov 1183ec6859b2STodor Tomov ispif->clock = devm_kcalloc(dev, 1184ec6859b2STodor Tomov ispif->nclocks, sizeof(*ispif->clock), 1185ec6859b2STodor Tomov GFP_KERNEL); 1186ec6859b2STodor Tomov if (!ispif->clock) 1187ec6859b2STodor Tomov return -ENOMEM; 1188ec6859b2STodor Tomov 1189ec6859b2STodor Tomov for (i = 0; i < ispif->nclocks; i++) { 1190ec6859b2STodor Tomov struct camss_clock *clock = &ispif->clock[i]; 1191ec6859b2STodor Tomov 1192ec6859b2STodor Tomov clock->clk = devm_clk_get(dev, res->clock[i]); 1193ec6859b2STodor Tomov if (IS_ERR(clock->clk)) 1194ec6859b2STodor Tomov return PTR_ERR(clock->clk); 1195ec6859b2STodor Tomov 1196ec6859b2STodor Tomov clock->freq = NULL; 1197ec6859b2STodor Tomov clock->nfreqs = 0; 1198ec6859b2STodor Tomov } 1199ec6859b2STodor Tomov 1200ec6859b2STodor Tomov ispif->nclocks_for_reset = 0; 1201ec6859b2STodor Tomov while (res->clock_for_reset[ispif->nclocks_for_reset]) 1202ec6859b2STodor Tomov ispif->nclocks_for_reset++; 1203ec6859b2STodor Tomov 1204ec6859b2STodor Tomov ispif->clock_for_reset = devm_kcalloc(dev, 1205ec6859b2STodor Tomov ispif->nclocks_for_reset, 1206ec6859b2STodor Tomov sizeof(*ispif->clock_for_reset), 1207ec6859b2STodor Tomov GFP_KERNEL); 1208ec6859b2STodor Tomov if (!ispif->clock_for_reset) 1209ec6859b2STodor Tomov return -ENOMEM; 1210ec6859b2STodor Tomov 1211ec6859b2STodor Tomov for (i = 0; i < ispif->nclocks_for_reset; i++) { 1212ec6859b2STodor Tomov struct camss_clock *clock = &ispif->clock_for_reset[i]; 1213ec6859b2STodor Tomov 1214ec6859b2STodor Tomov clock->clk = devm_clk_get(dev, res->clock_for_reset[i]); 1215ec6859b2STodor Tomov if (IS_ERR(clock->clk)) 1216ec6859b2STodor Tomov return PTR_ERR(clock->clk); 1217ec6859b2STodor Tomov 1218ec6859b2STodor Tomov clock->freq = NULL; 1219ec6859b2STodor Tomov clock->nfreqs = 0; 1220ec6859b2STodor Tomov } 1221ec6859b2STodor Tomov 1222ec6859b2STodor Tomov mutex_init(&ispif->power_lock); 1223ec6859b2STodor Tomov ispif->power_count = 0; 1224ec6859b2STodor Tomov 1225ec6859b2STodor Tomov mutex_init(&ispif->config_lock); 1226ec6859b2STodor Tomov 1227864ed874SAngeloGioacchino Del Regno for (i = 0; i < MSM_ISPIF_VFE_NUM; i++) 1228864ed874SAngeloGioacchino Del Regno init_completion(&ispif->reset_complete[i]); 1229ec6859b2STodor Tomov 1230ec6859b2STodor Tomov return 0; 1231ec6859b2STodor Tomov } 1232ec6859b2STodor Tomov 1233ec6859b2STodor Tomov /* 1234ec6859b2STodor Tomov * ispif_get_intf - Get ISPIF interface to use by VFE line id 1235ec6859b2STodor Tomov * @line_id: VFE line id that the ISPIF line is connected to 1236ec6859b2STodor Tomov * 1237ec6859b2STodor Tomov * Return ISPIF interface to use 1238ec6859b2STodor Tomov */ 1239ec6859b2STodor Tomov static enum ispif_intf ispif_get_intf(enum vfe_line_id line_id) 1240ec6859b2STodor Tomov { 1241ec6859b2STodor Tomov switch (line_id) { 1242ec6859b2STodor Tomov case (VFE_LINE_RDI0): 1243ec6859b2STodor Tomov return RDI0; 1244ec6859b2STodor Tomov case (VFE_LINE_RDI1): 1245ec6859b2STodor Tomov return RDI1; 1246ec6859b2STodor Tomov case (VFE_LINE_RDI2): 1247ec6859b2STodor Tomov return RDI2; 1248ec6859b2STodor Tomov case (VFE_LINE_PIX): 1249ec6859b2STodor Tomov return PIX0; 1250ec6859b2STodor Tomov default: 1251ec6859b2STodor Tomov return RDI0; 1252ec6859b2STodor Tomov } 1253ec6859b2STodor Tomov } 1254ec6859b2STodor Tomov 1255ec6859b2STodor Tomov /* 1256ec6859b2STodor Tomov * ispif_link_setup - Setup ISPIF connections 1257ec6859b2STodor Tomov * @entity: Pointer to media entity structure 1258ec6859b2STodor Tomov * @local: Pointer to local pad 1259ec6859b2STodor Tomov * @remote: Pointer to remote pad 1260ec6859b2STodor Tomov * @flags: Link flags 1261ec6859b2STodor Tomov * 1262ec6859b2STodor Tomov * Return 0 on success 1263ec6859b2STodor Tomov */ 1264ec6859b2STodor Tomov static int ispif_link_setup(struct media_entity *entity, 1265ec6859b2STodor Tomov const struct media_pad *local, 1266ec6859b2STodor Tomov const struct media_pad *remote, u32 flags) 1267ec6859b2STodor Tomov { 1268ec6859b2STodor Tomov if (flags & MEDIA_LNK_FL_ENABLED) { 1269ec6859b2STodor Tomov if (media_entity_remote_pad(local)) 1270ec6859b2STodor Tomov return -EBUSY; 1271ec6859b2STodor Tomov 1272ec6859b2STodor Tomov if (local->flags & MEDIA_PAD_FL_SINK) { 1273ec6859b2STodor Tomov struct v4l2_subdev *sd; 1274ec6859b2STodor Tomov struct ispif_line *line; 1275ec6859b2STodor Tomov 1276ec6859b2STodor Tomov sd = media_entity_to_v4l2_subdev(entity); 1277ec6859b2STodor Tomov line = v4l2_get_subdevdata(sd); 1278ec6859b2STodor Tomov 1279ec6859b2STodor Tomov msm_csid_get_csid_id(remote->entity, &line->csid_id); 1280ec6859b2STodor Tomov } else { /* MEDIA_PAD_FL_SOURCE */ 1281ec6859b2STodor Tomov struct v4l2_subdev *sd; 1282ec6859b2STodor Tomov struct ispif_line *line; 1283ec6859b2STodor Tomov enum vfe_line_id id; 1284ec6859b2STodor Tomov 1285ec6859b2STodor Tomov sd = media_entity_to_v4l2_subdev(entity); 1286ec6859b2STodor Tomov line = v4l2_get_subdevdata(sd); 1287ec6859b2STodor Tomov 1288ec6859b2STodor Tomov msm_vfe_get_vfe_id(remote->entity, &line->vfe_id); 1289ec6859b2STodor Tomov msm_vfe_get_vfe_line_id(remote->entity, &id); 1290ec6859b2STodor Tomov line->interface = ispif_get_intf(id); 1291ec6859b2STodor Tomov } 1292ec6859b2STodor Tomov } 1293ec6859b2STodor Tomov 1294ec6859b2STodor Tomov return 0; 1295ec6859b2STodor Tomov } 1296ec6859b2STodor Tomov 1297ec6859b2STodor Tomov static const struct v4l2_subdev_core_ops ispif_core_ops = { 1298ec6859b2STodor Tomov .s_power = ispif_set_power, 1299ec6859b2STodor Tomov }; 1300ec6859b2STodor Tomov 1301ec6859b2STodor Tomov static const struct v4l2_subdev_video_ops ispif_video_ops = { 1302ec6859b2STodor Tomov .s_stream = ispif_set_stream, 1303ec6859b2STodor Tomov }; 1304ec6859b2STodor Tomov 1305ec6859b2STodor Tomov static const struct v4l2_subdev_pad_ops ispif_pad_ops = { 1306ec6859b2STodor Tomov .enum_mbus_code = ispif_enum_mbus_code, 1307ec6859b2STodor Tomov .enum_frame_size = ispif_enum_frame_size, 1308ec6859b2STodor Tomov .get_fmt = ispif_get_format, 1309ec6859b2STodor Tomov .set_fmt = ispif_set_format, 1310ec6859b2STodor Tomov }; 1311ec6859b2STodor Tomov 1312ec6859b2STodor Tomov static const struct v4l2_subdev_ops ispif_v4l2_ops = { 1313ec6859b2STodor Tomov .core = &ispif_core_ops, 1314ec6859b2STodor Tomov .video = &ispif_video_ops, 1315ec6859b2STodor Tomov .pad = &ispif_pad_ops, 1316ec6859b2STodor Tomov }; 1317ec6859b2STodor Tomov 1318ec6859b2STodor Tomov static const struct v4l2_subdev_internal_ops ispif_v4l2_internal_ops = { 1319ec6859b2STodor Tomov .open = ispif_init_formats, 1320ec6859b2STodor Tomov }; 1321ec6859b2STodor Tomov 1322ec6859b2STodor Tomov static const struct media_entity_operations ispif_media_ops = { 1323ec6859b2STodor Tomov .link_setup = ispif_link_setup, 1324ec6859b2STodor Tomov .link_validate = v4l2_subdev_link_validate, 1325ec6859b2STodor Tomov }; 1326ec6859b2STodor Tomov 1327ec6859b2STodor Tomov /* 1328ec6859b2STodor Tomov * msm_ispif_register_entities - Register subdev node for ISPIF module 1329ec6859b2STodor Tomov * @ispif: ISPIF device 1330ec6859b2STodor Tomov * @v4l2_dev: V4L2 device 1331ec6859b2STodor Tomov * 1332ec6859b2STodor Tomov * Return 0 on success or a negative error code otherwise 1333ec6859b2STodor Tomov */ 1334ec6859b2STodor Tomov int msm_ispif_register_entities(struct ispif_device *ispif, 1335ec6859b2STodor Tomov struct v4l2_device *v4l2_dev) 1336ec6859b2STodor Tomov { 13379d95baf9SRobert Foss struct camss *camss; 1338ec6859b2STodor Tomov int ret; 1339ec6859b2STodor Tomov int i; 1340ec6859b2STodor Tomov 13419d95baf9SRobert Foss if (!ispif) 13429d95baf9SRobert Foss return 0; 13439d95baf9SRobert Foss 13449d95baf9SRobert Foss camss = ispif->camss; 13459d95baf9SRobert Foss 13469c3e59deSTodor Tomov for (i = 0; i < ispif->line_num; i++) { 1347ec6859b2STodor Tomov struct v4l2_subdev *sd = &ispif->line[i].subdev; 1348ec6859b2STodor Tomov struct media_pad *pads = ispif->line[i].pads; 1349ec6859b2STodor Tomov 1350ec6859b2STodor Tomov v4l2_subdev_init(sd, &ispif_v4l2_ops); 1351ec6859b2STodor Tomov sd->internal_ops = &ispif_v4l2_internal_ops; 1352ec6859b2STodor Tomov sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE; 1353ec6859b2STodor Tomov snprintf(sd->name, ARRAY_SIZE(sd->name), "%s%d", 1354ec6859b2STodor Tomov MSM_ISPIF_NAME, i); 1355ec6859b2STodor Tomov v4l2_set_subdevdata(sd, &ispif->line[i]); 1356ec6859b2STodor Tomov 1357ec6859b2STodor Tomov ret = ispif_init_formats(sd, NULL); 1358ec6859b2STodor Tomov if (ret < 0) { 13599d95baf9SRobert Foss dev_err(camss->dev, "Failed to init format: %d\n", ret); 1360ec6859b2STodor Tomov goto error; 1361ec6859b2STodor Tomov } 1362ec6859b2STodor Tomov 1363ec6859b2STodor Tomov pads[MSM_ISPIF_PAD_SINK].flags = MEDIA_PAD_FL_SINK; 1364ec6859b2STodor Tomov pads[MSM_ISPIF_PAD_SRC].flags = MEDIA_PAD_FL_SOURCE; 1365ec6859b2STodor Tomov 136650795910SAndrey Konovalov sd->entity.function = MEDIA_ENT_F_PROC_VIDEO_PIXEL_FORMATTER; 1367ec6859b2STodor Tomov sd->entity.ops = &ispif_media_ops; 1368ec6859b2STodor Tomov ret = media_entity_pads_init(&sd->entity, MSM_ISPIF_PADS_NUM, 1369ec6859b2STodor Tomov pads); 1370ec6859b2STodor Tomov if (ret < 0) { 13719d95baf9SRobert Foss dev_err(camss->dev, "Failed to init media entity: %d\n", 13729d95baf9SRobert Foss ret); 1373ec6859b2STodor Tomov goto error; 1374ec6859b2STodor Tomov } 1375ec6859b2STodor Tomov 1376ec6859b2STodor Tomov ret = v4l2_device_register_subdev(v4l2_dev, sd); 1377ec6859b2STodor Tomov if (ret < 0) { 13789d95baf9SRobert Foss dev_err(camss->dev, "Failed to register subdev: %d\n", 13799d95baf9SRobert Foss ret); 1380ec6859b2STodor Tomov media_entity_cleanup(&sd->entity); 1381ec6859b2STodor Tomov goto error; 1382ec6859b2STodor Tomov } 1383ec6859b2STodor Tomov } 1384ec6859b2STodor Tomov 1385ec6859b2STodor Tomov return 0; 1386ec6859b2STodor Tomov 1387ec6859b2STodor Tomov error: 1388ec6859b2STodor Tomov for (i--; i >= 0; i--) { 1389ec6859b2STodor Tomov struct v4l2_subdev *sd = &ispif->line[i].subdev; 1390ec6859b2STodor Tomov 1391ec6859b2STodor Tomov v4l2_device_unregister_subdev(sd); 1392ec6859b2STodor Tomov media_entity_cleanup(&sd->entity); 1393ec6859b2STodor Tomov } 1394ec6859b2STodor Tomov 1395ec6859b2STodor Tomov return ret; 1396ec6859b2STodor Tomov } 1397ec6859b2STodor Tomov 1398ec6859b2STodor Tomov /* 1399ec6859b2STodor Tomov * msm_ispif_unregister_entities - Unregister ISPIF module subdev node 1400ec6859b2STodor Tomov * @ispif: ISPIF device 1401ec6859b2STodor Tomov */ 1402ec6859b2STodor Tomov void msm_ispif_unregister_entities(struct ispif_device *ispif) 1403ec6859b2STodor Tomov { 1404ec6859b2STodor Tomov int i; 1405ec6859b2STodor Tomov 14069d95baf9SRobert Foss if (!ispif) 14079d95baf9SRobert Foss return; 14089d95baf9SRobert Foss 1409ec6859b2STodor Tomov mutex_destroy(&ispif->power_lock); 1410ec6859b2STodor Tomov mutex_destroy(&ispif->config_lock); 1411ec6859b2STodor Tomov 14129c3e59deSTodor Tomov for (i = 0; i < ispif->line_num; i++) { 1413ec6859b2STodor Tomov struct v4l2_subdev *sd = &ispif->line[i].subdev; 1414ec6859b2STodor Tomov 1415ec6859b2STodor Tomov v4l2_device_unregister_subdev(sd); 1416ec6859b2STodor Tomov media_entity_cleanup(&sd->entity); 1417ec6859b2STodor Tomov } 1418ec6859b2STodor Tomov } 1419