1 /*
2 cx231xx_avcore.c - driver for Conexant Cx23100/101/102
3 USB video capture devices
4
5 Copyright (C) 2008 <srinivasa.deevi at conexant dot com>
6
7 This program contains the specific code to control the avdecoder chip and
8 other related usb control functions for cx231xx based chipset.
9
10 This program is free software; you can redistribute it and/or modify
11 it under the terms of the GNU General Public License as published by
12 the Free Software Foundation; either version 2 of the License, or
13 (at your option) any later version.
14
15 This program is distributed in the hope that it will be useful,
16 but WITHOUT ANY WARRANTY; without even the implied warranty of
17 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 GNU General Public License for more details.
19
20 You should have received a copy of the GNU General Public License
21 along with this program; if not, write to the Free Software
22 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
23 */
24
25 #include <linux/init.h>
26 #include <linux/list.h>
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/bitmap.h>
30 #include <linux/usb.h>
31 #include <linux/i2c.h>
32 #include <linux/mm.h>
33 #include <linux/mutex.h>
34 #include <media/tuner.h>
35
36 #include <media/v4l2-common.h>
37 #include <media/v4l2-ioctl.h>
38 #include <media/v4l2-chip-ident.h>
39
40 #include "cx231xx.h"
41 #include "cx231xx-dif.h"
42
43 #define TUNER_MODE_FM_RADIO 0
44 /******************************************************************************
45 -: BLOCK ARRANGEMENT :-
46 I2S block ----------------------|
47 [I2S audio] |
48 |
49 Analog Front End --> Direct IF -|-> Cx25840 --> Audio
50 [video & audio] | [Audio]
51 |
52 |-> Cx25840 --> Video
53 [Video]
54
55 *******************************************************************************/
56 /******************************************************************************
57 * VERVE REGISTER *
58 * *
59 ******************************************************************************/
verve_write_byte(struct cx231xx * dev,u8 saddr,u8 data)60 static int verve_write_byte(struct cx231xx *dev, u8 saddr, u8 data)
61 {
62 return cx231xx_write_i2c_data(dev, VERVE_I2C_ADDRESS,
63 saddr, 1, data, 1);
64 }
65
verve_read_byte(struct cx231xx * dev,u8 saddr,u8 * data)66 static int verve_read_byte(struct cx231xx *dev, u8 saddr, u8 *data)
67 {
68 int status;
69 u32 temp = 0;
70
71 status = cx231xx_read_i2c_data(dev, VERVE_I2C_ADDRESS,
72 saddr, 1, &temp, 1);
73 *data = (u8) temp;
74 return status;
75 }
initGPIO(struct cx231xx * dev)76 void initGPIO(struct cx231xx *dev)
77 {
78 u32 _gpio_direction = 0;
79 u32 value = 0;
80 u8 val = 0;
81
82 _gpio_direction = _gpio_direction & 0xFC0003FF;
83 _gpio_direction = _gpio_direction | 0x03FDFC00;
84 cx231xx_send_gpio_cmd(dev, _gpio_direction, (u8 *)&value, 4, 0, 0);
85
86 verve_read_byte(dev, 0x07, &val);
87 cx231xx_info(" verve_read_byte address0x07=0x%x\n", val);
88 verve_write_byte(dev, 0x07, 0xF4);
89 verve_read_byte(dev, 0x07, &val);
90 cx231xx_info(" verve_read_byte address0x07=0x%x\n", val);
91
92 cx231xx_capture_start(dev, 1, 2);
93
94 cx231xx_mode_register(dev, EP_MODE_SET, 0x0500FE00);
95 cx231xx_mode_register(dev, GBULK_BIT_EN, 0xFFFDFFFF);
96
97 }
uninitGPIO(struct cx231xx * dev)98 void uninitGPIO(struct cx231xx *dev)
99 {
100 u8 value[4] = { 0, 0, 0, 0 };
101
102 cx231xx_capture_start(dev, 0, 2);
103 verve_write_byte(dev, 0x07, 0x14);
104 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
105 0x68, value, 4);
106 }
107
108 /******************************************************************************
109 * A F E - B L O C K C O N T R O L functions *
110 * [ANALOG FRONT END] *
111 ******************************************************************************/
afe_write_byte(struct cx231xx * dev,u16 saddr,u8 data)112 static int afe_write_byte(struct cx231xx *dev, u16 saddr, u8 data)
113 {
114 return cx231xx_write_i2c_data(dev, AFE_DEVICE_ADDRESS,
115 saddr, 2, data, 1);
116 }
117
afe_read_byte(struct cx231xx * dev,u16 saddr,u8 * data)118 static int afe_read_byte(struct cx231xx *dev, u16 saddr, u8 *data)
119 {
120 int status;
121 u32 temp = 0;
122
123 status = cx231xx_read_i2c_data(dev, AFE_DEVICE_ADDRESS,
124 saddr, 2, &temp, 1);
125 *data = (u8) temp;
126 return status;
127 }
128
cx231xx_afe_init_super_block(struct cx231xx * dev,u32 ref_count)129 int cx231xx_afe_init_super_block(struct cx231xx *dev, u32 ref_count)
130 {
131 int status = 0;
132 u8 temp = 0;
133 u8 afe_power_status = 0;
134 int i = 0;
135
136 /* super block initialize */
137 temp = (u8) (ref_count & 0xff);
138 status = afe_write_byte(dev, SUP_BLK_TUNE2, temp);
139 if (status < 0)
140 return status;
141
142 status = afe_read_byte(dev, SUP_BLK_TUNE2, &afe_power_status);
143 if (status < 0)
144 return status;
145
146 temp = (u8) ((ref_count & 0x300) >> 8);
147 temp |= 0x40;
148 status = afe_write_byte(dev, SUP_BLK_TUNE1, temp);
149 if (status < 0)
150 return status;
151
152 status = afe_write_byte(dev, SUP_BLK_PLL2, 0x0f);
153 if (status < 0)
154 return status;
155
156 /* enable pll */
157 while (afe_power_status != 0x18) {
158 status = afe_write_byte(dev, SUP_BLK_PWRDN, 0x18);
159 if (status < 0) {
160 cx231xx_info(
161 ": Init Super Block failed in send cmd\n");
162 break;
163 }
164
165 status = afe_read_byte(dev, SUP_BLK_PWRDN, &afe_power_status);
166 afe_power_status &= 0xff;
167 if (status < 0) {
168 cx231xx_info(
169 ": Init Super Block failed in receive cmd\n");
170 break;
171 }
172 i++;
173 if (i == 10) {
174 cx231xx_info(
175 ": Init Super Block force break in loop !!!!\n");
176 status = -1;
177 break;
178 }
179 }
180
181 if (status < 0)
182 return status;
183
184 /* start tuning filter */
185 status = afe_write_byte(dev, SUP_BLK_TUNE3, 0x40);
186 if (status < 0)
187 return status;
188
189 msleep(5);
190
191 /* exit tuning */
192 status = afe_write_byte(dev, SUP_BLK_TUNE3, 0x00);
193
194 return status;
195 }
196
cx231xx_afe_init_channels(struct cx231xx * dev)197 int cx231xx_afe_init_channels(struct cx231xx *dev)
198 {
199 int status = 0;
200
201 /* power up all 3 channels, clear pd_buffer */
202 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1, 0x00);
203 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2, 0x00);
204 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3, 0x00);
205
206 /* Enable quantizer calibration */
207 status = afe_write_byte(dev, ADC_COM_QUANT, 0x02);
208
209 /* channel initialize, force modulator (fb) reset */
210 status = afe_write_byte(dev, ADC_FB_FRCRST_CH1, 0x17);
211 status = afe_write_byte(dev, ADC_FB_FRCRST_CH2, 0x17);
212 status = afe_write_byte(dev, ADC_FB_FRCRST_CH3, 0x17);
213
214 /* start quantilizer calibration */
215 status = afe_write_byte(dev, ADC_CAL_ATEST_CH1, 0x10);
216 status = afe_write_byte(dev, ADC_CAL_ATEST_CH2, 0x10);
217 status = afe_write_byte(dev, ADC_CAL_ATEST_CH3, 0x10);
218 msleep(5);
219
220 /* exit modulator (fb) reset */
221 status = afe_write_byte(dev, ADC_FB_FRCRST_CH1, 0x07);
222 status = afe_write_byte(dev, ADC_FB_FRCRST_CH2, 0x07);
223 status = afe_write_byte(dev, ADC_FB_FRCRST_CH3, 0x07);
224
225 /* enable the pre_clamp in each channel for single-ended input */
226 status = afe_write_byte(dev, ADC_NTF_PRECLMP_EN_CH1, 0xf0);
227 status = afe_write_byte(dev, ADC_NTF_PRECLMP_EN_CH2, 0xf0);
228 status = afe_write_byte(dev, ADC_NTF_PRECLMP_EN_CH3, 0xf0);
229
230 /* use diode instead of resistor, so set term_en to 0, res_en to 0 */
231 status = cx231xx_reg_mask_write(dev, AFE_DEVICE_ADDRESS, 8,
232 ADC_QGAIN_RES_TRM_CH1, 3, 7, 0x00);
233 status = cx231xx_reg_mask_write(dev, AFE_DEVICE_ADDRESS, 8,
234 ADC_QGAIN_RES_TRM_CH2, 3, 7, 0x00);
235 status = cx231xx_reg_mask_write(dev, AFE_DEVICE_ADDRESS, 8,
236 ADC_QGAIN_RES_TRM_CH3, 3, 7, 0x00);
237
238 /* dynamic element matching off */
239 status = afe_write_byte(dev, ADC_DCSERVO_DEM_CH1, 0x03);
240 status = afe_write_byte(dev, ADC_DCSERVO_DEM_CH2, 0x03);
241 status = afe_write_byte(dev, ADC_DCSERVO_DEM_CH3, 0x03);
242
243 return status;
244 }
245
cx231xx_afe_setup_AFE_for_baseband(struct cx231xx * dev)246 int cx231xx_afe_setup_AFE_for_baseband(struct cx231xx *dev)
247 {
248 u8 c_value = 0;
249 int status = 0;
250
251 status = afe_read_byte(dev, ADC_PWRDN_CLAMP_CH2, &c_value);
252 c_value &= (~(0x50));
253 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2, c_value);
254
255 return status;
256 }
257
258 /*
259 The Analog Front End in Cx231xx has 3 channels. These
260 channels are used to share between different inputs
261 like tuner, s-video and composite inputs.
262
263 channel 1 ----- pin 1 to pin4(in reg is 1-4)
264 channel 2 ----- pin 5 to pin8(in reg is 5-8)
265 channel 3 ----- pin 9 to pin 12(in reg is 9-11)
266 */
cx231xx_afe_set_input_mux(struct cx231xx * dev,u32 input_mux)267 int cx231xx_afe_set_input_mux(struct cx231xx *dev, u32 input_mux)
268 {
269 u8 ch1_setting = (u8) input_mux;
270 u8 ch2_setting = (u8) (input_mux >> 8);
271 u8 ch3_setting = (u8) (input_mux >> 16);
272 int status = 0;
273 u8 value = 0;
274
275 if (ch1_setting != 0) {
276 status = afe_read_byte(dev, ADC_INPUT_CH1, &value);
277 value &= ~INPUT_SEL_MASK;
278 value |= (ch1_setting - 1) << 4;
279 value &= 0xff;
280 status = afe_write_byte(dev, ADC_INPUT_CH1, value);
281 }
282
283 if (ch2_setting != 0) {
284 status = afe_read_byte(dev, ADC_INPUT_CH2, &value);
285 value &= ~INPUT_SEL_MASK;
286 value |= (ch2_setting - 1) << 4;
287 value &= 0xff;
288 status = afe_write_byte(dev, ADC_INPUT_CH2, value);
289 }
290
291 /* For ch3_setting, the value to put in the register is
292 7 less than the input number */
293 if (ch3_setting != 0) {
294 status = afe_read_byte(dev, ADC_INPUT_CH3, &value);
295 value &= ~INPUT_SEL_MASK;
296 value |= (ch3_setting - 1) << 4;
297 value &= 0xff;
298 status = afe_write_byte(dev, ADC_INPUT_CH3, value);
299 }
300
301 return status;
302 }
303
cx231xx_afe_set_mode(struct cx231xx * dev,enum AFE_MODE mode)304 int cx231xx_afe_set_mode(struct cx231xx *dev, enum AFE_MODE mode)
305 {
306 int status = 0;
307
308 /*
309 * FIXME: We need to implement the AFE code for LOW IF and for HI IF.
310 * Currently, only baseband works.
311 */
312
313 switch (mode) {
314 case AFE_MODE_LOW_IF:
315 cx231xx_Setup_AFE_for_LowIF(dev);
316 break;
317 case AFE_MODE_BASEBAND:
318 status = cx231xx_afe_setup_AFE_for_baseband(dev);
319 break;
320 case AFE_MODE_EU_HI_IF:
321 /* SetupAFEforEuHiIF(); */
322 break;
323 case AFE_MODE_US_HI_IF:
324 /* SetupAFEforUsHiIF(); */
325 break;
326 case AFE_MODE_JAPAN_HI_IF:
327 /* SetupAFEforJapanHiIF(); */
328 break;
329 }
330
331 if ((mode != dev->afe_mode) &&
332 (dev->video_input == CX231XX_VMUX_TELEVISION))
333 status = cx231xx_afe_adjust_ref_count(dev,
334 CX231XX_VMUX_TELEVISION);
335
336 dev->afe_mode = mode;
337
338 return status;
339 }
340
cx231xx_afe_update_power_control(struct cx231xx * dev,enum AV_MODE avmode)341 int cx231xx_afe_update_power_control(struct cx231xx *dev,
342 enum AV_MODE avmode)
343 {
344 u8 afe_power_status = 0;
345 int status = 0;
346
347 switch (dev->model) {
348 case CX231XX_BOARD_CNXT_CARRAERA:
349 case CX231XX_BOARD_CNXT_RDE_250:
350 case CX231XX_BOARD_CNXT_SHELBY:
351 case CX231XX_BOARD_CNXT_RDU_250:
352 case CX231XX_BOARD_CNXT_RDE_253S:
353 case CX231XX_BOARD_CNXT_RDU_253S:
354 case CX231XX_BOARD_CNXT_VIDEO_GRABBER:
355 case CX231XX_BOARD_HAUPPAUGE_EXETER:
356 case CX231XX_BOARD_HAUPPAUGE_USBLIVE2:
357 case CX231XX_BOARD_PV_PLAYTV_USB_HYBRID:
358 if (avmode == POLARIS_AVMODE_ANALOGT_TV) {
359 while (afe_power_status != (FLD_PWRDN_TUNING_BIAS |
360 FLD_PWRDN_ENABLE_PLL)) {
361 status = afe_write_byte(dev, SUP_BLK_PWRDN,
362 FLD_PWRDN_TUNING_BIAS |
363 FLD_PWRDN_ENABLE_PLL);
364 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
365 &afe_power_status);
366 if (status < 0)
367 break;
368 }
369
370 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
371 0x00);
372 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
373 0x00);
374 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
375 0x00);
376 } else if (avmode == POLARIS_AVMODE_DIGITAL) {
377 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
378 0x70);
379 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
380 0x70);
381 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
382 0x70);
383
384 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
385 &afe_power_status);
386 afe_power_status |= FLD_PWRDN_PD_BANDGAP |
387 FLD_PWRDN_PD_BIAS |
388 FLD_PWRDN_PD_TUNECK;
389 status |= afe_write_byte(dev, SUP_BLK_PWRDN,
390 afe_power_status);
391 } else if (avmode == POLARIS_AVMODE_ENXTERNAL_AV) {
392 while (afe_power_status != (FLD_PWRDN_TUNING_BIAS |
393 FLD_PWRDN_ENABLE_PLL)) {
394 status = afe_write_byte(dev, SUP_BLK_PWRDN,
395 FLD_PWRDN_TUNING_BIAS |
396 FLD_PWRDN_ENABLE_PLL);
397 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
398 &afe_power_status);
399 if (status < 0)
400 break;
401 }
402
403 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
404 0x00);
405 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
406 0x00);
407 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
408 0x00);
409 } else {
410 cx231xx_info("Invalid AV mode input\n");
411 status = -1;
412 }
413 break;
414 default:
415 if (avmode == POLARIS_AVMODE_ANALOGT_TV) {
416 while (afe_power_status != (FLD_PWRDN_TUNING_BIAS |
417 FLD_PWRDN_ENABLE_PLL)) {
418 status = afe_write_byte(dev, SUP_BLK_PWRDN,
419 FLD_PWRDN_TUNING_BIAS |
420 FLD_PWRDN_ENABLE_PLL);
421 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
422 &afe_power_status);
423 if (status < 0)
424 break;
425 }
426
427 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
428 0x40);
429 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
430 0x40);
431 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
432 0x00);
433 } else if (avmode == POLARIS_AVMODE_DIGITAL) {
434 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
435 0x70);
436 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
437 0x70);
438 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
439 0x70);
440
441 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
442 &afe_power_status);
443 afe_power_status |= FLD_PWRDN_PD_BANDGAP |
444 FLD_PWRDN_PD_BIAS |
445 FLD_PWRDN_PD_TUNECK;
446 status |= afe_write_byte(dev, SUP_BLK_PWRDN,
447 afe_power_status);
448 } else if (avmode == POLARIS_AVMODE_ENXTERNAL_AV) {
449 while (afe_power_status != (FLD_PWRDN_TUNING_BIAS |
450 FLD_PWRDN_ENABLE_PLL)) {
451 status = afe_write_byte(dev, SUP_BLK_PWRDN,
452 FLD_PWRDN_TUNING_BIAS |
453 FLD_PWRDN_ENABLE_PLL);
454 status |= afe_read_byte(dev, SUP_BLK_PWRDN,
455 &afe_power_status);
456 if (status < 0)
457 break;
458 }
459
460 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH1,
461 0x00);
462 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH2,
463 0x00);
464 status |= afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3,
465 0x40);
466 } else {
467 cx231xx_info("Invalid AV mode input\n");
468 status = -1;
469 }
470 } /* switch */
471
472 return status;
473 }
474
cx231xx_afe_adjust_ref_count(struct cx231xx * dev,u32 video_input)475 int cx231xx_afe_adjust_ref_count(struct cx231xx *dev, u32 video_input)
476 {
477 u8 input_mode = 0;
478 u8 ntf_mode = 0;
479 int status = 0;
480
481 dev->video_input = video_input;
482
483 if (video_input == CX231XX_VMUX_TELEVISION) {
484 status = afe_read_byte(dev, ADC_INPUT_CH3, &input_mode);
485 status = afe_read_byte(dev, ADC_NTF_PRECLMP_EN_CH3,
486 &ntf_mode);
487 } else {
488 status = afe_read_byte(dev, ADC_INPUT_CH1, &input_mode);
489 status = afe_read_byte(dev, ADC_NTF_PRECLMP_EN_CH1,
490 &ntf_mode);
491 }
492
493 input_mode = (ntf_mode & 0x3) | ((input_mode & 0x6) << 1);
494
495 switch (input_mode) {
496 case SINGLE_ENDED:
497 dev->afe_ref_count = 0x23C;
498 break;
499 case LOW_IF:
500 dev->afe_ref_count = 0x24C;
501 break;
502 case EU_IF:
503 dev->afe_ref_count = 0x258;
504 break;
505 case US_IF:
506 dev->afe_ref_count = 0x260;
507 break;
508 default:
509 break;
510 }
511
512 status = cx231xx_afe_init_super_block(dev, dev->afe_ref_count);
513
514 return status;
515 }
516
517 /******************************************************************************
518 * V I D E O / A U D I O D E C O D E R C O N T R O L functions *
519 ******************************************************************************/
vid_blk_write_byte(struct cx231xx * dev,u16 saddr,u8 data)520 static int vid_blk_write_byte(struct cx231xx *dev, u16 saddr, u8 data)
521 {
522 return cx231xx_write_i2c_data(dev, VID_BLK_I2C_ADDRESS,
523 saddr, 2, data, 1);
524 }
525
vid_blk_read_byte(struct cx231xx * dev,u16 saddr,u8 * data)526 static int vid_blk_read_byte(struct cx231xx *dev, u16 saddr, u8 *data)
527 {
528 int status;
529 u32 temp = 0;
530
531 status = cx231xx_read_i2c_data(dev, VID_BLK_I2C_ADDRESS,
532 saddr, 2, &temp, 1);
533 *data = (u8) temp;
534 return status;
535 }
536
vid_blk_write_word(struct cx231xx * dev,u16 saddr,u32 data)537 static int vid_blk_write_word(struct cx231xx *dev, u16 saddr, u32 data)
538 {
539 return cx231xx_write_i2c_data(dev, VID_BLK_I2C_ADDRESS,
540 saddr, 2, data, 4);
541 }
542
vid_blk_read_word(struct cx231xx * dev,u16 saddr,u32 * data)543 static int vid_blk_read_word(struct cx231xx *dev, u16 saddr, u32 *data)
544 {
545 return cx231xx_read_i2c_data(dev, VID_BLK_I2C_ADDRESS,
546 saddr, 2, data, 4);
547 }
cx231xx_check_fw(struct cx231xx * dev)548 int cx231xx_check_fw(struct cx231xx *dev)
549 {
550 u8 temp = 0;
551 int status = 0;
552 status = vid_blk_read_byte(dev, DL_CTL_ADDRESS_LOW, &temp);
553 if (status < 0)
554 return status;
555 else
556 return temp;
557
558 }
559
cx231xx_set_video_input_mux(struct cx231xx * dev,u8 input)560 int cx231xx_set_video_input_mux(struct cx231xx *dev, u8 input)
561 {
562 int status = 0;
563
564 switch (INPUT(input)->type) {
565 case CX231XX_VMUX_COMPOSITE1:
566 case CX231XX_VMUX_SVIDEO:
567 if ((dev->current_pcb_config.type == USB_BUS_POWER) &&
568 (dev->power_mode != POLARIS_AVMODE_ENXTERNAL_AV)) {
569 /* External AV */
570 status = cx231xx_set_power_mode(dev,
571 POLARIS_AVMODE_ENXTERNAL_AV);
572 if (status < 0) {
573 cx231xx_errdev("%s: set_power_mode : Failed to"
574 " set Power - errCode [%d]!\n",
575 __func__, status);
576 return status;
577 }
578 }
579 status = cx231xx_set_decoder_video_input(dev,
580 INPUT(input)->type,
581 INPUT(input)->vmux);
582 break;
583 case CX231XX_VMUX_TELEVISION:
584 case CX231XX_VMUX_CABLE:
585 if ((dev->current_pcb_config.type == USB_BUS_POWER) &&
586 (dev->power_mode != POLARIS_AVMODE_ANALOGT_TV)) {
587 /* Tuner */
588 status = cx231xx_set_power_mode(dev,
589 POLARIS_AVMODE_ANALOGT_TV);
590 if (status < 0) {
591 cx231xx_errdev("%s: set_power_mode:Failed"
592 " to set Power - errCode [%d]!\n",
593 __func__, status);
594 return status;
595 }
596 }
597 if (dev->tuner_type == TUNER_NXP_TDA18271)
598 status = cx231xx_set_decoder_video_input(dev,
599 CX231XX_VMUX_TELEVISION,
600 INPUT(input)->vmux);
601 else
602 status = cx231xx_set_decoder_video_input(dev,
603 CX231XX_VMUX_COMPOSITE1,
604 INPUT(input)->vmux);
605
606 break;
607 default:
608 cx231xx_errdev("%s: set_power_mode : Unknown Input %d !\n",
609 __func__, INPUT(input)->type);
610 break;
611 }
612
613 /* save the selection */
614 dev->video_input = input;
615
616 return status;
617 }
618
cx231xx_set_decoder_video_input(struct cx231xx * dev,u8 pin_type,u8 input)619 int cx231xx_set_decoder_video_input(struct cx231xx *dev,
620 u8 pin_type, u8 input)
621 {
622 int status = 0;
623 u32 value = 0;
624
625 if (pin_type != dev->video_input) {
626 status = cx231xx_afe_adjust_ref_count(dev, pin_type);
627 if (status < 0) {
628 cx231xx_errdev("%s: adjust_ref_count :Failed to set"
629 "AFE input mux - errCode [%d]!\n",
630 __func__, status);
631 return status;
632 }
633 }
634
635 /* call afe block to set video inputs */
636 status = cx231xx_afe_set_input_mux(dev, input);
637 if (status < 0) {
638 cx231xx_errdev("%s: set_input_mux :Failed to set"
639 " AFE input mux - errCode [%d]!\n",
640 __func__, status);
641 return status;
642 }
643
644 switch (pin_type) {
645 case CX231XX_VMUX_COMPOSITE1:
646 status = vid_blk_read_word(dev, AFE_CTRL, &value);
647 value |= (0 << 13) | (1 << 4);
648 value &= ~(1 << 5);
649
650 /* set [24:23] [22:15] to 0 */
651 value &= (~(0x1ff8000));
652 /* set FUNC_MODE[24:23] = 2 IF_MOD[22:15] = 0 */
653 value |= 0x1000000;
654 status = vid_blk_write_word(dev, AFE_CTRL, value);
655
656 status = vid_blk_read_word(dev, OUT_CTRL1, &value);
657 value |= (1 << 7);
658 status = vid_blk_write_word(dev, OUT_CTRL1, value);
659
660 /* Set output mode */
661 status = cx231xx_read_modify_write_i2c_dword(dev,
662 VID_BLK_I2C_ADDRESS,
663 OUT_CTRL1,
664 FLD_OUT_MODE,
665 dev->board.output_mode);
666
667 /* Tell DIF object to go to baseband mode */
668 status = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND);
669 if (status < 0) {
670 cx231xx_errdev("%s: cx231xx_dif set to By pass"
671 " mode- errCode [%d]!\n",
672 __func__, status);
673 return status;
674 }
675
676 /* Read the DFE_CTRL1 register */
677 status = vid_blk_read_word(dev, DFE_CTRL1, &value);
678
679 /* enable the VBI_GATE_EN */
680 value |= FLD_VBI_GATE_EN;
681
682 /* Enable the auto-VGA enable */
683 value |= FLD_VGA_AUTO_EN;
684
685 /* Write it back */
686 status = vid_blk_write_word(dev, DFE_CTRL1, value);
687
688 /* Disable auto config of registers */
689 status = cx231xx_read_modify_write_i2c_dword(dev,
690 VID_BLK_I2C_ADDRESS,
691 MODE_CTRL, FLD_ACFG_DIS,
692 cx231xx_set_field(FLD_ACFG_DIS, 1));
693
694 /* Set CVBS input mode */
695 status = cx231xx_read_modify_write_i2c_dword(dev,
696 VID_BLK_I2C_ADDRESS,
697 MODE_CTRL, FLD_INPUT_MODE,
698 cx231xx_set_field(FLD_INPUT_MODE, INPUT_MODE_CVBS_0));
699 break;
700 case CX231XX_VMUX_SVIDEO:
701 /* Disable the use of DIF */
702
703 status = vid_blk_read_word(dev, AFE_CTRL, &value);
704
705 /* set [24:23] [22:15] to 0 */
706 value &= (~(0x1ff8000));
707 /* set FUNC_MODE[24:23] = 2
708 IF_MOD[22:15] = 0 DCR_BYP_CH2[4:4] = 1; */
709 value |= 0x1000010;
710 status = vid_blk_write_word(dev, AFE_CTRL, value);
711
712 /* Tell DIF object to go to baseband mode */
713 status = cx231xx_dif_set_standard(dev, DIF_USE_BASEBAND);
714 if (status < 0) {
715 cx231xx_errdev("%s: cx231xx_dif set to By pass"
716 " mode- errCode [%d]!\n",
717 __func__, status);
718 return status;
719 }
720
721 /* Read the DFE_CTRL1 register */
722 status = vid_blk_read_word(dev, DFE_CTRL1, &value);
723
724 /* enable the VBI_GATE_EN */
725 value |= FLD_VBI_GATE_EN;
726
727 /* Enable the auto-VGA enable */
728 value |= FLD_VGA_AUTO_EN;
729
730 /* Write it back */
731 status = vid_blk_write_word(dev, DFE_CTRL1, value);
732
733 /* Disable auto config of registers */
734 status = cx231xx_read_modify_write_i2c_dword(dev,
735 VID_BLK_I2C_ADDRESS,
736 MODE_CTRL, FLD_ACFG_DIS,
737 cx231xx_set_field(FLD_ACFG_DIS, 1));
738
739 /* Set YC input mode */
740 status = cx231xx_read_modify_write_i2c_dword(dev,
741 VID_BLK_I2C_ADDRESS,
742 MODE_CTRL,
743 FLD_INPUT_MODE,
744 cx231xx_set_field(FLD_INPUT_MODE, INPUT_MODE_YC_1));
745
746 /* Chroma to ADC2 */
747 status = vid_blk_read_word(dev, AFE_CTRL, &value);
748 value |= FLD_CHROMA_IN_SEL; /* set the chroma in select */
749
750 /* Clear VGA_SEL_CH2 and VGA_SEL_CH3 (bits 7 and 8)
751 This sets them to use video
752 rather than audio. Only one of the two will be in use. */
753 value &= ~(FLD_VGA_SEL_CH2 | FLD_VGA_SEL_CH3);
754
755 status = vid_blk_write_word(dev, AFE_CTRL, value);
756
757 status = cx231xx_afe_set_mode(dev, AFE_MODE_BASEBAND);
758 break;
759 case CX231XX_VMUX_TELEVISION:
760 case CX231XX_VMUX_CABLE:
761 default:
762 /* TODO: Test if this is also needed for xc2028/xc3028 */
763 if (dev->board.tuner_type == TUNER_XC5000) {
764 /* Disable the use of DIF */
765
766 status = vid_blk_read_word(dev, AFE_CTRL, &value);
767 value |= (0 << 13) | (1 << 4);
768 value &= ~(1 << 5);
769
770 /* set [24:23] [22:15] to 0 */
771 value &= (~(0x1FF8000));
772 /* set FUNC_MODE[24:23] = 2 IF_MOD[22:15] = 0 */
773 value |= 0x1000000;
774 status = vid_blk_write_word(dev, AFE_CTRL, value);
775
776 status = vid_blk_read_word(dev, OUT_CTRL1, &value);
777 value |= (1 << 7);
778 status = vid_blk_write_word(dev, OUT_CTRL1, value);
779
780 /* Set output mode */
781 status = cx231xx_read_modify_write_i2c_dword(dev,
782 VID_BLK_I2C_ADDRESS,
783 OUT_CTRL1, FLD_OUT_MODE,
784 dev->board.output_mode);
785
786 /* Tell DIF object to go to baseband mode */
787 status = cx231xx_dif_set_standard(dev,
788 DIF_USE_BASEBAND);
789 if (status < 0) {
790 cx231xx_errdev("%s: cx231xx_dif set to By pass"
791 " mode- errCode [%d]!\n",
792 __func__, status);
793 return status;
794 }
795
796 /* Read the DFE_CTRL1 register */
797 status = vid_blk_read_word(dev, DFE_CTRL1, &value);
798
799 /* enable the VBI_GATE_EN */
800 value |= FLD_VBI_GATE_EN;
801
802 /* Enable the auto-VGA enable */
803 value |= FLD_VGA_AUTO_EN;
804
805 /* Write it back */
806 status = vid_blk_write_word(dev, DFE_CTRL1, value);
807
808 /* Disable auto config of registers */
809 status = cx231xx_read_modify_write_i2c_dword(dev,
810 VID_BLK_I2C_ADDRESS,
811 MODE_CTRL, FLD_ACFG_DIS,
812 cx231xx_set_field(FLD_ACFG_DIS, 1));
813
814 /* Set CVBS input mode */
815 status = cx231xx_read_modify_write_i2c_dword(dev,
816 VID_BLK_I2C_ADDRESS,
817 MODE_CTRL, FLD_INPUT_MODE,
818 cx231xx_set_field(FLD_INPUT_MODE,
819 INPUT_MODE_CVBS_0));
820 } else {
821 /* Enable the DIF for the tuner */
822
823 /* Reinitialize the DIF */
824 status = cx231xx_dif_set_standard(dev, dev->norm);
825 if (status < 0) {
826 cx231xx_errdev("%s: cx231xx_dif set to By pass"
827 " mode- errCode [%d]!\n",
828 __func__, status);
829 return status;
830 }
831
832 /* Make sure bypass is cleared */
833 status = vid_blk_read_word(dev, DIF_MISC_CTRL, &value);
834
835 /* Clear the bypass bit */
836 value &= ~FLD_DIF_DIF_BYPASS;
837
838 /* Enable the use of the DIF block */
839 status = vid_blk_write_word(dev, DIF_MISC_CTRL, value);
840
841 /* Read the DFE_CTRL1 register */
842 status = vid_blk_read_word(dev, DFE_CTRL1, &value);
843
844 /* Disable the VBI_GATE_EN */
845 value &= ~FLD_VBI_GATE_EN;
846
847 /* Enable the auto-VGA enable, AGC, and
848 set the skip count to 2 */
849 value |= FLD_VGA_AUTO_EN | FLD_AGC_AUTO_EN | 0x00200000;
850
851 /* Write it back */
852 status = vid_blk_write_word(dev, DFE_CTRL1, value);
853
854 /* Wait until AGC locks up */
855 msleep(1);
856
857 /* Disable the auto-VGA enable AGC */
858 value &= ~(FLD_VGA_AUTO_EN);
859
860 /* Write it back */
861 status = vid_blk_write_word(dev, DFE_CTRL1, value);
862
863 /* Enable Polaris B0 AGC output */
864 status = vid_blk_read_word(dev, PIN_CTRL, &value);
865 value |= (FLD_OEF_AGC_RF) |
866 (FLD_OEF_AGC_IFVGA) |
867 (FLD_OEF_AGC_IF);
868 status = vid_blk_write_word(dev, PIN_CTRL, value);
869
870 /* Set output mode */
871 status = cx231xx_read_modify_write_i2c_dword(dev,
872 VID_BLK_I2C_ADDRESS,
873 OUT_CTRL1, FLD_OUT_MODE,
874 dev->board.output_mode);
875
876 /* Disable auto config of registers */
877 status = cx231xx_read_modify_write_i2c_dword(dev,
878 VID_BLK_I2C_ADDRESS,
879 MODE_CTRL, FLD_ACFG_DIS,
880 cx231xx_set_field(FLD_ACFG_DIS, 1));
881
882 /* Set CVBS input mode */
883 status = cx231xx_read_modify_write_i2c_dword(dev,
884 VID_BLK_I2C_ADDRESS,
885 MODE_CTRL, FLD_INPUT_MODE,
886 cx231xx_set_field(FLD_INPUT_MODE,
887 INPUT_MODE_CVBS_0));
888
889 /* Set some bits in AFE_CTRL so that channel 2 or 3
890 * is ready to receive audio */
891 /* Clear clamp for channels 2 and 3 (bit 16-17) */
892 /* Clear droop comp (bit 19-20) */
893 /* Set VGA_SEL (for audio control) (bit 7-8) */
894 status = vid_blk_read_word(dev, AFE_CTRL, &value);
895
896 /*Set Func mode:01-DIF 10-baseband 11-YUV*/
897 value &= (~(FLD_FUNC_MODE));
898 value |= 0x800000;
899
900 value |= FLD_VGA_SEL_CH3 | FLD_VGA_SEL_CH2;
901
902 status = vid_blk_write_word(dev, AFE_CTRL, value);
903
904 if (dev->tuner_type == TUNER_NXP_TDA18271) {
905 status = vid_blk_read_word(dev, PIN_CTRL,
906 &value);
907 status = vid_blk_write_word(dev, PIN_CTRL,
908 (value & 0xFFFFFFEF));
909 }
910
911 break;
912
913 }
914 break;
915 }
916
917 /* Set raw VBI mode */
918 status = cx231xx_read_modify_write_i2c_dword(dev,
919 VID_BLK_I2C_ADDRESS,
920 OUT_CTRL1, FLD_VBIHACTRAW_EN,
921 cx231xx_set_field(FLD_VBIHACTRAW_EN, 1));
922
923 status = vid_blk_read_word(dev, OUT_CTRL1, &value);
924 if (value & 0x02) {
925 value |= (1 << 19);
926 status = vid_blk_write_word(dev, OUT_CTRL1, value);
927 }
928
929 return status;
930 }
931
cx231xx_enable656(struct cx231xx * dev)932 void cx231xx_enable656(struct cx231xx *dev)
933 {
934 u8 temp = 0;
935 int status;
936 /*enable TS1 data[0:7] as output to export 656*/
937
938 status = vid_blk_write_byte(dev, TS1_PIN_CTL0, 0xFF);
939
940 /*enable TS1 clock as output to export 656*/
941
942 status = vid_blk_read_byte(dev, TS1_PIN_CTL1, &temp);
943 temp = temp|0x04;
944
945 status = vid_blk_write_byte(dev, TS1_PIN_CTL1, temp);
946
947 }
948 EXPORT_SYMBOL_GPL(cx231xx_enable656);
949
cx231xx_disable656(struct cx231xx * dev)950 void cx231xx_disable656(struct cx231xx *dev)
951 {
952 u8 temp = 0;
953 int status;
954
955
956 status = vid_blk_write_byte(dev, TS1_PIN_CTL0, 0x00);
957
958 status = vid_blk_read_byte(dev, TS1_PIN_CTL1, &temp);
959 temp = temp&0xFB;
960
961 status = vid_blk_write_byte(dev, TS1_PIN_CTL1, temp);
962 }
963 EXPORT_SYMBOL_GPL(cx231xx_disable656);
964
965 /*
966 * Handle any video-mode specific overrides that are different
967 * on a per video standards basis after touching the MODE_CTRL
968 * register which resets many values for autodetect
969 */
cx231xx_do_mode_ctrl_overrides(struct cx231xx * dev)970 int cx231xx_do_mode_ctrl_overrides(struct cx231xx *dev)
971 {
972 int status = 0;
973
974 cx231xx_info("do_mode_ctrl_overrides : 0x%x\n",
975 (unsigned int)dev->norm);
976
977 /* Change the DFE_CTRL3 bp_percent to fix flagging */
978 status = vid_blk_write_word(dev, DFE_CTRL3, 0xCD3F0280);
979
980 if (dev->norm & (V4L2_STD_NTSC | V4L2_STD_PAL_M)) {
981 cx231xx_info("do_mode_ctrl_overrides NTSC\n");
982
983 /* Move the close caption lines out of active video,
984 adjust the active video start point */
985 status = cx231xx_read_modify_write_i2c_dword(dev,
986 VID_BLK_I2C_ADDRESS,
987 VERT_TIM_CTRL,
988 FLD_VBLANK_CNT, 0x18);
989 status = cx231xx_read_modify_write_i2c_dword(dev,
990 VID_BLK_I2C_ADDRESS,
991 VERT_TIM_CTRL,
992 FLD_VACTIVE_CNT,
993 0x1E7000);
994 status = cx231xx_read_modify_write_i2c_dword(dev,
995 VID_BLK_I2C_ADDRESS,
996 VERT_TIM_CTRL,
997 FLD_V656BLANK_CNT,
998 0x1C000000);
999
1000 status = cx231xx_read_modify_write_i2c_dword(dev,
1001 VID_BLK_I2C_ADDRESS,
1002 HORIZ_TIM_CTRL,
1003 FLD_HBLANK_CNT,
1004 cx231xx_set_field
1005 (FLD_HBLANK_CNT, 0x79));
1006
1007 } else if (dev->norm & V4L2_STD_SECAM) {
1008 cx231xx_info("do_mode_ctrl_overrides SECAM\n");
1009 status = cx231xx_read_modify_write_i2c_dword(dev,
1010 VID_BLK_I2C_ADDRESS,
1011 VERT_TIM_CTRL,
1012 FLD_VBLANK_CNT, 0x20);
1013 status = cx231xx_read_modify_write_i2c_dword(dev,
1014 VID_BLK_I2C_ADDRESS,
1015 VERT_TIM_CTRL,
1016 FLD_VACTIVE_CNT,
1017 cx231xx_set_field
1018 (FLD_VACTIVE_CNT,
1019 0x244));
1020 status = cx231xx_read_modify_write_i2c_dword(dev,
1021 VID_BLK_I2C_ADDRESS,
1022 VERT_TIM_CTRL,
1023 FLD_V656BLANK_CNT,
1024 cx231xx_set_field
1025 (FLD_V656BLANK_CNT,
1026 0x24));
1027 /* Adjust the active video horizontal start point */
1028 status = cx231xx_read_modify_write_i2c_dword(dev,
1029 VID_BLK_I2C_ADDRESS,
1030 HORIZ_TIM_CTRL,
1031 FLD_HBLANK_CNT,
1032 cx231xx_set_field
1033 (FLD_HBLANK_CNT, 0x85));
1034 } else {
1035 cx231xx_info("do_mode_ctrl_overrides PAL\n");
1036 status = cx231xx_read_modify_write_i2c_dword(dev,
1037 VID_BLK_I2C_ADDRESS,
1038 VERT_TIM_CTRL,
1039 FLD_VBLANK_CNT, 0x20);
1040 status = cx231xx_read_modify_write_i2c_dword(dev,
1041 VID_BLK_I2C_ADDRESS,
1042 VERT_TIM_CTRL,
1043 FLD_VACTIVE_CNT,
1044 cx231xx_set_field
1045 (FLD_VACTIVE_CNT,
1046 0x244));
1047 status = cx231xx_read_modify_write_i2c_dword(dev,
1048 VID_BLK_I2C_ADDRESS,
1049 VERT_TIM_CTRL,
1050 FLD_V656BLANK_CNT,
1051 cx231xx_set_field
1052 (FLD_V656BLANK_CNT,
1053 0x24));
1054 /* Adjust the active video horizontal start point */
1055 status = cx231xx_read_modify_write_i2c_dword(dev,
1056 VID_BLK_I2C_ADDRESS,
1057 HORIZ_TIM_CTRL,
1058 FLD_HBLANK_CNT,
1059 cx231xx_set_field
1060 (FLD_HBLANK_CNT, 0x85));
1061
1062 }
1063
1064 return status;
1065 }
1066
cx231xx_unmute_audio(struct cx231xx * dev)1067 int cx231xx_unmute_audio(struct cx231xx *dev)
1068 {
1069 return vid_blk_write_byte(dev, PATH1_VOL_CTL, 0x24);
1070 }
1071 EXPORT_SYMBOL_GPL(cx231xx_unmute_audio);
1072
stopAudioFirmware(struct cx231xx * dev)1073 int stopAudioFirmware(struct cx231xx *dev)
1074 {
1075 return vid_blk_write_byte(dev, DL_CTL_CONTROL, 0x03);
1076 }
1077
restartAudioFirmware(struct cx231xx * dev)1078 int restartAudioFirmware(struct cx231xx *dev)
1079 {
1080 return vid_blk_write_byte(dev, DL_CTL_CONTROL, 0x13);
1081 }
1082
cx231xx_set_audio_input(struct cx231xx * dev,u8 input)1083 int cx231xx_set_audio_input(struct cx231xx *dev, u8 input)
1084 {
1085 int status = 0;
1086 enum AUDIO_INPUT ainput = AUDIO_INPUT_LINE;
1087
1088 switch (INPUT(input)->amux) {
1089 case CX231XX_AMUX_VIDEO:
1090 ainput = AUDIO_INPUT_TUNER_TV;
1091 break;
1092 case CX231XX_AMUX_LINE_IN:
1093 status = cx231xx_i2s_blk_set_audio_input(dev, input);
1094 ainput = AUDIO_INPUT_LINE;
1095 break;
1096 default:
1097 break;
1098 }
1099
1100 status = cx231xx_set_audio_decoder_input(dev, ainput);
1101
1102 return status;
1103 }
1104
cx231xx_set_audio_decoder_input(struct cx231xx * dev,enum AUDIO_INPUT audio_input)1105 int cx231xx_set_audio_decoder_input(struct cx231xx *dev,
1106 enum AUDIO_INPUT audio_input)
1107 {
1108 u32 dwval;
1109 int status;
1110 u8 gen_ctrl;
1111 u32 value = 0;
1112
1113 /* Put it in soft reset */
1114 status = vid_blk_read_byte(dev, GENERAL_CTL, &gen_ctrl);
1115 gen_ctrl |= 1;
1116 status = vid_blk_write_byte(dev, GENERAL_CTL, gen_ctrl);
1117
1118 switch (audio_input) {
1119 case AUDIO_INPUT_LINE:
1120 /* setup AUD_IO control from Merlin paralle output */
1121 value = cx231xx_set_field(FLD_AUD_CHAN1_SRC,
1122 AUD_CHAN_SRC_PARALLEL);
1123 status = vid_blk_write_word(dev, AUD_IO_CTRL, value);
1124
1125 /* setup input to Merlin, SRC2 connect to AC97
1126 bypass upsample-by-2, slave mode, sony mode, left justify
1127 adr 091c, dat 01000000 */
1128 status = vid_blk_read_word(dev, AC97_CTL, &dwval);
1129
1130 status = vid_blk_write_word(dev, AC97_CTL,
1131 (dwval | FLD_AC97_UP2X_BYPASS));
1132
1133 /* select the parallel1 and SRC3 */
1134 status = vid_blk_write_word(dev, BAND_OUT_SEL,
1135 cx231xx_set_field(FLD_SRC3_IN_SEL, 0x0) |
1136 cx231xx_set_field(FLD_SRC3_CLK_SEL, 0x0) |
1137 cx231xx_set_field(FLD_PARALLEL1_SRC_SEL, 0x0));
1138
1139 /* unmute all, AC97 in, independence mode
1140 adr 08d0, data 0x00063073 */
1141 status = vid_blk_write_word(dev, DL_CTL, 0x3000001);
1142 status = vid_blk_write_word(dev, PATH1_CTL1, 0x00063073);
1143
1144 /* set AVC maximum threshold, adr 08d4, dat ffff0024 */
1145 status = vid_blk_read_word(dev, PATH1_VOL_CTL, &dwval);
1146 status = vid_blk_write_word(dev, PATH1_VOL_CTL,
1147 (dwval | FLD_PATH1_AVC_THRESHOLD));
1148
1149 /* set SC maximum threshold, adr 08ec, dat ffffb3a3 */
1150 status = vid_blk_read_word(dev, PATH1_SC_CTL, &dwval);
1151 status = vid_blk_write_word(dev, PATH1_SC_CTL,
1152 (dwval | FLD_PATH1_SC_THRESHOLD));
1153 break;
1154
1155 case AUDIO_INPUT_TUNER_TV:
1156 default:
1157 status = stopAudioFirmware(dev);
1158 /* Setup SRC sources and clocks */
1159 status = vid_blk_write_word(dev, BAND_OUT_SEL,
1160 cx231xx_set_field(FLD_SRC6_IN_SEL, 0x00) |
1161 cx231xx_set_field(FLD_SRC6_CLK_SEL, 0x01) |
1162 cx231xx_set_field(FLD_SRC5_IN_SEL, 0x00) |
1163 cx231xx_set_field(FLD_SRC5_CLK_SEL, 0x02) |
1164 cx231xx_set_field(FLD_SRC4_IN_SEL, 0x02) |
1165 cx231xx_set_field(FLD_SRC4_CLK_SEL, 0x03) |
1166 cx231xx_set_field(FLD_SRC3_IN_SEL, 0x00) |
1167 cx231xx_set_field(FLD_SRC3_CLK_SEL, 0x00) |
1168 cx231xx_set_field(FLD_BASEBAND_BYPASS_CTL, 0x00) |
1169 cx231xx_set_field(FLD_AC97_SRC_SEL, 0x03) |
1170 cx231xx_set_field(FLD_I2S_SRC_SEL, 0x00) |
1171 cx231xx_set_field(FLD_PARALLEL2_SRC_SEL, 0x02) |
1172 cx231xx_set_field(FLD_PARALLEL1_SRC_SEL, 0x01));
1173
1174 /* Setup the AUD_IO control */
1175 status = vid_blk_write_word(dev, AUD_IO_CTRL,
1176 cx231xx_set_field(FLD_I2S_PORT_DIR, 0x00) |
1177 cx231xx_set_field(FLD_I2S_OUT_SRC, 0x00) |
1178 cx231xx_set_field(FLD_AUD_CHAN3_SRC, 0x00) |
1179 cx231xx_set_field(FLD_AUD_CHAN2_SRC, 0x00) |
1180 cx231xx_set_field(FLD_AUD_CHAN1_SRC, 0x03));
1181
1182 status = vid_blk_write_word(dev, PATH1_CTL1, 0x1F063870);
1183
1184 /* setAudioStandard(_audio_standard); */
1185 status = vid_blk_write_word(dev, PATH1_CTL1, 0x00063870);
1186
1187 status = restartAudioFirmware(dev);
1188
1189 switch (dev->board.tuner_type) {
1190 case TUNER_XC5000:
1191 /* SIF passthrough at 28.6363 MHz sample rate */
1192 status = cx231xx_read_modify_write_i2c_dword(dev,
1193 VID_BLK_I2C_ADDRESS,
1194 CHIP_CTRL,
1195 FLD_SIF_EN,
1196 cx231xx_set_field(FLD_SIF_EN, 1));
1197 break;
1198 case TUNER_NXP_TDA18271:
1199 /* Normal mode: SIF passthrough at 14.32 MHz */
1200 status = cx231xx_read_modify_write_i2c_dword(dev,
1201 VID_BLK_I2C_ADDRESS,
1202 CHIP_CTRL,
1203 FLD_SIF_EN,
1204 cx231xx_set_field(FLD_SIF_EN, 0));
1205 break;
1206 default:
1207 /* This is just a casual suggestion to people adding
1208 new boards in case they use a tuner type we don't
1209 currently know about */
1210 printk(KERN_INFO "Unknown tuner type configuring SIF");
1211 break;
1212 }
1213 break;
1214
1215 case AUDIO_INPUT_TUNER_FM:
1216 /* use SIF for FM radio
1217 setupFM();
1218 setAudioStandard(_audio_standard);
1219 */
1220 break;
1221
1222 case AUDIO_INPUT_MUTE:
1223 status = vid_blk_write_word(dev, PATH1_CTL1, 0x1F011012);
1224 break;
1225 }
1226
1227 /* Take it out of soft reset */
1228 status = vid_blk_read_byte(dev, GENERAL_CTL, &gen_ctrl);
1229 gen_ctrl &= ~1;
1230 status = vid_blk_write_byte(dev, GENERAL_CTL, gen_ctrl);
1231
1232 return status;
1233 }
1234
1235 /******************************************************************************
1236 * C H I P Specific C O N T R O L functions *
1237 ******************************************************************************/
cx231xx_init_ctrl_pin_status(struct cx231xx * dev)1238 int cx231xx_init_ctrl_pin_status(struct cx231xx *dev)
1239 {
1240 u32 value;
1241 int status = 0;
1242
1243 status = vid_blk_read_word(dev, PIN_CTRL, &value);
1244 value |= (~dev->board.ctl_pin_status_mask);
1245 status = vid_blk_write_word(dev, PIN_CTRL, value);
1246
1247 return status;
1248 }
1249
cx231xx_set_agc_analog_digital_mux_select(struct cx231xx * dev,u8 analog_or_digital)1250 int cx231xx_set_agc_analog_digital_mux_select(struct cx231xx *dev,
1251 u8 analog_or_digital)
1252 {
1253 int status = 0;
1254
1255 /* first set the direction to output */
1256 status = cx231xx_set_gpio_direction(dev,
1257 dev->board.
1258 agc_analog_digital_select_gpio, 1);
1259
1260 /* 0 - demod ; 1 - Analog mode */
1261 status = cx231xx_set_gpio_value(dev,
1262 dev->board.agc_analog_digital_select_gpio,
1263 analog_or_digital);
1264
1265 return status;
1266 }
1267
cx231xx_enable_i2c_port_3(struct cx231xx * dev,bool is_port_3)1268 int cx231xx_enable_i2c_port_3(struct cx231xx *dev, bool is_port_3)
1269 {
1270 u8 value[4] = { 0, 0, 0, 0 };
1271 int status = 0;
1272 bool current_is_port_3;
1273
1274 if (dev->board.dont_use_port_3)
1275 is_port_3 = false;
1276 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER,
1277 PWR_CTL_EN, value, 4);
1278 if (status < 0)
1279 return status;
1280
1281 current_is_port_3 = value[0] & I2C_DEMOD_EN ? true : false;
1282
1283 /* Just return, if already using the right port */
1284 if (current_is_port_3 == is_port_3)
1285 return 0;
1286
1287 if (is_port_3)
1288 value[0] |= I2C_DEMOD_EN;
1289 else
1290 value[0] &= ~I2C_DEMOD_EN;
1291
1292 cx231xx_info("Changing the i2c master port to %d\n",
1293 is_port_3 ? 3 : 1);
1294
1295 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
1296 PWR_CTL_EN, value, 4);
1297
1298 return status;
1299
1300 }
1301 EXPORT_SYMBOL_GPL(cx231xx_enable_i2c_port_3);
1302
update_HH_register_after_set_DIF(struct cx231xx * dev)1303 void update_HH_register_after_set_DIF(struct cx231xx *dev)
1304 {
1305 /*
1306 u8 status = 0;
1307 u32 value = 0;
1308
1309 vid_blk_write_word(dev, PIN_CTRL, 0xA0FFF82F);
1310 vid_blk_write_word(dev, DIF_MISC_CTRL, 0x0A203F11);
1311 vid_blk_write_word(dev, DIF_SRC_PHASE_INC, 0x1BEFBF06);
1312
1313 status = vid_blk_read_word(dev, AFE_CTRL_C2HH_SRC_CTRL, &value);
1314 vid_blk_write_word(dev, AFE_CTRL_C2HH_SRC_CTRL, 0x4485D390);
1315 status = vid_blk_read_word(dev, AFE_CTRL_C2HH_SRC_CTRL, &value);
1316 */
1317 }
1318
cx231xx_dump_HH_reg(struct cx231xx * dev)1319 void cx231xx_dump_HH_reg(struct cx231xx *dev)
1320 {
1321 u8 status = 0;
1322 u32 value = 0;
1323 u16 i = 0;
1324
1325 value = 0x45005390;
1326 status = vid_blk_write_word(dev, 0x104, value);
1327
1328 for (i = 0x100; i < 0x140; i++) {
1329 status = vid_blk_read_word(dev, i, &value);
1330 cx231xx_info("reg0x%x=0x%x\n", i, value);
1331 i = i+3;
1332 }
1333
1334 for (i = 0x300; i < 0x400; i++) {
1335 status = vid_blk_read_word(dev, i, &value);
1336 cx231xx_info("reg0x%x=0x%x\n", i, value);
1337 i = i+3;
1338 }
1339
1340 for (i = 0x400; i < 0x440; i++) {
1341 status = vid_blk_read_word(dev, i, &value);
1342 cx231xx_info("reg0x%x=0x%x\n", i, value);
1343 i = i+3;
1344 }
1345
1346 status = vid_blk_read_word(dev, AFE_CTRL_C2HH_SRC_CTRL, &value);
1347 cx231xx_info("AFE_CTRL_C2HH_SRC_CTRL=0x%x\n", value);
1348 vid_blk_write_word(dev, AFE_CTRL_C2HH_SRC_CTRL, 0x4485D390);
1349 status = vid_blk_read_word(dev, AFE_CTRL_C2HH_SRC_CTRL, &value);
1350 cx231xx_info("AFE_CTRL_C2HH_SRC_CTRL=0x%x\n", value);
1351 }
1352
cx231xx_dump_SC_reg(struct cx231xx * dev)1353 void cx231xx_dump_SC_reg(struct cx231xx *dev)
1354 {
1355 u8 value[4] = { 0, 0, 0, 0 };
1356 int status = 0;
1357 cx231xx_info("cx231xx_dump_SC_reg %s!\n", __TIME__);
1358
1359 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, BOARD_CFG_STAT,
1360 value, 4);
1361 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", BOARD_CFG_STAT, value[0],
1362 value[1], value[2], value[3]);
1363 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, TS_MODE_REG,
1364 value, 4);
1365 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", TS_MODE_REG, value[0],
1366 value[1], value[2], value[3]);
1367 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, TS1_CFG_REG,
1368 value, 4);
1369 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", TS1_CFG_REG, value[0],
1370 value[1], value[2], value[3]);
1371 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, TS1_LENGTH_REG,
1372 value, 4);
1373 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", TS1_LENGTH_REG, value[0],
1374 value[1], value[2], value[3]);
1375
1376 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, TS2_CFG_REG,
1377 value, 4);
1378 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", TS2_CFG_REG, value[0],
1379 value[1], value[2], value[3]);
1380 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, TS2_LENGTH_REG,
1381 value, 4);
1382 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", TS2_LENGTH_REG, value[0],
1383 value[1], value[2], value[3]);
1384 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, EP_MODE_SET,
1385 value, 4);
1386 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", EP_MODE_SET, value[0],
1387 value[1], value[2], value[3]);
1388 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_PTN1,
1389 value, 4);
1390 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_PTN1, value[0],
1391 value[1], value[2], value[3]);
1392
1393 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_PTN2,
1394 value, 4);
1395 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_PTN2, value[0],
1396 value[1], value[2], value[3]);
1397 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_PTN3,
1398 value, 4);
1399 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_PTN3, value[0],
1400 value[1], value[2], value[3]);
1401 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_MASK0,
1402 value, 4);
1403 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_MASK0, value[0],
1404 value[1], value[2], value[3]);
1405 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_MASK1,
1406 value, 4);
1407 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_MASK1, value[0],
1408 value[1], value[2], value[3]);
1409
1410 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_PWR_MASK2,
1411 value, 4);
1412 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_PWR_MASK2, value[0],
1413 value[1], value[2], value[3]);
1414 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_GAIN,
1415 value, 4);
1416 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_GAIN, value[0],
1417 value[1], value[2], value[3]);
1418 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_CAR_REG,
1419 value, 4);
1420 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_CAR_REG, value[0],
1421 value[1], value[2], value[3]);
1422 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_OT_CFG1,
1423 value, 4);
1424 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_OT_CFG1, value[0],
1425 value[1], value[2], value[3]);
1426
1427 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, CIR_OT_CFG2,
1428 value, 4);
1429 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", CIR_OT_CFG2, value[0],
1430 value[1], value[2], value[3]);
1431 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN,
1432 value, 4);
1433 cx231xx_info("reg0x%x=0x%x 0x%x 0x%x 0x%x\n", PWR_CTL_EN, value[0],
1434 value[1], value[2], value[3]);
1435
1436
1437 }
1438
cx231xx_Setup_AFE_for_LowIF(struct cx231xx * dev)1439 void cx231xx_Setup_AFE_for_LowIF(struct cx231xx *dev)
1440
1441 {
1442 u8 status = 0;
1443 u8 value = 0;
1444
1445
1446
1447 status = afe_read_byte(dev, ADC_STATUS2_CH3, &value);
1448 value = (value & 0xFE)|0x01;
1449 status = afe_write_byte(dev, ADC_STATUS2_CH3, value);
1450
1451 status = afe_read_byte(dev, ADC_STATUS2_CH3, &value);
1452 value = (value & 0xFE)|0x00;
1453 status = afe_write_byte(dev, ADC_STATUS2_CH3, value);
1454
1455
1456 /*
1457 config colibri to lo-if mode
1458
1459 FIXME: ntf_mode = 2'b00 by default. But set 0x1 would reduce
1460 the diff IF input by half,
1461
1462 for low-if agc defect
1463 */
1464
1465 status = afe_read_byte(dev, ADC_NTF_PRECLMP_EN_CH3, &value);
1466 value = (value & 0xFC)|0x00;
1467 status = afe_write_byte(dev, ADC_NTF_PRECLMP_EN_CH3, value);
1468
1469 status = afe_read_byte(dev, ADC_INPUT_CH3, &value);
1470 value = (value & 0xF9)|0x02;
1471 status = afe_write_byte(dev, ADC_INPUT_CH3, value);
1472
1473 status = afe_read_byte(dev, ADC_FB_FRCRST_CH3, &value);
1474 value = (value & 0xFB)|0x04;
1475 status = afe_write_byte(dev, ADC_FB_FRCRST_CH3, value);
1476
1477 status = afe_read_byte(dev, ADC_DCSERVO_DEM_CH3, &value);
1478 value = (value & 0xFC)|0x03;
1479 status = afe_write_byte(dev, ADC_DCSERVO_DEM_CH3, value);
1480
1481 status = afe_read_byte(dev, ADC_CTRL_DAC1_CH3, &value);
1482 value = (value & 0xFB)|0x04;
1483 status = afe_write_byte(dev, ADC_CTRL_DAC1_CH3, value);
1484
1485 status = afe_read_byte(dev, ADC_CTRL_DAC23_CH3, &value);
1486 value = (value & 0xF8)|0x06;
1487 status = afe_write_byte(dev, ADC_CTRL_DAC23_CH3, value);
1488
1489 status = afe_read_byte(dev, ADC_CTRL_DAC23_CH3, &value);
1490 value = (value & 0x8F)|0x40;
1491 status = afe_write_byte(dev, ADC_CTRL_DAC23_CH3, value);
1492
1493 status = afe_read_byte(dev, ADC_PWRDN_CLAMP_CH3, &value);
1494 value = (value & 0xDF)|0x20;
1495 status = afe_write_byte(dev, ADC_PWRDN_CLAMP_CH3, value);
1496 }
1497
cx231xx_set_Colibri_For_LowIF(struct cx231xx * dev,u32 if_freq,u8 spectral_invert,u32 mode)1498 void cx231xx_set_Colibri_For_LowIF(struct cx231xx *dev, u32 if_freq,
1499 u8 spectral_invert, u32 mode)
1500 {
1501 u32 colibri_carrier_offset = 0;
1502 u8 status = 0;
1503 u32 func_mode = 0x01; /* Device has a DIF if this function is called */
1504 u32 standard = 0;
1505 u8 value[4] = { 0, 0, 0, 0 };
1506
1507 cx231xx_info("Enter cx231xx_set_Colibri_For_LowIF()\n");
1508 value[0] = (u8) 0x6F;
1509 value[1] = (u8) 0x6F;
1510 value[2] = (u8) 0x6F;
1511 value[3] = (u8) 0x6F;
1512 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
1513 PWR_CTL_EN, value, 4);
1514
1515 /*Set colibri for low IF*/
1516 status = cx231xx_afe_set_mode(dev, AFE_MODE_LOW_IF);
1517
1518 /* Set C2HH for low IF operation.*/
1519 standard = dev->norm;
1520 status = cx231xx_dif_configure_C2HH_for_low_IF(dev, dev->active_mode,
1521 func_mode, standard);
1522
1523 /* Get colibri offsets.*/
1524 colibri_carrier_offset = cx231xx_Get_Colibri_CarrierOffset(mode,
1525 standard);
1526
1527 cx231xx_info("colibri_carrier_offset=%d, standard=0x%x\n",
1528 colibri_carrier_offset, standard);
1529
1530 /* Set the band Pass filter for DIF*/
1531 cx231xx_set_DIF_bandpass(dev, (if_freq+colibri_carrier_offset),
1532 spectral_invert, mode);
1533 }
1534
cx231xx_Get_Colibri_CarrierOffset(u32 mode,u32 standerd)1535 u32 cx231xx_Get_Colibri_CarrierOffset(u32 mode, u32 standerd)
1536 {
1537 u32 colibri_carrier_offset = 0;
1538
1539 if (mode == TUNER_MODE_FM_RADIO) {
1540 colibri_carrier_offset = 1100000;
1541 } else if (standerd & (V4L2_STD_MN | V4L2_STD_NTSC_M_JP)) {
1542 colibri_carrier_offset = 4832000; /*4.83MHz */
1543 } else if (standerd & (V4L2_STD_PAL_B | V4L2_STD_PAL_G)) {
1544 colibri_carrier_offset = 2700000; /*2.70MHz */
1545 } else if (standerd & (V4L2_STD_PAL_D | V4L2_STD_PAL_I
1546 | V4L2_STD_SECAM)) {
1547 colibri_carrier_offset = 2100000; /*2.10MHz */
1548 }
1549
1550 return colibri_carrier_offset;
1551 }
1552
cx231xx_set_DIF_bandpass(struct cx231xx * dev,u32 if_freq,u8 spectral_invert,u32 mode)1553 void cx231xx_set_DIF_bandpass(struct cx231xx *dev, u32 if_freq,
1554 u8 spectral_invert, u32 mode)
1555 {
1556 unsigned long pll_freq_word;
1557 int status = 0;
1558 u32 dif_misc_ctrl_value = 0;
1559 u64 pll_freq_u64 = 0;
1560 u32 i = 0;
1561
1562 cx231xx_info("if_freq=%d;spectral_invert=0x%x;mode=0x%x\n",
1563 if_freq, spectral_invert, mode);
1564
1565
1566 if (mode == TUNER_MODE_FM_RADIO) {
1567 pll_freq_word = 0x905A1CAC;
1568 status = vid_blk_write_word(dev, DIF_PLL_FREQ_WORD, pll_freq_word);
1569
1570 } else /*KSPROPERTY_TUNER_MODE_TV*/{
1571 /* Calculate the PLL frequency word based on the adjusted if_freq*/
1572 pll_freq_word = if_freq;
1573 pll_freq_u64 = (u64)pll_freq_word << 28L;
1574 do_div(pll_freq_u64, 50000000);
1575 pll_freq_word = (u32)pll_freq_u64;
1576 /*pll_freq_word = 0x3463497;*/
1577 status = vid_blk_write_word(dev, DIF_PLL_FREQ_WORD, pll_freq_word);
1578
1579 if (spectral_invert) {
1580 if_freq -= 400000;
1581 /* Enable Spectral Invert*/
1582 status = vid_blk_read_word(dev, DIF_MISC_CTRL,
1583 &dif_misc_ctrl_value);
1584 dif_misc_ctrl_value = dif_misc_ctrl_value | 0x00200000;
1585 status = vid_blk_write_word(dev, DIF_MISC_CTRL,
1586 dif_misc_ctrl_value);
1587 } else {
1588 if_freq += 400000;
1589 /* Disable Spectral Invert*/
1590 status = vid_blk_read_word(dev, DIF_MISC_CTRL,
1591 &dif_misc_ctrl_value);
1592 dif_misc_ctrl_value = dif_misc_ctrl_value & 0xFFDFFFFF;
1593 status = vid_blk_write_word(dev, DIF_MISC_CTRL,
1594 dif_misc_ctrl_value);
1595 }
1596
1597 if_freq = (if_freq/100000)*100000;
1598
1599 if (if_freq < 3000000)
1600 if_freq = 3000000;
1601
1602 if (if_freq > 16000000)
1603 if_freq = 16000000;
1604 }
1605
1606 cx231xx_info("Enter IF=%zd\n",
1607 sizeof(Dif_set_array)/sizeof(struct dif_settings));
1608 for (i = 0; i < sizeof(Dif_set_array)/sizeof(struct dif_settings); i++) {
1609 if (Dif_set_array[i].if_freq == if_freq) {
1610 status = vid_blk_write_word(dev,
1611 Dif_set_array[i].register_address, Dif_set_array[i].value);
1612 }
1613 }
1614 }
1615
1616 /******************************************************************************
1617 * D I F - B L O C K C O N T R O L functions *
1618 ******************************************************************************/
cx231xx_dif_configure_C2HH_for_low_IF(struct cx231xx * dev,u32 mode,u32 function_mode,u32 standard)1619 int cx231xx_dif_configure_C2HH_for_low_IF(struct cx231xx *dev, u32 mode,
1620 u32 function_mode, u32 standard)
1621 {
1622 int status = 0;
1623
1624
1625 if (mode == V4L2_TUNER_RADIO) {
1626 /* C2HH */
1627 /* lo if big signal */
1628 status = cx231xx_reg_mask_write(dev,
1629 VID_BLK_I2C_ADDRESS, 32,
1630 AFE_CTRL_C2HH_SRC_CTRL, 30, 31, 0x1);
1631 /* FUNC_MODE = DIF */
1632 status = cx231xx_reg_mask_write(dev,
1633 VID_BLK_I2C_ADDRESS, 32,
1634 AFE_CTRL_C2HH_SRC_CTRL, 23, 24, function_mode);
1635 /* IF_MODE */
1636 status = cx231xx_reg_mask_write(dev,
1637 VID_BLK_I2C_ADDRESS, 32,
1638 AFE_CTRL_C2HH_SRC_CTRL, 15, 22, 0xFF);
1639 /* no inv */
1640 status = cx231xx_reg_mask_write(dev,
1641 VID_BLK_I2C_ADDRESS, 32,
1642 AFE_CTRL_C2HH_SRC_CTRL, 9, 9, 0x1);
1643 } else if (standard != DIF_USE_BASEBAND) {
1644 if (standard & V4L2_STD_MN) {
1645 /* lo if big signal */
1646 status = cx231xx_reg_mask_write(dev,
1647 VID_BLK_I2C_ADDRESS, 32,
1648 AFE_CTRL_C2HH_SRC_CTRL, 30, 31, 0x1);
1649 /* FUNC_MODE = DIF */
1650 status = cx231xx_reg_mask_write(dev,
1651 VID_BLK_I2C_ADDRESS, 32,
1652 AFE_CTRL_C2HH_SRC_CTRL, 23, 24,
1653 function_mode);
1654 /* IF_MODE */
1655 status = cx231xx_reg_mask_write(dev,
1656 VID_BLK_I2C_ADDRESS, 32,
1657 AFE_CTRL_C2HH_SRC_CTRL, 15, 22, 0xb);
1658 /* no inv */
1659 status = cx231xx_reg_mask_write(dev,
1660 VID_BLK_I2C_ADDRESS, 32,
1661 AFE_CTRL_C2HH_SRC_CTRL, 9, 9, 0x1);
1662 /* 0x124, AUD_CHAN1_SRC = 0x3 */
1663 status = cx231xx_reg_mask_write(dev,
1664 VID_BLK_I2C_ADDRESS, 32,
1665 AUD_IO_CTRL, 0, 31, 0x00000003);
1666 } else if ((standard == V4L2_STD_PAL_I) |
1667 (standard & V4L2_STD_PAL_D) |
1668 (standard & V4L2_STD_SECAM)) {
1669 /* C2HH setup */
1670 /* lo if big signal */
1671 status = cx231xx_reg_mask_write(dev,
1672 VID_BLK_I2C_ADDRESS, 32,
1673 AFE_CTRL_C2HH_SRC_CTRL, 30, 31, 0x1);
1674 /* FUNC_MODE = DIF */
1675 status = cx231xx_reg_mask_write(dev,
1676 VID_BLK_I2C_ADDRESS, 32,
1677 AFE_CTRL_C2HH_SRC_CTRL, 23, 24,
1678 function_mode);
1679 /* IF_MODE */
1680 status = cx231xx_reg_mask_write(dev,
1681 VID_BLK_I2C_ADDRESS, 32,
1682 AFE_CTRL_C2HH_SRC_CTRL, 15, 22, 0xF);
1683 /* no inv */
1684 status = cx231xx_reg_mask_write(dev,
1685 VID_BLK_I2C_ADDRESS, 32,
1686 AFE_CTRL_C2HH_SRC_CTRL, 9, 9, 0x1);
1687 } else {
1688 /* default PAL BG */
1689 /* C2HH setup */
1690 /* lo if big signal */
1691 status = cx231xx_reg_mask_write(dev,
1692 VID_BLK_I2C_ADDRESS, 32,
1693 AFE_CTRL_C2HH_SRC_CTRL, 30, 31, 0x1);
1694 /* FUNC_MODE = DIF */
1695 status = cx231xx_reg_mask_write(dev,
1696 VID_BLK_I2C_ADDRESS, 32,
1697 AFE_CTRL_C2HH_SRC_CTRL, 23, 24,
1698 function_mode);
1699 /* IF_MODE */
1700 status = cx231xx_reg_mask_write(dev,
1701 VID_BLK_I2C_ADDRESS, 32,
1702 AFE_CTRL_C2HH_SRC_CTRL, 15, 22, 0xE);
1703 /* no inv */
1704 status = cx231xx_reg_mask_write(dev,
1705 VID_BLK_I2C_ADDRESS, 32,
1706 AFE_CTRL_C2HH_SRC_CTRL, 9, 9, 0x1);
1707 }
1708 }
1709
1710 return status;
1711 }
1712
cx231xx_dif_set_standard(struct cx231xx * dev,u32 standard)1713 int cx231xx_dif_set_standard(struct cx231xx *dev, u32 standard)
1714 {
1715 int status = 0;
1716 u32 dif_misc_ctrl_value = 0;
1717 u32 func_mode = 0;
1718
1719 cx231xx_info("%s: setStandard to %x\n", __func__, standard);
1720
1721 status = vid_blk_read_word(dev, DIF_MISC_CTRL, &dif_misc_ctrl_value);
1722 if (standard != DIF_USE_BASEBAND)
1723 dev->norm = standard;
1724
1725 switch (dev->model) {
1726 case CX231XX_BOARD_CNXT_CARRAERA:
1727 case CX231XX_BOARD_CNXT_RDE_250:
1728 case CX231XX_BOARD_CNXT_SHELBY:
1729 case CX231XX_BOARD_CNXT_RDU_250:
1730 case CX231XX_BOARD_CNXT_VIDEO_GRABBER:
1731 case CX231XX_BOARD_HAUPPAUGE_EXETER:
1732 func_mode = 0x03;
1733 break;
1734 case CX231XX_BOARD_CNXT_RDE_253S:
1735 case CX231XX_BOARD_CNXT_RDU_253S:
1736 func_mode = 0x01;
1737 break;
1738 default:
1739 func_mode = 0x01;
1740 }
1741
1742 status = cx231xx_dif_configure_C2HH_for_low_IF(dev, dev->active_mode,
1743 func_mode, standard);
1744
1745 if (standard == DIF_USE_BASEBAND) { /* base band */
1746 /* There is a different SRC_PHASE_INC value
1747 for baseband vs. DIF */
1748 status = vid_blk_write_word(dev, DIF_SRC_PHASE_INC, 0xDF7DF83);
1749 status = vid_blk_read_word(dev, DIF_MISC_CTRL,
1750 &dif_misc_ctrl_value);
1751 dif_misc_ctrl_value |= FLD_DIF_DIF_BYPASS;
1752 status = vid_blk_write_word(dev, DIF_MISC_CTRL,
1753 dif_misc_ctrl_value);
1754 } else if (standard & V4L2_STD_PAL_D) {
1755 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1756 DIF_PLL_CTRL, 0, 31, 0x6503bc0c);
1757 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1758 DIF_PLL_CTRL1, 0, 31, 0xbd038c85);
1759 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1760 DIF_PLL_CTRL2, 0, 31, 0x1db4640a);
1761 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1762 DIF_PLL_CTRL3, 0, 31, 0x00008800);
1763 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1764 DIF_AGC_IF_REF, 0, 31, 0x444C1380);
1765 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1766 DIF_AGC_CTRL_IF, 0, 31, 0xDA302600);
1767 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1768 DIF_AGC_CTRL_INT, 0, 31, 0xDA261700);
1769 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1770 DIF_AGC_CTRL_RF, 0, 31, 0xDA262600);
1771 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1772 DIF_AGC_IF_INT_CURRENT, 0, 31,
1773 0x26001700);
1774 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1775 DIF_AGC_RF_CURRENT, 0, 31,
1776 0x00002660);
1777 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1778 DIF_VIDEO_AGC_CTRL, 0, 31,
1779 0x72500800);
1780 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1781 DIF_VID_AUD_OVERRIDE, 0, 31,
1782 0x27000100);
1783 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1784 DIF_AV_SEP_CTRL, 0, 31, 0x3F3934EA);
1785 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1786 DIF_COMP_FLT_CTRL, 0, 31,
1787 0x00000000);
1788 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1789 DIF_SRC_PHASE_INC, 0, 31,
1790 0x1befbf06);
1791 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1792 DIF_SRC_GAIN_CONTROL, 0, 31,
1793 0x000035e8);
1794 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1795 DIF_RPT_VARIANCE, 0, 31, 0x00000000);
1796 /* Save the Spec Inversion value */
1797 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1798 dif_misc_ctrl_value |= 0x3a023F11;
1799 } else if (standard & V4L2_STD_PAL_I) {
1800 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1801 DIF_PLL_CTRL, 0, 31, 0x6503bc0c);
1802 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1803 DIF_PLL_CTRL1, 0, 31, 0xbd038c85);
1804 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1805 DIF_PLL_CTRL2, 0, 31, 0x1db4640a);
1806 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1807 DIF_PLL_CTRL3, 0, 31, 0x00008800);
1808 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1809 DIF_AGC_IF_REF, 0, 31, 0x444C1380);
1810 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1811 DIF_AGC_CTRL_IF, 0, 31, 0xDA302600);
1812 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1813 DIF_AGC_CTRL_INT, 0, 31, 0xDA261700);
1814 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1815 DIF_AGC_CTRL_RF, 0, 31, 0xDA262600);
1816 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1817 DIF_AGC_IF_INT_CURRENT, 0, 31,
1818 0x26001700);
1819 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1820 DIF_AGC_RF_CURRENT, 0, 31,
1821 0x00002660);
1822 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1823 DIF_VIDEO_AGC_CTRL, 0, 31,
1824 0x72500800);
1825 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1826 DIF_VID_AUD_OVERRIDE, 0, 31,
1827 0x27000100);
1828 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1829 DIF_AV_SEP_CTRL, 0, 31, 0x5F39A934);
1830 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1831 DIF_COMP_FLT_CTRL, 0, 31,
1832 0x00000000);
1833 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1834 DIF_SRC_PHASE_INC, 0, 31,
1835 0x1befbf06);
1836 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1837 DIF_SRC_GAIN_CONTROL, 0, 31,
1838 0x000035e8);
1839 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1840 DIF_RPT_VARIANCE, 0, 31, 0x00000000);
1841 /* Save the Spec Inversion value */
1842 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1843 dif_misc_ctrl_value |= 0x3a033F11;
1844 } else if (standard & V4L2_STD_PAL_M) {
1845 /* improved Low Frequency Phase Noise */
1846 status = vid_blk_write_word(dev, DIF_PLL_CTRL, 0xFF01FF0C);
1847 status = vid_blk_write_word(dev, DIF_PLL_CTRL1, 0xbd038c85);
1848 status = vid_blk_write_word(dev, DIF_PLL_CTRL2, 0x1db4640a);
1849 status = vid_blk_write_word(dev, DIF_PLL_CTRL3, 0x00008800);
1850 status = vid_blk_write_word(dev, DIF_AGC_IF_REF, 0x444C1380);
1851 status = vid_blk_write_word(dev, DIF_AGC_IF_INT_CURRENT,
1852 0x26001700);
1853 status = vid_blk_write_word(dev, DIF_AGC_RF_CURRENT,
1854 0x00002660);
1855 status = vid_blk_write_word(dev, DIF_VIDEO_AGC_CTRL,
1856 0x72500800);
1857 status = vid_blk_write_word(dev, DIF_VID_AUD_OVERRIDE,
1858 0x27000100);
1859 status = vid_blk_write_word(dev, DIF_AV_SEP_CTRL, 0x012c405d);
1860 status = vid_blk_write_word(dev, DIF_COMP_FLT_CTRL,
1861 0x009f50c1);
1862 status = vid_blk_write_word(dev, DIF_SRC_PHASE_INC,
1863 0x1befbf06);
1864 status = vid_blk_write_word(dev, DIF_SRC_GAIN_CONTROL,
1865 0x000035e8);
1866 status = vid_blk_write_word(dev, DIF_SOFT_RST_CTRL_REVB,
1867 0x00000000);
1868 /* Save the Spec Inversion value */
1869 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1870 dif_misc_ctrl_value |= 0x3A0A3F10;
1871 } else if (standard & (V4L2_STD_PAL_N | V4L2_STD_PAL_Nc)) {
1872 /* improved Low Frequency Phase Noise */
1873 status = vid_blk_write_word(dev, DIF_PLL_CTRL, 0xFF01FF0C);
1874 status = vid_blk_write_word(dev, DIF_PLL_CTRL1, 0xbd038c85);
1875 status = vid_blk_write_word(dev, DIF_PLL_CTRL2, 0x1db4640a);
1876 status = vid_blk_write_word(dev, DIF_PLL_CTRL3, 0x00008800);
1877 status = vid_blk_write_word(dev, DIF_AGC_IF_REF, 0x444C1380);
1878 status = vid_blk_write_word(dev, DIF_AGC_IF_INT_CURRENT,
1879 0x26001700);
1880 status = vid_blk_write_word(dev, DIF_AGC_RF_CURRENT,
1881 0x00002660);
1882 status = vid_blk_write_word(dev, DIF_VIDEO_AGC_CTRL,
1883 0x72500800);
1884 status = vid_blk_write_word(dev, DIF_VID_AUD_OVERRIDE,
1885 0x27000100);
1886 status = vid_blk_write_word(dev, DIF_AV_SEP_CTRL,
1887 0x012c405d);
1888 status = vid_blk_write_word(dev, DIF_COMP_FLT_CTRL,
1889 0x009f50c1);
1890 status = vid_blk_write_word(dev, DIF_SRC_PHASE_INC,
1891 0x1befbf06);
1892 status = vid_blk_write_word(dev, DIF_SRC_GAIN_CONTROL,
1893 0x000035e8);
1894 status = vid_blk_write_word(dev, DIF_SOFT_RST_CTRL_REVB,
1895 0x00000000);
1896 /* Save the Spec Inversion value */
1897 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1898 dif_misc_ctrl_value = 0x3A093F10;
1899 } else if (standard &
1900 (V4L2_STD_SECAM_B | V4L2_STD_SECAM_D | V4L2_STD_SECAM_G |
1901 V4L2_STD_SECAM_K | V4L2_STD_SECAM_K1)) {
1902
1903 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1904 DIF_PLL_CTRL, 0, 31, 0x6503bc0c);
1905 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1906 DIF_PLL_CTRL1, 0, 31, 0xbd038c85);
1907 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1908 DIF_PLL_CTRL2, 0, 31, 0x1db4640a);
1909 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1910 DIF_PLL_CTRL3, 0, 31, 0x00008800);
1911 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1912 DIF_AGC_IF_REF, 0, 31, 0x888C0380);
1913 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1914 DIF_AGC_CTRL_IF, 0, 31, 0xe0262600);
1915 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1916 DIF_AGC_CTRL_INT, 0, 31, 0xc2171700);
1917 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1918 DIF_AGC_CTRL_RF, 0, 31, 0xc2262600);
1919 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1920 DIF_AGC_IF_INT_CURRENT, 0, 31,
1921 0x26001700);
1922 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1923 DIF_AGC_RF_CURRENT, 0, 31,
1924 0x00002660);
1925 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1926 DIF_VID_AUD_OVERRIDE, 0, 31,
1927 0x27000100);
1928 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1929 DIF_AV_SEP_CTRL, 0, 31, 0x3F3530ec);
1930 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1931 DIF_COMP_FLT_CTRL, 0, 31,
1932 0x00000000);
1933 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1934 DIF_SRC_PHASE_INC, 0, 31,
1935 0x1befbf06);
1936 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1937 DIF_SRC_GAIN_CONTROL, 0, 31,
1938 0x000035e8);
1939 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1940 DIF_RPT_VARIANCE, 0, 31, 0x00000000);
1941 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1942 DIF_VIDEO_AGC_CTRL, 0, 31,
1943 0xf4000000);
1944
1945 /* Save the Spec Inversion value */
1946 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1947 dif_misc_ctrl_value |= 0x3a023F11;
1948 } else if (standard & (V4L2_STD_SECAM_L | V4L2_STD_SECAM_LC)) {
1949 /* Is it SECAM_L1? */
1950 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1951 DIF_PLL_CTRL, 0, 31, 0x6503bc0c);
1952 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1953 DIF_PLL_CTRL1, 0, 31, 0xbd038c85);
1954 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1955 DIF_PLL_CTRL2, 0, 31, 0x1db4640a);
1956 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1957 DIF_PLL_CTRL3, 0, 31, 0x00008800);
1958 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1959 DIF_AGC_IF_REF, 0, 31, 0x888C0380);
1960 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1961 DIF_AGC_CTRL_IF, 0, 31, 0xe0262600);
1962 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1963 DIF_AGC_CTRL_INT, 0, 31, 0xc2171700);
1964 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1965 DIF_AGC_CTRL_RF, 0, 31, 0xc2262600);
1966 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1967 DIF_AGC_IF_INT_CURRENT, 0, 31,
1968 0x26001700);
1969 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1970 DIF_AGC_RF_CURRENT, 0, 31,
1971 0x00002660);
1972 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1973 DIF_VID_AUD_OVERRIDE, 0, 31,
1974 0x27000100);
1975 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1976 DIF_AV_SEP_CTRL, 0, 31, 0x3F3530ec);
1977 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1978 DIF_COMP_FLT_CTRL, 0, 31,
1979 0x00000000);
1980 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1981 DIF_SRC_PHASE_INC, 0, 31,
1982 0x1befbf06);
1983 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1984 DIF_SRC_GAIN_CONTROL, 0, 31,
1985 0x000035e8);
1986 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1987 DIF_RPT_VARIANCE, 0, 31, 0x00000000);
1988 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
1989 DIF_VIDEO_AGC_CTRL, 0, 31,
1990 0xf2560000);
1991
1992 /* Save the Spec Inversion value */
1993 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
1994 dif_misc_ctrl_value |= 0x3a023F11;
1995
1996 } else if (standard & V4L2_STD_NTSC_M) {
1997 /* V4L2_STD_NTSC_M (75 IRE Setup) Or
1998 V4L2_STD_NTSC_M_JP (Japan, 0 IRE Setup) */
1999
2000 /* For NTSC the centre frequency of video coming out of
2001 sidewinder is around 7.1MHz or 3.6MHz depending on the
2002 spectral inversion. so for a non spectrally inverted channel
2003 the pll freq word is 0x03420c49
2004 */
2005
2006 status = vid_blk_write_word(dev, DIF_PLL_CTRL, 0x6503BC0C);
2007 status = vid_blk_write_word(dev, DIF_PLL_CTRL1, 0xBD038C85);
2008 status = vid_blk_write_word(dev, DIF_PLL_CTRL2, 0x1DB4640A);
2009 status = vid_blk_write_word(dev, DIF_PLL_CTRL3, 0x00008800);
2010 status = vid_blk_write_word(dev, DIF_AGC_IF_REF, 0x444C0380);
2011 status = vid_blk_write_word(dev, DIF_AGC_IF_INT_CURRENT,
2012 0x26001700);
2013 status = vid_blk_write_word(dev, DIF_AGC_RF_CURRENT,
2014 0x00002660);
2015 status = vid_blk_write_word(dev, DIF_VIDEO_AGC_CTRL,
2016 0x04000800);
2017 status = vid_blk_write_word(dev, DIF_VID_AUD_OVERRIDE,
2018 0x27000100);
2019 status = vid_blk_write_word(dev, DIF_AV_SEP_CTRL, 0x01296e1f);
2020
2021 status = vid_blk_write_word(dev, DIF_COMP_FLT_CTRL,
2022 0x009f50c1);
2023 status = vid_blk_write_word(dev, DIF_SRC_PHASE_INC,
2024 0x1befbf06);
2025 status = vid_blk_write_word(dev, DIF_SRC_GAIN_CONTROL,
2026 0x000035e8);
2027
2028 status = vid_blk_write_word(dev, DIF_AGC_CTRL_IF, 0xC2262600);
2029 status = vid_blk_write_word(dev, DIF_AGC_CTRL_INT,
2030 0xC2262600);
2031 status = vid_blk_write_word(dev, DIF_AGC_CTRL_RF, 0xC2262600);
2032
2033 /* Save the Spec Inversion value */
2034 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
2035 dif_misc_ctrl_value |= 0x3a003F10;
2036 } else {
2037 /* default PAL BG */
2038 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2039 DIF_PLL_CTRL, 0, 31, 0x6503bc0c);
2040 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2041 DIF_PLL_CTRL1, 0, 31, 0xbd038c85);
2042 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2043 DIF_PLL_CTRL2, 0, 31, 0x1db4640a);
2044 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2045 DIF_PLL_CTRL3, 0, 31, 0x00008800);
2046 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2047 DIF_AGC_IF_REF, 0, 31, 0x444C1380);
2048 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2049 DIF_AGC_CTRL_IF, 0, 31, 0xDA302600);
2050 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2051 DIF_AGC_CTRL_INT, 0, 31, 0xDA261700);
2052 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2053 DIF_AGC_CTRL_RF, 0, 31, 0xDA262600);
2054 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2055 DIF_AGC_IF_INT_CURRENT, 0, 31,
2056 0x26001700);
2057 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2058 DIF_AGC_RF_CURRENT, 0, 31,
2059 0x00002660);
2060 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2061 DIF_VIDEO_AGC_CTRL, 0, 31,
2062 0x72500800);
2063 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2064 DIF_VID_AUD_OVERRIDE, 0, 31,
2065 0x27000100);
2066 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2067 DIF_AV_SEP_CTRL, 0, 31, 0x3F3530EC);
2068 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2069 DIF_COMP_FLT_CTRL, 0, 31,
2070 0x00A653A8);
2071 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2072 DIF_SRC_PHASE_INC, 0, 31,
2073 0x1befbf06);
2074 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2075 DIF_SRC_GAIN_CONTROL, 0, 31,
2076 0x000035e8);
2077 status = cx231xx_reg_mask_write(dev, VID_BLK_I2C_ADDRESS, 32,
2078 DIF_RPT_VARIANCE, 0, 31, 0x00000000);
2079 /* Save the Spec Inversion value */
2080 dif_misc_ctrl_value &= FLD_DIF_SPEC_INV;
2081 dif_misc_ctrl_value |= 0x3a013F11;
2082 }
2083
2084 /* The AGC values should be the same for all standards,
2085 AUD_SRC_SEL[19] should always be disabled */
2086 dif_misc_ctrl_value &= ~FLD_DIF_AUD_SRC_SEL;
2087
2088 /* It is still possible to get Set Standard calls even when we
2089 are in FM mode.
2090 This is done to override the value for FM. */
2091 if (dev->active_mode == V4L2_TUNER_RADIO)
2092 dif_misc_ctrl_value = 0x7a080000;
2093
2094 /* Write the calculated value for misc ontrol register */
2095 status = vid_blk_write_word(dev, DIF_MISC_CTRL, dif_misc_ctrl_value);
2096
2097 return status;
2098 }
2099
cx231xx_tuner_pre_channel_change(struct cx231xx * dev)2100 int cx231xx_tuner_pre_channel_change(struct cx231xx *dev)
2101 {
2102 int status = 0;
2103 u32 dwval;
2104
2105 /* Set the RF and IF k_agc values to 3 */
2106 status = vid_blk_read_word(dev, DIF_AGC_IF_REF, &dwval);
2107 dwval &= ~(FLD_DIF_K_AGC_RF | FLD_DIF_K_AGC_IF);
2108 dwval |= 0x33000000;
2109
2110 status = vid_blk_write_word(dev, DIF_AGC_IF_REF, dwval);
2111
2112 return status;
2113 }
2114
cx231xx_tuner_post_channel_change(struct cx231xx * dev)2115 int cx231xx_tuner_post_channel_change(struct cx231xx *dev)
2116 {
2117 int status = 0;
2118 u32 dwval;
2119 cx231xx_info("cx231xx_tuner_post_channel_change dev->tuner_type =0%d\n",
2120 dev->tuner_type);
2121 /* Set the RF and IF k_agc values to 4 for PAL/NTSC and 8 for
2122 * SECAM L/B/D standards */
2123 status = vid_blk_read_word(dev, DIF_AGC_IF_REF, &dwval);
2124 dwval &= ~(FLD_DIF_K_AGC_RF | FLD_DIF_K_AGC_IF);
2125
2126 if (dev->norm & (V4L2_STD_SECAM_L | V4L2_STD_SECAM_B |
2127 V4L2_STD_SECAM_D)) {
2128 if (dev->tuner_type == TUNER_NXP_TDA18271) {
2129 dwval &= ~FLD_DIF_IF_REF;
2130 dwval |= 0x88000300;
2131 } else
2132 dwval |= 0x88000000;
2133 } else {
2134 if (dev->tuner_type == TUNER_NXP_TDA18271) {
2135 dwval &= ~FLD_DIF_IF_REF;
2136 dwval |= 0xCC000300;
2137 } else
2138 dwval |= 0x44000000;
2139 }
2140
2141 status = vid_blk_write_word(dev, DIF_AGC_IF_REF, dwval);
2142
2143 return status;
2144 }
2145
2146 /******************************************************************************
2147 * I 2 S - B L O C K C O N T R O L functions *
2148 ******************************************************************************/
cx231xx_i2s_blk_initialize(struct cx231xx * dev)2149 int cx231xx_i2s_blk_initialize(struct cx231xx *dev)
2150 {
2151 int status = 0;
2152 u32 value;
2153
2154 status = cx231xx_read_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2155 CH_PWR_CTRL1, 1, &value, 1);
2156 /* enables clock to delta-sigma and decimation filter */
2157 value |= 0x80;
2158 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2159 CH_PWR_CTRL1, 1, value, 1);
2160 /* power up all channel */
2161 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2162 CH_PWR_CTRL2, 1, 0x00, 1);
2163
2164 return status;
2165 }
2166
cx231xx_i2s_blk_update_power_control(struct cx231xx * dev,enum AV_MODE avmode)2167 int cx231xx_i2s_blk_update_power_control(struct cx231xx *dev,
2168 enum AV_MODE avmode)
2169 {
2170 int status = 0;
2171 u32 value = 0;
2172
2173 if (avmode != POLARIS_AVMODE_ENXTERNAL_AV) {
2174 status = cx231xx_read_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2175 CH_PWR_CTRL2, 1, &value, 1);
2176 value |= 0xfe;
2177 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2178 CH_PWR_CTRL2, 1, value, 1);
2179 } else {
2180 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2181 CH_PWR_CTRL2, 1, 0x00, 1);
2182 }
2183
2184 return status;
2185 }
2186
2187 /* set i2s_blk for audio input types */
cx231xx_i2s_blk_set_audio_input(struct cx231xx * dev,u8 audio_input)2188 int cx231xx_i2s_blk_set_audio_input(struct cx231xx *dev, u8 audio_input)
2189 {
2190 int status = 0;
2191
2192 switch (audio_input) {
2193 case CX231XX_AMUX_LINE_IN:
2194 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2195 CH_PWR_CTRL2, 1, 0x00, 1);
2196 status = cx231xx_write_i2c_data(dev, I2S_BLK_DEVICE_ADDRESS,
2197 CH_PWR_CTRL1, 1, 0x80, 1);
2198 break;
2199 case CX231XX_AMUX_VIDEO:
2200 default:
2201 break;
2202 }
2203
2204 dev->ctl_ainput = audio_input;
2205
2206 return status;
2207 }
2208
2209 /******************************************************************************
2210 * P O W E R C O N T R O L functions *
2211 ******************************************************************************/
cx231xx_set_power_mode(struct cx231xx * dev,enum AV_MODE mode)2212 int cx231xx_set_power_mode(struct cx231xx *dev, enum AV_MODE mode)
2213 {
2214 u8 value[4] = { 0, 0, 0, 0 };
2215 u32 tmp = 0;
2216 int status = 0;
2217
2218 if (dev->power_mode != mode)
2219 dev->power_mode = mode;
2220 else {
2221 cx231xx_info(" setPowerMode::mode = %d, No Change req.\n",
2222 mode);
2223 return 0;
2224 }
2225
2226 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN, value,
2227 4);
2228 if (status < 0)
2229 return status;
2230
2231 tmp = *((u32 *) value);
2232
2233 switch (mode) {
2234 case POLARIS_AVMODE_ENXTERNAL_AV:
2235
2236 tmp &= (~PWR_MODE_MASK);
2237
2238 tmp |= PWR_AV_EN;
2239 value[0] = (u8) tmp;
2240 value[1] = (u8) (tmp >> 8);
2241 value[2] = (u8) (tmp >> 16);
2242 value[3] = (u8) (tmp >> 24);
2243 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2244 PWR_CTL_EN, value, 4);
2245 msleep(PWR_SLEEP_INTERVAL);
2246
2247 tmp |= PWR_ISO_EN;
2248 value[0] = (u8) tmp;
2249 value[1] = (u8) (tmp >> 8);
2250 value[2] = (u8) (tmp >> 16);
2251 value[3] = (u8) (tmp >> 24);
2252 status =
2253 cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, PWR_CTL_EN,
2254 value, 4);
2255 msleep(PWR_SLEEP_INTERVAL);
2256
2257 tmp |= POLARIS_AVMODE_ENXTERNAL_AV;
2258 value[0] = (u8) tmp;
2259 value[1] = (u8) (tmp >> 8);
2260 value[2] = (u8) (tmp >> 16);
2261 value[3] = (u8) (tmp >> 24);
2262 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2263 PWR_CTL_EN, value, 4);
2264
2265 /* reset state of xceive tuner */
2266 dev->xc_fw_load_done = 0;
2267 break;
2268
2269 case POLARIS_AVMODE_ANALOGT_TV:
2270
2271 tmp |= PWR_DEMOD_EN;
2272 tmp |= (I2C_DEMOD_EN);
2273 value[0] = (u8) tmp;
2274 value[1] = (u8) (tmp >> 8);
2275 value[2] = (u8) (tmp >> 16);
2276 value[3] = (u8) (tmp >> 24);
2277 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2278 PWR_CTL_EN, value, 4);
2279 msleep(PWR_SLEEP_INTERVAL);
2280
2281 if (!(tmp & PWR_TUNER_EN)) {
2282 tmp |= (PWR_TUNER_EN);
2283 value[0] = (u8) tmp;
2284 value[1] = (u8) (tmp >> 8);
2285 value[2] = (u8) (tmp >> 16);
2286 value[3] = (u8) (tmp >> 24);
2287 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2288 PWR_CTL_EN, value, 4);
2289 msleep(PWR_SLEEP_INTERVAL);
2290 }
2291
2292 if (!(tmp & PWR_AV_EN)) {
2293 tmp |= PWR_AV_EN;
2294 value[0] = (u8) tmp;
2295 value[1] = (u8) (tmp >> 8);
2296 value[2] = (u8) (tmp >> 16);
2297 value[3] = (u8) (tmp >> 24);
2298 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2299 PWR_CTL_EN, value, 4);
2300 msleep(PWR_SLEEP_INTERVAL);
2301 }
2302 if (!(tmp & PWR_ISO_EN)) {
2303 tmp |= PWR_ISO_EN;
2304 value[0] = (u8) tmp;
2305 value[1] = (u8) (tmp >> 8);
2306 value[2] = (u8) (tmp >> 16);
2307 value[3] = (u8) (tmp >> 24);
2308 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2309 PWR_CTL_EN, value, 4);
2310 msleep(PWR_SLEEP_INTERVAL);
2311 }
2312
2313 if (!(tmp & POLARIS_AVMODE_ANALOGT_TV)) {
2314 tmp |= POLARIS_AVMODE_ANALOGT_TV;
2315 value[0] = (u8) tmp;
2316 value[1] = (u8) (tmp >> 8);
2317 value[2] = (u8) (tmp >> 16);
2318 value[3] = (u8) (tmp >> 24);
2319 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2320 PWR_CTL_EN, value, 4);
2321 msleep(PWR_SLEEP_INTERVAL);
2322 }
2323
2324 if (dev->board.tuner_type != TUNER_ABSENT) {
2325 /* Enable tuner */
2326 cx231xx_enable_i2c_port_3(dev, true);
2327
2328 /* reset the Tuner */
2329 if (dev->board.tuner_gpio)
2330 cx231xx_gpio_set(dev, dev->board.tuner_gpio);
2331
2332 if (dev->cx231xx_reset_analog_tuner)
2333 dev->cx231xx_reset_analog_tuner(dev);
2334 }
2335
2336 break;
2337
2338 case POLARIS_AVMODE_DIGITAL:
2339 if (!(tmp & PWR_TUNER_EN)) {
2340 tmp |= (PWR_TUNER_EN);
2341 value[0] = (u8) tmp;
2342 value[1] = (u8) (tmp >> 8);
2343 value[2] = (u8) (tmp >> 16);
2344 value[3] = (u8) (tmp >> 24);
2345 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2346 PWR_CTL_EN, value, 4);
2347 msleep(PWR_SLEEP_INTERVAL);
2348 }
2349 if (!(tmp & PWR_AV_EN)) {
2350 tmp |= PWR_AV_EN;
2351 value[0] = (u8) tmp;
2352 value[1] = (u8) (tmp >> 8);
2353 value[2] = (u8) (tmp >> 16);
2354 value[3] = (u8) (tmp >> 24);
2355 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2356 PWR_CTL_EN, value, 4);
2357 msleep(PWR_SLEEP_INTERVAL);
2358 }
2359 if (!(tmp & PWR_ISO_EN)) {
2360 tmp |= PWR_ISO_EN;
2361 value[0] = (u8) tmp;
2362 value[1] = (u8) (tmp >> 8);
2363 value[2] = (u8) (tmp >> 16);
2364 value[3] = (u8) (tmp >> 24);
2365 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2366 PWR_CTL_EN, value, 4);
2367 msleep(PWR_SLEEP_INTERVAL);
2368 }
2369
2370 tmp &= (~PWR_AV_MODE);
2371 tmp |= POLARIS_AVMODE_DIGITAL | I2C_DEMOD_EN;
2372 value[0] = (u8) tmp;
2373 value[1] = (u8) (tmp >> 8);
2374 value[2] = (u8) (tmp >> 16);
2375 value[3] = (u8) (tmp >> 24);
2376 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2377 PWR_CTL_EN, value, 4);
2378 msleep(PWR_SLEEP_INTERVAL);
2379
2380 if (!(tmp & PWR_DEMOD_EN)) {
2381 tmp |= PWR_DEMOD_EN;
2382 value[0] = (u8) tmp;
2383 value[1] = (u8) (tmp >> 8);
2384 value[2] = (u8) (tmp >> 16);
2385 value[3] = (u8) (tmp >> 24);
2386 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2387 PWR_CTL_EN, value, 4);
2388 msleep(PWR_SLEEP_INTERVAL);
2389 }
2390
2391 if (dev->board.tuner_type != TUNER_ABSENT) {
2392 /*
2393 * Enable tuner
2394 * Hauppauge Exeter seems to need to do something different!
2395 */
2396 if (dev->model == CX231XX_BOARD_HAUPPAUGE_EXETER)
2397 cx231xx_enable_i2c_port_3(dev, false);
2398 else
2399 cx231xx_enable_i2c_port_3(dev, true);
2400
2401 /* reset the Tuner */
2402 if (dev->board.tuner_gpio)
2403 cx231xx_gpio_set(dev, dev->board.tuner_gpio);
2404
2405 if (dev->cx231xx_reset_analog_tuner)
2406 dev->cx231xx_reset_analog_tuner(dev);
2407 }
2408 break;
2409
2410 default:
2411 break;
2412 }
2413
2414 msleep(PWR_SLEEP_INTERVAL);
2415
2416 /* For power saving, only enable Pwr_resetout_n
2417 when digital TV is selected. */
2418 if (mode == POLARIS_AVMODE_DIGITAL) {
2419 tmp |= PWR_RESETOUT_EN;
2420 value[0] = (u8) tmp;
2421 value[1] = (u8) (tmp >> 8);
2422 value[2] = (u8) (tmp >> 16);
2423 value[3] = (u8) (tmp >> 24);
2424 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2425 PWR_CTL_EN, value, 4);
2426 msleep(PWR_SLEEP_INTERVAL);
2427 }
2428
2429 /* update power control for afe */
2430 status = cx231xx_afe_update_power_control(dev, mode);
2431
2432 /* update power control for i2s_blk */
2433 status = cx231xx_i2s_blk_update_power_control(dev, mode);
2434
2435 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN, value,
2436 4);
2437
2438 return status;
2439 }
2440
cx231xx_power_suspend(struct cx231xx * dev)2441 int cx231xx_power_suspend(struct cx231xx *dev)
2442 {
2443 u8 value[4] = { 0, 0, 0, 0 };
2444 u32 tmp = 0;
2445 int status = 0;
2446
2447 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, PWR_CTL_EN,
2448 value, 4);
2449 if (status > 0)
2450 return status;
2451
2452 tmp = *((u32 *) value);
2453 tmp &= (~PWR_MODE_MASK);
2454
2455 value[0] = (u8) tmp;
2456 value[1] = (u8) (tmp >> 8);
2457 value[2] = (u8) (tmp >> 16);
2458 value[3] = (u8) (tmp >> 24);
2459 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, PWR_CTL_EN,
2460 value, 4);
2461
2462 return status;
2463 }
2464
2465 /******************************************************************************
2466 * S T R E A M C O N T R O L functions *
2467 ******************************************************************************/
cx231xx_start_stream(struct cx231xx * dev,u32 ep_mask)2468 int cx231xx_start_stream(struct cx231xx *dev, u32 ep_mask)
2469 {
2470 u8 value[4] = { 0x0, 0x0, 0x0, 0x0 };
2471 u32 tmp = 0;
2472 int status = 0;
2473
2474 cx231xx_info("cx231xx_start_stream():: ep_mask = %x\n", ep_mask);
2475 status = cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, EP_MODE_SET,
2476 value, 4);
2477 if (status < 0)
2478 return status;
2479
2480 tmp = *((u32 *) value);
2481 tmp |= ep_mask;
2482 value[0] = (u8) tmp;
2483 value[1] = (u8) (tmp >> 8);
2484 value[2] = (u8) (tmp >> 16);
2485 value[3] = (u8) (tmp >> 24);
2486
2487 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, EP_MODE_SET,
2488 value, 4);
2489
2490 return status;
2491 }
2492
cx231xx_stop_stream(struct cx231xx * dev,u32 ep_mask)2493 int cx231xx_stop_stream(struct cx231xx *dev, u32 ep_mask)
2494 {
2495 u8 value[4] = { 0x0, 0x0, 0x0, 0x0 };
2496 u32 tmp = 0;
2497 int status = 0;
2498
2499 cx231xx_info("cx231xx_stop_stream():: ep_mask = %x\n", ep_mask);
2500 status =
2501 cx231xx_read_ctrl_reg(dev, VRT_GET_REGISTER, EP_MODE_SET, value, 4);
2502 if (status < 0)
2503 return status;
2504
2505 tmp = *((u32 *) value);
2506 tmp &= (~ep_mask);
2507 value[0] = (u8) tmp;
2508 value[1] = (u8) (tmp >> 8);
2509 value[2] = (u8) (tmp >> 16);
2510 value[3] = (u8) (tmp >> 24);
2511
2512 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER, EP_MODE_SET,
2513 value, 4);
2514
2515 return status;
2516 }
2517
cx231xx_initialize_stream_xfer(struct cx231xx * dev,u32 media_type)2518 int cx231xx_initialize_stream_xfer(struct cx231xx *dev, u32 media_type)
2519 {
2520 int status = 0;
2521 u32 value = 0;
2522 u8 val[4] = { 0, 0, 0, 0 };
2523
2524 if (dev->udev->speed == USB_SPEED_HIGH) {
2525 switch (media_type) {
2526 case 81: /* audio */
2527 cx231xx_info("%s: Audio enter HANC\n", __func__);
2528 status =
2529 cx231xx_mode_register(dev, TS_MODE_REG, 0x9300);
2530 break;
2531
2532 case 2: /* vbi */
2533 cx231xx_info("%s: set vanc registers\n", __func__);
2534 status = cx231xx_mode_register(dev, TS_MODE_REG, 0x300);
2535 break;
2536
2537 case 3: /* sliced cc */
2538 cx231xx_info("%s: set hanc registers\n", __func__);
2539 status =
2540 cx231xx_mode_register(dev, TS_MODE_REG, 0x1300);
2541 break;
2542
2543 case 0: /* video */
2544 cx231xx_info("%s: set video registers\n", __func__);
2545 status = cx231xx_mode_register(dev, TS_MODE_REG, 0x100);
2546 break;
2547
2548 case 4: /* ts1 */
2549 cx231xx_info("%s: set ts1 registers", __func__);
2550
2551 if (dev->board.has_417) {
2552 cx231xx_info(" MPEG\n");
2553 value &= 0xFFFFFFFC;
2554 value |= 0x3;
2555
2556 status = cx231xx_mode_register(dev, TS_MODE_REG, value);
2557
2558 val[0] = 0x04;
2559 val[1] = 0xA3;
2560 val[2] = 0x3B;
2561 val[3] = 0x00;
2562 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2563 TS1_CFG_REG, val, 4);
2564
2565 val[0] = 0x00;
2566 val[1] = 0x08;
2567 val[2] = 0x00;
2568 val[3] = 0x08;
2569 status = cx231xx_write_ctrl_reg(dev, VRT_SET_REGISTER,
2570 TS1_LENGTH_REG, val, 4);
2571
2572 } else {
2573 cx231xx_info(" BDA\n");
2574 status = cx231xx_mode_register(dev, TS_MODE_REG, 0x101);
2575 status = cx231xx_mode_register(dev, TS1_CFG_REG, 0x010);
2576 }
2577 break;
2578
2579 case 6: /* ts1 parallel mode */
2580 cx231xx_info("%s: set ts1 parallel mode registers\n",
2581 __func__);
2582 status = cx231xx_mode_register(dev, TS_MODE_REG, 0x100);
2583 status = cx231xx_mode_register(dev, TS1_CFG_REG, 0x400);
2584 break;
2585 }
2586 } else {
2587 status = cx231xx_mode_register(dev, TS_MODE_REG, 0x101);
2588 }
2589
2590 return status;
2591 }
2592
cx231xx_capture_start(struct cx231xx * dev,int start,u8 media_type)2593 int cx231xx_capture_start(struct cx231xx *dev, int start, u8 media_type)
2594 {
2595 int rc = -1;
2596 u32 ep_mask = -1;
2597 struct pcb_config *pcb_config;
2598
2599 /* get EP for media type */
2600 pcb_config = (struct pcb_config *)&dev->current_pcb_config;
2601
2602 if (pcb_config->config_num == 1) {
2603 switch (media_type) {
2604 case 0: /* Video */
2605 ep_mask = ENABLE_EP4; /* ep4 [00:1000] */
2606 break;
2607 case 1: /* Audio */
2608 ep_mask = ENABLE_EP3; /* ep3 [00:0100] */
2609 break;
2610 case 2: /* Vbi */
2611 ep_mask = ENABLE_EP5; /* ep5 [01:0000] */
2612 break;
2613 case 3: /* Sliced_cc */
2614 ep_mask = ENABLE_EP6; /* ep6 [10:0000] */
2615 break;
2616 case 4: /* ts1 */
2617 case 6: /* ts1 parallel mode */
2618 ep_mask = ENABLE_EP1; /* ep1 [00:0001] */
2619 break;
2620 case 5: /* ts2 */
2621 ep_mask = ENABLE_EP2; /* ep2 [00:0010] */
2622 break;
2623 }
2624
2625 } else if (pcb_config->config_num > 1) {
2626 switch (media_type) {
2627 case 0: /* Video */
2628 ep_mask = ENABLE_EP4; /* ep4 [00:1000] */
2629 break;
2630 case 1: /* Audio */
2631 ep_mask = ENABLE_EP3; /* ep3 [00:0100] */
2632 break;
2633 case 2: /* Vbi */
2634 ep_mask = ENABLE_EP5; /* ep5 [01:0000] */
2635 break;
2636 case 3: /* Sliced_cc */
2637 ep_mask = ENABLE_EP6; /* ep6 [10:0000] */
2638 break;
2639 case 4: /* ts1 */
2640 case 6: /* ts1 parallel mode */
2641 ep_mask = ENABLE_EP1; /* ep1 [00:0001] */
2642 break;
2643 case 5: /* ts2 */
2644 ep_mask = ENABLE_EP2; /* ep2 [00:0010] */
2645 break;
2646 }
2647
2648 }
2649
2650 if (start) {
2651 rc = cx231xx_initialize_stream_xfer(dev, media_type);
2652
2653 if (rc < 0)
2654 return rc;
2655
2656 /* enable video capture */
2657 if (ep_mask > 0)
2658 rc = cx231xx_start_stream(dev, ep_mask);
2659 } else {
2660 /* disable video capture */
2661 if (ep_mask > 0)
2662 rc = cx231xx_stop_stream(dev, ep_mask);
2663 }
2664
2665 if (dev->mode == CX231XX_ANALOG_MODE)
2666 ;/* do any in Analog mode */
2667 else
2668 ;/* do any in digital mode */
2669
2670 return rc;
2671 }
2672 EXPORT_SYMBOL_GPL(cx231xx_capture_start);
2673
2674 /*****************************************************************************
2675 * G P I O B I T control functions *
2676 ******************************************************************************/
cx231xx_set_gpio_bit(struct cx231xx * dev,u32 gpio_bit,u8 * gpio_val)2677 int cx231xx_set_gpio_bit(struct cx231xx *dev, u32 gpio_bit, u8 *gpio_val)
2678 {
2679 int status = 0;
2680
2681 status = cx231xx_send_gpio_cmd(dev, gpio_bit, gpio_val, 4, 0, 0);
2682
2683 return status;
2684 }
2685
cx231xx_get_gpio_bit(struct cx231xx * dev,u32 gpio_bit,u8 * gpio_val)2686 int cx231xx_get_gpio_bit(struct cx231xx *dev, u32 gpio_bit, u8 *gpio_val)
2687 {
2688 int status = 0;
2689
2690 status = cx231xx_send_gpio_cmd(dev, gpio_bit, gpio_val, 4, 0, 1);
2691
2692 return status;
2693 }
2694
2695 /*
2696 * cx231xx_set_gpio_direction
2697 * Sets the direction of the GPIO pin to input or output
2698 *
2699 * Parameters :
2700 * pin_number : The GPIO Pin number to program the direction for
2701 * from 0 to 31
2702 * pin_value : The Direction of the GPIO Pin under reference.
2703 * 0 = Input direction
2704 * 1 = Output direction
2705 */
cx231xx_set_gpio_direction(struct cx231xx * dev,int pin_number,int pin_value)2706 int cx231xx_set_gpio_direction(struct cx231xx *dev,
2707 int pin_number, int pin_value)
2708 {
2709 int status = 0;
2710 u32 value = 0;
2711
2712 /* Check for valid pin_number - if 32 , bail out */
2713 if (pin_number >= 32)
2714 return -EINVAL;
2715
2716 /* input */
2717 if (pin_value == 0)
2718 value = dev->gpio_dir & (~(1 << pin_number)); /* clear */
2719 else
2720 value = dev->gpio_dir | (1 << pin_number);
2721
2722 status = cx231xx_set_gpio_bit(dev, value, (u8 *) &dev->gpio_val);
2723
2724 /* cache the value for future */
2725 dev->gpio_dir = value;
2726
2727 return status;
2728 }
2729
2730 /*
2731 * cx231xx_set_gpio_value
2732 * Sets the value of the GPIO pin to Logic high or low. The Pin under
2733 * reference should ALREADY BE SET IN OUTPUT MODE !!!!!!!!!
2734 *
2735 * Parameters :
2736 * pin_number : The GPIO Pin number to program the direction for
2737 * pin_value : The value of the GPIO Pin under reference.
2738 * 0 = set it to 0
2739 * 1 = set it to 1
2740 */
cx231xx_set_gpio_value(struct cx231xx * dev,int pin_number,int pin_value)2741 int cx231xx_set_gpio_value(struct cx231xx *dev, int pin_number, int pin_value)
2742 {
2743 int status = 0;
2744 u32 value = 0;
2745
2746 /* Check for valid pin_number - if 0xFF , bail out */
2747 if (pin_number >= 32)
2748 return -EINVAL;
2749
2750 /* first do a sanity check - if the Pin is not output, make it output */
2751 if ((dev->gpio_dir & (1 << pin_number)) == 0x00) {
2752 /* It was in input mode */
2753 value = dev->gpio_dir | (1 << pin_number);
2754 dev->gpio_dir = value;
2755 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2756 (u8 *) &dev->gpio_val);
2757 value = 0;
2758 }
2759
2760 if (pin_value == 0)
2761 value = dev->gpio_val & (~(1 << pin_number));
2762 else
2763 value = dev->gpio_val | (1 << pin_number);
2764
2765 /* store the value */
2766 dev->gpio_val = value;
2767
2768 /* toggle bit0 of GP_IO */
2769 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2770
2771 return status;
2772 }
2773
2774 /*****************************************************************************
2775 * G P I O I2C related functions *
2776 ******************************************************************************/
cx231xx_gpio_i2c_start(struct cx231xx * dev)2777 int cx231xx_gpio_i2c_start(struct cx231xx *dev)
2778 {
2779 int status = 0;
2780
2781 /* set SCL to output 1 ; set SDA to output 1 */
2782 dev->gpio_dir |= 1 << dev->board.tuner_scl_gpio;
2783 dev->gpio_dir |= 1 << dev->board.tuner_sda_gpio;
2784 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2785 dev->gpio_val |= 1 << dev->board.tuner_sda_gpio;
2786
2787 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2788 if (status < 0)
2789 return -EINVAL;
2790
2791 /* set SCL to output 1; set SDA to output 0 */
2792 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2793 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2794
2795 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2796 if (status < 0)
2797 return -EINVAL;
2798
2799 /* set SCL to output 0; set SDA to output 0 */
2800 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2801 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2802
2803 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2804 if (status < 0)
2805 return -EINVAL;
2806
2807 return status;
2808 }
2809
cx231xx_gpio_i2c_end(struct cx231xx * dev)2810 int cx231xx_gpio_i2c_end(struct cx231xx *dev)
2811 {
2812 int status = 0;
2813
2814 /* set SCL to output 0; set SDA to output 0 */
2815 dev->gpio_dir |= 1 << dev->board.tuner_scl_gpio;
2816 dev->gpio_dir |= 1 << dev->board.tuner_sda_gpio;
2817
2818 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2819 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2820
2821 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2822 if (status < 0)
2823 return -EINVAL;
2824
2825 /* set SCL to output 1; set SDA to output 0 */
2826 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2827 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2828
2829 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2830 if (status < 0)
2831 return -EINVAL;
2832
2833 /* set SCL to input ,release SCL cable control
2834 set SDA to input ,release SDA cable control */
2835 dev->gpio_dir &= ~(1 << dev->board.tuner_scl_gpio);
2836 dev->gpio_dir &= ~(1 << dev->board.tuner_sda_gpio);
2837
2838 status =
2839 cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2840 if (status < 0)
2841 return -EINVAL;
2842
2843 return status;
2844 }
2845
cx231xx_gpio_i2c_write_byte(struct cx231xx * dev,u8 data)2846 int cx231xx_gpio_i2c_write_byte(struct cx231xx *dev, u8 data)
2847 {
2848 int status = 0;
2849 u8 i;
2850
2851 /* set SCL to output ; set SDA to output */
2852 dev->gpio_dir |= 1 << dev->board.tuner_scl_gpio;
2853 dev->gpio_dir |= 1 << dev->board.tuner_sda_gpio;
2854
2855 for (i = 0; i < 8; i++) {
2856 if (((data << i) & 0x80) == 0) {
2857 /* set SCL to output 0; set SDA to output 0 */
2858 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2859 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2860 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2861 (u8 *)&dev->gpio_val);
2862
2863 /* set SCL to output 1; set SDA to output 0 */
2864 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2865 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2866 (u8 *)&dev->gpio_val);
2867
2868 /* set SCL to output 0; set SDA to output 0 */
2869 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2870 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2871 (u8 *)&dev->gpio_val);
2872 } else {
2873 /* set SCL to output 0; set SDA to output 1 */
2874 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2875 dev->gpio_val |= 1 << dev->board.tuner_sda_gpio;
2876 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2877 (u8 *)&dev->gpio_val);
2878
2879 /* set SCL to output 1; set SDA to output 1 */
2880 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2881 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2882 (u8 *)&dev->gpio_val);
2883
2884 /* set SCL to output 0; set SDA to output 1 */
2885 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2886 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2887 (u8 *)&dev->gpio_val);
2888 }
2889 }
2890 return status;
2891 }
2892
cx231xx_gpio_i2c_read_byte(struct cx231xx * dev,u8 * buf)2893 int cx231xx_gpio_i2c_read_byte(struct cx231xx *dev, u8 *buf)
2894 {
2895 u8 value = 0;
2896 int status = 0;
2897 u32 gpio_logic_value = 0;
2898 u8 i;
2899
2900 /* read byte */
2901 for (i = 0; i < 8; i++) { /* send write I2c addr */
2902
2903 /* set SCL to output 0; set SDA to input */
2904 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2905 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2906 (u8 *)&dev->gpio_val);
2907
2908 /* set SCL to output 1; set SDA to input */
2909 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
2910 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir,
2911 (u8 *)&dev->gpio_val);
2912
2913 /* get SDA data bit */
2914 gpio_logic_value = dev->gpio_val;
2915 status = cx231xx_get_gpio_bit(dev, dev->gpio_dir,
2916 (u8 *)&dev->gpio_val);
2917 if ((dev->gpio_val & (1 << dev->board.tuner_sda_gpio)) != 0)
2918 value |= (1 << (8 - i - 1));
2919
2920 dev->gpio_val = gpio_logic_value;
2921 }
2922
2923 /* set SCL to output 0,finish the read latest SCL signal.
2924 !!!set SDA to input, never to modify SDA direction at
2925 the same times */
2926 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2927 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2928
2929 /* store the value */
2930 *buf = value & 0xff;
2931
2932 return status;
2933 }
2934
cx231xx_gpio_i2c_read_ack(struct cx231xx * dev)2935 int cx231xx_gpio_i2c_read_ack(struct cx231xx *dev)
2936 {
2937 int status = 0;
2938 u32 gpio_logic_value = 0;
2939 int nCnt = 10;
2940 int nInit = nCnt;
2941
2942 /* clock stretch; set SCL to input; set SDA to input;
2943 get SCL value till SCL = 1 */
2944 dev->gpio_dir &= ~(1 << dev->board.tuner_sda_gpio);
2945 dev->gpio_dir &= ~(1 << dev->board.tuner_scl_gpio);
2946
2947 gpio_logic_value = dev->gpio_val;
2948 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2949
2950 do {
2951 msleep(2);
2952 status = cx231xx_get_gpio_bit(dev, dev->gpio_dir,
2953 (u8 *)&dev->gpio_val);
2954 nCnt--;
2955 } while (((dev->gpio_val &
2956 (1 << dev->board.tuner_scl_gpio)) == 0) &&
2957 (nCnt > 0));
2958
2959 if (nCnt == 0)
2960 cx231xx_info("No ACK after %d msec -GPIO I2C failed!",
2961 nInit * 10);
2962
2963 /*
2964 * readAck
2965 * through clock stretch, slave has given a SCL signal,
2966 * so the SDA data can be directly read.
2967 */
2968 status = cx231xx_get_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2969
2970 if ((dev->gpio_val & 1 << dev->board.tuner_sda_gpio) == 0) {
2971 dev->gpio_val = gpio_logic_value;
2972 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2973 status = 0;
2974 } else {
2975 dev->gpio_val = gpio_logic_value;
2976 dev->gpio_val |= (1 << dev->board.tuner_sda_gpio);
2977 }
2978
2979 /* read SDA end, set the SCL to output 0, after this operation,
2980 SDA direction can be changed. */
2981 dev->gpio_val = gpio_logic_value;
2982 dev->gpio_dir |= (1 << dev->board.tuner_scl_gpio);
2983 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
2984 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2985
2986 return status;
2987 }
2988
cx231xx_gpio_i2c_write_ack(struct cx231xx * dev)2989 int cx231xx_gpio_i2c_write_ack(struct cx231xx *dev)
2990 {
2991 int status = 0;
2992
2993 /* set SDA to ouput */
2994 dev->gpio_dir |= 1 << dev->board.tuner_sda_gpio;
2995 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
2996
2997 /* set SCL = 0 (output); set SDA = 0 (output) */
2998 dev->gpio_val &= ~(1 << dev->board.tuner_sda_gpio);
2999 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
3000 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3001
3002 /* set SCL = 1 (output); set SDA = 0 (output) */
3003 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
3004 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3005
3006 /* set SCL = 0 (output); set SDA = 0 (output) */
3007 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
3008 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3009
3010 /* set SDA to input,and then the slave will read data from SDA. */
3011 dev->gpio_dir &= ~(1 << dev->board.tuner_sda_gpio);
3012 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3013
3014 return status;
3015 }
3016
cx231xx_gpio_i2c_write_nak(struct cx231xx * dev)3017 int cx231xx_gpio_i2c_write_nak(struct cx231xx *dev)
3018 {
3019 int status = 0;
3020
3021 /* set scl to output ; set sda to input */
3022 dev->gpio_dir |= 1 << dev->board.tuner_scl_gpio;
3023 dev->gpio_dir &= ~(1 << dev->board.tuner_sda_gpio);
3024 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3025
3026 /* set scl to output 0; set sda to input */
3027 dev->gpio_val &= ~(1 << dev->board.tuner_scl_gpio);
3028 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3029
3030 /* set scl to output 1; set sda to input */
3031 dev->gpio_val |= 1 << dev->board.tuner_scl_gpio;
3032 status = cx231xx_set_gpio_bit(dev, dev->gpio_dir, (u8 *)&dev->gpio_val);
3033
3034 return status;
3035 }
3036
3037 /*****************************************************************************
3038 * G P I O I2C related functions *
3039 ******************************************************************************/
3040 /* cx231xx_gpio_i2c_read
3041 * Function to read data from gpio based I2C interface
3042 */
cx231xx_gpio_i2c_read(struct cx231xx * dev,u8 dev_addr,u8 * buf,u8 len)3043 int cx231xx_gpio_i2c_read(struct cx231xx *dev, u8 dev_addr, u8 *buf, u8 len)
3044 {
3045 int status = 0;
3046 int i = 0;
3047
3048 /* get the lock */
3049 mutex_lock(&dev->gpio_i2c_lock);
3050
3051 /* start */
3052 status = cx231xx_gpio_i2c_start(dev);
3053
3054 /* write dev_addr */
3055 status = cx231xx_gpio_i2c_write_byte(dev, (dev_addr << 1) + 1);
3056
3057 /* readAck */
3058 status = cx231xx_gpio_i2c_read_ack(dev);
3059
3060 /* read data */
3061 for (i = 0; i < len; i++) {
3062 /* read data */
3063 buf[i] = 0;
3064 status = cx231xx_gpio_i2c_read_byte(dev, &buf[i]);
3065
3066 if ((i + 1) != len) {
3067 /* only do write ack if we more length */
3068 status = cx231xx_gpio_i2c_write_ack(dev);
3069 }
3070 }
3071
3072 /* write NAK - inform reads are complete */
3073 status = cx231xx_gpio_i2c_write_nak(dev);
3074
3075 /* write end */
3076 status = cx231xx_gpio_i2c_end(dev);
3077
3078 /* release the lock */
3079 mutex_unlock(&dev->gpio_i2c_lock);
3080
3081 return status;
3082 }
3083
3084 /* cx231xx_gpio_i2c_write
3085 * Function to write data to gpio based I2C interface
3086 */
cx231xx_gpio_i2c_write(struct cx231xx * dev,u8 dev_addr,u8 * buf,u8 len)3087 int cx231xx_gpio_i2c_write(struct cx231xx *dev, u8 dev_addr, u8 *buf, u8 len)
3088 {
3089 int status = 0;
3090 int i = 0;
3091
3092 /* get the lock */
3093 mutex_lock(&dev->gpio_i2c_lock);
3094
3095 /* start */
3096 status = cx231xx_gpio_i2c_start(dev);
3097
3098 /* write dev_addr */
3099 status = cx231xx_gpio_i2c_write_byte(dev, dev_addr << 1);
3100
3101 /* read Ack */
3102 status = cx231xx_gpio_i2c_read_ack(dev);
3103
3104 for (i = 0; i < len; i++) {
3105 /* Write data */
3106 status = cx231xx_gpio_i2c_write_byte(dev, buf[i]);
3107
3108 /* read Ack */
3109 status = cx231xx_gpio_i2c_read_ack(dev);
3110 }
3111
3112 /* write End */
3113 status = cx231xx_gpio_i2c_end(dev);
3114
3115 /* release the lock */
3116 mutex_unlock(&dev->gpio_i2c_lock);
3117
3118 return 0;
3119 }
3120