diff options
author | Steve Longerbeam <slongerbeam@gmail.com> | 2014-08-19 13:52:40 -0400 |
---|---|---|
committer | Philipp Zabel <p.zabel@pengutronix.de> | 2014-09-02 08:55:42 -0400 |
commit | 2ffd48f2e7ae06c3d7b2bcde9a0cb211d1a32468 (patch) | |
tree | 7969a203b7fa3c3733594aee34795b2a43e7bb16 | |
parent | c2d670fd3b16304124162bef99313eaa289f2bc3 (diff) |
gpu: ipu-v3: Add Camera Sensor Interface unit
Adds the Camera Sensor Interface (CSI) unit required for video capture.
Signed-off-by: Steve Longerbeam <steve_longerbeam@mentor.com>
Removed the unused clk_get_rate in ipu_csi_init_interface and the
ipu_csi_ccir_err_detection_enable/disable functions.
Checkpatch cleanup.
Signed-off-by: Philipp Zabel <p.zabel@pengutronix.de>
-rw-r--r-- | drivers/gpu/ipu-v3/Makefile | 2 | ||||
-rw-r--r-- | drivers/gpu/ipu-v3/ipu-common.c | 44 | ||||
-rw-r--r-- | drivers/gpu/ipu-v3/ipu-csi.c | 741 | ||||
-rw-r--r-- | drivers/gpu/ipu-v3/ipu-prv.h | 6 | ||||
-rw-r--r-- | include/video/imx-ipu-v3.h | 32 |
5 files changed, 810 insertions, 15 deletions
diff --git a/drivers/gpu/ipu-v3/Makefile b/drivers/gpu/ipu-v3/Makefile index 0b42836caae1..d22bd06caa6d 100644 --- a/drivers/gpu/ipu-v3/Makefile +++ b/drivers/gpu/ipu-v3/Makefile | |||
@@ -1,4 +1,4 @@ | |||
1 | obj-$(CONFIG_IMX_IPUV3_CORE) += imx-ipu-v3.o | 1 | obj-$(CONFIG_IMX_IPUV3_CORE) += imx-ipu-v3.o |
2 | 2 | ||
3 | imx-ipu-v3-objs := ipu-common.o ipu-cpmem.o ipu-dc.o ipu-di.o \ | 3 | imx-ipu-v3-objs := ipu-common.o ipu-cpmem.o ipu-csi.o ipu-dc.o ipu-di.o \ |
4 | ipu-dp.o ipu-dmfc.o ipu-smfc.o | 4 | ipu-dp.o ipu-dmfc.o ipu-smfc.o |
diff --git a/drivers/gpu/ipu-v3/ipu-common.c b/drivers/gpu/ipu-v3/ipu-common.c index cae543115856..511c364231a2 100644 --- a/drivers/gpu/ipu-v3/ipu-common.c +++ b/drivers/gpu/ipu-v3/ipu-common.c | |||
@@ -217,18 +217,6 @@ int ipu_module_disable(struct ipu_soc *ipu, u32 mask) | |||
217 | } | 217 | } |
218 | EXPORT_SYMBOL_GPL(ipu_module_disable); | 218 | EXPORT_SYMBOL_GPL(ipu_module_disable); |
219 | 219 | ||
220 | int ipu_csi_enable(struct ipu_soc *ipu, int csi) | ||
221 | { | ||
222 | return ipu_module_enable(ipu, csi ? IPU_CONF_CSI1_EN : IPU_CONF_CSI0_EN); | ||
223 | } | ||
224 | EXPORT_SYMBOL_GPL(ipu_csi_enable); | ||
225 | |||
226 | int ipu_csi_disable(struct ipu_soc *ipu, int csi) | ||
227 | { | ||
228 | return ipu_module_disable(ipu, csi ? IPU_CONF_CSI1_EN : IPU_CONF_CSI0_EN); | ||
229 | } | ||
230 | EXPORT_SYMBOL_GPL(ipu_csi_disable); | ||
231 | |||
232 | int ipu_smfc_enable(struct ipu_soc *ipu) | 220 | int ipu_smfc_enable(struct ipu_soc *ipu) |
233 | { | 221 | { |
234 | return ipu_module_enable(ipu, IPU_CONF_SMFC_EN); | 222 | return ipu_module_enable(ipu, IPU_CONF_SMFC_EN); |
@@ -439,6 +427,8 @@ struct ipu_devtype { | |||
439 | unsigned long cpmem_ofs; | 427 | unsigned long cpmem_ofs; |
440 | unsigned long srm_ofs; | 428 | unsigned long srm_ofs; |
441 | unsigned long tpm_ofs; | 429 | unsigned long tpm_ofs; |
430 | unsigned long csi0_ofs; | ||
431 | unsigned long csi1_ofs; | ||
442 | unsigned long disp0_ofs; | 432 | unsigned long disp0_ofs; |
443 | unsigned long disp1_ofs; | 433 | unsigned long disp1_ofs; |
444 | unsigned long dc_tmpl_ofs; | 434 | unsigned long dc_tmpl_ofs; |
@@ -452,6 +442,8 @@ static struct ipu_devtype ipu_type_imx51 = { | |||
452 | .cpmem_ofs = 0x1f000000, | 442 | .cpmem_ofs = 0x1f000000, |
453 | .srm_ofs = 0x1f040000, | 443 | .srm_ofs = 0x1f040000, |
454 | .tpm_ofs = 0x1f060000, | 444 | .tpm_ofs = 0x1f060000, |
445 | .csi0_ofs = 0x1f030000, | ||
446 | .csi1_ofs = 0x1f038000, | ||
455 | .disp0_ofs = 0x1e040000, | 447 | .disp0_ofs = 0x1e040000, |
456 | .disp1_ofs = 0x1e048000, | 448 | .disp1_ofs = 0x1e048000, |
457 | .dc_tmpl_ofs = 0x1f080000, | 449 | .dc_tmpl_ofs = 0x1f080000, |
@@ -465,6 +457,8 @@ static struct ipu_devtype ipu_type_imx53 = { | |||
465 | .cpmem_ofs = 0x07000000, | 457 | .cpmem_ofs = 0x07000000, |
466 | .srm_ofs = 0x07040000, | 458 | .srm_ofs = 0x07040000, |
467 | .tpm_ofs = 0x07060000, | 459 | .tpm_ofs = 0x07060000, |
460 | .csi0_ofs = 0x07030000, | ||
461 | .csi1_ofs = 0x07038000, | ||
468 | .disp0_ofs = 0x06040000, | 462 | .disp0_ofs = 0x06040000, |
469 | .disp1_ofs = 0x06048000, | 463 | .disp1_ofs = 0x06048000, |
470 | .dc_tmpl_ofs = 0x07080000, | 464 | .dc_tmpl_ofs = 0x07080000, |
@@ -478,6 +472,8 @@ static struct ipu_devtype ipu_type_imx6q = { | |||
478 | .cpmem_ofs = 0x00300000, | 472 | .cpmem_ofs = 0x00300000, |
479 | .srm_ofs = 0x00340000, | 473 | .srm_ofs = 0x00340000, |
480 | .tpm_ofs = 0x00360000, | 474 | .tpm_ofs = 0x00360000, |
475 | .csi0_ofs = 0x00230000, | ||
476 | .csi1_ofs = 0x00238000, | ||
481 | .disp0_ofs = 0x00240000, | 477 | .disp0_ofs = 0x00240000, |
482 | .disp1_ofs = 0x00248000, | 478 | .disp1_ofs = 0x00248000, |
483 | .dc_tmpl_ofs = 0x00380000, | 479 | .dc_tmpl_ofs = 0x00380000, |
@@ -508,6 +504,20 @@ static int ipu_submodules_init(struct ipu_soc *ipu, | |||
508 | goto err_cpmem; | 504 | goto err_cpmem; |
509 | } | 505 | } |
510 | 506 | ||
507 | ret = ipu_csi_init(ipu, dev, 0, ipu_base + devtype->csi0_ofs, | ||
508 | IPU_CONF_CSI0_EN, ipu_clk); | ||
509 | if (ret) { | ||
510 | unit = "csi0"; | ||
511 | goto err_csi_0; | ||
512 | } | ||
513 | |||
514 | ret = ipu_csi_init(ipu, dev, 1, ipu_base + devtype->csi1_ofs, | ||
515 | IPU_CONF_CSI1_EN, ipu_clk); | ||
516 | if (ret) { | ||
517 | unit = "csi1"; | ||
518 | goto err_csi_1; | ||
519 | } | ||
520 | |||
511 | ret = ipu_di_init(ipu, dev, 0, ipu_base + devtype->disp0_ofs, | 521 | ret = ipu_di_init(ipu, dev, 0, ipu_base + devtype->disp0_ofs, |
512 | IPU_CONF_DI0_EN, ipu_clk); | 522 | IPU_CONF_DI0_EN, ipu_clk); |
513 | if (ret) { | 523 | if (ret) { |
@@ -562,6 +572,10 @@ err_dc: | |||
562 | err_di_1: | 572 | err_di_1: |
563 | ipu_di_exit(ipu, 0); | 573 | ipu_di_exit(ipu, 0); |
564 | err_di_0: | 574 | err_di_0: |
575 | ipu_csi_exit(ipu, 1); | ||
576 | err_csi_1: | ||
577 | ipu_csi_exit(ipu, 0); | ||
578 | err_csi_0: | ||
565 | ipu_cpmem_exit(ipu); | 579 | ipu_cpmem_exit(ipu); |
566 | err_cpmem: | 580 | err_cpmem: |
567 | dev_err(&pdev->dev, "init %s failed with %d\n", unit, ret); | 581 | dev_err(&pdev->dev, "init %s failed with %d\n", unit, ret); |
@@ -640,6 +654,8 @@ static void ipu_submodules_exit(struct ipu_soc *ipu) | |||
640 | ipu_dc_exit(ipu); | 654 | ipu_dc_exit(ipu); |
641 | ipu_di_exit(ipu, 1); | 655 | ipu_di_exit(ipu, 1); |
642 | ipu_di_exit(ipu, 0); | 656 | ipu_di_exit(ipu, 0); |
657 | ipu_csi_exit(ipu, 1); | ||
658 | ipu_csi_exit(ipu, 0); | ||
643 | ipu_cpmem_exit(ipu); | 659 | ipu_cpmem_exit(ipu); |
644 | } | 660 | } |
645 | 661 | ||
@@ -859,6 +875,10 @@ static int ipu_probe(struct platform_device *pdev) | |||
859 | ipu_base + devtype->cm_ofs + IPU_CM_IDMAC_REG_OFS); | 875 | ipu_base + devtype->cm_ofs + IPU_CM_IDMAC_REG_OFS); |
860 | dev_dbg(&pdev->dev, "cpmem: 0x%08lx\n", | 876 | dev_dbg(&pdev->dev, "cpmem: 0x%08lx\n", |
861 | ipu_base + devtype->cpmem_ofs); | 877 | ipu_base + devtype->cpmem_ofs); |
878 | dev_dbg(&pdev->dev, "csi0: 0x%08lx\n", | ||
879 | ipu_base + devtype->csi0_ofs); | ||
880 | dev_dbg(&pdev->dev, "csi1: 0x%08lx\n", | ||
881 | ipu_base + devtype->csi1_ofs); | ||
862 | dev_dbg(&pdev->dev, "disp0: 0x%08lx\n", | 882 | dev_dbg(&pdev->dev, "disp0: 0x%08lx\n", |
863 | ipu_base + devtype->disp0_ofs); | 883 | ipu_base + devtype->disp0_ofs); |
864 | dev_dbg(&pdev->dev, "disp1: 0x%08lx\n", | 884 | dev_dbg(&pdev->dev, "disp1: 0x%08lx\n", |
diff --git a/drivers/gpu/ipu-v3/ipu-csi.c b/drivers/gpu/ipu-v3/ipu-csi.c new file mode 100644 index 000000000000..d6f56471bd2a --- /dev/null +++ b/drivers/gpu/ipu-v3/ipu-csi.c | |||
@@ -0,0 +1,741 @@ | |||
1 | /* | ||
2 | * Copyright (C) 2012-2014 Mentor Graphics Inc. | ||
3 | * Copyright (C) 2005-2009 Freescale Semiconductor, Inc. | ||
4 | * | ||
5 | * This program is free software; you can redistribute it and/or modify it | ||
6 | * under the terms of the GNU General Public License as published by the | ||
7 | * Free Software Foundation; either version 2 of the License, or (at your | ||
8 | * option) any later version. | ||
9 | * | ||
10 | * This program is distributed in the hope that it will be useful, but | ||
11 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | ||
12 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | ||
13 | * for more details. | ||
14 | */ | ||
15 | #include <linux/export.h> | ||
16 | #include <linux/module.h> | ||
17 | #include <linux/types.h> | ||
18 | #include <linux/errno.h> | ||
19 | #include <linux/delay.h> | ||
20 | #include <linux/io.h> | ||
21 | #include <linux/err.h> | ||
22 | #include <linux/platform_device.h> | ||
23 | #include <linux/videodev2.h> | ||
24 | #include <uapi/linux/v4l2-mediabus.h> | ||
25 | #include <linux/clk.h> | ||
26 | #include <linux/clk-provider.h> | ||
27 | #include <linux/clkdev.h> | ||
28 | |||
29 | #include "ipu-prv.h" | ||
30 | |||
31 | struct ipu_csi { | ||
32 | void __iomem *base; | ||
33 | int id; | ||
34 | u32 module; | ||
35 | struct clk *clk_ipu; /* IPU bus clock */ | ||
36 | spinlock_t lock; | ||
37 | bool inuse; | ||
38 | struct ipu_soc *ipu; | ||
39 | }; | ||
40 | |||
41 | /* CSI Register Offsets */ | ||
42 | #define CSI_SENS_CONF 0x0000 | ||
43 | #define CSI_SENS_FRM_SIZE 0x0004 | ||
44 | #define CSI_ACT_FRM_SIZE 0x0008 | ||
45 | #define CSI_OUT_FRM_CTRL 0x000c | ||
46 | #define CSI_TST_CTRL 0x0010 | ||
47 | #define CSI_CCIR_CODE_1 0x0014 | ||
48 | #define CSI_CCIR_CODE_2 0x0018 | ||
49 | #define CSI_CCIR_CODE_3 0x001c | ||
50 | #define CSI_MIPI_DI 0x0020 | ||
51 | #define CSI_SKIP 0x0024 | ||
52 | #define CSI_CPD_CTRL 0x0028 | ||
53 | #define CSI_CPD_RC(n) (0x002c + ((n)*4)) | ||
54 | #define CSI_CPD_RS(n) (0x004c + ((n)*4)) | ||
55 | #define CSI_CPD_GRC(n) (0x005c + ((n)*4)) | ||
56 | #define CSI_CPD_GRS(n) (0x007c + ((n)*4)) | ||
57 | #define CSI_CPD_GBC(n) (0x008c + ((n)*4)) | ||
58 | #define CSI_CPD_GBS(n) (0x00Ac + ((n)*4)) | ||
59 | #define CSI_CPD_BC(n) (0x00Bc + ((n)*4)) | ||
60 | #define CSI_CPD_BS(n) (0x00Dc + ((n)*4)) | ||
61 | #define CSI_CPD_OFFSET1 0x00ec | ||
62 | #define CSI_CPD_OFFSET2 0x00f0 | ||
63 | |||
64 | /* CSI Register Fields */ | ||
65 | #define CSI_SENS_CONF_DATA_FMT_SHIFT 8 | ||
66 | #define CSI_SENS_CONF_DATA_FMT_MASK 0x00000700 | ||
67 | #define CSI_SENS_CONF_DATA_FMT_RGB_YUV444 0L | ||
68 | #define CSI_SENS_CONF_DATA_FMT_YUV422_YUYV 1L | ||
69 | #define CSI_SENS_CONF_DATA_FMT_YUV422_UYVY 2L | ||
70 | #define CSI_SENS_CONF_DATA_FMT_BAYER 3L | ||
71 | #define CSI_SENS_CONF_DATA_FMT_RGB565 4L | ||
72 | #define CSI_SENS_CONF_DATA_FMT_RGB555 5L | ||
73 | #define CSI_SENS_CONF_DATA_FMT_RGB444 6L | ||
74 | #define CSI_SENS_CONF_DATA_FMT_JPEG 7L | ||
75 | |||
76 | #define CSI_SENS_CONF_VSYNC_POL_SHIFT 0 | ||
77 | #define CSI_SENS_CONF_HSYNC_POL_SHIFT 1 | ||
78 | #define CSI_SENS_CONF_DATA_POL_SHIFT 2 | ||
79 | #define CSI_SENS_CONF_PIX_CLK_POL_SHIFT 3 | ||
80 | #define CSI_SENS_CONF_SENS_PRTCL_MASK 0x00000070 | ||
81 | #define CSI_SENS_CONF_SENS_PRTCL_SHIFT 4 | ||
82 | #define CSI_SENS_CONF_PACK_TIGHT_SHIFT 7 | ||
83 | #define CSI_SENS_CONF_DATA_WIDTH_SHIFT 11 | ||
84 | #define CSI_SENS_CONF_EXT_VSYNC_SHIFT 15 | ||
85 | #define CSI_SENS_CONF_DIVRATIO_SHIFT 16 | ||
86 | |||
87 | #define CSI_SENS_CONF_DIVRATIO_MASK 0x00ff0000 | ||
88 | #define CSI_SENS_CONF_DATA_DEST_SHIFT 24 | ||
89 | #define CSI_SENS_CONF_DATA_DEST_MASK 0x07000000 | ||
90 | #define CSI_SENS_CONF_JPEG8_EN_SHIFT 27 | ||
91 | #define CSI_SENS_CONF_JPEG_EN_SHIFT 28 | ||
92 | #define CSI_SENS_CONF_FORCE_EOF_SHIFT 29 | ||
93 | #define CSI_SENS_CONF_DATA_EN_POL_SHIFT 31 | ||
94 | |||
95 | #define CSI_DATA_DEST_IC 2 | ||
96 | #define CSI_DATA_DEST_IDMAC 4 | ||
97 | |||
98 | #define CSI_CCIR_ERR_DET_EN 0x01000000 | ||
99 | #define CSI_HORI_DOWNSIZE_EN 0x80000000 | ||
100 | #define CSI_VERT_DOWNSIZE_EN 0x40000000 | ||
101 | #define CSI_TEST_GEN_MODE_EN 0x01000000 | ||
102 | |||
103 | #define CSI_HSC_MASK 0x1fff0000 | ||
104 | #define CSI_HSC_SHIFT 16 | ||
105 | #define CSI_VSC_MASK 0x00000fff | ||
106 | #define CSI_VSC_SHIFT 0 | ||
107 | |||
108 | #define CSI_TEST_GEN_R_MASK 0x000000ff | ||
109 | #define CSI_TEST_GEN_R_SHIFT 0 | ||
110 | #define CSI_TEST_GEN_G_MASK 0x0000ff00 | ||
111 | #define CSI_TEST_GEN_G_SHIFT 8 | ||
112 | #define CSI_TEST_GEN_B_MASK 0x00ff0000 | ||
113 | #define CSI_TEST_GEN_B_SHIFT 16 | ||
114 | |||
115 | #define CSI_MAX_RATIO_SKIP_SMFC_MASK 0x00000007 | ||
116 | #define CSI_MAX_RATIO_SKIP_SMFC_SHIFT 0 | ||
117 | #define CSI_SKIP_SMFC_MASK 0x000000f8 | ||
118 | #define CSI_SKIP_SMFC_SHIFT 3 | ||
119 | #define CSI_ID_2_SKIP_MASK 0x00000300 | ||
120 | #define CSI_ID_2_SKIP_SHIFT 8 | ||
121 | |||
122 | #define CSI_COLOR_FIRST_ROW_MASK 0x00000002 | ||
123 | #define CSI_COLOR_FIRST_COMP_MASK 0x00000001 | ||
124 | |||
125 | /* MIPI CSI-2 data types */ | ||
126 | #define MIPI_DT_YUV420 0x18 /* YYY.../UYVY.... */ | ||
127 | #define MIPI_DT_YUV420_LEGACY 0x1a /* UYY.../VYY... */ | ||
128 | #define MIPI_DT_YUV422 0x1e /* UYVY... */ | ||
129 | #define MIPI_DT_RGB444 0x20 | ||
130 | #define MIPI_DT_RGB555 0x21 | ||
131 | #define MIPI_DT_RGB565 0x22 | ||
132 | #define MIPI_DT_RGB666 0x23 | ||
133 | #define MIPI_DT_RGB888 0x24 | ||
134 | #define MIPI_DT_RAW6 0x28 | ||
135 | #define MIPI_DT_RAW7 0x29 | ||
136 | #define MIPI_DT_RAW8 0x2a | ||
137 | #define MIPI_DT_RAW10 0x2b | ||
138 | #define MIPI_DT_RAW12 0x2c | ||
139 | #define MIPI_DT_RAW14 0x2d | ||
140 | |||
141 | /* | ||
142 | * Bitfield of CSI bus signal polarities and modes. | ||
143 | */ | ||
144 | struct ipu_csi_bus_config { | ||
145 | unsigned data_width:4; | ||
146 | unsigned clk_mode:3; | ||
147 | unsigned ext_vsync:1; | ||
148 | unsigned vsync_pol:1; | ||
149 | unsigned hsync_pol:1; | ||
150 | unsigned pixclk_pol:1; | ||
151 | unsigned data_pol:1; | ||
152 | unsigned sens_clksrc:1; | ||
153 | unsigned pack_tight:1; | ||
154 | unsigned force_eof:1; | ||
155 | unsigned data_en_pol:1; | ||
156 | |||
157 | unsigned data_fmt; | ||
158 | unsigned mipi_dt; | ||
159 | }; | ||
160 | |||
161 | /* | ||
162 | * Enumeration of CSI data bus widths. | ||
163 | */ | ||
164 | enum ipu_csi_data_width { | ||
165 | IPU_CSI_DATA_WIDTH_4 = 0, | ||
166 | IPU_CSI_DATA_WIDTH_8 = 1, | ||
167 | IPU_CSI_DATA_WIDTH_10 = 3, | ||
168 | IPU_CSI_DATA_WIDTH_12 = 5, | ||
169 | IPU_CSI_DATA_WIDTH_16 = 9, | ||
170 | }; | ||
171 | |||
172 | /* | ||
173 | * Enumeration of CSI clock modes. | ||
174 | */ | ||
175 | enum ipu_csi_clk_mode { | ||
176 | IPU_CSI_CLK_MODE_GATED_CLK, | ||
177 | IPU_CSI_CLK_MODE_NONGATED_CLK, | ||
178 | IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE, | ||
179 | IPU_CSI_CLK_MODE_CCIR656_INTERLACED, | ||
180 | IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR, | ||
181 | IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR, | ||
182 | IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR, | ||
183 | IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR, | ||
184 | }; | ||
185 | |||
186 | static inline u32 ipu_csi_read(struct ipu_csi *csi, unsigned offset) | ||
187 | { | ||
188 | return readl(csi->base + offset); | ||
189 | } | ||
190 | |||
191 | static inline void ipu_csi_write(struct ipu_csi *csi, u32 value, | ||
192 | unsigned offset) | ||
193 | { | ||
194 | writel(value, csi->base + offset); | ||
195 | } | ||
196 | |||
197 | /* | ||
198 | * Set mclk division ratio for generating test mode mclk. Only used | ||
199 | * for test generator. | ||
200 | */ | ||
201 | static int ipu_csi_set_testgen_mclk(struct ipu_csi *csi, u32 pixel_clk, | ||
202 | u32 ipu_clk) | ||
203 | { | ||
204 | u32 temp; | ||
205 | u32 div_ratio; | ||
206 | |||
207 | div_ratio = (ipu_clk / pixel_clk) - 1; | ||
208 | |||
209 | if (div_ratio > 0xFF || div_ratio < 0) { | ||
210 | dev_err(csi->ipu->dev, | ||
211 | "value of pixel_clk extends normal range\n"); | ||
212 | return -EINVAL; | ||
213 | } | ||
214 | |||
215 | temp = ipu_csi_read(csi, CSI_SENS_CONF); | ||
216 | temp &= ~CSI_SENS_CONF_DIVRATIO_MASK; | ||
217 | ipu_csi_write(csi, temp | (div_ratio << CSI_SENS_CONF_DIVRATIO_SHIFT), | ||
218 | CSI_SENS_CONF); | ||
219 | |||
220 | return 0; | ||
221 | } | ||
222 | |||
223 | /* | ||
224 | * Find the CSI data format and data width for the given V4L2 media | ||
225 | * bus pixel format code. | ||
226 | */ | ||
227 | static int mbus_code_to_bus_cfg(struct ipu_csi_bus_config *cfg, u32 mbus_code) | ||
228 | { | ||
229 | switch (mbus_code) { | ||
230 | case V4L2_MBUS_FMT_BGR565_2X8_BE: | ||
231 | case V4L2_MBUS_FMT_BGR565_2X8_LE: | ||
232 | case V4L2_MBUS_FMT_RGB565_2X8_BE: | ||
233 | case V4L2_MBUS_FMT_RGB565_2X8_LE: | ||
234 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB565; | ||
235 | cfg->mipi_dt = MIPI_DT_RGB565; | ||
236 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
237 | break; | ||
238 | case V4L2_MBUS_FMT_RGB444_2X8_PADHI_BE: | ||
239 | case V4L2_MBUS_FMT_RGB444_2X8_PADHI_LE: | ||
240 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB444; | ||
241 | cfg->mipi_dt = MIPI_DT_RGB444; | ||
242 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
243 | break; | ||
244 | case V4L2_MBUS_FMT_RGB555_2X8_PADHI_BE: | ||
245 | case V4L2_MBUS_FMT_RGB555_2X8_PADHI_LE: | ||
246 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_RGB555; | ||
247 | cfg->mipi_dt = MIPI_DT_RGB555; | ||
248 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
249 | break; | ||
250 | case V4L2_MBUS_FMT_UYVY8_2X8: | ||
251 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; | ||
252 | cfg->mipi_dt = MIPI_DT_YUV422; | ||
253 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
254 | break; | ||
255 | case V4L2_MBUS_FMT_YUYV8_2X8: | ||
256 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; | ||
257 | cfg->mipi_dt = MIPI_DT_YUV422; | ||
258 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
259 | break; | ||
260 | case V4L2_MBUS_FMT_UYVY8_1X16: | ||
261 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_UYVY; | ||
262 | cfg->mipi_dt = MIPI_DT_YUV422; | ||
263 | cfg->data_width = IPU_CSI_DATA_WIDTH_16; | ||
264 | break; | ||
265 | case V4L2_MBUS_FMT_YUYV8_1X16: | ||
266 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_YUV422_YUYV; | ||
267 | cfg->mipi_dt = MIPI_DT_YUV422; | ||
268 | cfg->data_width = IPU_CSI_DATA_WIDTH_16; | ||
269 | break; | ||
270 | case V4L2_MBUS_FMT_SBGGR8_1X8: | ||
271 | case V4L2_MBUS_FMT_SGBRG8_1X8: | ||
272 | case V4L2_MBUS_FMT_SGRBG8_1X8: | ||
273 | case V4L2_MBUS_FMT_SRGGB8_1X8: | ||
274 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; | ||
275 | cfg->mipi_dt = MIPI_DT_RAW8; | ||
276 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
277 | break; | ||
278 | case V4L2_MBUS_FMT_SBGGR10_DPCM8_1X8: | ||
279 | case V4L2_MBUS_FMT_SGBRG10_DPCM8_1X8: | ||
280 | case V4L2_MBUS_FMT_SGRBG10_DPCM8_1X8: | ||
281 | case V4L2_MBUS_FMT_SRGGB10_DPCM8_1X8: | ||
282 | case V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_BE: | ||
283 | case V4L2_MBUS_FMT_SBGGR10_2X8_PADHI_LE: | ||
284 | case V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_BE: | ||
285 | case V4L2_MBUS_FMT_SBGGR10_2X8_PADLO_LE: | ||
286 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; | ||
287 | cfg->mipi_dt = MIPI_DT_RAW10; | ||
288 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
289 | break; | ||
290 | case V4L2_MBUS_FMT_SBGGR10_1X10: | ||
291 | case V4L2_MBUS_FMT_SGBRG10_1X10: | ||
292 | case V4L2_MBUS_FMT_SGRBG10_1X10: | ||
293 | case V4L2_MBUS_FMT_SRGGB10_1X10: | ||
294 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; | ||
295 | cfg->mipi_dt = MIPI_DT_RAW10; | ||
296 | cfg->data_width = IPU_CSI_DATA_WIDTH_10; | ||
297 | break; | ||
298 | case V4L2_MBUS_FMT_SBGGR12_1X12: | ||
299 | case V4L2_MBUS_FMT_SGBRG12_1X12: | ||
300 | case V4L2_MBUS_FMT_SGRBG12_1X12: | ||
301 | case V4L2_MBUS_FMT_SRGGB12_1X12: | ||
302 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_BAYER; | ||
303 | cfg->mipi_dt = MIPI_DT_RAW12; | ||
304 | cfg->data_width = IPU_CSI_DATA_WIDTH_12; | ||
305 | break; | ||
306 | case V4L2_MBUS_FMT_JPEG_1X8: | ||
307 | /* TODO */ | ||
308 | cfg->data_fmt = CSI_SENS_CONF_DATA_FMT_JPEG; | ||
309 | cfg->mipi_dt = MIPI_DT_RAW8; | ||
310 | cfg->data_width = IPU_CSI_DATA_WIDTH_8; | ||
311 | break; | ||
312 | default: | ||
313 | return -EINVAL; | ||
314 | } | ||
315 | |||
316 | return 0; | ||
317 | } | ||
318 | |||
319 | /* | ||
320 | * Fill a CSI bus config struct from mbus_config and mbus_framefmt. | ||
321 | */ | ||
322 | static void fill_csi_bus_cfg(struct ipu_csi_bus_config *csicfg, | ||
323 | struct v4l2_mbus_config *mbus_cfg, | ||
324 | struct v4l2_mbus_framefmt *mbus_fmt) | ||
325 | { | ||
326 | memset(csicfg, 0, sizeof(*csicfg)); | ||
327 | |||
328 | mbus_code_to_bus_cfg(csicfg, mbus_fmt->code); | ||
329 | |||
330 | switch (mbus_cfg->type) { | ||
331 | case V4L2_MBUS_PARALLEL: | ||
332 | csicfg->ext_vsync = 1; | ||
333 | csicfg->vsync_pol = (mbus_cfg->flags & | ||
334 | V4L2_MBUS_VSYNC_ACTIVE_LOW) ? 1 : 0; | ||
335 | csicfg->hsync_pol = (mbus_cfg->flags & | ||
336 | V4L2_MBUS_HSYNC_ACTIVE_LOW) ? 1 : 0; | ||
337 | csicfg->pixclk_pol = (mbus_cfg->flags & | ||
338 | V4L2_MBUS_PCLK_SAMPLE_FALLING) ? 1 : 0; | ||
339 | csicfg->clk_mode = IPU_CSI_CLK_MODE_GATED_CLK; | ||
340 | break; | ||
341 | case V4L2_MBUS_BT656: | ||
342 | csicfg->ext_vsync = 0; | ||
343 | if (V4L2_FIELD_HAS_BOTH(mbus_fmt->field)) | ||
344 | csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_INTERLACED; | ||
345 | else | ||
346 | csicfg->clk_mode = IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE; | ||
347 | break; | ||
348 | case V4L2_MBUS_CSI2: | ||
349 | /* | ||
350 | * MIPI CSI-2 requires non gated clock mode, all other | ||
351 | * parameters are not applicable for MIPI CSI-2 bus. | ||
352 | */ | ||
353 | csicfg->clk_mode = IPU_CSI_CLK_MODE_NONGATED_CLK; | ||
354 | break; | ||
355 | default: | ||
356 | /* will never get here, keep compiler quiet */ | ||
357 | break; | ||
358 | } | ||
359 | } | ||
360 | |||
361 | int ipu_csi_init_interface(struct ipu_csi *csi, | ||
362 | struct v4l2_mbus_config *mbus_cfg, | ||
363 | struct v4l2_mbus_framefmt *mbus_fmt) | ||
364 | { | ||
365 | struct ipu_csi_bus_config cfg; | ||
366 | unsigned long flags; | ||
367 | u32 data = 0; | ||
368 | |||
369 | fill_csi_bus_cfg(&cfg, mbus_cfg, mbus_fmt); | ||
370 | |||
371 | /* Set the CSI_SENS_CONF register remaining fields */ | ||
372 | data |= cfg.data_width << CSI_SENS_CONF_DATA_WIDTH_SHIFT | | ||
373 | cfg.data_fmt << CSI_SENS_CONF_DATA_FMT_SHIFT | | ||
374 | cfg.data_pol << CSI_SENS_CONF_DATA_POL_SHIFT | | ||
375 | cfg.vsync_pol << CSI_SENS_CONF_VSYNC_POL_SHIFT | | ||
376 | cfg.hsync_pol << CSI_SENS_CONF_HSYNC_POL_SHIFT | | ||
377 | cfg.pixclk_pol << CSI_SENS_CONF_PIX_CLK_POL_SHIFT | | ||
378 | cfg.ext_vsync << CSI_SENS_CONF_EXT_VSYNC_SHIFT | | ||
379 | cfg.clk_mode << CSI_SENS_CONF_SENS_PRTCL_SHIFT | | ||
380 | cfg.pack_tight << CSI_SENS_CONF_PACK_TIGHT_SHIFT | | ||
381 | cfg.force_eof << CSI_SENS_CONF_FORCE_EOF_SHIFT | | ||
382 | cfg.data_en_pol << CSI_SENS_CONF_DATA_EN_POL_SHIFT; | ||
383 | |||
384 | spin_lock_irqsave(&csi->lock, flags); | ||
385 | |||
386 | ipu_csi_write(csi, data, CSI_SENS_CONF); | ||
387 | |||
388 | /* Setup sensor frame size */ | ||
389 | ipu_csi_write(csi, | ||
390 | (mbus_fmt->width - 1) | ((mbus_fmt->height - 1) << 16), | ||
391 | CSI_SENS_FRM_SIZE); | ||
392 | |||
393 | /* Set CCIR registers */ | ||
394 | |||
395 | switch (cfg.clk_mode) { | ||
396 | case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: | ||
397 | ipu_csi_write(csi, 0x40030, CSI_CCIR_CODE_1); | ||
398 | ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); | ||
399 | break; | ||
400 | case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: | ||
401 | if (mbus_fmt->width == 720 && mbus_fmt->height == 576) { | ||
402 | /* | ||
403 | * PAL case | ||
404 | * | ||
405 | * Field0BlankEnd = 0x6, Field0BlankStart = 0x2, | ||
406 | * Field0ActiveEnd = 0x4, Field0ActiveStart = 0 | ||
407 | * Field1BlankEnd = 0x7, Field1BlankStart = 0x3, | ||
408 | * Field1ActiveEnd = 0x5, Field1ActiveStart = 0x1 | ||
409 | */ | ||
410 | ipu_csi_write(csi, 0x40596 | CSI_CCIR_ERR_DET_EN, | ||
411 | CSI_CCIR_CODE_1); | ||
412 | ipu_csi_write(csi, 0xD07DF, CSI_CCIR_CODE_2); | ||
413 | ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); | ||
414 | |||
415 | } else if (mbus_fmt->width == 720 && mbus_fmt->height == 480) { | ||
416 | /* | ||
417 | * NTSC case | ||
418 | * | ||
419 | * Field0BlankEnd = 0x7, Field0BlankStart = 0x3, | ||
420 | * Field0ActiveEnd = 0x5, Field0ActiveStart = 0x1 | ||
421 | * Field1BlankEnd = 0x6, Field1BlankStart = 0x2, | ||
422 | * Field1ActiveEnd = 0x4, Field1ActiveStart = 0 | ||
423 | */ | ||
424 | ipu_csi_write(csi, 0xD07DF | CSI_CCIR_ERR_DET_EN, | ||
425 | CSI_CCIR_CODE_1); | ||
426 | ipu_csi_write(csi, 0x40596, CSI_CCIR_CODE_2); | ||
427 | ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); | ||
428 | } else { | ||
429 | dev_err(csi->ipu->dev, | ||
430 | "Unsupported CCIR656 interlaced video mode\n"); | ||
431 | spin_unlock_irqrestore(&csi->lock, flags); | ||
432 | return -EINVAL; | ||
433 | } | ||
434 | break; | ||
435 | case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: | ||
436 | case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: | ||
437 | case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: | ||
438 | case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: | ||
439 | ipu_csi_write(csi, 0x40030 | CSI_CCIR_ERR_DET_EN, | ||
440 | CSI_CCIR_CODE_1); | ||
441 | ipu_csi_write(csi, 0xFF0000, CSI_CCIR_CODE_3); | ||
442 | break; | ||
443 | case IPU_CSI_CLK_MODE_GATED_CLK: | ||
444 | case IPU_CSI_CLK_MODE_NONGATED_CLK: | ||
445 | ipu_csi_write(csi, 0, CSI_CCIR_CODE_1); | ||
446 | break; | ||
447 | } | ||
448 | |||
449 | dev_dbg(csi->ipu->dev, "CSI_SENS_CONF = 0x%08X\n", | ||
450 | ipu_csi_read(csi, CSI_SENS_CONF)); | ||
451 | dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE = 0x%08X\n", | ||
452 | ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); | ||
453 | |||
454 | spin_unlock_irqrestore(&csi->lock, flags); | ||
455 | |||
456 | return 0; | ||
457 | } | ||
458 | EXPORT_SYMBOL_GPL(ipu_csi_init_interface); | ||
459 | |||
460 | bool ipu_csi_is_interlaced(struct ipu_csi *csi) | ||
461 | { | ||
462 | unsigned long flags; | ||
463 | u32 sensor_protocol; | ||
464 | |||
465 | spin_lock_irqsave(&csi->lock, flags); | ||
466 | sensor_protocol = | ||
467 | (ipu_csi_read(csi, CSI_SENS_CONF) & | ||
468 | CSI_SENS_CONF_SENS_PRTCL_MASK) >> | ||
469 | CSI_SENS_CONF_SENS_PRTCL_SHIFT; | ||
470 | spin_unlock_irqrestore(&csi->lock, flags); | ||
471 | |||
472 | switch (sensor_protocol) { | ||
473 | case IPU_CSI_CLK_MODE_GATED_CLK: | ||
474 | case IPU_CSI_CLK_MODE_NONGATED_CLK: | ||
475 | case IPU_CSI_CLK_MODE_CCIR656_PROGRESSIVE: | ||
476 | case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_DDR: | ||
477 | case IPU_CSI_CLK_MODE_CCIR1120_PROGRESSIVE_SDR: | ||
478 | return false; | ||
479 | case IPU_CSI_CLK_MODE_CCIR656_INTERLACED: | ||
480 | case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_DDR: | ||
481 | case IPU_CSI_CLK_MODE_CCIR1120_INTERLACED_SDR: | ||
482 | return true; | ||
483 | default: | ||
484 | dev_err(csi->ipu->dev, | ||
485 | "CSI %d sensor protocol unsupported\n", csi->id); | ||
486 | return false; | ||
487 | } | ||
488 | } | ||
489 | EXPORT_SYMBOL_GPL(ipu_csi_is_interlaced); | ||
490 | |||
491 | void ipu_csi_get_window(struct ipu_csi *csi, struct v4l2_rect *w) | ||
492 | { | ||
493 | unsigned long flags; | ||
494 | u32 reg; | ||
495 | |||
496 | spin_lock_irqsave(&csi->lock, flags); | ||
497 | |||
498 | reg = ipu_csi_read(csi, CSI_ACT_FRM_SIZE); | ||
499 | w->width = (reg & 0xFFFF) + 1; | ||
500 | w->height = (reg >> 16 & 0xFFFF) + 1; | ||
501 | |||
502 | reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); | ||
503 | w->left = (reg & CSI_HSC_MASK) >> CSI_HSC_SHIFT; | ||
504 | w->top = (reg & CSI_VSC_MASK) >> CSI_VSC_SHIFT; | ||
505 | |||
506 | spin_unlock_irqrestore(&csi->lock, flags); | ||
507 | } | ||
508 | EXPORT_SYMBOL_GPL(ipu_csi_get_window); | ||
509 | |||
510 | void ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w) | ||
511 | { | ||
512 | unsigned long flags; | ||
513 | u32 reg; | ||
514 | |||
515 | spin_lock_irqsave(&csi->lock, flags); | ||
516 | |||
517 | ipu_csi_write(csi, (w->width - 1) | ((w->height - 1) << 16), | ||
518 | CSI_ACT_FRM_SIZE); | ||
519 | |||
520 | reg = ipu_csi_read(csi, CSI_OUT_FRM_CTRL); | ||
521 | reg &= ~(CSI_HSC_MASK | CSI_VSC_MASK); | ||
522 | reg |= ((w->top << CSI_VSC_SHIFT) | (w->left << CSI_HSC_SHIFT)); | ||
523 | ipu_csi_write(csi, reg, CSI_OUT_FRM_CTRL); | ||
524 | |||
525 | spin_unlock_irqrestore(&csi->lock, flags); | ||
526 | } | ||
527 | EXPORT_SYMBOL_GPL(ipu_csi_set_window); | ||
528 | |||
529 | void ipu_csi_set_test_generator(struct ipu_csi *csi, bool active, | ||
530 | u32 r_value, u32 g_value, u32 b_value, | ||
531 | u32 pix_clk) | ||
532 | { | ||
533 | unsigned long flags; | ||
534 | u32 ipu_clk = clk_get_rate(csi->clk_ipu); | ||
535 | u32 temp; | ||
536 | |||
537 | spin_lock_irqsave(&csi->lock, flags); | ||
538 | |||
539 | temp = ipu_csi_read(csi, CSI_TST_CTRL); | ||
540 | |||
541 | if (active == false) { | ||
542 | temp &= ~CSI_TEST_GEN_MODE_EN; | ||
543 | ipu_csi_write(csi, temp, CSI_TST_CTRL); | ||
544 | } else { | ||
545 | /* Set sensb_mclk div_ratio */ | ||
546 | ipu_csi_set_testgen_mclk(csi, pix_clk, ipu_clk); | ||
547 | |||
548 | temp &= ~(CSI_TEST_GEN_R_MASK | CSI_TEST_GEN_G_MASK | | ||
549 | CSI_TEST_GEN_B_MASK); | ||
550 | temp |= CSI_TEST_GEN_MODE_EN; | ||
551 | temp |= (r_value << CSI_TEST_GEN_R_SHIFT) | | ||
552 | (g_value << CSI_TEST_GEN_G_SHIFT) | | ||
553 | (b_value << CSI_TEST_GEN_B_SHIFT); | ||
554 | ipu_csi_write(csi, temp, CSI_TST_CTRL); | ||
555 | } | ||
556 | |||
557 | spin_unlock_irqrestore(&csi->lock, flags); | ||
558 | } | ||
559 | EXPORT_SYMBOL_GPL(ipu_csi_set_test_generator); | ||
560 | |||
561 | int ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc, | ||
562 | struct v4l2_mbus_framefmt *mbus_fmt) | ||
563 | { | ||
564 | struct ipu_csi_bus_config cfg; | ||
565 | unsigned long flags; | ||
566 | u32 temp; | ||
567 | |||
568 | if (vc > 3) | ||
569 | return -EINVAL; | ||
570 | |||
571 | mbus_code_to_bus_cfg(&cfg, mbus_fmt->code); | ||
572 | |||
573 | spin_lock_irqsave(&csi->lock, flags); | ||
574 | |||
575 | temp = ipu_csi_read(csi, CSI_MIPI_DI); | ||
576 | temp &= ~(0xff << (vc * 8)); | ||
577 | temp |= (cfg.mipi_dt << (vc * 8)); | ||
578 | ipu_csi_write(csi, temp, CSI_MIPI_DI); | ||
579 | |||
580 | spin_unlock_irqrestore(&csi->lock, flags); | ||
581 | |||
582 | return 0; | ||
583 | } | ||
584 | EXPORT_SYMBOL_GPL(ipu_csi_set_mipi_datatype); | ||
585 | |||
586 | int ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip, | ||
587 | u32 max_ratio, u32 id) | ||
588 | { | ||
589 | unsigned long flags; | ||
590 | u32 temp; | ||
591 | |||
592 | if (max_ratio > 5 || id > 3) | ||
593 | return -EINVAL; | ||
594 | |||
595 | spin_lock_irqsave(&csi->lock, flags); | ||
596 | |||
597 | temp = ipu_csi_read(csi, CSI_SKIP); | ||
598 | temp &= ~(CSI_MAX_RATIO_SKIP_SMFC_MASK | CSI_ID_2_SKIP_MASK | | ||
599 | CSI_SKIP_SMFC_MASK); | ||
600 | temp |= (max_ratio << CSI_MAX_RATIO_SKIP_SMFC_SHIFT) | | ||
601 | (id << CSI_ID_2_SKIP_SHIFT) | | ||
602 | (skip << CSI_SKIP_SMFC_SHIFT); | ||
603 | ipu_csi_write(csi, temp, CSI_SKIP); | ||
604 | |||
605 | spin_unlock_irqrestore(&csi->lock, flags); | ||
606 | |||
607 | return 0; | ||
608 | } | ||
609 | EXPORT_SYMBOL_GPL(ipu_csi_set_skip_smfc); | ||
610 | |||
611 | int ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest) | ||
612 | { | ||
613 | unsigned long flags; | ||
614 | u32 csi_sens_conf, dest; | ||
615 | |||
616 | if (csi_dest == IPU_CSI_DEST_IDMAC) | ||
617 | dest = CSI_DATA_DEST_IDMAC; | ||
618 | else | ||
619 | dest = CSI_DATA_DEST_IC; /* IC or VDIC */ | ||
620 | |||
621 | spin_lock_irqsave(&csi->lock, flags); | ||
622 | |||
623 | csi_sens_conf = ipu_csi_read(csi, CSI_SENS_CONF); | ||
624 | csi_sens_conf &= ~CSI_SENS_CONF_DATA_DEST_MASK; | ||
625 | csi_sens_conf |= (dest << CSI_SENS_CONF_DATA_DEST_SHIFT); | ||
626 | ipu_csi_write(csi, csi_sens_conf, CSI_SENS_CONF); | ||
627 | |||
628 | spin_unlock_irqrestore(&csi->lock, flags); | ||
629 | |||
630 | return 0; | ||
631 | } | ||
632 | EXPORT_SYMBOL_GPL(ipu_csi_set_dest); | ||
633 | |||
634 | int ipu_csi_enable(struct ipu_csi *csi) | ||
635 | { | ||
636 | ipu_module_enable(csi->ipu, csi->module); | ||
637 | |||
638 | return 0; | ||
639 | } | ||
640 | EXPORT_SYMBOL_GPL(ipu_csi_enable); | ||
641 | |||
642 | int ipu_csi_disable(struct ipu_csi *csi) | ||
643 | { | ||
644 | ipu_module_disable(csi->ipu, csi->module); | ||
645 | |||
646 | return 0; | ||
647 | } | ||
648 | EXPORT_SYMBOL_GPL(ipu_csi_disable); | ||
649 | |||
650 | struct ipu_csi *ipu_csi_get(struct ipu_soc *ipu, int id) | ||
651 | { | ||
652 | unsigned long flags; | ||
653 | struct ipu_csi *csi, *ret; | ||
654 | |||
655 | if (id > 1) | ||
656 | return ERR_PTR(-EINVAL); | ||
657 | |||
658 | csi = ipu->csi_priv[id]; | ||
659 | ret = csi; | ||
660 | |||
661 | spin_lock_irqsave(&csi->lock, flags); | ||
662 | |||
663 | if (csi->inuse) { | ||
664 | ret = ERR_PTR(-EBUSY); | ||
665 | goto unlock; | ||
666 | } | ||
667 | |||
668 | csi->inuse = true; | ||
669 | unlock: | ||
670 | spin_unlock_irqrestore(&csi->lock, flags); | ||
671 | return ret; | ||
672 | } | ||
673 | EXPORT_SYMBOL_GPL(ipu_csi_get); | ||
674 | |||
675 | void ipu_csi_put(struct ipu_csi *csi) | ||
676 | { | ||
677 | unsigned long flags; | ||
678 | |||
679 | spin_lock_irqsave(&csi->lock, flags); | ||
680 | csi->inuse = false; | ||
681 | spin_unlock_irqrestore(&csi->lock, flags); | ||
682 | } | ||
683 | EXPORT_SYMBOL_GPL(ipu_csi_put); | ||
684 | |||
685 | int ipu_csi_init(struct ipu_soc *ipu, struct device *dev, int id, | ||
686 | unsigned long base, u32 module, struct clk *clk_ipu) | ||
687 | { | ||
688 | struct ipu_csi *csi; | ||
689 | |||
690 | if (id > 1) | ||
691 | return -ENODEV; | ||
692 | |||
693 | csi = devm_kzalloc(dev, sizeof(*csi), GFP_KERNEL); | ||
694 | if (!csi) | ||
695 | return -ENOMEM; | ||
696 | |||
697 | ipu->csi_priv[id] = csi; | ||
698 | |||
699 | spin_lock_init(&csi->lock); | ||
700 | csi->module = module; | ||
701 | csi->id = id; | ||
702 | csi->clk_ipu = clk_ipu; | ||
703 | csi->base = devm_ioremap(dev, base, PAGE_SIZE); | ||
704 | if (!csi->base) | ||
705 | return -ENOMEM; | ||
706 | |||
707 | dev_dbg(dev, "CSI%d base: 0x%08lx remapped to %p\n", | ||
708 | id, base, csi->base); | ||
709 | csi->ipu = ipu; | ||
710 | |||
711 | return 0; | ||
712 | } | ||
713 | |||
714 | void ipu_csi_exit(struct ipu_soc *ipu, int id) | ||
715 | { | ||
716 | } | ||
717 | |||
718 | void ipu_csi_dump(struct ipu_csi *csi) | ||
719 | { | ||
720 | dev_dbg(csi->ipu->dev, "CSI_SENS_CONF: %08x\n", | ||
721 | ipu_csi_read(csi, CSI_SENS_CONF)); | ||
722 | dev_dbg(csi->ipu->dev, "CSI_SENS_FRM_SIZE: %08x\n", | ||
723 | ipu_csi_read(csi, CSI_SENS_FRM_SIZE)); | ||
724 | dev_dbg(csi->ipu->dev, "CSI_ACT_FRM_SIZE: %08x\n", | ||
725 | ipu_csi_read(csi, CSI_ACT_FRM_SIZE)); | ||
726 | dev_dbg(csi->ipu->dev, "CSI_OUT_FRM_CTRL: %08x\n", | ||
727 | ipu_csi_read(csi, CSI_OUT_FRM_CTRL)); | ||
728 | dev_dbg(csi->ipu->dev, "CSI_TST_CTRL: %08x\n", | ||
729 | ipu_csi_read(csi, CSI_TST_CTRL)); | ||
730 | dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_1: %08x\n", | ||
731 | ipu_csi_read(csi, CSI_CCIR_CODE_1)); | ||
732 | dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_2: %08x\n", | ||
733 | ipu_csi_read(csi, CSI_CCIR_CODE_2)); | ||
734 | dev_dbg(csi->ipu->dev, "CSI_CCIR_CODE_3: %08x\n", | ||
735 | ipu_csi_read(csi, CSI_CCIR_CODE_3)); | ||
736 | dev_dbg(csi->ipu->dev, "CSI_MIPI_DI: %08x\n", | ||
737 | ipu_csi_read(csi, CSI_MIPI_DI)); | ||
738 | dev_dbg(csi->ipu->dev, "CSI_SKIP: %08x\n", | ||
739 | ipu_csi_read(csi, CSI_SKIP)); | ||
740 | } | ||
741 | EXPORT_SYMBOL_GPL(ipu_csi_dump); | ||
diff --git a/drivers/gpu/ipu-v3/ipu-prv.h b/drivers/gpu/ipu-v3/ipu-prv.h index 1a5c55c05fe8..9b274f1259e1 100644 --- a/drivers/gpu/ipu-v3/ipu-prv.h +++ b/drivers/gpu/ipu-v3/ipu-prv.h | |||
@@ -157,6 +157,7 @@ struct ipuv3_channel { | |||
157 | }; | 157 | }; |
158 | 158 | ||
159 | struct ipu_cpmem; | 159 | struct ipu_cpmem; |
160 | struct ipu_csi; | ||
160 | struct ipu_dc_priv; | 161 | struct ipu_dc_priv; |
161 | struct ipu_dmfc_priv; | 162 | struct ipu_dmfc_priv; |
162 | struct ipu_di; | 163 | struct ipu_di; |
@@ -189,6 +190,7 @@ struct ipu_soc { | |||
189 | struct ipu_dp_priv *dp_priv; | 190 | struct ipu_dp_priv *dp_priv; |
190 | struct ipu_dmfc_priv *dmfc_priv; | 191 | struct ipu_dmfc_priv *dmfc_priv; |
191 | struct ipu_di *di_priv[2]; | 192 | struct ipu_di *di_priv[2]; |
193 | struct ipu_csi *csi_priv[2]; | ||
192 | struct ipu_smfc_priv *smfc_priv; | 194 | struct ipu_smfc_priv *smfc_priv; |
193 | }; | 195 | }; |
194 | 196 | ||
@@ -211,6 +213,10 @@ int ipu_module_disable(struct ipu_soc *ipu, u32 mask); | |||
211 | bool ipu_idmac_channel_busy(struct ipu_soc *ipu, unsigned int chno); | 213 | bool ipu_idmac_channel_busy(struct ipu_soc *ipu, unsigned int chno); |
212 | int ipu_wait_interrupt(struct ipu_soc *ipu, int irq, int ms); | 214 | int ipu_wait_interrupt(struct ipu_soc *ipu, int irq, int ms); |
213 | 215 | ||
216 | int ipu_csi_init(struct ipu_soc *ipu, struct device *dev, int id, | ||
217 | unsigned long base, u32 module, struct clk *clk_ipu); | ||
218 | void ipu_csi_exit(struct ipu_soc *ipu, int id); | ||
219 | |||
214 | int ipu_di_init(struct ipu_soc *ipu, struct device *dev, int id, | 220 | int ipu_di_init(struct ipu_soc *ipu, struct device *dev, int id, |
215 | unsigned long base, u32 module, struct clk *ipu_clk); | 221 | unsigned long base, u32 module, struct clk *ipu_clk); |
216 | void ipu_di_exit(struct ipu_soc *ipu, int id); | 222 | void ipu_di_exit(struct ipu_soc *ipu, int id); |
diff --git a/include/video/imx-ipu-v3.h b/include/video/imx-ipu-v3.h index f80fe13b0d4d..6d254275192b 100644 --- a/include/video/imx-ipu-v3.h +++ b/include/video/imx-ipu-v3.h | |||
@@ -16,6 +16,7 @@ | |||
16 | #include <linux/videodev2.h> | 16 | #include <linux/videodev2.h> |
17 | #include <linux/bitmap.h> | 17 | #include <linux/bitmap.h> |
18 | #include <linux/fb.h> | 18 | #include <linux/fb.h> |
19 | #include <media/v4l2-mediabus.h> | ||
19 | 20 | ||
20 | struct ipu_soc; | 21 | struct ipu_soc; |
21 | 22 | ||
@@ -61,6 +62,15 @@ struct ipu_di_signal_cfg { | |||
61 | u8 vsync_pin; | 62 | u8 vsync_pin; |
62 | }; | 63 | }; |
63 | 64 | ||
65 | /* | ||
66 | * Enumeration of CSI destinations | ||
67 | */ | ||
68 | enum ipu_csi_dest { | ||
69 | IPU_CSI_DEST_IDMAC, /* to memory via SMFC */ | ||
70 | IPU_CSI_DEST_IC, /* to Image Converter */ | ||
71 | IPU_CSI_DEST_VDIC, /* to VDIC */ | ||
72 | }; | ||
73 | |||
64 | enum ipu_color_space { | 74 | enum ipu_color_space { |
65 | IPUV3_COLORSPACE_RGB, | 75 | IPUV3_COLORSPACE_RGB, |
66 | IPUV3_COLORSPACE_YUV, | 76 | IPUV3_COLORSPACE_YUV, |
@@ -211,8 +221,26 @@ int ipu_dp_set_global_alpha(struct ipu_dp *dp, bool enable, u8 alpha, | |||
211 | /* | 221 | /* |
212 | * IPU CMOS Sensor Interface (csi) functions | 222 | * IPU CMOS Sensor Interface (csi) functions |
213 | */ | 223 | */ |
214 | int ipu_csi_enable(struct ipu_soc *ipu, int csi); | 224 | struct ipu_csi; |
215 | int ipu_csi_disable(struct ipu_soc *ipu, int csi); | 225 | int ipu_csi_init_interface(struct ipu_csi *csi, |
226 | struct v4l2_mbus_config *mbus_cfg, | ||
227 | struct v4l2_mbus_framefmt *mbus_fmt); | ||
228 | bool ipu_csi_is_interlaced(struct ipu_csi *csi); | ||
229 | void ipu_csi_get_window(struct ipu_csi *csi, struct v4l2_rect *w); | ||
230 | void ipu_csi_set_window(struct ipu_csi *csi, struct v4l2_rect *w); | ||
231 | void ipu_csi_set_test_generator(struct ipu_csi *csi, bool active, | ||
232 | u32 r_value, u32 g_value, u32 b_value, | ||
233 | u32 pix_clk); | ||
234 | int ipu_csi_set_mipi_datatype(struct ipu_csi *csi, u32 vc, | ||
235 | struct v4l2_mbus_framefmt *mbus_fmt); | ||
236 | int ipu_csi_set_skip_smfc(struct ipu_csi *csi, u32 skip, | ||
237 | u32 max_ratio, u32 id); | ||
238 | int ipu_csi_set_dest(struct ipu_csi *csi, enum ipu_csi_dest csi_dest); | ||
239 | int ipu_csi_enable(struct ipu_csi *csi); | ||
240 | int ipu_csi_disable(struct ipu_csi *csi); | ||
241 | struct ipu_csi *ipu_csi_get(struct ipu_soc *ipu, int id); | ||
242 | void ipu_csi_put(struct ipu_csi *csi); | ||
243 | void ipu_csi_dump(struct ipu_csi *csi); | ||
216 | 244 | ||
217 | /* | 245 | /* |
218 | * IPU Sensor Multiple FIFO Controller (SMFC) functions | 246 | * IPU Sensor Multiple FIFO Controller (SMFC) functions |