12ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 22ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Copyright (C) 2012-2014 Mentor Graphics Inc. 32ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Copyright (C) 2005-2009 Freescale Semiconductor, Inc. 42ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * 52ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * This program is free software; you can redistribute it and/or modify it 62ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * under the terms of the GNU General Public License as published by the 72ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Free Software Foundation; either version 2 of the License, or (at your 82ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * option) any later version. 92ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * 102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * This program is distributed in the hope that it will be useful, but 112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY 122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License 132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * for more details. 142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/export.h> 162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/module.h> 172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/types.h> 182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/errno.h> 192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/delay.h> 202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/io.h> 212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/err.h> 222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/platform_device.h> 232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/videodev2.h> 242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <uapi/linux/v4l2-mediabus.h> 252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/clk.h> 262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/clk-provider.h> 272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include <linux/clkdev.h> 282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#include "ipu-prv.h" 302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstruct ipu_csi { 322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam void __iomem *base; 332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam int id; 342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 module; 352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct clk *clk_ipu; /* IPU bus clock */ 362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spinlock_t lock; 372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam bool inuse; 382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct ipu_soc *ipu; 392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam}; 402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* CSI Register Offsets */ 422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF 0x0000 432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_FRM_SIZE 0x0004 442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_ACT_FRM_SIZE 0x0008 452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_OUT_FRM_CTRL 0x000c 462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TST_CTRL 0x0010 472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CCIR_CODE_1 0x0014 482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CCIR_CODE_2 0x0018 492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CCIR_CODE_3 0x001c 502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_MIPI_DI 0x0020 512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SKIP 0x0024 522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_CTRL 0x0028 532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_RC(n) (0x002c + ((n)*4)) 542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_RS(n) (0x004c + ((n)*4)) 552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_GRC(n) (0x005c + ((n)*4)) 562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_GRS(n) (0x007c + ((n)*4)) 572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_GBC(n) (0x008c + ((n)*4)) 582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_GBS(n) (0x00Ac + ((n)*4)) 592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_BC(n) (0x00Bc + ((n)*4)) 602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_BS(n) (0x00Dc + ((n)*4)) 612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_OFFSET1 0x00ec 622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CPD_OFFSET2 0x00f0 632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* CSI Register Fields */ 652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_SHIFT 8 662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_MASK 0x00000700 672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_RGB_YUV444 0L 682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_YUV422_YUYV 1L 692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_YUV422_UYVY 2L 702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_BAYER 3L 712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_RGB565 4L 722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_RGB555 5L 732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_RGB444 6L 742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_FMT_JPEG 7L 752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_VSYNC_POL_SHIFT 0 772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_HSYNC_POL_SHIFT 1 782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_POL_SHIFT 2 792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_PIX_CLK_POL_SHIFT 3 802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_SENS_PRTCL_MASK 0x00000070 812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_SENS_PRTCL_SHIFT 4 822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_PACK_TIGHT_SHIFT 7 832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_WIDTH_SHIFT 11 842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_EXT_VSYNC_SHIFT 15 852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DIVRATIO_SHIFT 16 862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DIVRATIO_MASK 0x00ff0000 882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_DEST_SHIFT 24 892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_DEST_MASK 0x07000000 902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_JPEG8_EN_SHIFT 27 912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_JPEG_EN_SHIFT 28 922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_FORCE_EOF_SHIFT 29 932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SENS_CONF_DATA_EN_POL_SHIFT 31 942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_DATA_DEST_IC 2 962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_DATA_DEST_IDMAC 4 972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_CCIR_ERR_DET_EN 0x01000000 992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_HORI_DOWNSIZE_EN 0x80000000 1002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_VERT_DOWNSIZE_EN 0x40000000 1012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_MODE_EN 0x01000000 1022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_HSC_MASK 0x1fff0000 1042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_HSC_SHIFT 16 1052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_VSC_MASK 0x00000fff 1062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_VSC_SHIFT 0 1072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_R_MASK 0x000000ff 1092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_R_SHIFT 0 1102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_G_MASK 0x0000ff00 1112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_G_SHIFT 8 1122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_B_MASK 0x00ff0000 1132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_TEST_GEN_B_SHIFT 16 1142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_MAX_RATIO_SKIP_SMFC_MASK 0x00000007 1162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_MAX_RATIO_SKIP_SMFC_SHIFT 0 1172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SKIP_SMFC_MASK 0x000000f8 1182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_SKIP_SMFC_SHIFT 3 1192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_ID_2_SKIP_MASK 0x00000300 1202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_ID_2_SKIP_SHIFT 8 1212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_COLOR_FIRST_ROW_MASK 0x00000002 1232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define CSI_COLOR_FIRST_COMP_MASK 0x00000001 1242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* MIPI CSI-2 data types */ 1262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_YUV420 0x18 /* YYY.../UYVY.... */ 1272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_YUV420_LEGACY 0x1a /* UYY.../VYY... */ 1282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_YUV422 0x1e /* UYVY... */ 1292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RGB444 0x20 1302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RGB555 0x21 1312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RGB565 0x22 1322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RGB666 0x23 1332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RGB888 0x24 1342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW6 0x28 1352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW7 0x29 1362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW8 0x2a 1372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW10 0x2b 1382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW12 0x2c 1392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam#define MIPI_DT_RAW14 0x2d 1402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 1422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Bitfield of CSI bus signal polarities and modes. 1432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 1442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstruct ipu_csi_bus_config { 1452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned data_width:4; 1462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned clk_mode:3; 1472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned ext_vsync:1; 1482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned vsync_pol:1; 1492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned hsync_pol:1; 1502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned pixclk_pol:1; 1512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned data_pol:1; 1522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned sens_clksrc:1; 1532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned pack_tight:1; 1542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned force_eof:1; 1552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned data_en_pol:1; 1562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned data_fmt; 1582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned mipi_dt; 1592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam}; 1602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 1622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Enumeration of CSI data bus widths. 1632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 1642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamenum ipu_csi_data_width { 1652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_DATA_WIDTH_4 = 0, 1662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_DATA_WIDTH_8 = 1, 1672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_DATA_WIDTH_10 = 3, 1682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_DATA_WIDTH_12 = 5, 1692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_DATA_WIDTH_16 = 9, 1702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam}; 1712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 1732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Enumeration of CSI clock modes. 1742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 1752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamenum ipu_csi_clk_mode { 1762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_GATED_CLK, 1772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_NONGATED_CLK, 1782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE, 1792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR656_INTERLACED, 1802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR, 1812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR, 1822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR, 1832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR, 1842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam}; 1852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstatic inline u32 ipu_csi_read(struct ipu_csi *csi, unsigned offset) 1872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 1882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return readl(csi->base + offset); 1892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 1902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstatic inline void ipu_csi_write(struct ipu_csi *csi, u32 value, 1922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned offset) 1932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 1942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam writel(value, csi->base + offset); 1952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 1962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 1972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 1982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Set mclk division ratio for generating test mode mclk. Only used 1992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * for test generator. 2002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 2012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstatic int ipu_csi_set_testgen_mclk(struct ipu_csi *csi, u32 pixel_clk, 2022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 ipu_clk) 2032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 2042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 temp; 2052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 div_ratio; 2062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 2072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam div_ratio = (ipu_clk / pixel_clk) - 1; 2082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 2092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (div_ratio > 0xFF || div_ratio < 0) { 2102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_err(csi->ipu->dev, 2112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam "value of pixel_clk extends normal range\n"); 2122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -EINVAL; 2132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 2142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 2152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp = ipu_csi_read(csi, CSI_SENS_CONF); 2162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp &= ~CSI_SENS_CONF_DIVRATIO_MASK; 2172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, temp | (div_ratio << CSI_SENS_CONF_DIVRATIO_SHIFT), 2182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_SENS_CONF); 2192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 2202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 2212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 2222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 2232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 2242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Find the CSI data format and data width for the given V4L2 media 2252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * bus pixel format code. 2262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 2272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstatic int mbus_code_to_bus_cfg(struct ipu_csi_bus_config *cfg, u32 mbus_code) 2282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 2292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam switch (mbus_code) { 2302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_BGR565_2X8_BE: 2312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_BGR565_2X8_LE: 2322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB565_2X8_BE: 2332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB565_2X8_LE: 2342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB565; 2352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RGB565; 2362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB444_2X8_PADHI_BE: 2392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB444_2X8_PADHI_LE: 2402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB444; 2412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RGB444; 2422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB555_2X8_PADHI_BE: 2452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_RGB555_2X8_PADHI_LE: 2462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB555; 2472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RGB555; 2482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_UYVY8_2X8: 2512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; 2522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_YUV422; 2532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_YUYV8_2X8: 2562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; 2572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_YUV422; 2582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_UYVY8_1X16: 2612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; 2622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_YUV422; 2632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_16; 2642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_YUYV8_1X16: 2662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; 2672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_YUV422; 2682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_16; 2692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR8_1X8: 2712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGBRG8_1X8: 2722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGRBG8_1X8: 2732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SRGGB8_1X8: 2742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; 2752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RAW8; 2762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_DPCM8_1X8: 2792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGBRG10_DPCM8_1X8: 2802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGRBG10_DPCM8_1X8: 2812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SRGGB10_DPCM8_1X8: 2822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_BE: 2832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE: 2842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_BE: 2852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_LE: 2862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; 2872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RAW10; 2882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 2892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR10_1X10: 2912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGBRG10_1X10: 2922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGRBG10_1X10: 2932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SRGGB10_1X10: 2942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; 2952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RAW10; 2962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_10; 2972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 2982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SBGGR12_1X12: 2992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGBRG12_1X12: 3002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SGRBG12_1X12: 3012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_SRGGB12_1X12: 3022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; 3032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RAW12; 3042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_12; 3052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_FMT_JPEG_1X8: 3072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* TODO */ 3082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_JPEG; 3092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->mipi_dt = MIPI_DT_RAW8; 3102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg->data_width = IPU_CSI_DATA_WIDTH_8; 3112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam default: 3132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -EINVAL; 3142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 3152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 3172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 3182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam/* 3202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Fill a CSI bus config struct from mbus_config and mbus_framefmt. 3212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 3222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstatic void fill_csi_bus_cfg(struct ipu_csi_bus_config *csicfg, 3232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct v4l2_mbus_config *mbus_cfg, 3242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct v4l2_mbus_framefmt *mbus_fmt) 3252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 3262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam memset(csicfg, 0, sizeof(*csicfg)); 3272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam mbus_code_to_bus_cfg(csicfg, mbus_fmt->code); 3292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam switch (mbus_cfg->type) { 3312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_PARALLEL: 3322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->ext_vsync = 1; 3332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->vsync_pol = (mbus_cfg->flags & 3342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam V4L2_MBUS_VSYNC_ACTIVE_LOW) ? 1 : 0; 3352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->hsync_pol = (mbus_cfg->flags & 3362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam V4L2_MBUS_HSYNC_ACTIVE_LOW) ? 1 : 0; 3372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->pixclk_pol = (mbus_cfg->flags & 3382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam V4L2_MBUS_PCLK_SAMPLE_FALLING) ? 1 : 0; 3392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->clk_mode = IPU_CSI_CLK_MODE_GATED_CLK; 3402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_BT656: 3422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->ext_vsync = 0; 3432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (V4L2_FIELD_HAS_BOTH(mbus_fmt->field)) 3442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_INTERLACED; 3452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam else 3462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE; 3472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case V4L2_MBUS_CSI2: 3492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* 3502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * MIPI CSI-2 requires non gated clock mode, all other 3512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * parameters are not applicable for MIPI CSI-2 bus. 3522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 3532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csicfg->clk_mode = IPU_CSI_CLK_MODE_NONGATED_CLK; 3542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam default: 3562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* will never get here, keep compiler quiet */ 3572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 3582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 3592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 3602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_init_interface(struct ipu_csi *csi, 3622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct v4l2_mbus_config *mbus_cfg, 3632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct v4l2_mbus_framefmt *mbus_fmt) 3642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 3652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct ipu_csi_bus_config cfg; 3662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 3672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 data = 0; 3682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam fill_csi_bus_cfg(&cfg, mbus_cfg, mbus_fmt); 3702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* Set the CSI_SENS_CONF register remaining fields */ 3722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam data |= cfg.data_width << CSI_SENS_CONF_DATA_WIDTH_SHIFT | 3732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.data_fmt << CSI_SENS_CONF_DATA_FMT_SHIFT | 3742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.data_pol << CSI_SENS_CONF_DATA_POL_SHIFT | 3752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.vsync_pol << CSI_SENS_CONF_VSYNC_POL_SHIFT | 3762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.hsync_pol << CSI_SENS_CONF_HSYNC_POL_SHIFT | 3772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.pixclk_pol << CSI_SENS_CONF_PIX_CLK_POL_SHIFT | 3782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.ext_vsync << CSI_SENS_CONF_EXT_VSYNC_SHIFT | 3792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.clk_mode << CSI_SENS_CONF_SENS_PRTCL_SHIFT | 3802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.pack_tight << CSI_SENS_CONF_PACK_TIGHT_SHIFT | 3812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.force_eof << CSI_SENS_CONF_FORCE_EOF_SHIFT | 3822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam cfg.data_en_pol << CSI_SENS_CONF_DATA_EN_POL_SHIFT; 3832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 3852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, data, CSI_SENS_CONF); 3872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* Setup sensor frame size */ 3892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 3902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (mbus_fmt->width - 1) | ((mbus_fmt->height - 1) << 16), 3912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_SENS_FRM_SIZE); 3922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* Set CCIR registers */ 3942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 3952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam switch (cfg.clk_mode) { 3962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: 3972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0x40030, CSI_CCIR_CODE_1); 3982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); 3992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 4002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: 4012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (mbus_fmt->width == 720 && mbus_fmt->height == 576) { 4022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* 4032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * PAL case 4042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * 4052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field0BlankEnd = 0x6, Field0BlankStart = 0x2, 4062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field0ActiveEnd = 0x4, Field0ActiveStart = 0 4072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field1BlankEnd = 0x7, Field1BlankStart = 0x3, 4082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field1ActiveEnd = 0x5, Field1ActiveStart = 0x1 4092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 4102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0x40596 | CSI_CCIR_ERR_DET_EN, 4112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_CCIR_CODE_1); 4122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xD07DF, CSI_CCIR_CODE_2); 4132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); 4142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } else if (mbus_fmt->width == 720 && mbus_fmt->height == 480) { 4162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* 4172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * NTSC case 4182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * 4192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field0BlankEnd = 0x7, Field0BlankStart = 0x3, 4202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field0ActiveEnd = 0x5, Field0ActiveStart = 0x1 4212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field1BlankEnd = 0x6, Field1BlankStart = 0x2, 4222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam * Field1ActiveEnd = 0x4, Field1ActiveStart = 0 4232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam */ 4242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xD07DF | CSI_CCIR_ERR_DET_EN, 4252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_CCIR_CODE_1); 4262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0x40596, CSI_CCIR_CODE_2); 4272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); 4282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } else { 4292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_err(csi->ipu->dev, 4302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam "Unsupported CCIR656 interlaced video mode\n"); 4312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 4322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -EINVAL; 4332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 4342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 4352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: 4362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: 4372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: 4382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: 4392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0x40030 | CSI_CCIR_ERR_DET_EN, 4402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_CCIR_CODE_1); 4412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); 4422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 4432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_GATED_CLK: 4442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_NONGATED_CLK: 4452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, 0, CSI_CCIR_CODE_1); 4462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam break; 4472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 4482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_SENS_CONF = 0x%08X\n", 4502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_SENS_CONF)); 4512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE = 0x%08X\n", 4522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); 4532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 4552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 4572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 4582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_init_interface); 4592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeambool ipu_csi_is_interlaced(struct ipu_csi *csi) 4612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 4622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 4632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 sensor_protocol; 4642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 4662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam sensor_protocol = 4672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (ipu_csi_read(csi, CSI_SENS_CONF) & 4682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_SENS_CONF_SENS_PRTCL_MASK) >> 4692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_SENS_CONF_SENS_PRTCL_SHIFT; 4702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 4712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam switch (sensor_protocol) { 4732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_GATED_CLK: 4742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_NONGATED_CLK: 4752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: 4762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: 4772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: 4782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return false; 4792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: 4802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: 4812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: 4822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return true; 4832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam default: 4842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_err(csi->ipu->dev, 4852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam "CSI %d sensor protocol unsupported\n", csi->id); 4862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return false; 4872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 4882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 4892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_is_interlaced); 4902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_get_window(struct ipu_csi *csi, struct v4l2_rect *w) 4922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 4932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 4942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 reg; 4952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 4972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 4982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam reg = ipu_csi_read(csi, CSI_ACT_FRM_SIZE); 4992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam w->width = (reg & 0xFFFF) + 1; 5002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam w->height = (reg >> 16 & 0xFFFF) + 1; 5012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); 5032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam w->left = (reg & CSI_HSC_MASK) >> CSI_HSC_SHIFT; 5042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam w->top = (reg & CSI_VSC_MASK) >> CSI_VSC_SHIFT; 5052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 5072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 5082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_get_window); 5092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w) 5112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 5122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 5132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 reg; 5142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 5162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, (w->width - 1) | ((w->height - 1) << 16), 5182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_ACT_FRM_SIZE); 5192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); 5212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam reg &= ~(CSI_HSC_MASK | CSI_VSC_MASK); 5222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam reg |= ((w->top << CSI_VSC_SHIFT) | (w->left << CSI_HSC_SHIFT)); 5232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); 5242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 5262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 5272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_set_window); 5282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_set_test_generator(struct ipu_csi *csi, bool active, 5302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 r_value, u32 g_value, u32 b_value, 5312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 pix_clk) 5322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 5332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 5342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 ipu_clk = clk_get_rate(csi->clk_ipu); 5352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 temp; 5362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 5382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp = ipu_csi_read(csi, CSI_TST_CTRL); 5402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (active == false) { 5422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp &= ~CSI_TEST_GEN_MODE_EN; 5432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, temp, CSI_TST_CTRL); 5442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } else { 5452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam /* Set sensb_mclk div_ratio */ 5462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_set_testgen_mclk(csi, pix_clk, ipu_clk); 5472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp &= ~(CSI_TEST_GEN_R_MASK | CSI_TEST_GEN_G_MASK | 5492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_TEST_GEN_B_MASK); 5502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp |= CSI_TEST_GEN_MODE_EN; 5512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp |= (r_value << CSI_TEST_GEN_R_SHIFT) | 5522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (g_value << CSI_TEST_GEN_G_SHIFT) | 5532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (b_value << CSI_TEST_GEN_B_SHIFT); 5542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, temp, CSI_TST_CTRL); 5552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 5562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 5582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 5592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_set_test_generator); 5602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc, 5622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct v4l2_mbus_framefmt *mbus_fmt) 5632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 5642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct ipu_csi_bus_config cfg; 5652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 5662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 temp; 5672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (vc > 3) 5692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -EINVAL; 5702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam mbus_code_to_bus_cfg(&cfg, mbus_fmt->code); 5722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 5742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp = ipu_csi_read(csi, CSI_MIPI_DI); 5762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp &= ~(0xff << (vc * 8)); 5772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp |= (cfg.mipi_dt << (vc * 8)); 5782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, temp, CSI_MIPI_DI); 5792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 5812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 5832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 5842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_set_mipi_datatype); 5852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip, 5872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 max_ratio, u32 id) 5882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 5892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 5902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 temp; 5912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (max_ratio > 5 || id > 3) 5932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -EINVAL; 5942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 5962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 5972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp = ipu_csi_read(csi, CSI_SKIP); 5982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp &= ~(CSI_MAX_RATIO_SKIP_SMFC_MASK | CSI_ID_2_SKIP_MASK | 5992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam CSI_SKIP_SMFC_MASK); 6002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam temp |= (max_ratio << CSI_MAX_RATIO_SKIP_SMFC_SHIFT) | 6012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (id << CSI_ID_2_SKIP_SHIFT) | 6022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam (skip << CSI_SKIP_SMFC_SHIFT); 6032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, temp, CSI_SKIP); 6042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 6062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 6082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_set_skip_smfc); 6102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest) 6122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 6142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam u32 csi_sens_conf, dest; 6152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (csi_dest == IPU_CSI_DEST_IDMAC) 6172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dest = CSI_DATA_DEST_IDMAC; 6182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam else 6192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dest = CSI_DATA_DEST_IC; /* IC or VDIC */ 6202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 6222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi_sens_conf = ipu_csi_read(csi, CSI_SENS_CONF); 6242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi_sens_conf &= ~CSI_SENS_CONF_DATA_DEST_MASK; 6252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi_sens_conf |= (dest << CSI_SENS_CONF_DATA_DEST_SHIFT); 6262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_write(csi, csi_sens_conf, CSI_SENS_CONF); 6272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 6292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 6312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_set_dest); 6332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_enable(struct ipu_csi *csi) 6352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_module_enable(csi->ipu, csi->module); 6372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 6392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_enable); 6412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6422ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_disable(struct ipu_csi *csi) 6432ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6442ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_module_disable(csi->ipu, csi->module); 6452ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6462ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 6472ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6482ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_disable); 6492ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6502ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamstruct ipu_csi *ipu_csi_get(struct ipu_soc *ipu, int id) 6512ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6522ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 6532ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct ipu_csi *csi, *ret; 6542ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6552ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (id > 1) 6562ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return ERR_PTR(-EINVAL); 6572ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6582ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi = ipu->csi_priv[id]; 6592ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ret = csi; 6602ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6612ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 6622ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6632ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (csi->inuse) { 6642ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ret = ERR_PTR(-EBUSY); 6652ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam goto unlock; 6662ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam } 6672ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6682ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->inuse = true; 6692ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamunlock: 6702ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 6712ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return ret; 6722ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6732ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_get); 6742ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6752ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_put(struct ipu_csi *csi) 6762ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6772ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long flags; 6782ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6792ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_irqsave(&csi->lock, flags); 6802ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->inuse = false; 6812ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_unlock_irqrestore(&csi->lock, flags); 6822ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 6832ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_put); 6842ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6852ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamint ipu_csi_init(struct ipu_soc *ipu, struct device *dev, int id, 6862ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam unsigned long base, u32 module, struct clk *clk_ipu) 6872ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 6882ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam struct ipu_csi *csi; 6892ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6902ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (id > 1) 6912ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -ENODEV; 6922ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6932ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi = devm_kzalloc(dev, sizeof(*csi), GFP_KERNEL); 6942ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (!csi) 6952ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -ENOMEM; 6962ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6972ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu->csi_priv[id] = csi; 6982ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 6992ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam spin_lock_init(&csi->lock); 7002ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->module = module; 7012ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->id = id; 7022ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->clk_ipu = clk_ipu; 7032ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->base = devm_ioremap(dev, base, PAGE_SIZE); 7042ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam if (!csi->base) 7052ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return -ENOMEM; 7062ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 7072ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(dev, "CSI%d base: 0x%08lx remapped to %p\n", 7082ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam id, base, csi->base); 7092ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam csi->ipu = ipu; 7102ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 7112ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam return 0; 7122ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 7132ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 7142ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_exit(struct ipu_soc *ipu, int id) 7152ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 7162ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 7172ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam 7182ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeamvoid ipu_csi_dump(struct ipu_csi *csi) 7192ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam{ 7202ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_SENS_CONF: %08x\n", 7212ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_SENS_CONF)); 7222ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_SENS_FRM_SIZE: %08x\n", 7232ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_SENS_FRM_SIZE)); 7242ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE: %08x\n", 7252ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); 7262ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_OUT_FRM_CTRL: %08x\n", 7272ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_OUT_FRM_CTRL)); 7282ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_TST_CTRL: %08x\n", 7292ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_TST_CTRL)); 7302ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_1: %08x\n", 7312ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_CCIR_CODE_1)); 7322ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_2: %08x\n", 7332ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_CCIR_CODE_2)); 7342ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_3: %08x\n", 7352ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_CCIR_CODE_3)); 7362ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_MIPI_DI: %08x\n", 7372ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_MIPI_DI)); 7382ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam dev_dbg(csi->ipu->dev, "CSI_SKIP: %08x\n", 7392ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam ipu_csi_read(csi, CSI_SKIP)); 7402ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve Longerbeam} 7412ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468Steve LongerbeamEXPORT_SYMBOL_GPL(ipu_csi_dump); 742