1 /*
2 * Register interface file for EXYNOS FIMC-LITE (camera interface) driver
3 *
4 * Copyright (C) 2012 Samsung Electronics Co., Ltd.
5 * Author: 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/bitops.h>
13 #include <linux/delay.h>
14 #include <linux/io.h>
15 #include <media/drv-intf/exynos-fimc.h>
16
17 #include "fimc-lite-reg.h"
18 #include "fimc-lite.h"
19 #include "fimc-core.h"
20
21 #define FLITE_RESET_TIMEOUT 50 /* in ms */
22
flite_hw_reset(struct fimc_lite * dev)23 void flite_hw_reset(struct fimc_lite *dev)
24 {
25 unsigned long end = jiffies + msecs_to_jiffies(FLITE_RESET_TIMEOUT);
26 u32 cfg;
27
28 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
29 cfg |= FLITE_REG_CIGCTRL_SWRST_REQ;
30 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
31
32 while (time_is_after_jiffies(end)) {
33 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
34 if (cfg & FLITE_REG_CIGCTRL_SWRST_RDY)
35 break;
36 usleep_range(1000, 5000);
37 }
38
39 cfg |= FLITE_REG_CIGCTRL_SWRST;
40 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
41 }
42
flite_hw_clear_pending_irq(struct fimc_lite * dev)43 void flite_hw_clear_pending_irq(struct fimc_lite *dev)
44 {
45 u32 cfg = readl(dev->regs + FLITE_REG_CISTATUS);
46 cfg &= ~FLITE_REG_CISTATUS_IRQ_CAM;
47 writel(cfg, dev->regs + FLITE_REG_CISTATUS);
48 }
49
flite_hw_get_interrupt_source(struct fimc_lite * dev)50 u32 flite_hw_get_interrupt_source(struct fimc_lite *dev)
51 {
52 u32 intsrc = readl(dev->regs + FLITE_REG_CISTATUS);
53 return intsrc & FLITE_REG_CISTATUS_IRQ_MASK;
54 }
55
flite_hw_clear_last_capture_end(struct fimc_lite * dev)56 void flite_hw_clear_last_capture_end(struct fimc_lite *dev)
57 {
58
59 u32 cfg = readl(dev->regs + FLITE_REG_CISTATUS2);
60 cfg &= ~FLITE_REG_CISTATUS2_LASTCAPEND;
61 writel(cfg, dev->regs + FLITE_REG_CISTATUS2);
62 }
63
flite_hw_set_interrupt_mask(struct fimc_lite * dev)64 void flite_hw_set_interrupt_mask(struct fimc_lite *dev)
65 {
66 u32 cfg, intsrc;
67
68 /* Select interrupts to be enabled for each output mode */
69 if (atomic_read(&dev->out_path) == FIMC_IO_DMA) {
70 intsrc = FLITE_REG_CIGCTRL_IRQ_OVFEN |
71 FLITE_REG_CIGCTRL_IRQ_LASTEN |
72 FLITE_REG_CIGCTRL_IRQ_STARTEN |
73 FLITE_REG_CIGCTRL_IRQ_ENDEN;
74 } else {
75 /* An output to the FIMC-IS */
76 intsrc = FLITE_REG_CIGCTRL_IRQ_OVFEN |
77 FLITE_REG_CIGCTRL_IRQ_LASTEN;
78 }
79
80 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
81 cfg |= FLITE_REG_CIGCTRL_IRQ_DISABLE_MASK;
82 cfg &= ~intsrc;
83 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
84 }
85
flite_hw_capture_start(struct fimc_lite * dev)86 void flite_hw_capture_start(struct fimc_lite *dev)
87 {
88 u32 cfg = readl(dev->regs + FLITE_REG_CIIMGCPT);
89 cfg |= FLITE_REG_CIIMGCPT_IMGCPTEN;
90 writel(cfg, dev->regs + FLITE_REG_CIIMGCPT);
91 }
92
flite_hw_capture_stop(struct fimc_lite * dev)93 void flite_hw_capture_stop(struct fimc_lite *dev)
94 {
95 u32 cfg = readl(dev->regs + FLITE_REG_CIIMGCPT);
96 cfg &= ~FLITE_REG_CIIMGCPT_IMGCPTEN;
97 writel(cfg, dev->regs + FLITE_REG_CIIMGCPT);
98 }
99
100 /*
101 * Test pattern (color bars) enable/disable. External sensor
102 * pixel clock must be active for the test pattern to work.
103 */
flite_hw_set_test_pattern(struct fimc_lite * dev,bool on)104 void flite_hw_set_test_pattern(struct fimc_lite *dev, bool on)
105 {
106 u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
107 if (on)
108 cfg |= FLITE_REG_CIGCTRL_TEST_PATTERN_COLORBAR;
109 else
110 cfg &= ~FLITE_REG_CIGCTRL_TEST_PATTERN_COLORBAR;
111 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
112 }
113
114 static const u32 src_pixfmt_map[8][3] = {
115 { MEDIA_BUS_FMT_YUYV8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_YCBYCR,
116 FLITE_REG_CIGCTRL_YUV422_1P },
117 { MEDIA_BUS_FMT_YVYU8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_YCRYCB,
118 FLITE_REG_CIGCTRL_YUV422_1P },
119 { MEDIA_BUS_FMT_UYVY8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_CBYCRY,
120 FLITE_REG_CIGCTRL_YUV422_1P },
121 { MEDIA_BUS_FMT_VYUY8_2X8, FLITE_REG_CISRCSIZE_ORDER422_IN_CRYCBY,
122 FLITE_REG_CIGCTRL_YUV422_1P },
123 { MEDIA_BUS_FMT_SGRBG8_1X8, 0, FLITE_REG_CIGCTRL_RAW8 },
124 { MEDIA_BUS_FMT_SGRBG10_1X10, 0, FLITE_REG_CIGCTRL_RAW10 },
125 { MEDIA_BUS_FMT_SGRBG12_1X12, 0, FLITE_REG_CIGCTRL_RAW12 },
126 { MEDIA_BUS_FMT_JPEG_1X8, 0, FLITE_REG_CIGCTRL_USER(1) },
127 };
128
129 /* Set camera input pixel format and resolution */
flite_hw_set_source_format(struct fimc_lite * dev,struct flite_frame * f)130 void flite_hw_set_source_format(struct fimc_lite *dev, struct flite_frame *f)
131 {
132 u32 pixelcode = f->fmt->mbus_code;
133 int i = ARRAY_SIZE(src_pixfmt_map);
134 u32 cfg;
135
136 while (--i) {
137 if (src_pixfmt_map[i][0] == pixelcode)
138 break;
139 }
140
141 if (i == 0 && src_pixfmt_map[i][0] != pixelcode) {
142 v4l2_err(&dev->ve.vdev,
143 "Unsupported pixel code, falling back to %#08x\n",
144 src_pixfmt_map[i][0]);
145 }
146
147 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
148 cfg &= ~FLITE_REG_CIGCTRL_FMT_MASK;
149 cfg |= src_pixfmt_map[i][2];
150 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
151
152 cfg = readl(dev->regs + FLITE_REG_CISRCSIZE);
153 cfg &= ~(FLITE_REG_CISRCSIZE_ORDER422_MASK |
154 FLITE_REG_CISRCSIZE_SIZE_CAM_MASK);
155 cfg |= (f->f_width << 16) | f->f_height;
156 cfg |= src_pixfmt_map[i][1];
157 writel(cfg, dev->regs + FLITE_REG_CISRCSIZE);
158 }
159
160 /* Set the camera host input window offsets (cropping) */
flite_hw_set_window_offset(struct fimc_lite * dev,struct flite_frame * f)161 void flite_hw_set_window_offset(struct fimc_lite *dev, struct flite_frame *f)
162 {
163 u32 hoff2, voff2;
164 u32 cfg;
165
166 cfg = readl(dev->regs + FLITE_REG_CIWDOFST);
167 cfg &= ~FLITE_REG_CIWDOFST_OFST_MASK;
168 cfg |= (f->rect.left << 16) | f->rect.top;
169 cfg |= FLITE_REG_CIWDOFST_WINOFSEN;
170 writel(cfg, dev->regs + FLITE_REG_CIWDOFST);
171
172 hoff2 = f->f_width - f->rect.width - f->rect.left;
173 voff2 = f->f_height - f->rect.height - f->rect.top;
174
175 cfg = (hoff2 << 16) | voff2;
176 writel(cfg, dev->regs + FLITE_REG_CIWDOFST2);
177 }
178
179 /* Select camera port (A, B) */
flite_hw_set_camera_port(struct fimc_lite * dev,int id)180 static void flite_hw_set_camera_port(struct fimc_lite *dev, int id)
181 {
182 u32 cfg = readl(dev->regs + FLITE_REG_CIGENERAL);
183 if (id == 0)
184 cfg &= ~FLITE_REG_CIGENERAL_CAM_B;
185 else
186 cfg |= FLITE_REG_CIGENERAL_CAM_B;
187 writel(cfg, dev->regs + FLITE_REG_CIGENERAL);
188 }
189
190 /* Select serial or parallel bus, camera port (A,B) and set signals polarity */
flite_hw_set_camera_bus(struct fimc_lite * dev,struct fimc_source_info * si)191 void flite_hw_set_camera_bus(struct fimc_lite *dev,
192 struct fimc_source_info *si)
193 {
194 u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
195 unsigned int flags = si->flags;
196
197 if (si->sensor_bus_type != FIMC_BUS_TYPE_MIPI_CSI2) {
198 cfg &= ~(FLITE_REG_CIGCTRL_SELCAM_MIPI |
199 FLITE_REG_CIGCTRL_INVPOLPCLK |
200 FLITE_REG_CIGCTRL_INVPOLVSYNC |
201 FLITE_REG_CIGCTRL_INVPOLHREF);
202
203 if (flags & V4L2_MBUS_PCLK_SAMPLE_FALLING)
204 cfg |= FLITE_REG_CIGCTRL_INVPOLPCLK;
205
206 if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW)
207 cfg |= FLITE_REG_CIGCTRL_INVPOLVSYNC;
208
209 if (flags & V4L2_MBUS_HSYNC_ACTIVE_LOW)
210 cfg |= FLITE_REG_CIGCTRL_INVPOLHREF;
211 } else {
212 cfg |= FLITE_REG_CIGCTRL_SELCAM_MIPI;
213 }
214
215 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
216
217 flite_hw_set_camera_port(dev, si->mux_id);
218 }
219
flite_hw_set_pack12(struct fimc_lite * dev,int on)220 static void flite_hw_set_pack12(struct fimc_lite *dev, int on)
221 {
222 u32 cfg = readl(dev->regs + FLITE_REG_CIODMAFMT);
223
224 cfg &= ~FLITE_REG_CIODMAFMT_PACK12;
225
226 if (on)
227 cfg |= FLITE_REG_CIODMAFMT_PACK12;
228
229 writel(cfg, dev->regs + FLITE_REG_CIODMAFMT);
230 }
231
flite_hw_set_out_order(struct fimc_lite * dev,struct flite_frame * f)232 static void flite_hw_set_out_order(struct fimc_lite *dev, struct flite_frame *f)
233 {
234 static const u32 pixcode[4][2] = {
235 { MEDIA_BUS_FMT_YUYV8_2X8, FLITE_REG_CIODMAFMT_YCBYCR },
236 { MEDIA_BUS_FMT_YVYU8_2X8, FLITE_REG_CIODMAFMT_YCRYCB },
237 { MEDIA_BUS_FMT_UYVY8_2X8, FLITE_REG_CIODMAFMT_CBYCRY },
238 { MEDIA_BUS_FMT_VYUY8_2X8, FLITE_REG_CIODMAFMT_CRYCBY },
239 };
240 u32 cfg = readl(dev->regs + FLITE_REG_CIODMAFMT);
241 int i = ARRAY_SIZE(pixcode);
242
243 while (--i)
244 if (pixcode[i][0] == f->fmt->mbus_code)
245 break;
246 cfg &= ~FLITE_REG_CIODMAFMT_YCBCR_ORDER_MASK;
247 writel(cfg | pixcode[i][1], dev->regs + FLITE_REG_CIODMAFMT);
248 }
249
flite_hw_set_dma_window(struct fimc_lite * dev,struct flite_frame * f)250 void flite_hw_set_dma_window(struct fimc_lite *dev, struct flite_frame *f)
251 {
252 u32 cfg;
253
254 /* Maximum output pixel size */
255 cfg = readl(dev->regs + FLITE_REG_CIOCAN);
256 cfg &= ~FLITE_REG_CIOCAN_MASK;
257 cfg = (f->f_height << 16) | f->f_width;
258 writel(cfg, dev->regs + FLITE_REG_CIOCAN);
259
260 /* DMA offsets */
261 cfg = readl(dev->regs + FLITE_REG_CIOOFF);
262 cfg &= ~FLITE_REG_CIOOFF_MASK;
263 cfg |= (f->rect.top << 16) | f->rect.left;
264 writel(cfg, dev->regs + FLITE_REG_CIOOFF);
265 }
266
flite_hw_set_dma_buffer(struct fimc_lite * dev,struct flite_buffer * buf)267 void flite_hw_set_dma_buffer(struct fimc_lite *dev, struct flite_buffer *buf)
268 {
269 unsigned int index;
270 u32 cfg;
271
272 if (dev->dd->max_dma_bufs == 1)
273 index = 0;
274 else
275 index = buf->index;
276
277 if (index == 0)
278 writel(buf->paddr, dev->regs + FLITE_REG_CIOSA);
279 else
280 writel(buf->paddr, dev->regs + FLITE_REG_CIOSAN(index - 1));
281
282 cfg = readl(dev->regs + FLITE_REG_CIFCNTSEQ);
283 cfg |= BIT(index);
284 writel(cfg, dev->regs + FLITE_REG_CIFCNTSEQ);
285 }
286
flite_hw_mask_dma_buffer(struct fimc_lite * dev,u32 index)287 void flite_hw_mask_dma_buffer(struct fimc_lite *dev, u32 index)
288 {
289 u32 cfg;
290
291 if (dev->dd->max_dma_bufs == 1)
292 index = 0;
293
294 cfg = readl(dev->regs + FLITE_REG_CIFCNTSEQ);
295 cfg &= ~BIT(index);
296 writel(cfg, dev->regs + FLITE_REG_CIFCNTSEQ);
297 }
298
299 /* Enable/disable output DMA, set output pixel size and offsets (composition) */
flite_hw_set_output_dma(struct fimc_lite * dev,struct flite_frame * f,bool enable)300 void flite_hw_set_output_dma(struct fimc_lite *dev, struct flite_frame *f,
301 bool enable)
302 {
303 u32 cfg = readl(dev->regs + FLITE_REG_CIGCTRL);
304
305 if (!enable) {
306 cfg |= FLITE_REG_CIGCTRL_ODMA_DISABLE;
307 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
308 return;
309 }
310
311 cfg &= ~FLITE_REG_CIGCTRL_ODMA_DISABLE;
312 writel(cfg, dev->regs + FLITE_REG_CIGCTRL);
313
314 flite_hw_set_out_order(dev, f);
315 flite_hw_set_dma_window(dev, f);
316 flite_hw_set_pack12(dev, 0);
317 }
318
flite_hw_dump_regs(struct fimc_lite * dev,const char * label)319 void flite_hw_dump_regs(struct fimc_lite *dev, const char *label)
320 {
321 struct {
322 u32 offset;
323 const char * const name;
324 } registers[] = {
325 { 0x00, "CISRCSIZE" },
326 { 0x04, "CIGCTRL" },
327 { 0x08, "CIIMGCPT" },
328 { 0x0c, "CICPTSEQ" },
329 { 0x10, "CIWDOFST" },
330 { 0x14, "CIWDOFST2" },
331 { 0x18, "CIODMAFMT" },
332 { 0x20, "CIOCAN" },
333 { 0x24, "CIOOFF" },
334 { 0x30, "CIOSA" },
335 { 0x40, "CISTATUS" },
336 { 0x44, "CISTATUS2" },
337 { 0xf0, "CITHOLD" },
338 { 0xfc, "CIGENERAL" },
339 };
340 u32 i;
341
342 v4l2_info(&dev->subdev, "--- %s ---\n", label);
343
344 for (i = 0; i < ARRAY_SIZE(registers); i++) {
345 u32 cfg = readl(dev->regs + registers[i].offset);
346 v4l2_info(&dev->subdev, "%9s: 0x%08x\n",
347 registers[i].name, cfg);
348 }
349 }
350