diff options
Diffstat (limited to 'drivers/media/video/s5p-fimc/fimc-lite-reg.c')
-rw-r--r-- | drivers/media/video/s5p-fimc/fimc-lite-reg.c | 300 |
1 files changed, 300 insertions, 0 deletions
diff --git a/drivers/media/video/s5p-fimc/fimc-lite-reg.c b/drivers/media/video/s5p-fimc/fimc-lite-reg.c new file mode 100644 index 000000000000..419adfb7cdf9 --- /dev/null +++ b/drivers/media/video/s5p-fimc/fimc-lite-reg.c | |||
@@ -0,0 +1,300 @@ | |||
1 | /* | ||
2 | * Register interface file for EXYNOS FIMC-LITE (camera interface) driver | ||
3 | * | ||
4 | * Copyright (C) 2012 Samsung Electronics Co., Ltd. | ||
5 | * Sylwester Nawrocki <s.nawrocki@samsung.com> | ||
6 | * | ||
7 | * This program is free software; you can redistribute it and/or modify | ||
8 | * it under the terms of the GNU General Public License version 2 as | ||
9 | * published by the Free Software Foundation. | ||
10 | */ | ||
11 | |||
12 | #include <linux/io.h> | ||
13 | #include <linux/delay.h> | ||
14 | #include <media/s5p_fimc.h> | ||
15 | |||
16 | #include "fimc-lite-reg.h" | ||
17 | #include "fimc-lite.h" | ||
18 | #include "fimc-core.h" | ||
19 | |||
20 | #define FLITE_RESET_TIMEOUT 50 /* in ms */ | ||
21 | |||
22 | void flite_hw_reset(struct fimc_lite *dev) | ||
23 | { | ||
24 | unsigned long end = jiffies + msecs_to_jiffies(FLITE_RESET_TIMEOUT); | ||
25 | u32 cfg; | ||
26 | |||
27 | cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
28 | cfg |= FLITE_REG_CIGCTRL_SWRST_REQ; | ||
29 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
30 | |||
31 | while (time_is_after_jiffies(end)) { | ||
32 | cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
33 | if (cfg & FLITE_REG_CIGCTRL_SWRST_RDY) | ||
34 | break; | ||
35 | usleep_range(1000, 5000); | ||
36 | } | ||
37 | |||
38 | cfg |= FLITE_REG_CIGCTRL_SWRST; | ||
39 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
40 | } | ||
41 | |||
42 | void flite_hw_clear_pending_irq(struct fimc_lite *dev) | ||
43 | { | ||
44 | u32 cfg = readl(dev->regs + FLITE_REG_CISTATUS); | ||
45 | cfg &= ~FLITE_REG_CISTATUS_IRQ_CAM; | ||
46 | writel(cfg, dev->regs + FLITE_REG_CISTATUS); | ||
47 | } | ||
48 | |||
49 | u32 flite_hw_get_interrupt_source(struct fimc_lite *dev) | ||
50 | { | ||
51 | u32 intsrc = readl(dev->regs + FLITE_REG_CISTATUS); | ||
52 | return intsrc & FLITE_REG_CISTATUS_IRQ_MASK; | ||
53 | } | ||
54 | |||
55 | void flite_hw_clear_last_capture_end(struct fimc_lite *dev) | ||
56 | { | ||
57 | |||
58 | u32 cfg = readl(dev->regs + FLITE_REG_CISTATUS2); | ||
59 | cfg &= ~FLITE_REG_CISTATUS2_LASTCAPEND; | ||
60 | writel(cfg, dev->regs + FLITE_REG_CISTATUS2); | ||
61 | } | ||
62 | |||
63 | void flite_hw_set_interrupt_mask(struct fimc_lite *dev) | ||
64 | { | ||
65 | u32 cfg, intsrc; | ||
66 | |||
67 | /* Select interrupts to be enabled for each output mode */ | ||
68 | if (dev->out_path == FIMC_IO_DMA) { | ||
69 | intsrc = FLITE_REG_CIGCTRL_IRQ_OVFEN | | ||
70 | FLITE_REG_CIGCTRL_IRQ_LASTEN | | ||
71 | FLITE_REG_CIGCTRL_IRQ_STARTEN; | ||
72 | } else { | ||
73 | /* An output to the FIMC-IS */ | ||
74 | intsrc = FLITE_REG_CIGCTRL_IRQ_OVFEN | | ||
75 | FLITE_REG_CIGCTRL_IRQ_LASTEN; | ||
76 | } | ||
77 | |||
78 | cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
79 | cfg |= FLITE_REG_CIGCTRL_IRQ_DISABLE_MASK; | ||
80 | cfg &= ~intsrc; | ||
81 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
82 | } | ||
83 | |||
84 | void flite_hw_capture_start(struct fimc_lite *dev) | ||
85 | { | ||
86 | u32 cfg = readl(dev->regs + FLITE_REG_CIIMGCPT); | ||
87 | cfg |= FLITE_REG_CIIMGCPT_IMGCPTEN; | ||
88 | writel(cfg, dev->regs + FLITE_REG_CIIMGCPT); | ||
89 | } | ||
90 | |||
91 | void flite_hw_capture_stop(struct fimc_lite *dev) | ||
92 | { | ||
93 | u32 cfg = readl(dev->regs + FLITE_REG_CIIMGCPT); | ||
94 | cfg &= ~FLITE_REG_CIIMGCPT_IMGCPTEN; | ||
95 | writel(cfg, dev->regs + FLITE_REG_CIIMGCPT); | ||
96 | } | ||
97 | |||
98 | /* | ||
99 | * Test pattern (color bars) enable/disable. External sensor | ||
100 | * pixel clock must be active for the test pattern to work. | ||
101 | */ | ||
102 | void flite_hw_set_test_pattern(struct fimc_lite *dev, bool on) | ||
103 | { | ||
104 | u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
105 | if (on) | ||
106 | cfg |= FLITE_REG_CIGCTRL_TEST_PATTERN_COLORBAR; | ||
107 | else | ||
108 | cfg &= ~FLITE_REG_CIGCTRL_TEST_PATTERN_COLORBAR; | ||
109 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
110 | } | ||
111 | |||
112 | static const u32 src_pixfmt_map[8][3] = { | ||
113 | { V4L2_MBUS_FMT_YUYV8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_YCBYCR, | ||
114 | FLITE_REG_CIGCTRL_YUV422_1P }, | ||
115 | { V4L2_MBUS_FMT_YVYU8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_YCRYCB, | ||
116 | FLITE_REG_CIGCTRL_YUV422_1P }, | ||
117 | { V4L2_MBUS_FMT_UYVY8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_CBYCRY, | ||
118 | FLITE_REG_CIGCTRL_YUV422_1P }, | ||
119 | { V4L2_MBUS_FMT_VYUY8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_CRYCBY, | ||
120 | FLITE_REG_CIGCTRL_YUV422_1P }, | ||
121 | { V4L2_PIX_FMT_SGRBG8, 0, FLITE_REG_CIGCTRL_RAW8 }, | ||
122 | { V4L2_PIX_FMT_SGRBG10, 0, FLITE_REG_CIGCTRL_RAW10 }, | ||
123 | { V4L2_PIX_FMT_SGRBG12, 0, FLITE_REG_CIGCTRL_RAW12 }, | ||
124 | { V4L2_MBUS_FMT_JPEG_1X8, 0, FLITE_REG_CIGCTRL_USER(1) }, | ||
125 | }; | ||
126 | |||
127 | /* Set camera input pixel format and resolution */ | ||
128 | void flite_hw_set_source_format(struct fimc_lite *dev, struct flite_frame *f) | ||
129 | { | ||
130 | enum v4l2_mbus_pixelcode pixelcode = dev->fmt->mbus_code; | ||
131 | unsigned int i = ARRAY_SIZE(src_pixfmt_map); | ||
132 | u32 cfg; | ||
133 | |||
134 | while (i-- >= 0) { | ||
135 | if (src_pixfmt_map[i][0] == pixelcode) | ||
136 | break; | ||
137 | } | ||
138 | |||
139 | if (i == 0 && src_pixfmt_map[i][0] != pixelcode) { | ||
140 | v4l2_err(dev->vfd, | ||
141 | "Unsupported pixel code, falling back to %#08x\n", | ||
142 | src_pixfmt_map[i][0]); | ||
143 | } | ||
144 | |||
145 | cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
146 | cfg &= ~FLITE_REG_CIGCTRL_FMT_MASK; | ||
147 | cfg |= src_pixfmt_map[i][2]; | ||
148 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
149 | |||
150 | cfg = readl(dev->regs + FLITE_REG_CISRCSIZE); | ||
151 | cfg &= ~(FLITE_REG_CISRCSIZE_ORDER422_MASK | | ||
152 | FLITE_REG_CISRCSIZE_SIZE_CAM_MASK); | ||
153 | cfg |= (f->f_width << 16) | f->f_height; | ||
154 | cfg |= src_pixfmt_map[i][1]; | ||
155 | writel(cfg, dev->regs + FLITE_REG_CISRCSIZE); | ||
156 | } | ||
157 | |||
158 | /* Set the camera host input window offsets (cropping) */ | ||
159 | void flite_hw_set_window_offset(struct fimc_lite *dev, struct flite_frame *f) | ||
160 | { | ||
161 | u32 hoff2, voff2; | ||
162 | u32 cfg; | ||
163 | |||
164 | cfg = readl(dev->regs + FLITE_REG_CIWDOFST); | ||
165 | cfg &= ~FLITE_REG_CIWDOFST_OFST_MASK; | ||
166 | cfg |= (f->rect.left << 16) | f->rect.top; | ||
167 | cfg |= FLITE_REG_CIWDOFST_WINOFSEN; | ||
168 | writel(cfg, dev->regs + FLITE_REG_CIWDOFST); | ||
169 | |||
170 | hoff2 = f->f_width - f->rect.width - f->rect.left; | ||
171 | voff2 = f->f_height - f->rect.height - f->rect.top; | ||
172 | |||
173 | cfg = (hoff2 << 16) | voff2; | ||
174 | writel(cfg, dev->regs + FLITE_REG_CIWDOFST2); | ||
175 | } | ||
176 | |||
177 | /* Select camera port (A, B) */ | ||
178 | static void flite_hw_set_camera_port(struct fimc_lite *dev, int id) | ||
179 | { | ||
180 | u32 cfg = readl(dev->regs + FLITE_REG_CIGENERAL); | ||
181 | if (id == 0) | ||
182 | cfg &= ~FLITE_REG_CIGENERAL_CAM_B; | ||
183 | else | ||
184 | cfg |= FLITE_REG_CIGENERAL_CAM_B; | ||
185 | writel(cfg, dev->regs + FLITE_REG_CIGENERAL); | ||
186 | } | ||
187 | |||
188 | /* Select serial or parallel bus, camera port (A,B) and set signals polarity */ | ||
189 | void flite_hw_set_camera_bus(struct fimc_lite *dev, | ||
190 | struct s5p_fimc_isp_info *s_info) | ||
191 | { | ||
192 | u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
193 | unsigned int flags = s_info->flags; | ||
194 | |||
195 | if (s_info->bus_type != FIMC_MIPI_CSI2) { | ||
196 | cfg &= ~(FLITE_REG_CIGCTRL_SELCAM_MIPI | | ||
197 | FLITE_REG_CIGCTRL_INVPOLPCLK | | ||
198 | FLITE_REG_CIGCTRL_INVPOLVSYNC | | ||
199 | FLITE_REG_CIGCTRL_INVPOLHREF); | ||
200 | |||
201 | if (flags & V4L2_MBUS_PCLK_SAMPLE_FALLING) | ||
202 | cfg |= FLITE_REG_CIGCTRL_INVPOLPCLK; | ||
203 | |||
204 | if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW) | ||
205 | cfg |= FLITE_REG_CIGCTRL_INVPOLVSYNC; | ||
206 | |||
207 | if (flags & V4L2_MBUS_HSYNC_ACTIVE_LOW) | ||
208 | cfg |= FLITE_REG_CIGCTRL_INVPOLHREF; | ||
209 | } else { | ||
210 | cfg |= FLITE_REG_CIGCTRL_SELCAM_MIPI; | ||
211 | } | ||
212 | |||
213 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
214 | |||
215 | flite_hw_set_camera_port(dev, s_info->mux_id); | ||
216 | } | ||
217 | |||
218 | void flite_hw_set_out_order(struct fimc_lite *dev, struct flite_frame *f) | ||
219 | { | ||
220 | static const u32 pixcode[4][2] = { | ||
221 | { V4L2_MBUS_FMT_YUYV8_2X8, FLITE_REG_CIODMAFMT_YCBYCR }, | ||
222 | { V4L2_MBUS_FMT_YVYU8_2X8, FLITE_REG_CIODMAFMT_YCRYCB }, | ||
223 | { V4L2_MBUS_FMT_UYVY8_2X8, FLITE_REG_CIODMAFMT_CBYCRY }, | ||
224 | { V4L2_MBUS_FMT_VYUY8_2X8, FLITE_REG_CIODMAFMT_CRYCBY }, | ||
225 | }; | ||
226 | u32 cfg = readl(dev->regs + FLITE_REG_CIODMAFMT); | ||
227 | unsigned int i = ARRAY_SIZE(pixcode); | ||
228 | |||
229 | while (i-- >= 0) | ||
230 | if (pixcode[i][0] == dev->fmt->mbus_code) | ||
231 | break; | ||
232 | cfg &= ~FLITE_REG_CIODMAFMT_YCBCR_ORDER_MASK; | ||
233 | writel(cfg | pixcode[i][1], dev->regs + FLITE_REG_CIODMAFMT); | ||
234 | } | ||
235 | |||
236 | void flite_hw_set_dma_window(struct fimc_lite *dev, struct flite_frame *f) | ||
237 | { | ||
238 | u32 cfg; | ||
239 | |||
240 | /* Maximum output pixel size */ | ||
241 | cfg = readl(dev->regs + FLITE_REG_CIOCAN); | ||
242 | cfg &= ~FLITE_REG_CIOCAN_MASK; | ||
243 | cfg = (f->f_height << 16) | f->f_width; | ||
244 | writel(cfg, dev->regs + FLITE_REG_CIOCAN); | ||
245 | |||
246 | /* DMA offsets */ | ||
247 | cfg = readl(dev->regs + FLITE_REG_CIOOFF); | ||
248 | cfg &= ~FLITE_REG_CIOOFF_MASK; | ||
249 | cfg |= (f->rect.top << 16) | f->rect.left; | ||
250 | writel(cfg, dev->regs + FLITE_REG_CIOOFF); | ||
251 | } | ||
252 | |||
253 | /* Enable/disable output DMA, set output pixel size and offsets (composition) */ | ||
254 | void flite_hw_set_output_dma(struct fimc_lite *dev, struct flite_frame *f, | ||
255 | bool enable) | ||
256 | { | ||
257 | u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL); | ||
258 | |||
259 | if (!enable) { | ||
260 | cfg |= FLITE_REG_CIGCTRL_ODMA_DISABLE; | ||
261 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
262 | return; | ||
263 | } | ||
264 | |||
265 | cfg &= ~FLITE_REG_CIGCTRL_ODMA_DISABLE; | ||
266 | writel(cfg, dev->regs + FLITE_REG_CIGCTRL); | ||
267 | |||
268 | flite_hw_set_out_order(dev, f); | ||
269 | flite_hw_set_dma_window(dev, f); | ||
270 | } | ||
271 | |||
272 | void flite_hw_dump_regs(struct fimc_lite *dev, const char *label) | ||
273 | { | ||
274 | struct { | ||
275 | u32 offset; | ||
276 | const char * const name; | ||
277 | } registers[] = { | ||
278 | { 0x00, "CISRCSIZE" }, | ||
279 | { 0x04, "CIGCTRL" }, | ||
280 | { 0x08, "CIIMGCPT" }, | ||
281 | { 0x0c, "CICPTSEQ" }, | ||
282 | { 0x10, "CIWDOFST" }, | ||
283 | { 0x14, "CIWDOFST2" }, | ||
284 | { 0x18, "CIODMAFMT" }, | ||
285 | { 0x20, "CIOCAN" }, | ||
286 | { 0x24, "CIOOFF" }, | ||
287 | { 0x30, "CIOSA" }, | ||
288 | { 0x40, "CISTATUS" }, | ||
289 | { 0x44, "CISTATUS2" }, | ||
290 | { 0xf0, "CITHOLD" }, | ||
291 | { 0xfc, "CIGENERAL" }, | ||
292 | }; | ||
293 | u32 i; | ||
294 | |||
295 | pr_info("--- %s ---\n", label); | ||
296 | for (i = 0; i < ARRAY_SIZE(registers); i++) { | ||
297 | u32 cfg = readl(dev->regs + registers[i].offset); | ||
298 | pr_info("%s: %s:\t0x%08x\n", __func__, registers[i].name, cfg); | ||
299 | } | ||
300 | } | ||