Loading...
1/*
2 * isppreview.c
3 *
4 * TI OMAP3 ISP driver - Preview module
5 *
6 * Copyright (C) 2010 Nokia Corporation
7 * Copyright (C) 2009 Texas Instruments, Inc.
8 *
9 * Contacts: Laurent Pinchart <laurent.pinchart@ideasonboard.com>
10 * Sakari Ailus <sakari.ailus@iki.fi>
11 *
12 * This program is free software; you can redistribute it and/or modify
13 * it under the terms of the GNU General Public License version 2 as
14 * published by the Free Software Foundation.
15 *
16 * This program is distributed in the hope that it will be useful, but
17 * WITHOUT ANY WARRANTY; without even the implied warranty of
18 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
19 * General Public License for more details.
20 *
21 * You should have received a copy of the GNU General Public License
22 * along with this program; if not, write to the Free Software
23 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
24 * 02110-1301 USA
25 */
26
27#include <linux/device.h>
28#include <linux/mm.h>
29#include <linux/module.h>
30#include <linux/mutex.h>
31#include <linux/uaccess.h>
32
33#include "isp.h"
34#include "ispreg.h"
35#include "isppreview.h"
36
37/* Default values in Office Fluorescent Light for RGBtoRGB Blending */
38static struct omap3isp_prev_rgbtorgb flr_rgb2rgb = {
39 { /* RGB-RGB Matrix */
40 {0x01E2, 0x0F30, 0x0FEE},
41 {0x0F9B, 0x01AC, 0x0FB9},
42 {0x0FE0, 0x0EC0, 0x0260}
43 }, /* RGB Offset */
44 {0x0000, 0x0000, 0x0000}
45};
46
47/* Default values in Office Fluorescent Light for RGB to YUV Conversion*/
48static struct omap3isp_prev_csc flr_prev_csc = {
49 { /* CSC Coef Matrix */
50 {66, 129, 25},
51 {-38, -75, 112},
52 {112, -94 , -18}
53 }, /* CSC Offset */
54 {0x0, 0x0, 0x0}
55};
56
57/* Default values in Office Fluorescent Light for CFA Gradient*/
58#define FLR_CFA_GRADTHRS_HORZ 0x28
59#define FLR_CFA_GRADTHRS_VERT 0x28
60
61/* Default values in Office Fluorescent Light for Chroma Suppression*/
62#define FLR_CSUP_GAIN 0x0D
63#define FLR_CSUP_THRES 0xEB
64
65/* Default values in Office Fluorescent Light for Noise Filter*/
66#define FLR_NF_STRGTH 0x03
67
68/* Default values for White Balance */
69#define FLR_WBAL_DGAIN 0x100
70#define FLR_WBAL_COEF 0x20
71
72/* Default values in Office Fluorescent Light for Black Adjustment*/
73#define FLR_BLKADJ_BLUE 0x0
74#define FLR_BLKADJ_GREEN 0x0
75#define FLR_BLKADJ_RED 0x0
76
77#define DEF_DETECT_CORRECT_VAL 0xe
78
79/*
80 * Margins and image size limits.
81 *
82 * The preview engine crops several rows and columns internally depending on
83 * which filters are enabled. To avoid format changes when the filters are
84 * enabled or disabled (which would prevent them from being turned on or off
85 * during streaming), the driver assumes all the filters are enabled when
86 * computing sink crop and source format limits.
87 *
88 * If a filter is disabled, additional cropping is automatically added at the
89 * preview engine input by the driver to avoid overflow at line and frame end.
90 * This is completely transparent for applications.
91 *
92 * Median filter 4 pixels
93 * Noise filter,
94 * Faulty pixels correction 4 pixels, 4 lines
95 * CFA filter 4 pixels, 4 lines in Bayer mode
96 * 2 lines in other modes
97 * Color suppression 2 pixels
98 * or luma enhancement
99 * -------------------------------------------------------------
100 * Maximum total 14 pixels, 8 lines
101 *
102 * The color suppression and luma enhancement filters are applied after bayer to
103 * YUV conversion. They thus can crop one pixel on the left and one pixel on the
104 * right side of the image without changing the color pattern. When both those
105 * filters are disabled, the driver must crop the two pixels on the same side of
106 * the image to avoid changing the bayer pattern. The left margin is thus set to
107 * 8 pixels and the right margin to 6 pixels.
108 */
109
110#define PREV_MARGIN_LEFT 8
111#define PREV_MARGIN_RIGHT 6
112#define PREV_MARGIN_TOP 4
113#define PREV_MARGIN_BOTTOM 4
114
115#define PREV_MIN_IN_WIDTH 64
116#define PREV_MIN_IN_HEIGHT 8
117#define PREV_MAX_IN_HEIGHT 16384
118
119#define PREV_MIN_OUT_WIDTH 0
120#define PREV_MIN_OUT_HEIGHT 0
121#define PREV_MAX_OUT_WIDTH_REV_1 1280
122#define PREV_MAX_OUT_WIDTH_REV_2 3300
123#define PREV_MAX_OUT_WIDTH_REV_15 4096
124
125/*
126 * Coeficient Tables for the submodules in Preview.
127 * Array is initialised with the values from.the tables text file.
128 */
129
130/*
131 * CFA Filter Coefficient Table
132 *
133 */
134static u32 cfa_coef_table[] = {
135#include "cfa_coef_table.h"
136};
137
138/*
139 * Default Gamma Correction Table - All components
140 */
141static u32 gamma_table[] = {
142#include "gamma_table.h"
143};
144
145/*
146 * Noise Filter Threshold table
147 */
148static u32 noise_filter_table[] = {
149#include "noise_filter_table.h"
150};
151
152/*
153 * Luminance Enhancement Table
154 */
155static u32 luma_enhance_table[] = {
156#include "luma_enhance_table.h"
157};
158
159/*
160 * preview_enable_invalaw - Enable/Disable Inverse A-Law module in Preview.
161 * @enable: 1 - Reverse the A-Law done in CCDC.
162 */
163static void
164preview_enable_invalaw(struct isp_prev_device *prev, u8 enable)
165{
166 struct isp_device *isp = to_isp_device(prev);
167
168 if (enable)
169 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
170 ISPPRV_PCR_WIDTH | ISPPRV_PCR_INVALAW);
171 else
172 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
173 ISPPRV_PCR_WIDTH | ISPPRV_PCR_INVALAW);
174}
175
176/*
177 * preview_enable_drkframe_capture - Enable/Disable of the darkframe capture.
178 * @prev -
179 * @enable: 1 - Enable, 0 - Disable
180 *
181 * NOTE: PRV_WSDR_ADDR and PRV_WADD_OFFSET must be set also
182 * The process is applied for each captured frame.
183 */
184static void
185preview_enable_drkframe_capture(struct isp_prev_device *prev, u8 enable)
186{
187 struct isp_device *isp = to_isp_device(prev);
188
189 if (enable)
190 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
191 ISPPRV_PCR_DRKFCAP);
192 else
193 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
194 ISPPRV_PCR_DRKFCAP);
195}
196
197/*
198 * preview_enable_drkframe - Enable/Disable of the darkframe subtract.
199 * @enable: 1 - Acquires memory bandwidth since the pixels in each frame is
200 * subtracted with the pixels in the current frame.
201 *
202 * The process is applied for each captured frame.
203 */
204static void
205preview_enable_drkframe(struct isp_prev_device *prev, u8 enable)
206{
207 struct isp_device *isp = to_isp_device(prev);
208
209 if (enable)
210 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
211 ISPPRV_PCR_DRKFEN);
212 else
213 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
214 ISPPRV_PCR_DRKFEN);
215}
216
217/*
218 * preview_config_drkf_shadcomp - Configures shift value in shading comp.
219 * @scomp_shtval: 3bit value of shift used in shading compensation.
220 */
221static void
222preview_config_drkf_shadcomp(struct isp_prev_device *prev,
223 const void *scomp_shtval)
224{
225 struct isp_device *isp = to_isp_device(prev);
226 const u32 *shtval = scomp_shtval;
227
228 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
229 ISPPRV_PCR_SCOMP_SFT_MASK,
230 *shtval << ISPPRV_PCR_SCOMP_SFT_SHIFT);
231}
232
233/*
234 * preview_enable_hmed - Enables/Disables of the Horizontal Median Filter.
235 * @enable: 1 - Enables Horizontal Median Filter.
236 */
237static void
238preview_enable_hmed(struct isp_prev_device *prev, u8 enable)
239{
240 struct isp_device *isp = to_isp_device(prev);
241
242 if (enable)
243 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
244 ISPPRV_PCR_HMEDEN);
245 else
246 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
247 ISPPRV_PCR_HMEDEN);
248}
249
250/*
251 * preview_config_hmed - Configures the Horizontal Median Filter.
252 * @prev_hmed: Structure containing the odd and even distance between the
253 * pixels in the image along with the filter threshold.
254 */
255static void
256preview_config_hmed(struct isp_prev_device *prev, const void *prev_hmed)
257{
258 struct isp_device *isp = to_isp_device(prev);
259 const struct omap3isp_prev_hmed *hmed = prev_hmed;
260
261 isp_reg_writel(isp, (hmed->odddist == 1 ? 0 : ISPPRV_HMED_ODDDIST) |
262 (hmed->evendist == 1 ? 0 : ISPPRV_HMED_EVENDIST) |
263 (hmed->thres << ISPPRV_HMED_THRESHOLD_SHIFT),
264 OMAP3_ISP_IOMEM_PREV, ISPPRV_HMED);
265}
266
267/*
268 * preview_config_noisefilter - Configures the Noise Filter.
269 * @prev_nf: Structure containing the noisefilter table, strength to be used
270 * for the noise filter and the defect correction enable flag.
271 */
272static void
273preview_config_noisefilter(struct isp_prev_device *prev, const void *prev_nf)
274{
275 struct isp_device *isp = to_isp_device(prev);
276 const struct omap3isp_prev_nf *nf = prev_nf;
277 unsigned int i;
278
279 isp_reg_writel(isp, nf->spread, OMAP3_ISP_IOMEM_PREV, ISPPRV_NF);
280 isp_reg_writel(isp, ISPPRV_NF_TABLE_ADDR,
281 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
282 for (i = 0; i < OMAP3ISP_PREV_NF_TBL_SIZE; i++) {
283 isp_reg_writel(isp, nf->table[i],
284 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_DATA);
285 }
286}
287
288/*
289 * preview_config_dcor - Configures the defect correction
290 * @prev_dcor: Structure containing the defect correct thresholds
291 */
292static void
293preview_config_dcor(struct isp_prev_device *prev, const void *prev_dcor)
294{
295 struct isp_device *isp = to_isp_device(prev);
296 const struct omap3isp_prev_dcor *dcor = prev_dcor;
297
298 isp_reg_writel(isp, dcor->detect_correct[0],
299 OMAP3_ISP_IOMEM_PREV, ISPPRV_CDC_THR0);
300 isp_reg_writel(isp, dcor->detect_correct[1],
301 OMAP3_ISP_IOMEM_PREV, ISPPRV_CDC_THR1);
302 isp_reg_writel(isp, dcor->detect_correct[2],
303 OMAP3_ISP_IOMEM_PREV, ISPPRV_CDC_THR2);
304 isp_reg_writel(isp, dcor->detect_correct[3],
305 OMAP3_ISP_IOMEM_PREV, ISPPRV_CDC_THR3);
306 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
307 ISPPRV_PCR_DCCOUP,
308 dcor->couplet_mode_en ? ISPPRV_PCR_DCCOUP : 0);
309}
310
311/*
312 * preview_config_cfa - Configures the CFA Interpolation parameters.
313 * @prev_cfa: Structure containing the CFA interpolation table, CFA format
314 * in the image, vertical and horizontal gradient threshold.
315 */
316static void
317preview_config_cfa(struct isp_prev_device *prev, const void *prev_cfa)
318{
319 struct isp_device *isp = to_isp_device(prev);
320 const struct omap3isp_prev_cfa *cfa = prev_cfa;
321 unsigned int i;
322
323 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
324 ISPPRV_PCR_CFAFMT_MASK,
325 cfa->format << ISPPRV_PCR_CFAFMT_SHIFT);
326
327 isp_reg_writel(isp,
328 (cfa->gradthrs_vert << ISPPRV_CFA_GRADTH_VER_SHIFT) |
329 (cfa->gradthrs_horz << ISPPRV_CFA_GRADTH_HOR_SHIFT),
330 OMAP3_ISP_IOMEM_PREV, ISPPRV_CFA);
331
332 isp_reg_writel(isp, ISPPRV_CFA_TABLE_ADDR,
333 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
334
335 for (i = 0; i < OMAP3ISP_PREV_CFA_TBL_SIZE; i++) {
336 isp_reg_writel(isp, cfa->table[i],
337 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_DATA);
338 }
339}
340
341/*
342 * preview_config_gammacorrn - Configures the Gamma Correction table values
343 * @gtable: Structure containing the table for red, blue, green gamma table.
344 */
345static void
346preview_config_gammacorrn(struct isp_prev_device *prev, const void *gtable)
347{
348 struct isp_device *isp = to_isp_device(prev);
349 const struct omap3isp_prev_gtables *gt = gtable;
350 unsigned int i;
351
352 isp_reg_writel(isp, ISPPRV_REDGAMMA_TABLE_ADDR,
353 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
354 for (i = 0; i < OMAP3ISP_PREV_GAMMA_TBL_SIZE; i++)
355 isp_reg_writel(isp, gt->red[i], OMAP3_ISP_IOMEM_PREV,
356 ISPPRV_SET_TBL_DATA);
357
358 isp_reg_writel(isp, ISPPRV_GREENGAMMA_TABLE_ADDR,
359 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
360 for (i = 0; i < OMAP3ISP_PREV_GAMMA_TBL_SIZE; i++)
361 isp_reg_writel(isp, gt->green[i], OMAP3_ISP_IOMEM_PREV,
362 ISPPRV_SET_TBL_DATA);
363
364 isp_reg_writel(isp, ISPPRV_BLUEGAMMA_TABLE_ADDR,
365 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
366 for (i = 0; i < OMAP3ISP_PREV_GAMMA_TBL_SIZE; i++)
367 isp_reg_writel(isp, gt->blue[i], OMAP3_ISP_IOMEM_PREV,
368 ISPPRV_SET_TBL_DATA);
369}
370
371/*
372 * preview_config_luma_enhancement - Sets the Luminance Enhancement table.
373 * @ytable: Structure containing the table for Luminance Enhancement table.
374 */
375static void
376preview_config_luma_enhancement(struct isp_prev_device *prev,
377 const void *ytable)
378{
379 struct isp_device *isp = to_isp_device(prev);
380 const struct omap3isp_prev_luma *yt = ytable;
381 unsigned int i;
382
383 isp_reg_writel(isp, ISPPRV_YENH_TABLE_ADDR,
384 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_ADDR);
385 for (i = 0; i < OMAP3ISP_PREV_YENH_TBL_SIZE; i++) {
386 isp_reg_writel(isp, yt->table[i],
387 OMAP3_ISP_IOMEM_PREV, ISPPRV_SET_TBL_DATA);
388 }
389}
390
391/*
392 * preview_config_chroma_suppression - Configures the Chroma Suppression.
393 * @csup: Structure containing the threshold value for suppression
394 * and the hypass filter enable flag.
395 */
396static void
397preview_config_chroma_suppression(struct isp_prev_device *prev,
398 const void *csup)
399{
400 struct isp_device *isp = to_isp_device(prev);
401 const struct omap3isp_prev_csup *cs = csup;
402
403 isp_reg_writel(isp,
404 cs->gain | (cs->thres << ISPPRV_CSUP_THRES_SHIFT) |
405 (cs->hypf_en << ISPPRV_CSUP_HPYF_SHIFT),
406 OMAP3_ISP_IOMEM_PREV, ISPPRV_CSUP);
407}
408
409/*
410 * preview_enable_noisefilter - Enables/Disables the Noise Filter.
411 * @enable: 1 - Enables the Noise Filter.
412 */
413static void
414preview_enable_noisefilter(struct isp_prev_device *prev, u8 enable)
415{
416 struct isp_device *isp = to_isp_device(prev);
417
418 if (enable)
419 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
420 ISPPRV_PCR_NFEN);
421 else
422 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
423 ISPPRV_PCR_NFEN);
424}
425
426/*
427 * preview_enable_dcor - Enables/Disables the defect correction.
428 * @enable: 1 - Enables the defect correction.
429 */
430static void
431preview_enable_dcor(struct isp_prev_device *prev, u8 enable)
432{
433 struct isp_device *isp = to_isp_device(prev);
434
435 if (enable)
436 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
437 ISPPRV_PCR_DCOREN);
438 else
439 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
440 ISPPRV_PCR_DCOREN);
441}
442
443/*
444 * preview_enable_gammabypass - Enables/Disables the GammaByPass
445 * @enable: 1 - Bypasses Gamma - 10bit input is cropped to 8MSB.
446 * 0 - Goes through Gamma Correction. input and output is 10bit.
447 */
448static void
449preview_enable_gammabypass(struct isp_prev_device *prev, u8 enable)
450{
451 struct isp_device *isp = to_isp_device(prev);
452
453 if (enable)
454 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
455 ISPPRV_PCR_GAMMA_BYPASS);
456 else
457 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
458 ISPPRV_PCR_GAMMA_BYPASS);
459}
460
461/*
462 * preview_enable_luma_enhancement - Enables/Disables Luminance Enhancement
463 * @enable: 1 - Enable the Luminance Enhancement.
464 */
465static void
466preview_enable_luma_enhancement(struct isp_prev_device *prev, u8 enable)
467{
468 struct isp_device *isp = to_isp_device(prev);
469
470 if (enable)
471 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
472 ISPPRV_PCR_YNENHEN);
473 else
474 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
475 ISPPRV_PCR_YNENHEN);
476}
477
478/*
479 * preview_enable_chroma_suppression - Enables/Disables Chrominance Suppr.
480 * @enable: 1 - Enable the Chrominance Suppression.
481 */
482static void
483preview_enable_chroma_suppression(struct isp_prev_device *prev, u8 enable)
484{
485 struct isp_device *isp = to_isp_device(prev);
486
487 if (enable)
488 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
489 ISPPRV_PCR_SUPEN);
490 else
491 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
492 ISPPRV_PCR_SUPEN);
493}
494
495/*
496 * preview_config_whitebalance - Configures the White Balance parameters.
497 * @prev_wbal: Structure containing the digital gain and white balance
498 * coefficient.
499 *
500 * Coefficient matrix always with default values.
501 */
502static void
503preview_config_whitebalance(struct isp_prev_device *prev, const void *prev_wbal)
504{
505 struct isp_device *isp = to_isp_device(prev);
506 const struct omap3isp_prev_wbal *wbal = prev_wbal;
507 u32 val;
508
509 isp_reg_writel(isp, wbal->dgain, OMAP3_ISP_IOMEM_PREV, ISPPRV_WB_DGAIN);
510
511 val = wbal->coef0 << ISPPRV_WBGAIN_COEF0_SHIFT;
512 val |= wbal->coef1 << ISPPRV_WBGAIN_COEF1_SHIFT;
513 val |= wbal->coef2 << ISPPRV_WBGAIN_COEF2_SHIFT;
514 val |= wbal->coef3 << ISPPRV_WBGAIN_COEF3_SHIFT;
515 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_WBGAIN);
516
517 isp_reg_writel(isp,
518 ISPPRV_WBSEL_COEF0 << ISPPRV_WBSEL_N0_0_SHIFT |
519 ISPPRV_WBSEL_COEF1 << ISPPRV_WBSEL_N0_1_SHIFT |
520 ISPPRV_WBSEL_COEF0 << ISPPRV_WBSEL_N0_2_SHIFT |
521 ISPPRV_WBSEL_COEF1 << ISPPRV_WBSEL_N0_3_SHIFT |
522 ISPPRV_WBSEL_COEF2 << ISPPRV_WBSEL_N1_0_SHIFT |
523 ISPPRV_WBSEL_COEF3 << ISPPRV_WBSEL_N1_1_SHIFT |
524 ISPPRV_WBSEL_COEF2 << ISPPRV_WBSEL_N1_2_SHIFT |
525 ISPPRV_WBSEL_COEF3 << ISPPRV_WBSEL_N1_3_SHIFT |
526 ISPPRV_WBSEL_COEF0 << ISPPRV_WBSEL_N2_0_SHIFT |
527 ISPPRV_WBSEL_COEF1 << ISPPRV_WBSEL_N2_1_SHIFT |
528 ISPPRV_WBSEL_COEF0 << ISPPRV_WBSEL_N2_2_SHIFT |
529 ISPPRV_WBSEL_COEF1 << ISPPRV_WBSEL_N2_3_SHIFT |
530 ISPPRV_WBSEL_COEF2 << ISPPRV_WBSEL_N3_0_SHIFT |
531 ISPPRV_WBSEL_COEF3 << ISPPRV_WBSEL_N3_1_SHIFT |
532 ISPPRV_WBSEL_COEF2 << ISPPRV_WBSEL_N3_2_SHIFT |
533 ISPPRV_WBSEL_COEF3 << ISPPRV_WBSEL_N3_3_SHIFT,
534 OMAP3_ISP_IOMEM_PREV, ISPPRV_WBSEL);
535}
536
537/*
538 * preview_config_blkadj - Configures the Black Adjustment parameters.
539 * @prev_blkadj: Structure containing the black adjustment towards red, green,
540 * blue.
541 */
542static void
543preview_config_blkadj(struct isp_prev_device *prev, const void *prev_blkadj)
544{
545 struct isp_device *isp = to_isp_device(prev);
546 const struct omap3isp_prev_blkadj *blkadj = prev_blkadj;
547
548 isp_reg_writel(isp, (blkadj->blue << ISPPRV_BLKADJOFF_B_SHIFT) |
549 (blkadj->green << ISPPRV_BLKADJOFF_G_SHIFT) |
550 (blkadj->red << ISPPRV_BLKADJOFF_R_SHIFT),
551 OMAP3_ISP_IOMEM_PREV, ISPPRV_BLKADJOFF);
552}
553
554/*
555 * preview_config_rgb_blending - Configures the RGB-RGB Blending matrix.
556 * @rgb2rgb: Structure containing the rgb to rgb blending matrix and the rgb
557 * offset.
558 */
559static void
560preview_config_rgb_blending(struct isp_prev_device *prev, const void *rgb2rgb)
561{
562 struct isp_device *isp = to_isp_device(prev);
563 const struct omap3isp_prev_rgbtorgb *rgbrgb = rgb2rgb;
564 u32 val;
565
566 val = (rgbrgb->matrix[0][0] & 0xfff) << ISPPRV_RGB_MAT1_MTX_RR_SHIFT;
567 val |= (rgbrgb->matrix[0][1] & 0xfff) << ISPPRV_RGB_MAT1_MTX_GR_SHIFT;
568 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_MAT1);
569
570 val = (rgbrgb->matrix[0][2] & 0xfff) << ISPPRV_RGB_MAT2_MTX_BR_SHIFT;
571 val |= (rgbrgb->matrix[1][0] & 0xfff) << ISPPRV_RGB_MAT2_MTX_RG_SHIFT;
572 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_MAT2);
573
574 val = (rgbrgb->matrix[1][1] & 0xfff) << ISPPRV_RGB_MAT3_MTX_GG_SHIFT;
575 val |= (rgbrgb->matrix[1][2] & 0xfff) << ISPPRV_RGB_MAT3_MTX_BG_SHIFT;
576 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_MAT3);
577
578 val = (rgbrgb->matrix[2][0] & 0xfff) << ISPPRV_RGB_MAT4_MTX_RB_SHIFT;
579 val |= (rgbrgb->matrix[2][1] & 0xfff) << ISPPRV_RGB_MAT4_MTX_GB_SHIFT;
580 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_MAT4);
581
582 val = (rgbrgb->matrix[2][2] & 0xfff) << ISPPRV_RGB_MAT5_MTX_BB_SHIFT;
583 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_MAT5);
584
585 val = (rgbrgb->offset[0] & 0x3ff) << ISPPRV_RGB_OFF1_MTX_OFFR_SHIFT;
586 val |= (rgbrgb->offset[1] & 0x3ff) << ISPPRV_RGB_OFF1_MTX_OFFG_SHIFT;
587 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_OFF1);
588
589 val = (rgbrgb->offset[2] & 0x3ff) << ISPPRV_RGB_OFF2_MTX_OFFB_SHIFT;
590 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_RGB_OFF2);
591}
592
593/*
594 * Configures the color space conversion (RGB toYCbYCr) matrix
595 * @prev_csc: Structure containing the RGB to YCbYCr matrix and the
596 * YCbCr offset.
597 */
598static void
599preview_config_csc(struct isp_prev_device *prev, const void *prev_csc)
600{
601 struct isp_device *isp = to_isp_device(prev);
602 const struct omap3isp_prev_csc *csc = prev_csc;
603 u32 val;
604
605 val = (csc->matrix[0][0] & 0x3ff) << ISPPRV_CSC0_RY_SHIFT;
606 val |= (csc->matrix[0][1] & 0x3ff) << ISPPRV_CSC0_GY_SHIFT;
607 val |= (csc->matrix[0][2] & 0x3ff) << ISPPRV_CSC0_BY_SHIFT;
608 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_CSC0);
609
610 val = (csc->matrix[1][0] & 0x3ff) << ISPPRV_CSC1_RCB_SHIFT;
611 val |= (csc->matrix[1][1] & 0x3ff) << ISPPRV_CSC1_GCB_SHIFT;
612 val |= (csc->matrix[1][2] & 0x3ff) << ISPPRV_CSC1_BCB_SHIFT;
613 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_CSC1);
614
615 val = (csc->matrix[2][0] & 0x3ff) << ISPPRV_CSC2_RCR_SHIFT;
616 val |= (csc->matrix[2][1] & 0x3ff) << ISPPRV_CSC2_GCR_SHIFT;
617 val |= (csc->matrix[2][2] & 0x3ff) << ISPPRV_CSC2_BCR_SHIFT;
618 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_CSC2);
619
620 val = (csc->offset[0] & 0xff) << ISPPRV_CSC_OFFSET_Y_SHIFT;
621 val |= (csc->offset[1] & 0xff) << ISPPRV_CSC_OFFSET_CB_SHIFT;
622 val |= (csc->offset[2] & 0xff) << ISPPRV_CSC_OFFSET_CR_SHIFT;
623 isp_reg_writel(isp, val, OMAP3_ISP_IOMEM_PREV, ISPPRV_CSC_OFFSET);
624}
625
626/*
627 * preview_update_contrast - Updates the contrast.
628 * @contrast: Pointer to hold the current programmed contrast value.
629 *
630 * Value should be programmed before enabling the module.
631 */
632static void
633preview_update_contrast(struct isp_prev_device *prev, u8 contrast)
634{
635 struct prev_params *params;
636 unsigned long flags;
637
638 spin_lock_irqsave(&prev->params.lock, flags);
639 params = (prev->params.active & OMAP3ISP_PREV_CONTRAST)
640 ? &prev->params.params[0] : &prev->params.params[1];
641
642 if (params->contrast != (contrast * ISPPRV_CONTRAST_UNITS)) {
643 params->contrast = contrast * ISPPRV_CONTRAST_UNITS;
644 params->update |= OMAP3ISP_PREV_CONTRAST;
645 }
646 spin_unlock_irqrestore(&prev->params.lock, flags);
647}
648
649/*
650 * preview_config_contrast - Configures the Contrast.
651 * @params: Contrast value (u8 pointer, U8Q0 format).
652 *
653 * Value should be programmed before enabling the module.
654 */
655static void
656preview_config_contrast(struct isp_prev_device *prev, const void *params)
657{
658 struct isp_device *isp = to_isp_device(prev);
659
660 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_CNT_BRT,
661 0xff << ISPPRV_CNT_BRT_CNT_SHIFT,
662 *(u8 *)params << ISPPRV_CNT_BRT_CNT_SHIFT);
663}
664
665/*
666 * preview_update_brightness - Updates the brightness in preview module.
667 * @brightness: Pointer to hold the current programmed brightness value.
668 *
669 */
670static void
671preview_update_brightness(struct isp_prev_device *prev, u8 brightness)
672{
673 struct prev_params *params;
674 unsigned long flags;
675
676 spin_lock_irqsave(&prev->params.lock, flags);
677 params = (prev->params.active & OMAP3ISP_PREV_BRIGHTNESS)
678 ? &prev->params.params[0] : &prev->params.params[1];
679
680 if (params->brightness != (brightness * ISPPRV_BRIGHT_UNITS)) {
681 params->brightness = brightness * ISPPRV_BRIGHT_UNITS;
682 params->update |= OMAP3ISP_PREV_BRIGHTNESS;
683 }
684 spin_unlock_irqrestore(&prev->params.lock, flags);
685}
686
687/*
688 * preview_config_brightness - Configures the brightness.
689 * @params: Brightness value (u8 pointer, U8Q0 format).
690 */
691static void
692preview_config_brightness(struct isp_prev_device *prev, const void *params)
693{
694 struct isp_device *isp = to_isp_device(prev);
695
696 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_CNT_BRT,
697 0xff << ISPPRV_CNT_BRT_BRT_SHIFT,
698 *(u8 *)params << ISPPRV_CNT_BRT_BRT_SHIFT);
699}
700
701/*
702 * preview_config_yc_range - Configures the max and min Y and C values.
703 * @yclimit: Structure containing the range of Y and C values.
704 */
705static void
706preview_config_yc_range(struct isp_prev_device *prev, const void *yclimit)
707{
708 struct isp_device *isp = to_isp_device(prev);
709 const struct omap3isp_prev_yclimit *yc = yclimit;
710
711 isp_reg_writel(isp,
712 yc->maxC << ISPPRV_SETUP_YC_MAXC_SHIFT |
713 yc->maxY << ISPPRV_SETUP_YC_MAXY_SHIFT |
714 yc->minC << ISPPRV_SETUP_YC_MINC_SHIFT |
715 yc->minY << ISPPRV_SETUP_YC_MINY_SHIFT,
716 OMAP3_ISP_IOMEM_PREV, ISPPRV_SETUP_YC);
717}
718
719static u32
720preview_params_lock(struct isp_prev_device *prev, u32 update, bool shadow)
721{
722 u32 active = prev->params.active;
723
724 if (shadow) {
725 /* Mark all shadow parameters we are going to touch as busy. */
726 prev->params.params[0].busy |= ~active & update;
727 prev->params.params[1].busy |= active & update;
728 } else {
729 /* Mark all active parameters we are going to touch as busy. */
730 update = (prev->params.params[0].update & active)
731 | (prev->params.params[1].update & ~active);
732
733 prev->params.params[0].busy |= active & update;
734 prev->params.params[1].busy |= ~active & update;
735 }
736
737 return update;
738}
739
740static void
741preview_params_unlock(struct isp_prev_device *prev, u32 update, bool shadow)
742{
743 u32 active = prev->params.active;
744
745 if (shadow) {
746 /* Set the update flag for shadow parameters that have been
747 * updated and clear the busy flag for all shadow parameters.
748 */
749 prev->params.params[0].update |= (~active & update);
750 prev->params.params[1].update |= (active & update);
751 prev->params.params[0].busy &= active;
752 prev->params.params[1].busy &= ~active;
753 } else {
754 /* Clear the update flag for active parameters that have been
755 * applied and the busy flag for all active parameters.
756 */
757 prev->params.params[0].update &= ~(active & update);
758 prev->params.params[1].update &= ~(~active & update);
759 prev->params.params[0].busy &= ~active;
760 prev->params.params[1].busy &= active;
761 }
762}
763
764static void preview_params_switch(struct isp_prev_device *prev)
765{
766 u32 to_switch;
767
768 /* Switch active parameters with updated shadow parameters when the
769 * shadow parameter has been updated and neither the active not the
770 * shadow parameter is busy.
771 */
772 to_switch = (prev->params.params[0].update & ~prev->params.active)
773 | (prev->params.params[1].update & prev->params.active);
774 to_switch &= ~(prev->params.params[0].busy |
775 prev->params.params[1].busy);
776 if (to_switch == 0)
777 return;
778
779 prev->params.active ^= to_switch;
780
781 /* Remove the update flag for the shadow copy of parameters we have
782 * switched.
783 */
784 prev->params.params[0].update &= ~(~prev->params.active & to_switch);
785 prev->params.params[1].update &= ~(prev->params.active & to_switch);
786}
787
788/* preview parameters update structure */
789struct preview_update {
790 void (*config)(struct isp_prev_device *, const void *);
791 void (*enable)(struct isp_prev_device *, u8);
792 unsigned int param_offset;
793 unsigned int param_size;
794 unsigned int config_offset;
795 bool skip;
796};
797
798/* Keep the array indexed by the OMAP3ISP_PREV_* bit number. */
799static const struct preview_update update_attrs[] = {
800 /* OMAP3ISP_PREV_LUMAENH */ {
801 preview_config_luma_enhancement,
802 preview_enable_luma_enhancement,
803 offsetof(struct prev_params, luma),
804 FIELD_SIZEOF(struct prev_params, luma),
805 offsetof(struct omap3isp_prev_update_config, luma),
806 }, /* OMAP3ISP_PREV_INVALAW */ {
807 NULL,
808 preview_enable_invalaw,
809 }, /* OMAP3ISP_PREV_HRZ_MED */ {
810 preview_config_hmed,
811 preview_enable_hmed,
812 offsetof(struct prev_params, hmed),
813 FIELD_SIZEOF(struct prev_params, hmed),
814 offsetof(struct omap3isp_prev_update_config, hmed),
815 }, /* OMAP3ISP_PREV_CFA */ {
816 preview_config_cfa,
817 NULL,
818 offsetof(struct prev_params, cfa),
819 FIELD_SIZEOF(struct prev_params, cfa),
820 offsetof(struct omap3isp_prev_update_config, cfa),
821 }, /* OMAP3ISP_PREV_CHROMA_SUPP */ {
822 preview_config_chroma_suppression,
823 preview_enable_chroma_suppression,
824 offsetof(struct prev_params, csup),
825 FIELD_SIZEOF(struct prev_params, csup),
826 offsetof(struct omap3isp_prev_update_config, csup),
827 }, /* OMAP3ISP_PREV_WB */ {
828 preview_config_whitebalance,
829 NULL,
830 offsetof(struct prev_params, wbal),
831 FIELD_SIZEOF(struct prev_params, wbal),
832 offsetof(struct omap3isp_prev_update_config, wbal),
833 }, /* OMAP3ISP_PREV_BLKADJ */ {
834 preview_config_blkadj,
835 NULL,
836 offsetof(struct prev_params, blkadj),
837 FIELD_SIZEOF(struct prev_params, blkadj),
838 offsetof(struct omap3isp_prev_update_config, blkadj),
839 }, /* OMAP3ISP_PREV_RGB2RGB */ {
840 preview_config_rgb_blending,
841 NULL,
842 offsetof(struct prev_params, rgb2rgb),
843 FIELD_SIZEOF(struct prev_params, rgb2rgb),
844 offsetof(struct omap3isp_prev_update_config, rgb2rgb),
845 }, /* OMAP3ISP_PREV_COLOR_CONV */ {
846 preview_config_csc,
847 NULL,
848 offsetof(struct prev_params, csc),
849 FIELD_SIZEOF(struct prev_params, csc),
850 offsetof(struct omap3isp_prev_update_config, csc),
851 }, /* OMAP3ISP_PREV_YC_LIMIT */ {
852 preview_config_yc_range,
853 NULL,
854 offsetof(struct prev_params, yclimit),
855 FIELD_SIZEOF(struct prev_params, yclimit),
856 offsetof(struct omap3isp_prev_update_config, yclimit),
857 }, /* OMAP3ISP_PREV_DEFECT_COR */ {
858 preview_config_dcor,
859 preview_enable_dcor,
860 offsetof(struct prev_params, dcor),
861 FIELD_SIZEOF(struct prev_params, dcor),
862 offsetof(struct omap3isp_prev_update_config, dcor),
863 }, /* OMAP3ISP_PREV_GAMMABYPASS */ {
864 NULL,
865 preview_enable_gammabypass,
866 }, /* OMAP3ISP_PREV_DRK_FRM_CAPTURE */ {
867 NULL,
868 preview_enable_drkframe_capture,
869 }, /* OMAP3ISP_PREV_DRK_FRM_SUBTRACT */ {
870 NULL,
871 preview_enable_drkframe,
872 }, /* OMAP3ISP_PREV_LENS_SHADING */ {
873 preview_config_drkf_shadcomp,
874 preview_enable_drkframe,
875 }, /* OMAP3ISP_PREV_NF */ {
876 preview_config_noisefilter,
877 preview_enable_noisefilter,
878 offsetof(struct prev_params, nf),
879 FIELD_SIZEOF(struct prev_params, nf),
880 offsetof(struct omap3isp_prev_update_config, nf),
881 }, /* OMAP3ISP_PREV_GAMMA */ {
882 preview_config_gammacorrn,
883 NULL,
884 offsetof(struct prev_params, gamma),
885 FIELD_SIZEOF(struct prev_params, gamma),
886 offsetof(struct omap3isp_prev_update_config, gamma),
887 }, /* OMAP3ISP_PREV_CONTRAST */ {
888 preview_config_contrast,
889 NULL,
890 offsetof(struct prev_params, contrast),
891 0, 0, true,
892 }, /* OMAP3ISP_PREV_BRIGHTNESS */ {
893 preview_config_brightness,
894 NULL,
895 offsetof(struct prev_params, brightness),
896 0, 0, true,
897 },
898};
899
900/*
901 * preview_config - Copy and update local structure with userspace preview
902 * configuration.
903 * @prev: ISP preview engine
904 * @cfg: Configuration
905 *
906 * Return zero if success or -EFAULT if the configuration can't be copied from
907 * userspace.
908 */
909static int preview_config(struct isp_prev_device *prev,
910 struct omap3isp_prev_update_config *cfg)
911{
912 unsigned long flags;
913 unsigned int i;
914 int rval = 0;
915 u32 update;
916 u32 active;
917
918 if (cfg->update == 0)
919 return 0;
920
921 /* Mark the shadow parameters we're going to update as busy. */
922 spin_lock_irqsave(&prev->params.lock, flags);
923 preview_params_lock(prev, cfg->update, true);
924 active = prev->params.active;
925 spin_unlock_irqrestore(&prev->params.lock, flags);
926
927 update = 0;
928
929 for (i = 0; i < ARRAY_SIZE(update_attrs); i++) {
930 const struct preview_update *attr = &update_attrs[i];
931 struct prev_params *params;
932 unsigned int bit = 1 << i;
933
934 if (attr->skip || !(cfg->update & bit))
935 continue;
936
937 params = &prev->params.params[!!(active & bit)];
938
939 if (cfg->flag & bit) {
940 void __user *from = *(void * __user *)
941 ((void *)cfg + attr->config_offset);
942 void *to = (void *)params + attr->param_offset;
943 size_t size = attr->param_size;
944
945 if (to && from && size) {
946 if (copy_from_user(to, from, size)) {
947 rval = -EFAULT;
948 break;
949 }
950 }
951 params->features |= bit;
952 } else {
953 params->features &= ~bit;
954 }
955
956 update |= bit;
957 }
958
959 spin_lock_irqsave(&prev->params.lock, flags);
960 preview_params_unlock(prev, update, true);
961 preview_params_switch(prev);
962 spin_unlock_irqrestore(&prev->params.lock, flags);
963
964 return rval;
965}
966
967/*
968 * preview_setup_hw - Setup preview registers and/or internal memory
969 * @prev: pointer to preview private structure
970 * @update: Bitmask of parameters to setup
971 * @active: Bitmask of parameters active in set 0
972 * Note: can be called from interrupt context
973 * Return none
974 */
975static void preview_setup_hw(struct isp_prev_device *prev, u32 update,
976 u32 active)
977{
978 unsigned int i;
979 u32 features;
980
981 if (update == 0)
982 return;
983
984 features = (prev->params.params[0].features & active)
985 | (prev->params.params[1].features & ~active);
986
987 for (i = 0; i < ARRAY_SIZE(update_attrs); i++) {
988 const struct preview_update *attr = &update_attrs[i];
989 struct prev_params *params;
990 unsigned int bit = 1 << i;
991 void *param_ptr;
992
993 if (!(update & bit))
994 continue;
995
996 params = &prev->params.params[!(active & bit)];
997
998 if (params->features & bit) {
999 if (attr->config) {
1000 param_ptr = (void *)params + attr->param_offset;
1001 attr->config(prev, param_ptr);
1002 }
1003 if (attr->enable)
1004 attr->enable(prev, 1);
1005 } else {
1006 if (attr->enable)
1007 attr->enable(prev, 0);
1008 }
1009 }
1010}
1011
1012/*
1013 * preview_config_ycpos - Configure byte layout of YUV image.
1014 * @mode: Indicates the required byte layout.
1015 */
1016static void
1017preview_config_ycpos(struct isp_prev_device *prev,
1018 enum v4l2_mbus_pixelcode pixelcode)
1019{
1020 struct isp_device *isp = to_isp_device(prev);
1021 enum preview_ycpos_mode mode;
1022
1023 switch (pixelcode) {
1024 case V4L2_MBUS_FMT_YUYV8_1X16:
1025 mode = YCPOS_CrYCbY;
1026 break;
1027 case V4L2_MBUS_FMT_UYVY8_1X16:
1028 mode = YCPOS_YCrYCb;
1029 break;
1030 default:
1031 return;
1032 }
1033
1034 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1035 ISPPRV_PCR_YCPOS_CrYCbY,
1036 mode << ISPPRV_PCR_YCPOS_SHIFT);
1037}
1038
1039/*
1040 * preview_config_averager - Enable / disable / configure averager
1041 * @average: Average value to be configured.
1042 */
1043static void preview_config_averager(struct isp_prev_device *prev, u8 average)
1044{
1045 struct isp_device *isp = to_isp_device(prev);
1046 struct prev_params *params;
1047 int reg = 0;
1048
1049 params = (prev->params.active & OMAP3ISP_PREV_CFA)
1050 ? &prev->params.params[0] : &prev->params.params[1];
1051
1052 if (params->cfa.format == OMAP3ISP_CFAFMT_BAYER)
1053 reg = ISPPRV_AVE_EVENDIST_2 << ISPPRV_AVE_EVENDIST_SHIFT |
1054 ISPPRV_AVE_ODDDIST_2 << ISPPRV_AVE_ODDDIST_SHIFT |
1055 average;
1056 else if (params->cfa.format == OMAP3ISP_CFAFMT_RGBFOVEON)
1057 reg = ISPPRV_AVE_EVENDIST_3 << ISPPRV_AVE_EVENDIST_SHIFT |
1058 ISPPRV_AVE_ODDDIST_3 << ISPPRV_AVE_ODDDIST_SHIFT |
1059 average;
1060 isp_reg_writel(isp, reg, OMAP3_ISP_IOMEM_PREV, ISPPRV_AVE);
1061}
1062
1063/*
1064 * preview_config_input_format - Configure the input format
1065 * @prev: The preview engine
1066 * @format: Format on the preview engine sink pad
1067 *
1068 * Enable CFA interpolation for Bayer formats and disable it for greyscale
1069 * formats.
1070 */
1071static void preview_config_input_format(struct isp_prev_device *prev,
1072 const struct v4l2_mbus_framefmt *format)
1073{
1074 struct isp_device *isp = to_isp_device(prev);
1075
1076 if (format->code != V4L2_MBUS_FMT_Y10_1X10)
1077 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1078 ISPPRV_PCR_CFAEN);
1079 else
1080 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1081 ISPPRV_PCR_CFAEN);
1082}
1083
1084/*
1085 * preview_config_input_size - Configure the input frame size
1086 *
1087 * The preview engine crops several rows and columns internally depending on
1088 * which processing blocks are enabled. The driver assumes all those blocks are
1089 * enabled when reporting source pad formats to userspace. If this assumption is
1090 * not true, rows and columns must be manually cropped at the preview engine
1091 * input to avoid overflows at the end of lines and frames.
1092 *
1093 * See the explanation at the PREV_MARGIN_* definitions for more details.
1094 */
1095static void preview_config_input_size(struct isp_prev_device *prev, u32 active)
1096{
1097 const struct v4l2_mbus_framefmt *format = &prev->formats[PREV_PAD_SINK];
1098 struct isp_device *isp = to_isp_device(prev);
1099 unsigned int sph = prev->crop.left;
1100 unsigned int eph = prev->crop.left + prev->crop.width - 1;
1101 unsigned int slv = prev->crop.top;
1102 unsigned int elv = prev->crop.top + prev->crop.height - 1;
1103 u32 features;
1104
1105 if (format->code != V4L2_MBUS_FMT_Y10_1X10) {
1106 sph -= 2;
1107 eph += 2;
1108 slv -= 2;
1109 elv += 2;
1110 }
1111
1112 features = (prev->params.params[0].features & active)
1113 | (prev->params.params[1].features & ~active);
1114
1115 if (features & (OMAP3ISP_PREV_DEFECT_COR | OMAP3ISP_PREV_NF)) {
1116 sph -= 2;
1117 eph += 2;
1118 slv -= 2;
1119 elv += 2;
1120 }
1121 if (features & OMAP3ISP_PREV_HRZ_MED) {
1122 sph -= 2;
1123 eph += 2;
1124 }
1125 if (features & (OMAP3ISP_PREV_CHROMA_SUPP | OMAP3ISP_PREV_LUMAENH))
1126 sph -= 2;
1127
1128 isp_reg_writel(isp, (sph << ISPPRV_HORZ_INFO_SPH_SHIFT) | eph,
1129 OMAP3_ISP_IOMEM_PREV, ISPPRV_HORZ_INFO);
1130 isp_reg_writel(isp, (slv << ISPPRV_VERT_INFO_SLV_SHIFT) | elv,
1131 OMAP3_ISP_IOMEM_PREV, ISPPRV_VERT_INFO);
1132}
1133
1134/*
1135 * preview_config_inlineoffset - Configures the Read address line offset.
1136 * @prev: Preview module
1137 * @offset: Line offset
1138 *
1139 * According to the TRM, the line offset must be aligned on a 32 bytes boundary.
1140 * However, a hardware bug requires the memory start address to be aligned on a
1141 * 64 bytes boundary, so the offset probably should be aligned on 64 bytes as
1142 * well.
1143 */
1144static void
1145preview_config_inlineoffset(struct isp_prev_device *prev, u32 offset)
1146{
1147 struct isp_device *isp = to_isp_device(prev);
1148
1149 isp_reg_writel(isp, offset & 0xffff, OMAP3_ISP_IOMEM_PREV,
1150 ISPPRV_RADR_OFFSET);
1151}
1152
1153/*
1154 * preview_set_inaddr - Sets memory address of input frame.
1155 * @addr: 32bit memory address aligned on 32byte boundary.
1156 *
1157 * Configures the memory address from which the input frame is to be read.
1158 */
1159static void preview_set_inaddr(struct isp_prev_device *prev, u32 addr)
1160{
1161 struct isp_device *isp = to_isp_device(prev);
1162
1163 isp_reg_writel(isp, addr, OMAP3_ISP_IOMEM_PREV, ISPPRV_RSDR_ADDR);
1164}
1165
1166/*
1167 * preview_config_outlineoffset - Configures the Write address line offset.
1168 * @offset: Line Offset for the preview output.
1169 *
1170 * The offset must be a multiple of 32 bytes.
1171 */
1172static void preview_config_outlineoffset(struct isp_prev_device *prev,
1173 u32 offset)
1174{
1175 struct isp_device *isp = to_isp_device(prev);
1176
1177 isp_reg_writel(isp, offset & 0xffff, OMAP3_ISP_IOMEM_PREV,
1178 ISPPRV_WADD_OFFSET);
1179}
1180
1181/*
1182 * preview_set_outaddr - Sets the memory address to store output frame
1183 * @addr: 32bit memory address aligned on 32byte boundary.
1184 *
1185 * Configures the memory address to which the output frame is written.
1186 */
1187static void preview_set_outaddr(struct isp_prev_device *prev, u32 addr)
1188{
1189 struct isp_device *isp = to_isp_device(prev);
1190
1191 isp_reg_writel(isp, addr, OMAP3_ISP_IOMEM_PREV, ISPPRV_WSDR_ADDR);
1192}
1193
1194static void preview_adjust_bandwidth(struct isp_prev_device *prev)
1195{
1196 struct isp_pipeline *pipe = to_isp_pipeline(&prev->subdev.entity);
1197 struct isp_device *isp = to_isp_device(prev);
1198 const struct v4l2_mbus_framefmt *ifmt = &prev->formats[PREV_PAD_SINK];
1199 unsigned long l3_ick = pipe->l3_ick;
1200 struct v4l2_fract *timeperframe;
1201 unsigned int cycles_per_frame;
1202 unsigned int requests_per_frame;
1203 unsigned int cycles_per_request;
1204 unsigned int minimum;
1205 unsigned int maximum;
1206 unsigned int value;
1207
1208 if (prev->input != PREVIEW_INPUT_MEMORY) {
1209 isp_reg_clr(isp, OMAP3_ISP_IOMEM_SBL, ISPSBL_SDR_REQ_EXP,
1210 ISPSBL_SDR_REQ_PRV_EXP_MASK);
1211 return;
1212 }
1213
1214 /* Compute the minimum number of cycles per request, based on the
1215 * pipeline maximum data rate. This is an absolute lower bound if we
1216 * don't want SBL overflows, so round the value up.
1217 */
1218 cycles_per_request = div_u64((u64)l3_ick / 2 * 256 + pipe->max_rate - 1,
1219 pipe->max_rate);
1220 minimum = DIV_ROUND_UP(cycles_per_request, 32);
1221
1222 /* Compute the maximum number of cycles per request, based on the
1223 * requested frame rate. This is a soft upper bound to achieve a frame
1224 * rate equal or higher than the requested value, so round the value
1225 * down.
1226 */
1227 timeperframe = &pipe->max_timeperframe;
1228
1229 requests_per_frame = DIV_ROUND_UP(ifmt->width * 2, 256) * ifmt->height;
1230 cycles_per_frame = div_u64((u64)l3_ick * timeperframe->numerator,
1231 timeperframe->denominator);
1232 cycles_per_request = cycles_per_frame / requests_per_frame;
1233
1234 maximum = cycles_per_request / 32;
1235
1236 value = max(minimum, maximum);
1237
1238 dev_dbg(isp->dev, "%s: cycles per request = %u\n", __func__, value);
1239 isp_reg_clr_set(isp, OMAP3_ISP_IOMEM_SBL, ISPSBL_SDR_REQ_EXP,
1240 ISPSBL_SDR_REQ_PRV_EXP_MASK,
1241 value << ISPSBL_SDR_REQ_PRV_EXP_SHIFT);
1242}
1243
1244/*
1245 * omap3isp_preview_busy - Gets busy state of preview module.
1246 */
1247int omap3isp_preview_busy(struct isp_prev_device *prev)
1248{
1249 struct isp_device *isp = to_isp_device(prev);
1250
1251 return isp_reg_readl(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR)
1252 & ISPPRV_PCR_BUSY;
1253}
1254
1255/*
1256 * omap3isp_preview_restore_context - Restores the values of preview registers
1257 */
1258void omap3isp_preview_restore_context(struct isp_device *isp)
1259{
1260 struct isp_prev_device *prev = &isp->isp_prev;
1261 const u32 update = OMAP3ISP_PREV_FEATURES_END - 1;
1262
1263 prev->params.params[0].update = prev->params.active & update;
1264 prev->params.params[1].update = ~prev->params.active & update;
1265
1266 preview_setup_hw(prev, update, prev->params.active);
1267
1268 prev->params.params[0].update = 0;
1269 prev->params.params[1].update = 0;
1270}
1271
1272/*
1273 * preview_print_status - Dump preview module registers to the kernel log
1274 */
1275#define PREV_PRINT_REGISTER(isp, name)\
1276 dev_dbg(isp->dev, "###PRV " #name "=0x%08x\n", \
1277 isp_reg_readl(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_##name))
1278
1279static void preview_print_status(struct isp_prev_device *prev)
1280{
1281 struct isp_device *isp = to_isp_device(prev);
1282
1283 dev_dbg(isp->dev, "-------------Preview Register dump----------\n");
1284
1285 PREV_PRINT_REGISTER(isp, PCR);
1286 PREV_PRINT_REGISTER(isp, HORZ_INFO);
1287 PREV_PRINT_REGISTER(isp, VERT_INFO);
1288 PREV_PRINT_REGISTER(isp, RSDR_ADDR);
1289 PREV_PRINT_REGISTER(isp, RADR_OFFSET);
1290 PREV_PRINT_REGISTER(isp, DSDR_ADDR);
1291 PREV_PRINT_REGISTER(isp, DRKF_OFFSET);
1292 PREV_PRINT_REGISTER(isp, WSDR_ADDR);
1293 PREV_PRINT_REGISTER(isp, WADD_OFFSET);
1294 PREV_PRINT_REGISTER(isp, AVE);
1295 PREV_PRINT_REGISTER(isp, HMED);
1296 PREV_PRINT_REGISTER(isp, NF);
1297 PREV_PRINT_REGISTER(isp, WB_DGAIN);
1298 PREV_PRINT_REGISTER(isp, WBGAIN);
1299 PREV_PRINT_REGISTER(isp, WBSEL);
1300 PREV_PRINT_REGISTER(isp, CFA);
1301 PREV_PRINT_REGISTER(isp, BLKADJOFF);
1302 PREV_PRINT_REGISTER(isp, RGB_MAT1);
1303 PREV_PRINT_REGISTER(isp, RGB_MAT2);
1304 PREV_PRINT_REGISTER(isp, RGB_MAT3);
1305 PREV_PRINT_REGISTER(isp, RGB_MAT4);
1306 PREV_PRINT_REGISTER(isp, RGB_MAT5);
1307 PREV_PRINT_REGISTER(isp, RGB_OFF1);
1308 PREV_PRINT_REGISTER(isp, RGB_OFF2);
1309 PREV_PRINT_REGISTER(isp, CSC0);
1310 PREV_PRINT_REGISTER(isp, CSC1);
1311 PREV_PRINT_REGISTER(isp, CSC2);
1312 PREV_PRINT_REGISTER(isp, CSC_OFFSET);
1313 PREV_PRINT_REGISTER(isp, CNT_BRT);
1314 PREV_PRINT_REGISTER(isp, CSUP);
1315 PREV_PRINT_REGISTER(isp, SETUP_YC);
1316 PREV_PRINT_REGISTER(isp, SET_TBL_ADDR);
1317 PREV_PRINT_REGISTER(isp, CDC_THR0);
1318 PREV_PRINT_REGISTER(isp, CDC_THR1);
1319 PREV_PRINT_REGISTER(isp, CDC_THR2);
1320 PREV_PRINT_REGISTER(isp, CDC_THR3);
1321
1322 dev_dbg(isp->dev, "--------------------------------------------\n");
1323}
1324
1325/*
1326 * preview_init_params - init image processing parameters.
1327 * @prev: pointer to previewer private structure
1328 */
1329static void preview_init_params(struct isp_prev_device *prev)
1330{
1331 struct prev_params *params;
1332 unsigned int i;
1333
1334 spin_lock_init(&prev->params.lock);
1335
1336 prev->params.active = ~0;
1337 prev->params.params[0].busy = 0;
1338 prev->params.params[0].update = OMAP3ISP_PREV_FEATURES_END - 1;
1339 prev->params.params[1].busy = 0;
1340 prev->params.params[1].update = 0;
1341
1342 params = &prev->params.params[0];
1343
1344 /* Init values */
1345 params->contrast = ISPPRV_CONTRAST_DEF * ISPPRV_CONTRAST_UNITS;
1346 params->brightness = ISPPRV_BRIGHT_DEF * ISPPRV_BRIGHT_UNITS;
1347 params->cfa.format = OMAP3ISP_CFAFMT_BAYER;
1348 memcpy(params->cfa.table, cfa_coef_table,
1349 sizeof(params->cfa.table));
1350 params->cfa.gradthrs_horz = FLR_CFA_GRADTHRS_HORZ;
1351 params->cfa.gradthrs_vert = FLR_CFA_GRADTHRS_VERT;
1352 params->csup.gain = FLR_CSUP_GAIN;
1353 params->csup.thres = FLR_CSUP_THRES;
1354 params->csup.hypf_en = 0;
1355 memcpy(params->luma.table, luma_enhance_table,
1356 sizeof(params->luma.table));
1357 params->nf.spread = FLR_NF_STRGTH;
1358 memcpy(params->nf.table, noise_filter_table, sizeof(params->nf.table));
1359 params->dcor.couplet_mode_en = 1;
1360 for (i = 0; i < OMAP3ISP_PREV_DETECT_CORRECT_CHANNELS; i++)
1361 params->dcor.detect_correct[i] = DEF_DETECT_CORRECT_VAL;
1362 memcpy(params->gamma.blue, gamma_table, sizeof(params->gamma.blue));
1363 memcpy(params->gamma.green, gamma_table, sizeof(params->gamma.green));
1364 memcpy(params->gamma.red, gamma_table, sizeof(params->gamma.red));
1365 params->wbal.dgain = FLR_WBAL_DGAIN;
1366 params->wbal.coef0 = FLR_WBAL_COEF;
1367 params->wbal.coef1 = FLR_WBAL_COEF;
1368 params->wbal.coef2 = FLR_WBAL_COEF;
1369 params->wbal.coef3 = FLR_WBAL_COEF;
1370 params->blkadj.red = FLR_BLKADJ_RED;
1371 params->blkadj.green = FLR_BLKADJ_GREEN;
1372 params->blkadj.blue = FLR_BLKADJ_BLUE;
1373 params->rgb2rgb = flr_rgb2rgb;
1374 params->csc = flr_prev_csc;
1375 params->yclimit.minC = ISPPRV_YC_MIN;
1376 params->yclimit.maxC = ISPPRV_YC_MAX;
1377 params->yclimit.minY = ISPPRV_YC_MIN;
1378 params->yclimit.maxY = ISPPRV_YC_MAX;
1379
1380 params->features = OMAP3ISP_PREV_CFA | OMAP3ISP_PREV_DEFECT_COR
1381 | OMAP3ISP_PREV_NF | OMAP3ISP_PREV_GAMMA
1382 | OMAP3ISP_PREV_BLKADJ | OMAP3ISP_PREV_YC_LIMIT
1383 | OMAP3ISP_PREV_RGB2RGB | OMAP3ISP_PREV_COLOR_CONV
1384 | OMAP3ISP_PREV_WB | OMAP3ISP_PREV_BRIGHTNESS
1385 | OMAP3ISP_PREV_CONTRAST;
1386}
1387
1388/*
1389 * preview_max_out_width - Handle previewer hardware ouput limitations
1390 * @isp_revision : ISP revision
1391 * returns maximum width output for current isp revision
1392 */
1393static unsigned int preview_max_out_width(struct isp_prev_device *prev)
1394{
1395 struct isp_device *isp = to_isp_device(prev);
1396
1397 switch (isp->revision) {
1398 case ISP_REVISION_1_0:
1399 return PREV_MAX_OUT_WIDTH_REV_1;
1400
1401 case ISP_REVISION_2_0:
1402 default:
1403 return PREV_MAX_OUT_WIDTH_REV_2;
1404
1405 case ISP_REVISION_15_0:
1406 return PREV_MAX_OUT_WIDTH_REV_15;
1407 }
1408}
1409
1410static void preview_configure(struct isp_prev_device *prev)
1411{
1412 struct isp_device *isp = to_isp_device(prev);
1413 struct v4l2_mbus_framefmt *format;
1414 unsigned long flags;
1415 u32 update;
1416 u32 active;
1417
1418 spin_lock_irqsave(&prev->params.lock, flags);
1419 /* Mark all active parameters we are going to touch as busy. */
1420 update = preview_params_lock(prev, 0, false);
1421 active = prev->params.active;
1422 spin_unlock_irqrestore(&prev->params.lock, flags);
1423
1424 preview_setup_hw(prev, update, active);
1425
1426 if (prev->output & PREVIEW_OUTPUT_MEMORY)
1427 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1428 ISPPRV_PCR_SDRPORT);
1429 else
1430 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1431 ISPPRV_PCR_SDRPORT);
1432
1433 if (prev->output & PREVIEW_OUTPUT_RESIZER)
1434 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1435 ISPPRV_PCR_RSZPORT);
1436 else
1437 isp_reg_clr(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1438 ISPPRV_PCR_RSZPORT);
1439
1440 /* PREV_PAD_SINK */
1441 format = &prev->formats[PREV_PAD_SINK];
1442
1443 preview_adjust_bandwidth(prev);
1444
1445 preview_config_input_format(prev, format);
1446 preview_config_input_size(prev, active);
1447
1448 if (prev->input == PREVIEW_INPUT_CCDC)
1449 preview_config_inlineoffset(prev, 0);
1450 else
1451 preview_config_inlineoffset(prev,
1452 ALIGN(format->width, 0x20) * 2);
1453
1454 /* PREV_PAD_SOURCE */
1455 format = &prev->formats[PREV_PAD_SOURCE];
1456
1457 if (prev->output & PREVIEW_OUTPUT_MEMORY)
1458 preview_config_outlineoffset(prev,
1459 ALIGN(format->width, 0x10) * 2);
1460
1461 preview_config_averager(prev, 0);
1462 preview_config_ycpos(prev, format->code);
1463
1464 spin_lock_irqsave(&prev->params.lock, flags);
1465 preview_params_unlock(prev, update, false);
1466 spin_unlock_irqrestore(&prev->params.lock, flags);
1467}
1468
1469/* -----------------------------------------------------------------------------
1470 * Interrupt handling
1471 */
1472
1473static void preview_enable_oneshot(struct isp_prev_device *prev)
1474{
1475 struct isp_device *isp = to_isp_device(prev);
1476
1477 /* The PCR.SOURCE bit is automatically reset to 0 when the PCR.ENABLE
1478 * bit is set. As the preview engine is used in single-shot mode, we
1479 * need to set PCR.SOURCE before enabling the preview engine.
1480 */
1481 if (prev->input == PREVIEW_INPUT_MEMORY)
1482 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1483 ISPPRV_PCR_SOURCE);
1484
1485 isp_reg_set(isp, OMAP3_ISP_IOMEM_PREV, ISPPRV_PCR,
1486 ISPPRV_PCR_EN | ISPPRV_PCR_ONESHOT);
1487}
1488
1489void omap3isp_preview_isr_frame_sync(struct isp_prev_device *prev)
1490{
1491 /*
1492 * If ISP_VIDEO_DMAQUEUE_QUEUED is set, DMA queue had an underrun
1493 * condition, the module was paused and now we have a buffer queued
1494 * on the output again. Restart the pipeline if running in continuous
1495 * mode.
1496 */
1497 if (prev->state == ISP_PIPELINE_STREAM_CONTINUOUS &&
1498 prev->video_out.dmaqueue_flags & ISP_VIDEO_DMAQUEUE_QUEUED) {
1499 preview_enable_oneshot(prev);
1500 isp_video_dmaqueue_flags_clr(&prev->video_out);
1501 }
1502}
1503
1504static void preview_isr_buffer(struct isp_prev_device *prev)
1505{
1506 struct isp_pipeline *pipe = to_isp_pipeline(&prev->subdev.entity);
1507 struct isp_buffer *buffer;
1508 int restart = 0;
1509
1510 if (prev->input == PREVIEW_INPUT_MEMORY) {
1511 buffer = omap3isp_video_buffer_next(&prev->video_in);
1512 if (buffer != NULL)
1513 preview_set_inaddr(prev, buffer->isp_addr);
1514 pipe->state |= ISP_PIPELINE_IDLE_INPUT;
1515 }
1516
1517 if (prev->output & PREVIEW_OUTPUT_MEMORY) {
1518 buffer = omap3isp_video_buffer_next(&prev->video_out);
1519 if (buffer != NULL) {
1520 preview_set_outaddr(prev, buffer->isp_addr);
1521 restart = 1;
1522 }
1523 pipe->state |= ISP_PIPELINE_IDLE_OUTPUT;
1524 }
1525
1526 switch (prev->state) {
1527 case ISP_PIPELINE_STREAM_SINGLESHOT:
1528 if (isp_pipeline_ready(pipe))
1529 omap3isp_pipeline_set_stream(pipe,
1530 ISP_PIPELINE_STREAM_SINGLESHOT);
1531 break;
1532
1533 case ISP_PIPELINE_STREAM_CONTINUOUS:
1534 /* If an underrun occurs, the video queue operation handler will
1535 * restart the preview engine. Otherwise restart it immediately.
1536 */
1537 if (restart)
1538 preview_enable_oneshot(prev);
1539 break;
1540
1541 case ISP_PIPELINE_STREAM_STOPPED:
1542 default:
1543 return;
1544 }
1545}
1546
1547/*
1548 * omap3isp_preview_isr - ISP preview engine interrupt handler
1549 *
1550 * Manage the preview engine video buffers and configure shadowed registers.
1551 */
1552void omap3isp_preview_isr(struct isp_prev_device *prev)
1553{
1554 unsigned long flags;
1555 u32 update;
1556 u32 active;
1557
1558 if (omap3isp_module_sync_is_stopping(&prev->wait, &prev->stopping))
1559 return;
1560
1561 spin_lock_irqsave(&prev->params.lock, flags);
1562 preview_params_switch(prev);
1563 update = preview_params_lock(prev, 0, false);
1564 active = prev->params.active;
1565 spin_unlock_irqrestore(&prev->params.lock, flags);
1566
1567 preview_setup_hw(prev, update, active);
1568 preview_config_input_size(prev, active);
1569
1570 if (prev->input == PREVIEW_INPUT_MEMORY ||
1571 prev->output & PREVIEW_OUTPUT_MEMORY)
1572 preview_isr_buffer(prev);
1573 else if (prev->state == ISP_PIPELINE_STREAM_CONTINUOUS)
1574 preview_enable_oneshot(prev);
1575
1576 spin_lock_irqsave(&prev->params.lock, flags);
1577 preview_params_unlock(prev, update, false);
1578 spin_unlock_irqrestore(&prev->params.lock, flags);
1579}
1580
1581/* -----------------------------------------------------------------------------
1582 * ISP video operations
1583 */
1584
1585static int preview_video_queue(struct isp_video *video,
1586 struct isp_buffer *buffer)
1587{
1588 struct isp_prev_device *prev = &video->isp->isp_prev;
1589
1590 if (video->type == V4L2_BUF_TYPE_VIDEO_OUTPUT)
1591 preview_set_inaddr(prev, buffer->isp_addr);
1592
1593 if (video->type == V4L2_BUF_TYPE_VIDEO_CAPTURE)
1594 preview_set_outaddr(prev, buffer->isp_addr);
1595
1596 return 0;
1597}
1598
1599static const struct isp_video_operations preview_video_ops = {
1600 .queue = preview_video_queue,
1601};
1602
1603/* -----------------------------------------------------------------------------
1604 * V4L2 subdev operations
1605 */
1606
1607/*
1608 * preview_s_ctrl - Handle set control subdev method
1609 * @ctrl: pointer to v4l2 control structure
1610 */
1611static int preview_s_ctrl(struct v4l2_ctrl *ctrl)
1612{
1613 struct isp_prev_device *prev =
1614 container_of(ctrl->handler, struct isp_prev_device, ctrls);
1615
1616 switch (ctrl->id) {
1617 case V4L2_CID_BRIGHTNESS:
1618 preview_update_brightness(prev, ctrl->val);
1619 break;
1620 case V4L2_CID_CONTRAST:
1621 preview_update_contrast(prev, ctrl->val);
1622 break;
1623 }
1624
1625 return 0;
1626}
1627
1628static const struct v4l2_ctrl_ops preview_ctrl_ops = {
1629 .s_ctrl = preview_s_ctrl,
1630};
1631
1632/*
1633 * preview_ioctl - Handle preview module private ioctl's
1634 * @prev: pointer to preview context structure
1635 * @cmd: configuration command
1636 * @arg: configuration argument
1637 * return -EINVAL or zero on success
1638 */
1639static long preview_ioctl(struct v4l2_subdev *sd, unsigned int cmd, void *arg)
1640{
1641 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
1642
1643 switch (cmd) {
1644 case VIDIOC_OMAP3ISP_PRV_CFG:
1645 return preview_config(prev, arg);
1646
1647 default:
1648 return -ENOIOCTLCMD;
1649 }
1650}
1651
1652/*
1653 * preview_set_stream - Enable/Disable streaming on preview subdev
1654 * @sd : pointer to v4l2 subdev structure
1655 * @enable: 1 == Enable, 0 == Disable
1656 * return -EINVAL or zero on success
1657 */
1658static int preview_set_stream(struct v4l2_subdev *sd, int enable)
1659{
1660 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
1661 struct isp_video *video_out = &prev->video_out;
1662 struct isp_device *isp = to_isp_device(prev);
1663 struct device *dev = to_device(prev);
1664
1665 if (prev->state == ISP_PIPELINE_STREAM_STOPPED) {
1666 if (enable == ISP_PIPELINE_STREAM_STOPPED)
1667 return 0;
1668
1669 omap3isp_subclk_enable(isp, OMAP3_ISP_SUBCLK_PREVIEW);
1670 preview_configure(prev);
1671 atomic_set(&prev->stopping, 0);
1672 preview_print_status(prev);
1673 }
1674
1675 switch (enable) {
1676 case ISP_PIPELINE_STREAM_CONTINUOUS:
1677 if (prev->output & PREVIEW_OUTPUT_MEMORY)
1678 omap3isp_sbl_enable(isp, OMAP3_ISP_SBL_PREVIEW_WRITE);
1679
1680 if (video_out->dmaqueue_flags & ISP_VIDEO_DMAQUEUE_QUEUED ||
1681 !(prev->output & PREVIEW_OUTPUT_MEMORY))
1682 preview_enable_oneshot(prev);
1683
1684 isp_video_dmaqueue_flags_clr(video_out);
1685 break;
1686
1687 case ISP_PIPELINE_STREAM_SINGLESHOT:
1688 if (prev->input == PREVIEW_INPUT_MEMORY)
1689 omap3isp_sbl_enable(isp, OMAP3_ISP_SBL_PREVIEW_READ);
1690 if (prev->output & PREVIEW_OUTPUT_MEMORY)
1691 omap3isp_sbl_enable(isp, OMAP3_ISP_SBL_PREVIEW_WRITE);
1692
1693 preview_enable_oneshot(prev);
1694 break;
1695
1696 case ISP_PIPELINE_STREAM_STOPPED:
1697 if (omap3isp_module_sync_idle(&sd->entity, &prev->wait,
1698 &prev->stopping))
1699 dev_dbg(dev, "%s: stop timeout.\n", sd->name);
1700 omap3isp_sbl_disable(isp, OMAP3_ISP_SBL_PREVIEW_READ);
1701 omap3isp_sbl_disable(isp, OMAP3_ISP_SBL_PREVIEW_WRITE);
1702 omap3isp_subclk_disable(isp, OMAP3_ISP_SUBCLK_PREVIEW);
1703 isp_video_dmaqueue_flags_clr(video_out);
1704 break;
1705 }
1706
1707 prev->state = enable;
1708 return 0;
1709}
1710
1711static struct v4l2_mbus_framefmt *
1712__preview_get_format(struct isp_prev_device *prev, struct v4l2_subdev_fh *fh,
1713 unsigned int pad, enum v4l2_subdev_format_whence which)
1714{
1715 if (which == V4L2_SUBDEV_FORMAT_TRY)
1716 return v4l2_subdev_get_try_format(fh, pad);
1717 else
1718 return &prev->formats[pad];
1719}
1720
1721static struct v4l2_rect *
1722__preview_get_crop(struct isp_prev_device *prev, struct v4l2_subdev_fh *fh,
1723 enum v4l2_subdev_format_whence which)
1724{
1725 if (which == V4L2_SUBDEV_FORMAT_TRY)
1726 return v4l2_subdev_get_try_crop(fh, PREV_PAD_SINK);
1727 else
1728 return &prev->crop;
1729}
1730
1731/* previewer format descriptions */
1732static const unsigned int preview_input_fmts[] = {
1733 V4L2_MBUS_FMT_Y10_1X10,
1734 V4L2_MBUS_FMT_SGRBG10_1X10,
1735 V4L2_MBUS_FMT_SRGGB10_1X10,
1736 V4L2_MBUS_FMT_SBGGR10_1X10,
1737 V4L2_MBUS_FMT_SGBRG10_1X10,
1738};
1739
1740static const unsigned int preview_output_fmts[] = {
1741 V4L2_MBUS_FMT_UYVY8_1X16,
1742 V4L2_MBUS_FMT_YUYV8_1X16,
1743};
1744
1745/*
1746 * preview_try_format - Validate a format
1747 * @prev: ISP preview engine
1748 * @fh: V4L2 subdev file handle
1749 * @pad: pad number
1750 * @fmt: format to be validated
1751 * @which: try/active format selector
1752 *
1753 * Validate and adjust the given format for the given pad based on the preview
1754 * engine limits and the format and crop rectangles on other pads.
1755 */
1756static void preview_try_format(struct isp_prev_device *prev,
1757 struct v4l2_subdev_fh *fh, unsigned int pad,
1758 struct v4l2_mbus_framefmt *fmt,
1759 enum v4l2_subdev_format_whence which)
1760{
1761 enum v4l2_mbus_pixelcode pixelcode;
1762 struct v4l2_rect *crop;
1763 unsigned int i;
1764
1765 switch (pad) {
1766 case PREV_PAD_SINK:
1767 /* When reading data from the CCDC, the input size has already
1768 * been mangled by the CCDC output pad so it can be accepted
1769 * as-is.
1770 *
1771 * When reading data from memory, clamp the requested width and
1772 * height. The TRM doesn't specify a minimum input height, make
1773 * sure we got enough lines to enable the noise filter and color
1774 * filter array interpolation.
1775 */
1776 if (prev->input == PREVIEW_INPUT_MEMORY) {
1777 fmt->width = clamp_t(u32, fmt->width, PREV_MIN_IN_WIDTH,
1778 preview_max_out_width(prev));
1779 fmt->height = clamp_t(u32, fmt->height,
1780 PREV_MIN_IN_HEIGHT,
1781 PREV_MAX_IN_HEIGHT);
1782 }
1783
1784 fmt->colorspace = V4L2_COLORSPACE_SRGB;
1785
1786 for (i = 0; i < ARRAY_SIZE(preview_input_fmts); i++) {
1787 if (fmt->code == preview_input_fmts[i])
1788 break;
1789 }
1790
1791 /* If not found, use SGRBG10 as default */
1792 if (i >= ARRAY_SIZE(preview_input_fmts))
1793 fmt->code = V4L2_MBUS_FMT_SGRBG10_1X10;
1794 break;
1795
1796 case PREV_PAD_SOURCE:
1797 pixelcode = fmt->code;
1798 *fmt = *__preview_get_format(prev, fh, PREV_PAD_SINK, which);
1799
1800 switch (pixelcode) {
1801 case V4L2_MBUS_FMT_YUYV8_1X16:
1802 case V4L2_MBUS_FMT_UYVY8_1X16:
1803 fmt->code = pixelcode;
1804 break;
1805
1806 default:
1807 fmt->code = V4L2_MBUS_FMT_YUYV8_1X16;
1808 break;
1809 }
1810
1811 /* The preview module output size is configurable through the
1812 * averager (horizontal scaling by 1/1, 1/2, 1/4 or 1/8). This
1813 * is not supported yet, hardcode the output size to the crop
1814 * rectangle size.
1815 */
1816 crop = __preview_get_crop(prev, fh, which);
1817 fmt->width = crop->width;
1818 fmt->height = crop->height;
1819
1820 fmt->colorspace = V4L2_COLORSPACE_JPEG;
1821 break;
1822 }
1823
1824 fmt->field = V4L2_FIELD_NONE;
1825}
1826
1827/*
1828 * preview_try_crop - Validate a crop rectangle
1829 * @prev: ISP preview engine
1830 * @sink: format on the sink pad
1831 * @crop: crop rectangle to be validated
1832 *
1833 * The preview engine crops lines and columns for its internal operation,
1834 * depending on which filters are enabled. Enforce minimum crop margins to
1835 * handle that transparently for userspace.
1836 *
1837 * See the explanation at the PREV_MARGIN_* definitions for more details.
1838 */
1839static void preview_try_crop(struct isp_prev_device *prev,
1840 const struct v4l2_mbus_framefmt *sink,
1841 struct v4l2_rect *crop)
1842{
1843 unsigned int left = PREV_MARGIN_LEFT;
1844 unsigned int right = sink->width - PREV_MARGIN_RIGHT;
1845 unsigned int top = PREV_MARGIN_TOP;
1846 unsigned int bottom = sink->height - PREV_MARGIN_BOTTOM;
1847
1848 /* When processing data on-the-fly from the CCDC, at least 2 pixels must
1849 * be cropped from the left and right sides of the image. As we don't
1850 * know which filters will be enabled, increase the left and right
1851 * margins by two.
1852 */
1853 if (prev->input == PREVIEW_INPUT_CCDC) {
1854 left += 2;
1855 right -= 2;
1856 }
1857
1858 /* Restrict left/top to even values to keep the Bayer pattern. */
1859 crop->left &= ~1;
1860 crop->top &= ~1;
1861
1862 crop->left = clamp_t(u32, crop->left, left, right - PREV_MIN_OUT_WIDTH);
1863 crop->top = clamp_t(u32, crop->top, top, bottom - PREV_MIN_OUT_HEIGHT);
1864 crop->width = clamp_t(u32, crop->width, PREV_MIN_OUT_WIDTH,
1865 right - crop->left);
1866 crop->height = clamp_t(u32, crop->height, PREV_MIN_OUT_HEIGHT,
1867 bottom - crop->top);
1868}
1869
1870/*
1871 * preview_enum_mbus_code - Handle pixel format enumeration
1872 * @sd : pointer to v4l2 subdev structure
1873 * @fh : V4L2 subdev file handle
1874 * @code : pointer to v4l2_subdev_mbus_code_enum structure
1875 * return -EINVAL or zero on success
1876 */
1877static int preview_enum_mbus_code(struct v4l2_subdev *sd,
1878 struct v4l2_subdev_fh *fh,
1879 struct v4l2_subdev_mbus_code_enum *code)
1880{
1881 switch (code->pad) {
1882 case PREV_PAD_SINK:
1883 if (code->index >= ARRAY_SIZE(preview_input_fmts))
1884 return -EINVAL;
1885
1886 code->code = preview_input_fmts[code->index];
1887 break;
1888 case PREV_PAD_SOURCE:
1889 if (code->index >= ARRAY_SIZE(preview_output_fmts))
1890 return -EINVAL;
1891
1892 code->code = preview_output_fmts[code->index];
1893 break;
1894 default:
1895 return -EINVAL;
1896 }
1897
1898 return 0;
1899}
1900
1901static int preview_enum_frame_size(struct v4l2_subdev *sd,
1902 struct v4l2_subdev_fh *fh,
1903 struct v4l2_subdev_frame_size_enum *fse)
1904{
1905 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
1906 struct v4l2_mbus_framefmt format;
1907
1908 if (fse->index != 0)
1909 return -EINVAL;
1910
1911 format.code = fse->code;
1912 format.width = 1;
1913 format.height = 1;
1914 preview_try_format(prev, fh, fse->pad, &format, V4L2_SUBDEV_FORMAT_TRY);
1915 fse->min_width = format.width;
1916 fse->min_height = format.height;
1917
1918 if (format.code != fse->code)
1919 return -EINVAL;
1920
1921 format.code = fse->code;
1922 format.width = -1;
1923 format.height = -1;
1924 preview_try_format(prev, fh, fse->pad, &format, V4L2_SUBDEV_FORMAT_TRY);
1925 fse->max_width = format.width;
1926 fse->max_height = format.height;
1927
1928 return 0;
1929}
1930
1931/*
1932 * preview_get_selection - Retrieve a selection rectangle on a pad
1933 * @sd: ISP preview V4L2 subdevice
1934 * @fh: V4L2 subdev file handle
1935 * @sel: Selection rectangle
1936 *
1937 * The only supported rectangles are the crop rectangles on the sink pad.
1938 *
1939 * Return 0 on success or a negative error code otherwise.
1940 */
1941static int preview_get_selection(struct v4l2_subdev *sd,
1942 struct v4l2_subdev_fh *fh,
1943 struct v4l2_subdev_selection *sel)
1944{
1945 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
1946 struct v4l2_mbus_framefmt *format;
1947
1948 if (sel->pad != PREV_PAD_SINK)
1949 return -EINVAL;
1950
1951 switch (sel->target) {
1952 case V4L2_SUBDEV_SEL_TGT_CROP_BOUNDS:
1953 sel->r.left = 0;
1954 sel->r.top = 0;
1955 sel->r.width = INT_MAX;
1956 sel->r.height = INT_MAX;
1957
1958 format = __preview_get_format(prev, fh, PREV_PAD_SINK,
1959 sel->which);
1960 preview_try_crop(prev, format, &sel->r);
1961 break;
1962
1963 case V4L2_SUBDEV_SEL_TGT_CROP_ACTUAL:
1964 sel->r = *__preview_get_crop(prev, fh, sel->which);
1965 break;
1966
1967 default:
1968 return -EINVAL;
1969 }
1970
1971 return 0;
1972}
1973
1974/*
1975 * preview_set_selection - Set a selection rectangle on a pad
1976 * @sd: ISP preview V4L2 subdevice
1977 * @fh: V4L2 subdev file handle
1978 * @sel: Selection rectangle
1979 *
1980 * The only supported rectangle is the actual crop rectangle on the sink pad.
1981 *
1982 * Return 0 on success or a negative error code otherwise.
1983 */
1984static int preview_set_selection(struct v4l2_subdev *sd,
1985 struct v4l2_subdev_fh *fh,
1986 struct v4l2_subdev_selection *sel)
1987{
1988 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
1989 struct v4l2_mbus_framefmt *format;
1990
1991 if (sel->target != V4L2_SUBDEV_SEL_TGT_CROP_ACTUAL ||
1992 sel->pad != PREV_PAD_SINK)
1993 return -EINVAL;
1994
1995 /* The crop rectangle can't be changed while streaming. */
1996 if (prev->state != ISP_PIPELINE_STREAM_STOPPED)
1997 return -EBUSY;
1998
1999 /* Modifying the crop rectangle always changes the format on the source
2000 * pad. If the KEEP_CONFIG flag is set, just return the current crop
2001 * rectangle.
2002 */
2003 if (sel->flags & V4L2_SUBDEV_SEL_FLAG_KEEP_CONFIG) {
2004 sel->r = *__preview_get_crop(prev, fh, sel->which);
2005 return 0;
2006 }
2007
2008 format = __preview_get_format(prev, fh, PREV_PAD_SINK, sel->which);
2009 preview_try_crop(prev, format, &sel->r);
2010 *__preview_get_crop(prev, fh, sel->which) = sel->r;
2011
2012 /* Update the source format. */
2013 format = __preview_get_format(prev, fh, PREV_PAD_SOURCE, sel->which);
2014 preview_try_format(prev, fh, PREV_PAD_SOURCE, format, sel->which);
2015
2016 return 0;
2017}
2018
2019/*
2020 * preview_get_format - Handle get format by pads subdev method
2021 * @sd : pointer to v4l2 subdev structure
2022 * @fh : V4L2 subdev file handle
2023 * @fmt: pointer to v4l2 subdev format structure
2024 * return -EINVAL or zero on success
2025 */
2026static int preview_get_format(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh,
2027 struct v4l2_subdev_format *fmt)
2028{
2029 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
2030 struct v4l2_mbus_framefmt *format;
2031
2032 format = __preview_get_format(prev, fh, fmt->pad, fmt->which);
2033 if (format == NULL)
2034 return -EINVAL;
2035
2036 fmt->format = *format;
2037 return 0;
2038}
2039
2040/*
2041 * preview_set_format - Handle set format by pads subdev method
2042 * @sd : pointer to v4l2 subdev structure
2043 * @fh : V4L2 subdev file handle
2044 * @fmt: pointer to v4l2 subdev format structure
2045 * return -EINVAL or zero on success
2046 */
2047static int preview_set_format(struct v4l2_subdev *sd, struct v4l2_subdev_fh *fh,
2048 struct v4l2_subdev_format *fmt)
2049{
2050 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
2051 struct v4l2_mbus_framefmt *format;
2052 struct v4l2_rect *crop;
2053
2054 format = __preview_get_format(prev, fh, fmt->pad, fmt->which);
2055 if (format == NULL)
2056 return -EINVAL;
2057
2058 preview_try_format(prev, fh, fmt->pad, &fmt->format, fmt->which);
2059 *format = fmt->format;
2060
2061 /* Propagate the format from sink to source */
2062 if (fmt->pad == PREV_PAD_SINK) {
2063 /* Reset the crop rectangle. */
2064 crop = __preview_get_crop(prev, fh, fmt->which);
2065 crop->left = 0;
2066 crop->top = 0;
2067 crop->width = fmt->format.width;
2068 crop->height = fmt->format.height;
2069
2070 preview_try_crop(prev, &fmt->format, crop);
2071
2072 /* Update the source format. */
2073 format = __preview_get_format(prev, fh, PREV_PAD_SOURCE,
2074 fmt->which);
2075 preview_try_format(prev, fh, PREV_PAD_SOURCE, format,
2076 fmt->which);
2077 }
2078
2079 return 0;
2080}
2081
2082/*
2083 * preview_init_formats - Initialize formats on all pads
2084 * @sd: ISP preview V4L2 subdevice
2085 * @fh: V4L2 subdev file handle
2086 *
2087 * Initialize all pad formats with default values. If fh is not NULL, try
2088 * formats are initialized on the file handle. Otherwise active formats are
2089 * initialized on the device.
2090 */
2091static int preview_init_formats(struct v4l2_subdev *sd,
2092 struct v4l2_subdev_fh *fh)
2093{
2094 struct v4l2_subdev_format format;
2095
2096 memset(&format, 0, sizeof(format));
2097 format.pad = PREV_PAD_SINK;
2098 format.which = fh ? V4L2_SUBDEV_FORMAT_TRY : V4L2_SUBDEV_FORMAT_ACTIVE;
2099 format.format.code = V4L2_MBUS_FMT_SGRBG10_1X10;
2100 format.format.width = 4096;
2101 format.format.height = 4096;
2102 preview_set_format(sd, fh, &format);
2103
2104 return 0;
2105}
2106
2107/* subdev core operations */
2108static const struct v4l2_subdev_core_ops preview_v4l2_core_ops = {
2109 .ioctl = preview_ioctl,
2110};
2111
2112/* subdev video operations */
2113static const struct v4l2_subdev_video_ops preview_v4l2_video_ops = {
2114 .s_stream = preview_set_stream,
2115};
2116
2117/* subdev pad operations */
2118static const struct v4l2_subdev_pad_ops preview_v4l2_pad_ops = {
2119 .enum_mbus_code = preview_enum_mbus_code,
2120 .enum_frame_size = preview_enum_frame_size,
2121 .get_fmt = preview_get_format,
2122 .set_fmt = preview_set_format,
2123 .get_selection = preview_get_selection,
2124 .set_selection = preview_set_selection,
2125};
2126
2127/* subdev operations */
2128static const struct v4l2_subdev_ops preview_v4l2_ops = {
2129 .core = &preview_v4l2_core_ops,
2130 .video = &preview_v4l2_video_ops,
2131 .pad = &preview_v4l2_pad_ops,
2132};
2133
2134/* subdev internal operations */
2135static const struct v4l2_subdev_internal_ops preview_v4l2_internal_ops = {
2136 .open = preview_init_formats,
2137};
2138
2139/* -----------------------------------------------------------------------------
2140 * Media entity operations
2141 */
2142
2143/*
2144 * preview_link_setup - Setup previewer connections.
2145 * @entity : Pointer to media entity structure
2146 * @local : Pointer to local pad array
2147 * @remote : Pointer to remote pad array
2148 * @flags : Link flags
2149 * return -EINVAL or zero on success
2150 */
2151static int preview_link_setup(struct media_entity *entity,
2152 const struct media_pad *local,
2153 const struct media_pad *remote, u32 flags)
2154{
2155 struct v4l2_subdev *sd = media_entity_to_v4l2_subdev(entity);
2156 struct isp_prev_device *prev = v4l2_get_subdevdata(sd);
2157
2158 switch (local->index | media_entity_type(remote->entity)) {
2159 case PREV_PAD_SINK | MEDIA_ENT_T_DEVNODE:
2160 /* read from memory */
2161 if (flags & MEDIA_LNK_FL_ENABLED) {
2162 if (prev->input == PREVIEW_INPUT_CCDC)
2163 return -EBUSY;
2164 prev->input = PREVIEW_INPUT_MEMORY;
2165 } else {
2166 if (prev->input == PREVIEW_INPUT_MEMORY)
2167 prev->input = PREVIEW_INPUT_NONE;
2168 }
2169 break;
2170
2171 case PREV_PAD_SINK | MEDIA_ENT_T_V4L2_SUBDEV:
2172 /* read from ccdc */
2173 if (flags & MEDIA_LNK_FL_ENABLED) {
2174 if (prev->input == PREVIEW_INPUT_MEMORY)
2175 return -EBUSY;
2176 prev->input = PREVIEW_INPUT_CCDC;
2177 } else {
2178 if (prev->input == PREVIEW_INPUT_CCDC)
2179 prev->input = PREVIEW_INPUT_NONE;
2180 }
2181 break;
2182
2183 /*
2184 * The ISP core doesn't support pipelines with multiple video outputs.
2185 * Revisit this when it will be implemented, and return -EBUSY for now.
2186 */
2187
2188 case PREV_PAD_SOURCE | MEDIA_ENT_T_DEVNODE:
2189 /* write to memory */
2190 if (flags & MEDIA_LNK_FL_ENABLED) {
2191 if (prev->output & ~PREVIEW_OUTPUT_MEMORY)
2192 return -EBUSY;
2193 prev->output |= PREVIEW_OUTPUT_MEMORY;
2194 } else {
2195 prev->output &= ~PREVIEW_OUTPUT_MEMORY;
2196 }
2197 break;
2198
2199 case PREV_PAD_SOURCE | MEDIA_ENT_T_V4L2_SUBDEV:
2200 /* write to resizer */
2201 if (flags & MEDIA_LNK_FL_ENABLED) {
2202 if (prev->output & ~PREVIEW_OUTPUT_RESIZER)
2203 return -EBUSY;
2204 prev->output |= PREVIEW_OUTPUT_RESIZER;
2205 } else {
2206 prev->output &= ~PREVIEW_OUTPUT_RESIZER;
2207 }
2208 break;
2209
2210 default:
2211 return -EINVAL;
2212 }
2213
2214 return 0;
2215}
2216
2217/* media operations */
2218static const struct media_entity_operations preview_media_ops = {
2219 .link_setup = preview_link_setup,
2220 .link_validate = v4l2_subdev_link_validate,
2221};
2222
2223void omap3isp_preview_unregister_entities(struct isp_prev_device *prev)
2224{
2225 v4l2_device_unregister_subdev(&prev->subdev);
2226 omap3isp_video_unregister(&prev->video_in);
2227 omap3isp_video_unregister(&prev->video_out);
2228}
2229
2230int omap3isp_preview_register_entities(struct isp_prev_device *prev,
2231 struct v4l2_device *vdev)
2232{
2233 int ret;
2234
2235 /* Register the subdev and video nodes. */
2236 ret = v4l2_device_register_subdev(vdev, &prev->subdev);
2237 if (ret < 0)
2238 goto error;
2239
2240 ret = omap3isp_video_register(&prev->video_in, vdev);
2241 if (ret < 0)
2242 goto error;
2243
2244 ret = omap3isp_video_register(&prev->video_out, vdev);
2245 if (ret < 0)
2246 goto error;
2247
2248 return 0;
2249
2250error:
2251 omap3isp_preview_unregister_entities(prev);
2252 return ret;
2253}
2254
2255/* -----------------------------------------------------------------------------
2256 * ISP previewer initialisation and cleanup
2257 */
2258
2259/*
2260 * preview_init_entities - Initialize subdev and media entity.
2261 * @prev : Pointer to preview structure
2262 * return -ENOMEM or zero on success
2263 */
2264static int preview_init_entities(struct isp_prev_device *prev)
2265{
2266 struct v4l2_subdev *sd = &prev->subdev;
2267 struct media_pad *pads = prev->pads;
2268 struct media_entity *me = &sd->entity;
2269 int ret;
2270
2271 prev->input = PREVIEW_INPUT_NONE;
2272
2273 v4l2_subdev_init(sd, &preview_v4l2_ops);
2274 sd->internal_ops = &preview_v4l2_internal_ops;
2275 strlcpy(sd->name, "OMAP3 ISP preview", sizeof(sd->name));
2276 sd->grp_id = 1 << 16; /* group ID for isp subdevs */
2277 v4l2_set_subdevdata(sd, prev);
2278 sd->flags |= V4L2_SUBDEV_FL_HAS_DEVNODE;
2279
2280 v4l2_ctrl_handler_init(&prev->ctrls, 2);
2281 v4l2_ctrl_new_std(&prev->ctrls, &preview_ctrl_ops, V4L2_CID_BRIGHTNESS,
2282 ISPPRV_BRIGHT_LOW, ISPPRV_BRIGHT_HIGH,
2283 ISPPRV_BRIGHT_STEP, ISPPRV_BRIGHT_DEF);
2284 v4l2_ctrl_new_std(&prev->ctrls, &preview_ctrl_ops, V4L2_CID_CONTRAST,
2285 ISPPRV_CONTRAST_LOW, ISPPRV_CONTRAST_HIGH,
2286 ISPPRV_CONTRAST_STEP, ISPPRV_CONTRAST_DEF);
2287 v4l2_ctrl_handler_setup(&prev->ctrls);
2288 sd->ctrl_handler = &prev->ctrls;
2289
2290 pads[PREV_PAD_SINK].flags = MEDIA_PAD_FL_SINK;
2291 pads[PREV_PAD_SOURCE].flags = MEDIA_PAD_FL_SOURCE;
2292
2293 me->ops = &preview_media_ops;
2294 ret = media_entity_init(me, PREV_PADS_NUM, pads, 0);
2295 if (ret < 0)
2296 return ret;
2297
2298 preview_init_formats(sd, NULL);
2299
2300 /* According to the OMAP34xx TRM, video buffers need to be aligned on a
2301 * 32 bytes boundary. However, an undocumented hardware bug requires a
2302 * 64 bytes boundary at the preview engine input.
2303 */
2304 prev->video_in.type = V4L2_BUF_TYPE_VIDEO_OUTPUT;
2305 prev->video_in.ops = &preview_video_ops;
2306 prev->video_in.isp = to_isp_device(prev);
2307 prev->video_in.capture_mem = PAGE_ALIGN(4096 * 4096) * 2 * 3;
2308 prev->video_in.bpl_alignment = 64;
2309 prev->video_out.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2310 prev->video_out.ops = &preview_video_ops;
2311 prev->video_out.isp = to_isp_device(prev);
2312 prev->video_out.capture_mem = PAGE_ALIGN(4096 * 4096) * 2 * 3;
2313 prev->video_out.bpl_alignment = 32;
2314
2315 ret = omap3isp_video_init(&prev->video_in, "preview");
2316 if (ret < 0)
2317 goto error_video_in;
2318
2319 ret = omap3isp_video_init(&prev->video_out, "preview");
2320 if (ret < 0)
2321 goto error_video_out;
2322
2323 /* Connect the video nodes to the previewer subdev. */
2324 ret = media_entity_create_link(&prev->video_in.video.entity, 0,
2325 &prev->subdev.entity, PREV_PAD_SINK, 0);
2326 if (ret < 0)
2327 goto error_link;
2328
2329 ret = media_entity_create_link(&prev->subdev.entity, PREV_PAD_SOURCE,
2330 &prev->video_out.video.entity, 0, 0);
2331 if (ret < 0)
2332 goto error_link;
2333
2334 return 0;
2335
2336error_link:
2337 omap3isp_video_cleanup(&prev->video_out);
2338error_video_out:
2339 omap3isp_video_cleanup(&prev->video_in);
2340error_video_in:
2341 media_entity_cleanup(&prev->subdev.entity);
2342 return ret;
2343}
2344
2345/*
2346 * omap3isp_preview_init - Previewer initialization.
2347 * @dev : Pointer to ISP device
2348 * return -ENOMEM or zero on success
2349 */
2350int omap3isp_preview_init(struct isp_device *isp)
2351{
2352 struct isp_prev_device *prev = &isp->isp_prev;
2353
2354 init_waitqueue_head(&prev->wait);
2355
2356 preview_init_params(prev);
2357
2358 return preview_init_entities(prev);
2359}
2360
2361void omap3isp_preview_cleanup(struct isp_device *isp)
2362{
2363 struct isp_prev_device *prev = &isp->isp_prev;
2364
2365 v4l2_ctrl_handler_free(&prev->ctrls);
2366 omap3isp_video_cleanup(&prev->video_in);
2367 omap3isp_video_cleanup(&prev->video_out);
2368 media_entity_cleanup(&prev->subdev.entity);
2369}