1*c1024049SMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0-only
2*c1024049SMauro Carvalho Chehab /*
3*c1024049SMauro Carvalho Chehab * Samsung s3c24xx/s3c64xx SoC CAMIF driver
4*c1024049SMauro Carvalho Chehab *
5*c1024049SMauro Carvalho Chehab * Copyright (C) 2012 Sylwester Nawrocki <sylvester.nawrocki@gmail.com>
6*c1024049SMauro Carvalho Chehab * Copyright (C) 2012 Tomasz Figa <tomasz.figa@gmail.com>
7*c1024049SMauro Carvalho Chehab */
8*c1024049SMauro Carvalho Chehab #define pr_fmt(fmt) "%s:%d " fmt, __func__, __LINE__
9*c1024049SMauro Carvalho Chehab
10*c1024049SMauro Carvalho Chehab #include <linux/delay.h>
11*c1024049SMauro Carvalho Chehab #include "camif-regs.h"
12*c1024049SMauro Carvalho Chehab
13*c1024049SMauro Carvalho Chehab #define camif_write(_camif, _off, _val) writel(_val, (_camif)->io_base + (_off))
14*c1024049SMauro Carvalho Chehab #define camif_read(_camif, _off) readl((_camif)->io_base + (_off))
15*c1024049SMauro Carvalho Chehab
camif_hw_reset(struct camif_dev * camif)16*c1024049SMauro Carvalho Chehab void camif_hw_reset(struct camif_dev *camif)
17*c1024049SMauro Carvalho Chehab {
18*c1024049SMauro Carvalho Chehab u32 cfg;
19*c1024049SMauro Carvalho Chehab
20*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CISRCFMT);
21*c1024049SMauro Carvalho Chehab cfg |= CISRCFMT_ITU601_8BIT;
22*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISRCFMT, cfg);
23*c1024049SMauro Carvalho Chehab
24*c1024049SMauro Carvalho Chehab /* S/W reset */
25*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIGCTRL);
26*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_SWRST;
27*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV)
28*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_IRQ_LEVEL;
29*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIGCTRL, cfg);
30*c1024049SMauro Carvalho Chehab udelay(10);
31*c1024049SMauro Carvalho Chehab
32*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIGCTRL);
33*c1024049SMauro Carvalho Chehab cfg &= ~CIGCTRL_SWRST;
34*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIGCTRL, cfg);
35*c1024049SMauro Carvalho Chehab udelay(10);
36*c1024049SMauro Carvalho Chehab }
37*c1024049SMauro Carvalho Chehab
camif_hw_clear_pending_irq(struct camif_vp * vp)38*c1024049SMauro Carvalho Chehab void camif_hw_clear_pending_irq(struct camif_vp *vp)
39*c1024049SMauro Carvalho Chehab {
40*c1024049SMauro Carvalho Chehab u32 cfg = camif_read(vp->camif, S3C_CAMIF_REG_CIGCTRL);
41*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_IRQ_CLR(vp->id);
42*c1024049SMauro Carvalho Chehab camif_write(vp->camif, S3C_CAMIF_REG_CIGCTRL, cfg);
43*c1024049SMauro Carvalho Chehab }
44*c1024049SMauro Carvalho Chehab
45*c1024049SMauro Carvalho Chehab /*
46*c1024049SMauro Carvalho Chehab * Sets video test pattern (off, color bar, horizontal or vertical gradient).
47*c1024049SMauro Carvalho Chehab * External sensor pixel clock must be active for the test pattern to work.
48*c1024049SMauro Carvalho Chehab */
camif_hw_set_test_pattern(struct camif_dev * camif,unsigned int pattern)49*c1024049SMauro Carvalho Chehab void camif_hw_set_test_pattern(struct camif_dev *camif, unsigned int pattern)
50*c1024049SMauro Carvalho Chehab {
51*c1024049SMauro Carvalho Chehab u32 cfg = camif_read(camif, S3C_CAMIF_REG_CIGCTRL);
52*c1024049SMauro Carvalho Chehab cfg &= ~CIGCTRL_TESTPATTERN_MASK;
53*c1024049SMauro Carvalho Chehab cfg |= (pattern << 27);
54*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIGCTRL, cfg);
55*c1024049SMauro Carvalho Chehab }
56*c1024049SMauro Carvalho Chehab
camif_hw_set_effect(struct camif_dev * camif,unsigned int effect,unsigned int cr,unsigned int cb)57*c1024049SMauro Carvalho Chehab void camif_hw_set_effect(struct camif_dev *camif, unsigned int effect,
58*c1024049SMauro Carvalho Chehab unsigned int cr, unsigned int cb)
59*c1024049SMauro Carvalho Chehab {
60*c1024049SMauro Carvalho Chehab static const struct v4l2_control colorfx[] = {
61*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_NONE, CIIMGEFF_FIN_BYPASS },
62*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_BW, CIIMGEFF_FIN_ARBITRARY },
63*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_SEPIA, CIIMGEFF_FIN_ARBITRARY },
64*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_NEGATIVE, CIIMGEFF_FIN_NEGATIVE },
65*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_ART_FREEZE, CIIMGEFF_FIN_ARTFREEZE },
66*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_EMBOSS, CIIMGEFF_FIN_EMBOSSING },
67*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_SILHOUETTE, CIIMGEFF_FIN_SILHOUETTE },
68*c1024049SMauro Carvalho Chehab { V4L2_COLORFX_SET_CBCR, CIIMGEFF_FIN_ARBITRARY },
69*c1024049SMauro Carvalho Chehab };
70*c1024049SMauro Carvalho Chehab unsigned int i, cfg;
71*c1024049SMauro Carvalho Chehab
72*c1024049SMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(colorfx); i++)
73*c1024049SMauro Carvalho Chehab if (colorfx[i].id == effect)
74*c1024049SMauro Carvalho Chehab break;
75*c1024049SMauro Carvalho Chehab
76*c1024049SMauro Carvalho Chehab if (i == ARRAY_SIZE(colorfx))
77*c1024049SMauro Carvalho Chehab return;
78*c1024049SMauro Carvalho Chehab
79*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIIMGEFF(camif->vp->offset));
80*c1024049SMauro Carvalho Chehab /* Set effect */
81*c1024049SMauro Carvalho Chehab cfg &= ~CIIMGEFF_FIN_MASK;
82*c1024049SMauro Carvalho Chehab cfg |= colorfx[i].value;
83*c1024049SMauro Carvalho Chehab /* Set both paths */
84*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision >= S3C6400_CAMIF_IP_REV) {
85*c1024049SMauro Carvalho Chehab if (effect == V4L2_COLORFX_NONE)
86*c1024049SMauro Carvalho Chehab cfg &= ~CIIMGEFF_IE_ENABLE_MASK;
87*c1024049SMauro Carvalho Chehab else
88*c1024049SMauro Carvalho Chehab cfg |= CIIMGEFF_IE_ENABLE_MASK;
89*c1024049SMauro Carvalho Chehab }
90*c1024049SMauro Carvalho Chehab cfg &= ~CIIMGEFF_PAT_CBCR_MASK;
91*c1024049SMauro Carvalho Chehab cfg |= cr | (cb << 13);
92*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIIMGEFF(camif->vp->offset), cfg);
93*c1024049SMauro Carvalho Chehab }
94*c1024049SMauro Carvalho Chehab
95*c1024049SMauro Carvalho Chehab static const u32 src_pixfmt_map[8][2] = {
96*c1024049SMauro Carvalho Chehab { MEDIA_BUS_FMT_YUYV8_2X8, CISRCFMT_ORDER422_YCBYCR },
97*c1024049SMauro Carvalho Chehab { MEDIA_BUS_FMT_YVYU8_2X8, CISRCFMT_ORDER422_YCRYCB },
98*c1024049SMauro Carvalho Chehab { MEDIA_BUS_FMT_UYVY8_2X8, CISRCFMT_ORDER422_CBYCRY },
99*c1024049SMauro Carvalho Chehab { MEDIA_BUS_FMT_VYUY8_2X8, CISRCFMT_ORDER422_CRYCBY },
100*c1024049SMauro Carvalho Chehab };
101*c1024049SMauro Carvalho Chehab
102*c1024049SMauro Carvalho Chehab /* Set camera input pixel format and resolution */
camif_hw_set_source_format(struct camif_dev * camif)103*c1024049SMauro Carvalho Chehab void camif_hw_set_source_format(struct camif_dev *camif)
104*c1024049SMauro Carvalho Chehab {
105*c1024049SMauro Carvalho Chehab struct v4l2_mbus_framefmt *mf = &camif->mbus_fmt;
106*c1024049SMauro Carvalho Chehab int i;
107*c1024049SMauro Carvalho Chehab u32 cfg;
108*c1024049SMauro Carvalho Chehab
109*c1024049SMauro Carvalho Chehab for (i = ARRAY_SIZE(src_pixfmt_map) - 1; i >= 0; i--) {
110*c1024049SMauro Carvalho Chehab if (src_pixfmt_map[i][0] == mf->code)
111*c1024049SMauro Carvalho Chehab break;
112*c1024049SMauro Carvalho Chehab }
113*c1024049SMauro Carvalho Chehab if (i < 0) {
114*c1024049SMauro Carvalho Chehab i = 0;
115*c1024049SMauro Carvalho Chehab dev_err(camif->dev,
116*c1024049SMauro Carvalho Chehab "Unsupported pixel code, falling back to %#08x\n",
117*c1024049SMauro Carvalho Chehab src_pixfmt_map[i][0]);
118*c1024049SMauro Carvalho Chehab }
119*c1024049SMauro Carvalho Chehab
120*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CISRCFMT);
121*c1024049SMauro Carvalho Chehab cfg &= ~(CISRCFMT_ORDER422_MASK | CISRCFMT_SIZE_CAM_MASK);
122*c1024049SMauro Carvalho Chehab cfg |= (mf->width << 16) | mf->height;
123*c1024049SMauro Carvalho Chehab cfg |= src_pixfmt_map[i][1];
124*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISRCFMT, cfg);
125*c1024049SMauro Carvalho Chehab }
126*c1024049SMauro Carvalho Chehab
127*c1024049SMauro Carvalho Chehab /* Set the camera host input window offsets (cropping) */
camif_hw_set_camera_crop(struct camif_dev * camif)128*c1024049SMauro Carvalho Chehab void camif_hw_set_camera_crop(struct camif_dev *camif)
129*c1024049SMauro Carvalho Chehab {
130*c1024049SMauro Carvalho Chehab struct v4l2_mbus_framefmt *mf = &camif->mbus_fmt;
131*c1024049SMauro Carvalho Chehab struct v4l2_rect *crop = &camif->camif_crop;
132*c1024049SMauro Carvalho Chehab u32 hoff2, voff2;
133*c1024049SMauro Carvalho Chehab u32 cfg;
134*c1024049SMauro Carvalho Chehab
135*c1024049SMauro Carvalho Chehab /* Note: s3c244x requirement: left = f_width - rect.width / 2 */
136*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIWDOFST);
137*c1024049SMauro Carvalho Chehab cfg &= ~(CIWDOFST_OFST_MASK | CIWDOFST_WINOFSEN);
138*c1024049SMauro Carvalho Chehab cfg |= (crop->left << 16) | crop->top;
139*c1024049SMauro Carvalho Chehab if (crop->left != 0 || crop->top != 0)
140*c1024049SMauro Carvalho Chehab cfg |= CIWDOFST_WINOFSEN;
141*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIWDOFST, cfg);
142*c1024049SMauro Carvalho Chehab
143*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV) {
144*c1024049SMauro Carvalho Chehab hoff2 = mf->width - crop->width - crop->left;
145*c1024049SMauro Carvalho Chehab voff2 = mf->height - crop->height - crop->top;
146*c1024049SMauro Carvalho Chehab cfg = (hoff2 << 16) | voff2;
147*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIWDOFST2, cfg);
148*c1024049SMauro Carvalho Chehab }
149*c1024049SMauro Carvalho Chehab }
150*c1024049SMauro Carvalho Chehab
camif_hw_clear_fifo_overflow(struct camif_vp * vp)151*c1024049SMauro Carvalho Chehab void camif_hw_clear_fifo_overflow(struct camif_vp *vp)
152*c1024049SMauro Carvalho Chehab {
153*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
154*c1024049SMauro Carvalho Chehab u32 cfg;
155*c1024049SMauro Carvalho Chehab
156*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIWDOFST);
157*c1024049SMauro Carvalho Chehab if (vp->id == 0)
158*c1024049SMauro Carvalho Chehab cfg |= (CIWDOFST_CLROVCOFIY | CIWDOFST_CLROVCOFICB |
159*c1024049SMauro Carvalho Chehab CIWDOFST_CLROVCOFICR);
160*c1024049SMauro Carvalho Chehab else
161*c1024049SMauro Carvalho Chehab cfg |= (/* CIWDOFST_CLROVPRFIY | */ CIWDOFST_CLROVPRFICB |
162*c1024049SMauro Carvalho Chehab CIWDOFST_CLROVPRFICR);
163*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIWDOFST, cfg);
164*c1024049SMauro Carvalho Chehab }
165*c1024049SMauro Carvalho Chehab
166*c1024049SMauro Carvalho Chehab /* Set video bus signals polarity */
camif_hw_set_camera_bus(struct camif_dev * camif)167*c1024049SMauro Carvalho Chehab void camif_hw_set_camera_bus(struct camif_dev *camif)
168*c1024049SMauro Carvalho Chehab {
169*c1024049SMauro Carvalho Chehab unsigned int flags = camif->pdata.sensor.flags;
170*c1024049SMauro Carvalho Chehab
171*c1024049SMauro Carvalho Chehab u32 cfg = camif_read(camif, S3C_CAMIF_REG_CIGCTRL);
172*c1024049SMauro Carvalho Chehab
173*c1024049SMauro Carvalho Chehab cfg &= ~(CIGCTRL_INVPOLPCLK | CIGCTRL_INVPOLVSYNC |
174*c1024049SMauro Carvalho Chehab CIGCTRL_INVPOLHREF | CIGCTRL_INVPOLFIELD);
175*c1024049SMauro Carvalho Chehab
176*c1024049SMauro Carvalho Chehab if (flags & V4L2_MBUS_PCLK_SAMPLE_FALLING)
177*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_INVPOLPCLK;
178*c1024049SMauro Carvalho Chehab
179*c1024049SMauro Carvalho Chehab if (flags & V4L2_MBUS_VSYNC_ACTIVE_LOW)
180*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_INVPOLVSYNC;
181*c1024049SMauro Carvalho Chehab /*
182*c1024049SMauro Carvalho Chehab * HREF is normally high during frame active data
183*c1024049SMauro Carvalho Chehab * transmission and low during horizontal synchronization
184*c1024049SMauro Carvalho Chehab * period. Thus HREF active high means HSYNC active low.
185*c1024049SMauro Carvalho Chehab */
186*c1024049SMauro Carvalho Chehab if (flags & V4L2_MBUS_HSYNC_ACTIVE_HIGH)
187*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_INVPOLHREF; /* HREF active low */
188*c1024049SMauro Carvalho Chehab
189*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV) {
190*c1024049SMauro Carvalho Chehab if (flags & V4L2_MBUS_FIELD_EVEN_LOW)
191*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_INVPOLFIELD;
192*c1024049SMauro Carvalho Chehab cfg |= CIGCTRL_FIELDMODE;
193*c1024049SMauro Carvalho Chehab }
194*c1024049SMauro Carvalho Chehab
195*c1024049SMauro Carvalho Chehab pr_debug("Setting CIGCTRL to: %#x\n", cfg);
196*c1024049SMauro Carvalho Chehab
197*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIGCTRL, cfg);
198*c1024049SMauro Carvalho Chehab }
199*c1024049SMauro Carvalho Chehab
camif_hw_set_output_addr(struct camif_vp * vp,struct camif_addr * paddr,int i)200*c1024049SMauro Carvalho Chehab void camif_hw_set_output_addr(struct camif_vp *vp,
201*c1024049SMauro Carvalho Chehab struct camif_addr *paddr, int i)
202*c1024049SMauro Carvalho Chehab {
203*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
204*c1024049SMauro Carvalho Chehab
205*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIYSA(vp->id, i), paddr->y);
206*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV
207*c1024049SMauro Carvalho Chehab || vp->id == VP_CODEC) {
208*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CICBSA(vp->id, i),
209*c1024049SMauro Carvalho Chehab paddr->cb);
210*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CICRSA(vp->id, i),
211*c1024049SMauro Carvalho Chehab paddr->cr);
212*c1024049SMauro Carvalho Chehab }
213*c1024049SMauro Carvalho Chehab
214*c1024049SMauro Carvalho Chehab pr_debug("dst_buf[%d]: %pad, cb: %pad, cr: %pad\n",
215*c1024049SMauro Carvalho Chehab i, &paddr->y, &paddr->cb, &paddr->cr);
216*c1024049SMauro Carvalho Chehab }
217*c1024049SMauro Carvalho Chehab
camif_hw_set_out_dma_size(struct camif_vp * vp)218*c1024049SMauro Carvalho Chehab static void camif_hw_set_out_dma_size(struct camif_vp *vp)
219*c1024049SMauro Carvalho Chehab {
220*c1024049SMauro Carvalho Chehab struct camif_frame *frame = &vp->out_frame;
221*c1024049SMauro Carvalho Chehab u32 cfg;
222*c1024049SMauro Carvalho Chehab
223*c1024049SMauro Carvalho Chehab cfg = camif_read(vp->camif, S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset));
224*c1024049SMauro Carvalho Chehab cfg &= ~CITRGFMT_TARGETSIZE_MASK;
225*c1024049SMauro Carvalho Chehab cfg |= (frame->f_width << 16) | frame->f_height;
226*c1024049SMauro Carvalho Chehab camif_write(vp->camif, S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset), cfg);
227*c1024049SMauro Carvalho Chehab }
228*c1024049SMauro Carvalho Chehab
camif_get_dma_burst(u32 width,u32 ybpp,u32 * mburst,u32 * rburst)229*c1024049SMauro Carvalho Chehab static void camif_get_dma_burst(u32 width, u32 ybpp, u32 *mburst, u32 *rburst)
230*c1024049SMauro Carvalho Chehab {
231*c1024049SMauro Carvalho Chehab unsigned int nwords = width * ybpp / 4;
232*c1024049SMauro Carvalho Chehab unsigned int div, rem;
233*c1024049SMauro Carvalho Chehab
234*c1024049SMauro Carvalho Chehab if (WARN_ON(width < 8 || (width * ybpp) & 7))
235*c1024049SMauro Carvalho Chehab return;
236*c1024049SMauro Carvalho Chehab
237*c1024049SMauro Carvalho Chehab for (div = 16; div >= 2; div /= 2) {
238*c1024049SMauro Carvalho Chehab if (nwords < div)
239*c1024049SMauro Carvalho Chehab continue;
240*c1024049SMauro Carvalho Chehab
241*c1024049SMauro Carvalho Chehab rem = nwords & (div - 1);
242*c1024049SMauro Carvalho Chehab if (rem == 0) {
243*c1024049SMauro Carvalho Chehab *mburst = div;
244*c1024049SMauro Carvalho Chehab *rburst = div;
245*c1024049SMauro Carvalho Chehab break;
246*c1024049SMauro Carvalho Chehab }
247*c1024049SMauro Carvalho Chehab if (rem == div / 2 || rem == div / 4) {
248*c1024049SMauro Carvalho Chehab *mburst = div;
249*c1024049SMauro Carvalho Chehab *rburst = rem;
250*c1024049SMauro Carvalho Chehab break;
251*c1024049SMauro Carvalho Chehab }
252*c1024049SMauro Carvalho Chehab }
253*c1024049SMauro Carvalho Chehab }
254*c1024049SMauro Carvalho Chehab
camif_hw_set_output_dma(struct camif_vp * vp)255*c1024049SMauro Carvalho Chehab void camif_hw_set_output_dma(struct camif_vp *vp)
256*c1024049SMauro Carvalho Chehab {
257*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
258*c1024049SMauro Carvalho Chehab struct camif_frame *frame = &vp->out_frame;
259*c1024049SMauro Carvalho Chehab const struct camif_fmt *fmt = vp->out_fmt;
260*c1024049SMauro Carvalho Chehab unsigned int ymburst = 0, yrburst = 0;
261*c1024049SMauro Carvalho Chehab u32 cfg;
262*c1024049SMauro Carvalho Chehab
263*c1024049SMauro Carvalho Chehab camif_hw_set_out_dma_size(vp);
264*c1024049SMauro Carvalho Chehab
265*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV) {
266*c1024049SMauro Carvalho Chehab struct camif_dma_offset *offset = &frame->dma_offset;
267*c1024049SMauro Carvalho Chehab /* Set the input dma offsets. */
268*c1024049SMauro Carvalho Chehab cfg = S3C_CISS_OFFS_INITIAL(offset->initial);
269*c1024049SMauro Carvalho Chehab cfg |= S3C_CISS_OFFS_LINE(offset->line);
270*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISSY(vp->id), cfg);
271*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISSCB(vp->id), cfg);
272*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISSCR(vp->id), cfg);
273*c1024049SMauro Carvalho Chehab }
274*c1024049SMauro Carvalho Chehab
275*c1024049SMauro Carvalho Chehab /* Configure DMA burst values */
276*c1024049SMauro Carvalho Chehab camif_get_dma_burst(frame->rect.width, fmt->ybpp, &ymburst, &yrburst);
277*c1024049SMauro Carvalho Chehab
278*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CICTRL(vp->id, vp->offset));
279*c1024049SMauro Carvalho Chehab cfg &= ~CICTRL_BURST_MASK;
280*c1024049SMauro Carvalho Chehab
281*c1024049SMauro Carvalho Chehab cfg |= CICTRL_YBURST1(ymburst) | CICTRL_YBURST2(yrburst);
282*c1024049SMauro Carvalho Chehab cfg |= CICTRL_CBURST1(ymburst / 2) | CICTRL_CBURST2(yrburst / 2);
283*c1024049SMauro Carvalho Chehab
284*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CICTRL(vp->id, vp->offset), cfg);
285*c1024049SMauro Carvalho Chehab
286*c1024049SMauro Carvalho Chehab pr_debug("ymburst: %u, yrburst: %u\n", ymburst, yrburst);
287*c1024049SMauro Carvalho Chehab }
288*c1024049SMauro Carvalho Chehab
camif_hw_set_input_path(struct camif_vp * vp)289*c1024049SMauro Carvalho Chehab void camif_hw_set_input_path(struct camif_vp *vp)
290*c1024049SMauro Carvalho Chehab {
291*c1024049SMauro Carvalho Chehab u32 cfg = camif_read(vp->camif, S3C_CAMIF_REG_MSCTRL(vp->id));
292*c1024049SMauro Carvalho Chehab cfg &= ~MSCTRL_SEL_DMA_CAM;
293*c1024049SMauro Carvalho Chehab camif_write(vp->camif, S3C_CAMIF_REG_MSCTRL(vp->id), cfg);
294*c1024049SMauro Carvalho Chehab }
295*c1024049SMauro Carvalho Chehab
camif_hw_set_target_format(struct camif_vp * vp)296*c1024049SMauro Carvalho Chehab void camif_hw_set_target_format(struct camif_vp *vp)
297*c1024049SMauro Carvalho Chehab {
298*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
299*c1024049SMauro Carvalho Chehab struct camif_frame *frame = &vp->out_frame;
300*c1024049SMauro Carvalho Chehab u32 cfg;
301*c1024049SMauro Carvalho Chehab
302*c1024049SMauro Carvalho Chehab pr_debug("fw: %d, fh: %d color: %d\n", frame->f_width,
303*c1024049SMauro Carvalho Chehab frame->f_height, vp->out_fmt->color);
304*c1024049SMauro Carvalho Chehab
305*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset));
306*c1024049SMauro Carvalho Chehab cfg &= ~CITRGFMT_TARGETSIZE_MASK;
307*c1024049SMauro Carvalho Chehab
308*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C244X_CAMIF_IP_REV) {
309*c1024049SMauro Carvalho Chehab /* We currently support only YCbCr 4:2:2 at the camera input */
310*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_IN422;
311*c1024049SMauro Carvalho Chehab cfg &= ~CITRGFMT_OUT422;
312*c1024049SMauro Carvalho Chehab if (vp->out_fmt->color == IMG_FMT_YCBCR422P)
313*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_OUT422;
314*c1024049SMauro Carvalho Chehab } else {
315*c1024049SMauro Carvalho Chehab cfg &= ~CITRGFMT_OUTFORMAT_MASK;
316*c1024049SMauro Carvalho Chehab switch (vp->out_fmt->color) {
317*c1024049SMauro Carvalho Chehab case IMG_FMT_RGB565...IMG_FMT_XRGB8888:
318*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_OUTFORMAT_RGB;
319*c1024049SMauro Carvalho Chehab break;
320*c1024049SMauro Carvalho Chehab case IMG_FMT_YCBCR420...IMG_FMT_YCRCB420:
321*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_OUTFORMAT_YCBCR420;
322*c1024049SMauro Carvalho Chehab break;
323*c1024049SMauro Carvalho Chehab case IMG_FMT_YCBCR422P:
324*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_OUTFORMAT_YCBCR422;
325*c1024049SMauro Carvalho Chehab break;
326*c1024049SMauro Carvalho Chehab case IMG_FMT_YCBYCR422...IMG_FMT_CRYCBY422:
327*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_OUTFORMAT_YCBCR422I;
328*c1024049SMauro Carvalho Chehab break;
329*c1024049SMauro Carvalho Chehab }
330*c1024049SMauro Carvalho Chehab }
331*c1024049SMauro Carvalho Chehab
332*c1024049SMauro Carvalho Chehab /* Rotation is only supported by s3c64xx */
333*c1024049SMauro Carvalho Chehab if (vp->rotation == 90 || vp->rotation == 270)
334*c1024049SMauro Carvalho Chehab cfg |= (frame->f_height << 16) | frame->f_width;
335*c1024049SMauro Carvalho Chehab else
336*c1024049SMauro Carvalho Chehab cfg |= (frame->f_width << 16) | frame->f_height;
337*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset), cfg);
338*c1024049SMauro Carvalho Chehab
339*c1024049SMauro Carvalho Chehab /* Target area, output pixel width * height */
340*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CITAREA(vp->id, vp->offset));
341*c1024049SMauro Carvalho Chehab cfg &= ~CITAREA_MASK;
342*c1024049SMauro Carvalho Chehab cfg |= (frame->f_width * frame->f_height);
343*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CITAREA(vp->id, vp->offset), cfg);
344*c1024049SMauro Carvalho Chehab }
345*c1024049SMauro Carvalho Chehab
camif_hw_set_flip(struct camif_vp * vp)346*c1024049SMauro Carvalho Chehab void camif_hw_set_flip(struct camif_vp *vp)
347*c1024049SMauro Carvalho Chehab {
348*c1024049SMauro Carvalho Chehab u32 cfg = camif_read(vp->camif,
349*c1024049SMauro Carvalho Chehab S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset));
350*c1024049SMauro Carvalho Chehab
351*c1024049SMauro Carvalho Chehab cfg &= ~CITRGFMT_FLIP_MASK;
352*c1024049SMauro Carvalho Chehab
353*c1024049SMauro Carvalho Chehab if (vp->hflip)
354*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_FLIP_Y_MIRROR;
355*c1024049SMauro Carvalho Chehab if (vp->vflip)
356*c1024049SMauro Carvalho Chehab cfg |= CITRGFMT_FLIP_X_MIRROR;
357*c1024049SMauro Carvalho Chehab
358*c1024049SMauro Carvalho Chehab camif_write(vp->camif, S3C_CAMIF_REG_CITRGFMT(vp->id, vp->offset), cfg);
359*c1024049SMauro Carvalho Chehab }
360*c1024049SMauro Carvalho Chehab
camif_hw_set_prescaler(struct camif_vp * vp)361*c1024049SMauro Carvalho Chehab static void camif_hw_set_prescaler(struct camif_vp *vp)
362*c1024049SMauro Carvalho Chehab {
363*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
364*c1024049SMauro Carvalho Chehab struct camif_scaler *sc = &vp->scaler;
365*c1024049SMauro Carvalho Chehab u32 cfg, shfactor, addr;
366*c1024049SMauro Carvalho Chehab
367*c1024049SMauro Carvalho Chehab addr = S3C_CAMIF_REG_CISCPRERATIO(vp->id, vp->offset);
368*c1024049SMauro Carvalho Chehab
369*c1024049SMauro Carvalho Chehab shfactor = 10 - (sc->h_shift + sc->v_shift);
370*c1024049SMauro Carvalho Chehab cfg = shfactor << 28;
371*c1024049SMauro Carvalho Chehab
372*c1024049SMauro Carvalho Chehab cfg |= (sc->pre_h_ratio << 16) | sc->pre_v_ratio;
373*c1024049SMauro Carvalho Chehab camif_write(camif, addr, cfg);
374*c1024049SMauro Carvalho Chehab
375*c1024049SMauro Carvalho Chehab cfg = (sc->pre_dst_width << 16) | sc->pre_dst_height;
376*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISCPREDST(vp->id, vp->offset), cfg);
377*c1024049SMauro Carvalho Chehab }
378*c1024049SMauro Carvalho Chehab
camif_s3c244x_hw_set_scaler(struct camif_vp * vp)379*c1024049SMauro Carvalho Chehab static void camif_s3c244x_hw_set_scaler(struct camif_vp *vp)
380*c1024049SMauro Carvalho Chehab {
381*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
382*c1024049SMauro Carvalho Chehab struct camif_scaler *scaler = &vp->scaler;
383*c1024049SMauro Carvalho Chehab unsigned int color = vp->out_fmt->color;
384*c1024049SMauro Carvalho Chehab u32 cfg;
385*c1024049SMauro Carvalho Chehab
386*c1024049SMauro Carvalho Chehab camif_hw_set_prescaler(vp);
387*c1024049SMauro Carvalho Chehab
388*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CISCCTRL(vp->id, vp->offset));
389*c1024049SMauro Carvalho Chehab
390*c1024049SMauro Carvalho Chehab cfg &= ~(CISCCTRL_SCALEUP_MASK | CISCCTRL_SCALERBYPASS |
391*c1024049SMauro Carvalho Chehab CISCCTRL_MAIN_RATIO_MASK | CIPRSCCTRL_RGB_FORMAT_24BIT);
392*c1024049SMauro Carvalho Chehab
393*c1024049SMauro Carvalho Chehab if (scaler->enable) {
394*c1024049SMauro Carvalho Chehab if (scaler->scaleup_h) {
395*c1024049SMauro Carvalho Chehab if (vp->id == VP_CODEC)
396*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALEUP_H;
397*c1024049SMauro Carvalho Chehab else
398*c1024049SMauro Carvalho Chehab cfg |= CIPRSCCTRL_SCALEUP_H;
399*c1024049SMauro Carvalho Chehab }
400*c1024049SMauro Carvalho Chehab if (scaler->scaleup_v) {
401*c1024049SMauro Carvalho Chehab if (vp->id == VP_CODEC)
402*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALEUP_V;
403*c1024049SMauro Carvalho Chehab else
404*c1024049SMauro Carvalho Chehab cfg |= CIPRSCCTRL_SCALEUP_V;
405*c1024049SMauro Carvalho Chehab }
406*c1024049SMauro Carvalho Chehab } else {
407*c1024049SMauro Carvalho Chehab if (vp->id == VP_CODEC)
408*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALERBYPASS;
409*c1024049SMauro Carvalho Chehab }
410*c1024049SMauro Carvalho Chehab
411*c1024049SMauro Carvalho Chehab cfg |= ((scaler->main_h_ratio & 0x1ff) << 16);
412*c1024049SMauro Carvalho Chehab cfg |= scaler->main_v_ratio & 0x1ff;
413*c1024049SMauro Carvalho Chehab
414*c1024049SMauro Carvalho Chehab if (vp->id == VP_PREVIEW) {
415*c1024049SMauro Carvalho Chehab if (color == IMG_FMT_XRGB8888)
416*c1024049SMauro Carvalho Chehab cfg |= CIPRSCCTRL_RGB_FORMAT_24BIT;
417*c1024049SMauro Carvalho Chehab cfg |= CIPRSCCTRL_SAMPLE;
418*c1024049SMauro Carvalho Chehab }
419*c1024049SMauro Carvalho Chehab
420*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISCCTRL(vp->id, vp->offset), cfg);
421*c1024049SMauro Carvalho Chehab
422*c1024049SMauro Carvalho Chehab pr_debug("main: h_ratio: %#x, v_ratio: %#x",
423*c1024049SMauro Carvalho Chehab scaler->main_h_ratio, scaler->main_v_ratio);
424*c1024049SMauro Carvalho Chehab }
425*c1024049SMauro Carvalho Chehab
camif_s3c64xx_hw_set_scaler(struct camif_vp * vp)426*c1024049SMauro Carvalho Chehab static void camif_s3c64xx_hw_set_scaler(struct camif_vp *vp)
427*c1024049SMauro Carvalho Chehab {
428*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
429*c1024049SMauro Carvalho Chehab struct camif_scaler *scaler = &vp->scaler;
430*c1024049SMauro Carvalho Chehab unsigned int color = vp->out_fmt->color;
431*c1024049SMauro Carvalho Chehab u32 cfg;
432*c1024049SMauro Carvalho Chehab
433*c1024049SMauro Carvalho Chehab camif_hw_set_prescaler(vp);
434*c1024049SMauro Carvalho Chehab
435*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CISCCTRL(vp->id, vp->offset));
436*c1024049SMauro Carvalho Chehab
437*c1024049SMauro Carvalho Chehab cfg &= ~(CISCCTRL_CSCR2Y_WIDE | CISCCTRL_CSCY2R_WIDE
438*c1024049SMauro Carvalho Chehab | CISCCTRL_SCALEUP_H | CISCCTRL_SCALEUP_V
439*c1024049SMauro Carvalho Chehab | CISCCTRL_SCALERBYPASS | CISCCTRL_ONE2ONE
440*c1024049SMauro Carvalho Chehab | CISCCTRL_INRGB_FMT_MASK | CISCCTRL_OUTRGB_FMT_MASK
441*c1024049SMauro Carvalho Chehab | CISCCTRL_INTERLACE | CISCCTRL_EXTRGB_EXTENSION
442*c1024049SMauro Carvalho Chehab | CISCCTRL_MAIN_RATIO_MASK);
443*c1024049SMauro Carvalho Chehab
444*c1024049SMauro Carvalho Chehab cfg |= (CISCCTRL_CSCR2Y_WIDE | CISCCTRL_CSCY2R_WIDE);
445*c1024049SMauro Carvalho Chehab
446*c1024049SMauro Carvalho Chehab if (!scaler->enable) {
447*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALERBYPASS;
448*c1024049SMauro Carvalho Chehab } else {
449*c1024049SMauro Carvalho Chehab if (scaler->scaleup_h)
450*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALEUP_H;
451*c1024049SMauro Carvalho Chehab if (scaler->scaleup_v)
452*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALEUP_V;
453*c1024049SMauro Carvalho Chehab if (scaler->copy)
454*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_ONE2ONE;
455*c1024049SMauro Carvalho Chehab }
456*c1024049SMauro Carvalho Chehab
457*c1024049SMauro Carvalho Chehab switch (color) {
458*c1024049SMauro Carvalho Chehab case IMG_FMT_RGB666:
459*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_OUTRGB_FMT_RGB666;
460*c1024049SMauro Carvalho Chehab break;
461*c1024049SMauro Carvalho Chehab case IMG_FMT_XRGB8888:
462*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_OUTRGB_FMT_RGB888;
463*c1024049SMauro Carvalho Chehab break;
464*c1024049SMauro Carvalho Chehab }
465*c1024049SMauro Carvalho Chehab
466*c1024049SMauro Carvalho Chehab cfg |= (scaler->main_h_ratio & 0x1ff) << 16;
467*c1024049SMauro Carvalho Chehab cfg |= scaler->main_v_ratio & 0x1ff;
468*c1024049SMauro Carvalho Chehab
469*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CISCCTRL(vp->id, vp->offset), cfg);
470*c1024049SMauro Carvalho Chehab
471*c1024049SMauro Carvalho Chehab pr_debug("main: h_ratio: %#x, v_ratio: %#x",
472*c1024049SMauro Carvalho Chehab scaler->main_h_ratio, scaler->main_v_ratio);
473*c1024049SMauro Carvalho Chehab }
474*c1024049SMauro Carvalho Chehab
camif_hw_set_scaler(struct camif_vp * vp)475*c1024049SMauro Carvalho Chehab void camif_hw_set_scaler(struct camif_vp *vp)
476*c1024049SMauro Carvalho Chehab {
477*c1024049SMauro Carvalho Chehab unsigned int ip_rev = vp->camif->variant->ip_revision;
478*c1024049SMauro Carvalho Chehab
479*c1024049SMauro Carvalho Chehab if (ip_rev == S3C244X_CAMIF_IP_REV)
480*c1024049SMauro Carvalho Chehab camif_s3c244x_hw_set_scaler(vp);
481*c1024049SMauro Carvalho Chehab else
482*c1024049SMauro Carvalho Chehab camif_s3c64xx_hw_set_scaler(vp);
483*c1024049SMauro Carvalho Chehab }
484*c1024049SMauro Carvalho Chehab
camif_hw_enable_scaler(struct camif_vp * vp,bool on)485*c1024049SMauro Carvalho Chehab void camif_hw_enable_scaler(struct camif_vp *vp, bool on)
486*c1024049SMauro Carvalho Chehab {
487*c1024049SMauro Carvalho Chehab u32 addr = S3C_CAMIF_REG_CISCCTRL(vp->id, vp->offset);
488*c1024049SMauro Carvalho Chehab u32 cfg;
489*c1024049SMauro Carvalho Chehab
490*c1024049SMauro Carvalho Chehab cfg = camif_read(vp->camif, addr);
491*c1024049SMauro Carvalho Chehab if (on)
492*c1024049SMauro Carvalho Chehab cfg |= CISCCTRL_SCALERSTART;
493*c1024049SMauro Carvalho Chehab else
494*c1024049SMauro Carvalho Chehab cfg &= ~CISCCTRL_SCALERSTART;
495*c1024049SMauro Carvalho Chehab camif_write(vp->camif, addr, cfg);
496*c1024049SMauro Carvalho Chehab }
497*c1024049SMauro Carvalho Chehab
camif_hw_set_lastirq(struct camif_vp * vp,int enable)498*c1024049SMauro Carvalho Chehab void camif_hw_set_lastirq(struct camif_vp *vp, int enable)
499*c1024049SMauro Carvalho Chehab {
500*c1024049SMauro Carvalho Chehab u32 addr = S3C_CAMIF_REG_CICTRL(vp->id, vp->offset);
501*c1024049SMauro Carvalho Chehab u32 cfg;
502*c1024049SMauro Carvalho Chehab
503*c1024049SMauro Carvalho Chehab cfg = camif_read(vp->camif, addr);
504*c1024049SMauro Carvalho Chehab if (enable)
505*c1024049SMauro Carvalho Chehab cfg |= CICTRL_LASTIRQ_ENABLE;
506*c1024049SMauro Carvalho Chehab else
507*c1024049SMauro Carvalho Chehab cfg &= ~CICTRL_LASTIRQ_ENABLE;
508*c1024049SMauro Carvalho Chehab camif_write(vp->camif, addr, cfg);
509*c1024049SMauro Carvalho Chehab }
510*c1024049SMauro Carvalho Chehab
camif_hw_enable_capture(struct camif_vp * vp)511*c1024049SMauro Carvalho Chehab void camif_hw_enable_capture(struct camif_vp *vp)
512*c1024049SMauro Carvalho Chehab {
513*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
514*c1024049SMauro Carvalho Chehab u32 cfg;
515*c1024049SMauro Carvalho Chehab
516*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIIMGCPT(vp->offset));
517*c1024049SMauro Carvalho Chehab camif->stream_count++;
518*c1024049SMauro Carvalho Chehab
519*c1024049SMauro Carvalho Chehab if (camif->variant->ip_revision == S3C6410_CAMIF_IP_REV)
520*c1024049SMauro Carvalho Chehab cfg |= CIIMGCPT_CPT_FREN_ENABLE(vp->id);
521*c1024049SMauro Carvalho Chehab
522*c1024049SMauro Carvalho Chehab if (vp->scaler.enable)
523*c1024049SMauro Carvalho Chehab cfg |= CIIMGCPT_IMGCPTEN_SC(vp->id);
524*c1024049SMauro Carvalho Chehab
525*c1024049SMauro Carvalho Chehab if (camif->stream_count == 1)
526*c1024049SMauro Carvalho Chehab cfg |= CIIMGCPT_IMGCPTEN;
527*c1024049SMauro Carvalho Chehab
528*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIIMGCPT(vp->offset), cfg);
529*c1024049SMauro Carvalho Chehab
530*c1024049SMauro Carvalho Chehab pr_debug("CIIMGCPT: %#x, camif->stream_count: %d\n",
531*c1024049SMauro Carvalho Chehab cfg, camif->stream_count);
532*c1024049SMauro Carvalho Chehab }
533*c1024049SMauro Carvalho Chehab
camif_hw_disable_capture(struct camif_vp * vp)534*c1024049SMauro Carvalho Chehab void camif_hw_disable_capture(struct camif_vp *vp)
535*c1024049SMauro Carvalho Chehab {
536*c1024049SMauro Carvalho Chehab struct camif_dev *camif = vp->camif;
537*c1024049SMauro Carvalho Chehab u32 cfg;
538*c1024049SMauro Carvalho Chehab
539*c1024049SMauro Carvalho Chehab cfg = camif_read(camif, S3C_CAMIF_REG_CIIMGCPT(vp->offset));
540*c1024049SMauro Carvalho Chehab cfg &= ~CIIMGCPT_IMGCPTEN_SC(vp->id);
541*c1024049SMauro Carvalho Chehab
542*c1024049SMauro Carvalho Chehab if (WARN_ON(--(camif->stream_count) < 0))
543*c1024049SMauro Carvalho Chehab camif->stream_count = 0;
544*c1024049SMauro Carvalho Chehab
545*c1024049SMauro Carvalho Chehab if (camif->stream_count == 0)
546*c1024049SMauro Carvalho Chehab cfg &= ~CIIMGCPT_IMGCPTEN;
547*c1024049SMauro Carvalho Chehab
548*c1024049SMauro Carvalho Chehab pr_debug("CIIMGCPT: %#x, camif->stream_count: %d\n",
549*c1024049SMauro Carvalho Chehab cfg, camif->stream_count);
550*c1024049SMauro Carvalho Chehab
551*c1024049SMauro Carvalho Chehab camif_write(camif, S3C_CAMIF_REG_CIIMGCPT(vp->offset), cfg);
552*c1024049SMauro Carvalho Chehab }
553*c1024049SMauro Carvalho Chehab
camif_hw_dump_regs(struct camif_dev * camif,const char * label)554*c1024049SMauro Carvalho Chehab void camif_hw_dump_regs(struct camif_dev *camif, const char *label)
555*c1024049SMauro Carvalho Chehab {
556*c1024049SMauro Carvalho Chehab static const struct {
557*c1024049SMauro Carvalho Chehab u32 offset;
558*c1024049SMauro Carvalho Chehab const char * const name;
559*c1024049SMauro Carvalho Chehab } registers[] = {
560*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISRCFMT, "CISRCFMT" },
561*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIWDOFST, "CIWDOFST" },
562*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIGCTRL, "CIGCTRL" },
563*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIWDOFST2, "CIWDOFST2" },
564*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(0, 0), "CICOYSA0" },
565*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICBSA(0, 0), "CICOCBSA0" },
566*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICRSA(0, 0), "CICOCRSA0" },
567*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(0, 1), "CICOYSA1" },
568*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICBSA(0, 1), "CICOCBSA1" },
569*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICRSA(0, 1), "CICOCRSA1" },
570*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(0, 2), "CICOYSA2" },
571*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICBSA(0, 2), "CICOCBSA2" },
572*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICRSA(0, 2), "CICOCRSA2" },
573*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(0, 3), "CICOYSA3" },
574*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICBSA(0, 3), "CICOCBSA3" },
575*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICRSA(0, 3), "CICOCRSA3" },
576*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(1, 0), "CIPRYSA0" },
577*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(1, 1), "CIPRYSA1" },
578*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(1, 2), "CIPRYSA2" },
579*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIYSA(1, 3), "CIPRYSA3" },
580*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CITRGFMT(0, 0), "CICOTRGFMT" },
581*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CITRGFMT(1, 0), "CIPRTRGFMT" },
582*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICTRL(0, 0), "CICOCTRL" },
583*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CICTRL(1, 0), "CIPRCTRL" },
584*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCPREDST(0, 0), "CICOSCPREDST" },
585*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCPREDST(1, 0), "CIPRSCPREDST" },
586*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCPRERATIO(0, 0), "CICOSCPRERATIO" },
587*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCPRERATIO(1, 0), "CIPRSCPRERATIO" },
588*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCCTRL(0, 0), "CICOSCCTRL" },
589*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISCCTRL(1, 0), "CIPRSCCTRL" },
590*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CITAREA(0, 0), "CICOTAREA" },
591*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CITAREA(1, 0), "CIPRTAREA" },
592*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISTATUS(0, 0), "CICOSTATUS" },
593*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CISTATUS(1, 0), "CIPRSTATUS" },
594*c1024049SMauro Carvalho Chehab { S3C_CAMIF_REG_CIIMGCPT(0), "CIIMGCPT" },
595*c1024049SMauro Carvalho Chehab };
596*c1024049SMauro Carvalho Chehab u32 i;
597*c1024049SMauro Carvalho Chehab
598*c1024049SMauro Carvalho Chehab pr_info("--- %s ---\n", label);
599*c1024049SMauro Carvalho Chehab for (i = 0; i < ARRAY_SIZE(registers); i++) {
600*c1024049SMauro Carvalho Chehab u32 cfg = readl(camif->io_base + registers[i].offset);
601*c1024049SMauro Carvalho Chehab dev_info(camif->dev, "%s:\t0x%08x\n", registers[i].name, cfg);
602*c1024049SMauro Carvalho Chehab }
603*c1024049SMauro Carvalho Chehab }
604