1 /* cx25840 - Conexant CX25840 audio/video decoder driver
3 * Copyright (C) 2004 Ulf Eklund
5 * Based on the saa7115 driver and on the first verison of Chris Kennedy's
8 * Changes by Tyler Trafford <tatrafford@comcast.net>
9 * - cleanup/rewrite for V4L2 API (2005)
11 * VBI support by Hans Verkuil <hverkuil@xs4all.nl>.
13 * This program is free software; you can redistribute it and/or
14 * modify it under the terms of the GNU General Public License
15 * as published by the Free Software Foundation; either version 2
16 * of the License, or (at your option) any later version.
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
23 * You should have received a copy of the GNU General Public License
24 * along with this program; if not, write to the Free Software
25 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
29 #include <linux/kernel.h>
30 #include <linux/module.h>
31 #include <linux/slab.h>
32 #include <linux/videodev2.h>
33 #include <linux/i2c.h>
34 #include <media/audiochip.h>
35 #include <media/v4l2-common.h>
39 MODULE_DESCRIPTION("Conexant CX25840 audio/video decoder driver");
40 MODULE_AUTHOR("Ulf Eklund, Chris Kennedy, Hans Verkuil, Tyler Trafford");
41 MODULE_LICENSE("GPL");
43 static unsigned short normal_i2c
[] = { 0x88 >> 1, I2C_CLIENT_END
};
46 static int cx25840_debug
;
48 module_param_named(debug
,cx25840_debug
, int, 0644);
50 MODULE_PARM_DESC(debug
, "Debugging messages [0=Off (default) 1=On]");
54 /* ----------------------------------------------------------------------- */
56 int cx25840_write(struct i2c_client
*client
, u16 addr
, u8 value
)
59 buffer
[0] = addr
>> 8;
60 buffer
[1] = addr
& 0xff;
62 return i2c_master_send(client
, buffer
, 3);
65 int cx25840_write4(struct i2c_client
*client
, u16 addr
, u32 value
)
68 buffer
[0] = addr
>> 8;
69 buffer
[1] = addr
& 0xff;
70 buffer
[2] = value
>> 24;
71 buffer
[3] = (value
>> 16) & 0xff;
72 buffer
[4] = (value
>> 8) & 0xff;
73 buffer
[5] = value
& 0xff;
74 return i2c_master_send(client
, buffer
, 6);
77 u8
cx25840_read(struct i2c_client
* client
, u16 addr
)
80 buffer
[0] = addr
>> 8;
81 buffer
[1] = addr
& 0xff;
83 if (i2c_master_send(client
, buffer
, 2) < 2)
86 if (i2c_master_recv(client
, buffer
, 1) < 1)
92 u32
cx25840_read4(struct i2c_client
* client
, u16 addr
)
95 buffer
[0] = addr
>> 8;
96 buffer
[1] = addr
& 0xff;
98 if (i2c_master_send(client
, buffer
, 2) < 2)
101 if (i2c_master_recv(client
, buffer
, 4) < 4)
104 return (buffer
[0] << 24) | (buffer
[1] << 16) |
105 (buffer
[2] << 8) | buffer
[3];
108 int cx25840_and_or(struct i2c_client
*client
, u16 addr
, u8 and_mask
,
111 return cx25840_write(client
, addr
,
112 (cx25840_read(client
, addr
) & and_mask
) |
116 /* ----------------------------------------------------------------------- */
118 static int set_input(struct i2c_client
*client
, enum cx25840_video_input vid_input
,
119 enum cx25840_audio_input aud_input
);
120 static void log_status(struct i2c_client
*client
);
122 /* ----------------------------------------------------------------------- */
124 static void init_dll1(struct i2c_client
*client
)
126 /* This is the Hauppauge sequence used to
127 * initialize the Delay Lock Loop 1 (ADC DLL). */
128 cx25840_write(client
, 0x159, 0x23);
129 cx25840_write(client
, 0x15a, 0x87);
130 cx25840_write(client
, 0x15b, 0x06);
131 cx25840_write(client
, 0x159, 0xe1);
132 cx25840_write(client
, 0x15a, 0x86);
133 cx25840_write(client
, 0x159, 0xe0);
134 cx25840_write(client
, 0x159, 0xe1);
135 cx25840_write(client
, 0x15b, 0x10);
138 static void init_dll2(struct i2c_client
*client
)
140 /* This is the Hauppauge sequence used to
141 * initialize the Delay Lock Loop 2 (ADC DLL). */
142 cx25840_write(client
, 0x15d, 0xe3);
143 cx25840_write(client
, 0x15e, 0x86);
144 cx25840_write(client
, 0x15f, 0x06);
145 cx25840_write(client
, 0x15d, 0xe1);
146 cx25840_write(client
, 0x15d, 0xe0);
147 cx25840_write(client
, 0x15d, 0xe1);
150 static void cx25840_initialize(struct i2c_client
*client
, int loadfw
)
152 struct cx25840_state
*state
= i2c_get_clientdata(client
);
154 /* datasheet startup in numbered steps, refer to page 3-77 */
156 cx25840_and_or(client
, 0x803, ~0x10, 0x00);
157 /* The default of this register should be 4, but I get 0 instead.
158 * Set this register to 4 manually. */
159 cx25840_write(client
, 0x000, 0x04);
163 cx25840_write(client
, 0x136, 0x0a);
165 cx25840_write(client
, 0x13c, 0x01);
166 cx25840_write(client
, 0x13c, 0x00);
169 cx25840_loadfw(client
);
171 cx25840_write(client
, 0x115, 0x8c);
172 cx25840_write(client
, 0x116, 0x07);
173 cx25840_write(client
, 0x118, 0x02);
175 cx25840_write(client
, 0x4a5, 0x80);
176 cx25840_write(client
, 0x4a5, 0x00);
177 cx25840_write(client
, 0x402, 0x00);
179 cx25840_write(client
, 0x401, 0x18);
180 cx25840_write(client
, 0x4a2, 0x10);
181 cx25840_write(client
, 0x402, 0x04);
183 cx25840_write(client
, 0x8d3, 0x1f);
184 cx25840_write(client
, 0x8e3, 0x03);
186 cx25840_vbi_setup(client
);
188 /* trial and error says these are needed to get audio */
189 cx25840_write(client
, 0x914, 0xa0);
190 cx25840_write(client
, 0x918, 0xa0);
191 cx25840_write(client
, 0x919, 0x01);
193 /* stereo prefered */
194 cx25840_write(client
, 0x809, 0x04);
196 cx25840_write(client
, 0x8cf, 0x0f);
199 set_input(client
, state
->vid_input
, state
->aud_input
);
201 /* start microcontroller */
202 cx25840_and_or(client
, 0x803, ~0x10, 0x10);
205 /* ----------------------------------------------------------------------- */
207 static void input_change(struct i2c_client
*client
)
209 struct cx25840_state
*state
= i2c_get_clientdata(client
);
210 v4l2_std_id std
= cx25840_get_v4lstd(client
);
212 /* Note: perhaps V4L2_STD_PAL_M should be handled as V4L2_STD_NTSC
213 instead of V4L2_STD_PAL. Someone needs to test this. */
214 if (std
& V4L2_STD_PAL
) {
215 /* Follow tuner change procedure for PAL */
216 cx25840_write(client
, 0x808, 0xff);
217 cx25840_write(client
, 0x80b, 0x10);
218 } else if (std
& V4L2_STD_SECAM
) {
219 /* Select autodetect for SECAM */
220 cx25840_write(client
, 0x808, 0xff);
221 cx25840_write(client
, 0x80b, 0x10);
222 } else if (std
& V4L2_STD_NTSC
) {
223 /* Certain Hauppauge PVR150 models have a hardware bug
224 that causes audio to drop out. For these models the
225 audio standard must be set explicitly.
226 To be precise: it affects cards with tuner models
227 85, 99 and 112 (model numbers from tveeprom). */
228 int hw_fix
= state
->pvr150_workaround
;
230 if (std
== V4L2_STD_NTSC_M_JP
) {
231 /* Japan uses EIAJ audio standard */
232 cx25840_write(client
, 0x808, hw_fix
? 0x2f : 0xf7);
233 } else if (std
== V4L2_STD_NTSC_M_KR
) {
234 /* South Korea uses A2 audio standard */
235 cx25840_write(client
, 0x808, hw_fix
? 0x3f : 0xf8);
237 /* Others use the BTSC audio standard */
238 cx25840_write(client
, 0x808, hw_fix
? 0x1f : 0xf6);
240 cx25840_write(client
, 0x80b, 0x00);
243 if (cx25840_read(client
, 0x803) & 0x10) {
244 /* restart audio decoder microcontroller */
245 cx25840_and_or(client
, 0x803, ~0x10, 0x00);
246 cx25840_and_or(client
, 0x803, ~0x10, 0x10);
250 static int set_input(struct i2c_client
*client
, enum cx25840_video_input vid_input
,
251 enum cx25840_audio_input aud_input
)
253 struct cx25840_state
*state
= i2c_get_clientdata(client
);
254 u8 is_composite
= (vid_input
>= CX25840_COMPOSITE1
&&
255 vid_input
<= CX25840_COMPOSITE8
);
258 v4l_dbg(1, cx25840_debug
, client
, "decoder set video input %d, audio input %d\n",
259 vid_input
, aud_input
);
262 reg
= 0xf0 + (vid_input
- CX25840_COMPOSITE1
);
264 int luma
= vid_input
& 0xf0;
265 int chroma
= vid_input
& 0xf00;
267 if ((vid_input
& ~0xff0) ||
268 luma
< CX25840_SVIDEO_LUMA1
|| luma
> CX25840_SVIDEO_LUMA4
||
269 chroma
< CX25840_SVIDEO_CHROMA4
|| chroma
> CX25840_SVIDEO_CHROMA8
) {
270 v4l_err(client
, "0x%04x is not a valid video input!\n", vid_input
);
273 reg
= 0xf0 + ((luma
- CX25840_SVIDEO_LUMA1
) >> 4);
274 if (chroma
>= CX25840_SVIDEO_CHROMA7
) {
276 reg
|= (chroma
- CX25840_SVIDEO_CHROMA7
) >> 2;
279 reg
|= (chroma
- CX25840_SVIDEO_CHROMA4
) >> 4;
284 case CX25840_AUDIO_SERIAL
:
285 /* do nothing, use serial audio input */
287 case CX25840_AUDIO4
: reg
&= ~0x30; break;
288 case CX25840_AUDIO5
: reg
&= ~0x30; reg
|= 0x10; break;
289 case CX25840_AUDIO6
: reg
&= ~0x30; reg
|= 0x20; break;
290 case CX25840_AUDIO7
: reg
&= ~0xc0; break;
291 case CX25840_AUDIO8
: reg
&= ~0xc0; reg
|= 0x40; break;
294 v4l_err(client
, "0x%04x is not a valid audio input!\n", aud_input
);
298 cx25840_write(client
, 0x103, reg
);
299 /* Set INPUT_MODE to Composite (0) or S-Video (1) */
300 cx25840_and_or(client
, 0x401, ~0x6, is_composite
? 0 : 0x02);
301 /* Set CH_SEL_ADC2 to 1 if input comes from CH3 */
302 cx25840_and_or(client
, 0x102, ~0x2, (reg
& 0x80) == 0 ? 2 : 0);
303 /* Set DUAL_MODE_ADC2 to 1 if input comes from both CH2 and CH3 */
304 if ((reg
& 0xc0) != 0xc0 && (reg
& 0x30) != 0x30)
305 cx25840_and_or(client
, 0x102, ~0x4, 4);
307 cx25840_and_or(client
, 0x102, ~0x4, 0);
309 state
->vid_input
= vid_input
;
310 state
->aud_input
= aud_input
;
311 cx25840_audio_set_path(client
);
312 input_change(client
);
316 /* ----------------------------------------------------------------------- */
318 static int set_v4lstd(struct i2c_client
*client
, v4l2_std_id std
)
320 u8 fmt
=0; /* zero is autodetect */
322 /* First tests should be against specific std */
323 if (std
== V4L2_STD_NTSC_M_JP
) {
325 } else if (std
== V4L2_STD_NTSC_443
) {
327 } else if (std
== V4L2_STD_PAL_M
) {
329 } else if (std
== V4L2_STD_PAL_N
) {
331 } else if (std
== V4L2_STD_PAL_Nc
) {
333 } else if (std
== V4L2_STD_PAL_60
) {
336 /* Then, test against generic ones */
337 if (std
& V4L2_STD_NTSC
) {
339 } else if (std
& V4L2_STD_PAL
) {
341 } else if (std
& V4L2_STD_SECAM
) {
346 cx25840_and_or(client
, 0x400, ~0xf, fmt
);
347 cx25840_vbi_setup(client
);
351 v4l2_std_id
cx25840_get_v4lstd(struct i2c_client
* client
)
353 /* check VID_FMT_SEL first */
354 u8 fmt
= cx25840_read(client
, 0x400) & 0xf;
357 /* check AFD_FMT_STAT if set to autodetect */
358 fmt
= cx25840_read(client
, 0x40d) & 0xf;
362 case 0x1: return V4L2_STD_NTSC_M
| V4L2_STD_NTSC_M_KR
;
363 case 0x2: return V4L2_STD_NTSC_M_JP
;
364 case 0x3: return V4L2_STD_NTSC_443
;
365 case 0x4: return V4L2_STD_PAL
;
366 case 0x5: return V4L2_STD_PAL_M
;
367 case 0x6: return V4L2_STD_PAL_N
;
368 case 0x7: return V4L2_STD_PAL_Nc
;
369 case 0x8: return V4L2_STD_PAL_60
;
370 case 0xc: return V4L2_STD_SECAM
;
371 default: return V4L2_STD_UNKNOWN
;
375 /* ----------------------------------------------------------------------- */
377 static int set_v4lctrl(struct i2c_client
*client
, struct v4l2_control
*ctrl
)
379 struct cx25840_state
*state
= i2c_get_clientdata(client
);
382 case CX25840_CID_ENABLE_PVR150_WORKAROUND
:
383 state
->pvr150_workaround
= ctrl
->value
;
384 set_input(client
, state
->vid_input
, state
->aud_input
);
387 case V4L2_CID_BRIGHTNESS
:
388 if (ctrl
->value
< 0 || ctrl
->value
> 255) {
389 v4l_err(client
, "invalid brightness setting %d\n",
394 cx25840_write(client
, 0x414, ctrl
->value
- 128);
397 case V4L2_CID_CONTRAST
:
398 if (ctrl
->value
< 0 || ctrl
->value
> 127) {
399 v4l_err(client
, "invalid contrast setting %d\n",
404 cx25840_write(client
, 0x415, ctrl
->value
<< 1);
407 case V4L2_CID_SATURATION
:
408 if (ctrl
->value
< 0 || ctrl
->value
> 127) {
409 v4l_err(client
, "invalid saturation setting %d\n",
414 cx25840_write(client
, 0x420, ctrl
->value
<< 1);
415 cx25840_write(client
, 0x421, ctrl
->value
<< 1);
419 if (ctrl
->value
< -127 || ctrl
->value
> 127) {
420 v4l_err(client
, "invalid hue setting %d\n", ctrl
->value
);
424 cx25840_write(client
, 0x422, ctrl
->value
);
427 case V4L2_CID_AUDIO_VOLUME
:
428 case V4L2_CID_AUDIO_BASS
:
429 case V4L2_CID_AUDIO_TREBLE
:
430 case V4L2_CID_AUDIO_BALANCE
:
431 case V4L2_CID_AUDIO_MUTE
:
432 return cx25840_audio(client
, VIDIOC_S_CTRL
, ctrl
);
441 static int get_v4lctrl(struct i2c_client
*client
, struct v4l2_control
*ctrl
)
443 struct cx25840_state
*state
= i2c_get_clientdata(client
);
446 case CX25840_CID_ENABLE_PVR150_WORKAROUND
:
447 ctrl
->value
= state
->pvr150_workaround
;
449 case V4L2_CID_BRIGHTNESS
:
450 ctrl
->value
= (s8
)cx25840_read(client
, 0x414) + 128;
452 case V4L2_CID_CONTRAST
:
453 ctrl
->value
= cx25840_read(client
, 0x415) >> 1;
455 case V4L2_CID_SATURATION
:
456 ctrl
->value
= cx25840_read(client
, 0x420) >> 1;
459 ctrl
->value
= (s8
)cx25840_read(client
, 0x422);
461 case V4L2_CID_AUDIO_VOLUME
:
462 case V4L2_CID_AUDIO_BASS
:
463 case V4L2_CID_AUDIO_TREBLE
:
464 case V4L2_CID_AUDIO_BALANCE
:
465 case V4L2_CID_AUDIO_MUTE
:
466 return cx25840_audio(client
, VIDIOC_G_CTRL
, ctrl
);
474 /* ----------------------------------------------------------------------- */
476 static int get_v4lfmt(struct i2c_client
*client
, struct v4l2_format
*fmt
)
479 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
480 return cx25840_vbi(client
, VIDIOC_G_FMT
, fmt
);
488 static int set_v4lfmt(struct i2c_client
*client
, struct v4l2_format
*fmt
)
490 struct v4l2_pix_format
*pix
;
491 int HSC
, VSC
, Vsrc
, Hsrc
, filter
, Vlines
;
492 int is_pal
= !(cx25840_get_v4lstd(client
) & V4L2_STD_NTSC
);
495 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
496 pix
= &(fmt
->fmt
.pix
);
498 Vsrc
= (cx25840_read(client
, 0x476) & 0x3f) << 4;
499 Vsrc
|= (cx25840_read(client
, 0x475) & 0xf0) >> 4;
501 Hsrc
= (cx25840_read(client
, 0x472) & 0x3f) << 4;
502 Hsrc
|= (cx25840_read(client
, 0x471) & 0xf0) >> 4;
504 Vlines
= pix
->height
+ (is_pal
? 4 : 7);
506 if ((pix
->width
* 16 < Hsrc
) || (Hsrc
< pix
->width
) ||
507 (Vlines
* 8 < Vsrc
) || (Vsrc
< Vlines
)) {
508 v4l_err(client
, "%dx%d is not a valid size!\n",
509 pix
->width
, pix
->height
);
513 HSC
= (Hsrc
* (1 << 20)) / pix
->width
- (1 << 20);
514 VSC
= (1 << 16) - (Vsrc
* (1 << 9) / Vlines
- (1 << 9));
517 if (pix
->width
>= 385)
519 else if (pix
->width
> 192)
521 else if (pix
->width
> 96)
526 v4l_dbg(1, cx25840_debug
, client
, "decoder set size %dx%d -> scale %ux%u\n",
527 pix
->width
, pix
->height
, HSC
, VSC
);
530 cx25840_write(client
, 0x418, HSC
& 0xff);
531 cx25840_write(client
, 0x419, (HSC
>> 8) & 0xff);
532 cx25840_write(client
, 0x41a, HSC
>> 16);
534 cx25840_write(client
, 0x41c, VSC
& 0xff);
535 cx25840_write(client
, 0x41d, VSC
>> 8);
536 /* VS_INTRLACE=1 VFILT=filter */
537 cx25840_write(client
, 0x41e, 0x8 | filter
);
540 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
541 return cx25840_vbi(client
, VIDIOC_S_FMT
, fmt
);
543 case V4L2_BUF_TYPE_VBI_CAPTURE
:
544 return cx25840_vbi(client
, VIDIOC_S_FMT
, fmt
);
553 /* ----------------------------------------------------------------------- */
555 static struct v4l2_queryctrl cx25840_qctrl
[] = {
557 .id
= V4L2_CID_BRIGHTNESS
,
558 .type
= V4L2_CTRL_TYPE_INTEGER
,
559 .name
= "Brightness",
563 .default_value
= 128,
566 .id
= V4L2_CID_CONTRAST
,
567 .type
= V4L2_CTRL_TYPE_INTEGER
,
575 .id
= V4L2_CID_SATURATION
,
576 .type
= V4L2_CTRL_TYPE_INTEGER
,
577 .name
= "Saturation",
585 .type
= V4L2_CTRL_TYPE_INTEGER
,
593 .id
= V4L2_CID_AUDIO_VOLUME
,
594 .type
= V4L2_CTRL_TYPE_INTEGER
,
599 .default_value
= 58880,
602 .id
= V4L2_CID_AUDIO_BALANCE
,
603 .type
= V4L2_CTRL_TYPE_INTEGER
,
608 .default_value
= 32768,
611 .id
= V4L2_CID_AUDIO_MUTE
,
612 .type
= V4L2_CTRL_TYPE_BOOLEAN
,
620 .id
= V4L2_CID_AUDIO_BASS
,
621 .type
= V4L2_CTRL_TYPE_INTEGER
,
626 .default_value
= 32768,
628 .id
= V4L2_CID_AUDIO_TREBLE
,
629 .type
= V4L2_CTRL_TYPE_INTEGER
,
634 .default_value
= 32768,
638 /* ----------------------------------------------------------------------- */
640 static int cx25840_command(struct i2c_client
*client
, unsigned int cmd
,
643 struct cx25840_state
*state
= i2c_get_clientdata(client
);
644 struct v4l2_tuner
*vt
= arg
;
647 #ifdef CONFIG_VIDEO_ADV_DEBUG
648 /* ioctls to allow direct access to the
649 * cx25840 registers for testing */
650 case VIDIOC_INT_G_REGISTER
:
652 struct v4l2_register
*reg
= arg
;
654 if (reg
->i2c_id
!= I2C_DRIVERID_CX25840
)
656 reg
->val
= cx25840_read(client
, reg
->reg
& 0x0fff);
660 case VIDIOC_INT_S_REGISTER
:
662 struct v4l2_register
*reg
= arg
;
664 if (reg
->i2c_id
!= I2C_DRIVERID_CX25840
)
666 if (!capable(CAP_SYS_ADMIN
))
668 cx25840_write(client
, reg
->reg
& 0x0fff, reg
->val
& 0xff);
673 case VIDIOC_INT_DECODE_VBI_LINE
:
674 return cx25840_vbi(client
, cmd
, arg
);
676 case VIDIOC_INT_AUDIO_CLOCK_FREQ
:
677 return cx25840_audio(client
, cmd
, arg
);
679 case VIDIOC_STREAMON
:
680 v4l_dbg(1, cx25840_debug
, client
, "enable output\n");
681 cx25840_write(client
, 0x115, 0x8c);
682 cx25840_write(client
, 0x116, 0x07);
685 case VIDIOC_STREAMOFF
:
686 v4l_dbg(1, cx25840_debug
, client
, "disable output\n");
687 cx25840_write(client
, 0x115, 0x00);
688 cx25840_write(client
, 0x116, 0x00);
691 case VIDIOC_LOG_STATUS
:
696 return get_v4lctrl(client
, (struct v4l2_control
*)arg
);
699 return set_v4lctrl(client
, (struct v4l2_control
*)arg
);
701 case VIDIOC_QUERYCTRL
:
703 struct v4l2_queryctrl
*qc
= arg
;
706 for (i
= 0; i
< ARRAY_SIZE(cx25840_qctrl
); i
++)
707 if (qc
->id
&& qc
->id
== cx25840_qctrl
[i
].id
) {
708 memcpy(qc
, &cx25840_qctrl
[i
], sizeof(*qc
));
715 *(v4l2_std_id
*)arg
= cx25840_get_v4lstd(client
);
720 return set_v4lstd(client
, *(v4l2_std_id
*)arg
);
727 *(int *)arg
= state
->vid_input
;
731 return set_input(client
, *(enum cx25840_video_input
*)arg
, state
->aud_input
);
735 struct v4l2_audio
*input
= arg
;
737 return set_input(client
, state
->vid_input
, input
->index
);
742 struct v4l2_audio
*input
= arg
;
744 memset(input
, 0, sizeof(*input
));
745 input
->index
= state
->aud_input
;
749 case VIDIOC_S_FREQUENCY
:
750 input_change(client
);
755 u8 mode
= cx25840_read(client
, 0x804);
756 u8 pref
= cx25840_read(client
, 0x809) & 0xf;
757 u8 vpres
= cx25840_read(client
, 0x80a) & 0x10;
764 V4L2_TUNER_CAP_STEREO
| V4L2_TUNER_CAP_LANG1
|
765 V4L2_TUNER_CAP_LANG2
| V4L2_TUNER_CAP_SAP
;
767 vt
->signal
= vpres
? 0xffff : 0x0;
769 /* get rxsubchans and audmode */
770 if ((mode
& 0xf) == 1)
771 val
|= V4L2_TUNER_SUB_STEREO
;
773 val
|= V4L2_TUNER_SUB_MONO
;
775 if (mode
== 2 || mode
== 4)
776 val
|= V4L2_TUNER_SUB_LANG1
| V4L2_TUNER_SUB_LANG2
;
779 val
|= V4L2_TUNER_SUB_SAP
;
781 vt
->rxsubchans
= val
;
785 vt
->audmode
= V4L2_TUNER_MODE_MONO
;
789 vt
->audmode
= V4L2_TUNER_MODE_LANG2
;
793 vt
->audmode
= V4L2_TUNER_MODE_STEREO
;
799 switch (vt
->audmode
) {
800 case V4L2_TUNER_MODE_MONO
:
801 case V4L2_TUNER_MODE_LANG1
:
802 /* Force PREF_MODE to MONO */
803 cx25840_and_or(client
, 0x809, ~0xf, 0x00);
805 case V4L2_TUNER_MODE_STEREO
:
806 /* Force PREF_MODE to STEREO */
807 cx25840_and_or(client
, 0x809, ~0xf, 0x04);
809 case V4L2_TUNER_MODE_LANG2
:
810 /* Force PREF_MODE to LANG2 */
811 cx25840_and_or(client
, 0x809, ~0xf, 0x01);
817 return get_v4lfmt(client
, (struct v4l2_format
*)arg
);
820 return set_v4lfmt(client
, (struct v4l2_format
*)arg
);
822 case VIDIOC_INT_RESET
:
823 cx25840_initialize(client
, 0);
826 case VIDIOC_INT_G_CHIP_IDENT
:
827 *(enum v4l2_chip_ident
*)arg
=
828 V4L2_IDENT_CX25840
+ ((cx25840_read(client
, 0x100) >> 4) & 0xf);
838 /* ----------------------------------------------------------------------- */
840 static struct i2c_driver i2c_driver_cx25840
;
842 static int cx25840_detect_client(struct i2c_adapter
*adapter
, int address
,
845 struct i2c_client
*client
;
846 struct cx25840_state
*state
;
849 /* Check if the adapter supports the needed features
850 * Not until kernel version 2.6.11 did the bit-algo
851 * correctly report that it would do an I2C-level xfer */
852 if (!i2c_check_functionality(adapter
, I2C_FUNC_I2C
))
855 client
= kzalloc(sizeof(struct i2c_client
), GFP_KERNEL
);
859 client
->addr
= address
;
860 client
->adapter
= adapter
;
861 client
->driver
= &i2c_driver_cx25840
;
862 snprintf(client
->name
, sizeof(client
->name
) - 1, "cx25840");
864 v4l_dbg(1, cx25840_debug
, client
, "detecting cx25840 client on address 0x%x\n", address
<< 1);
866 device_id
= cx25840_read(client
, 0x101) << 8;
867 device_id
|= cx25840_read(client
, 0x100);
869 /* The high byte of the device ID should be
870 * 0x84 if chip is present */
871 if ((device_id
& 0xff00) != 0x8400) {
872 v4l_dbg(1, cx25840_debug
, client
, "cx25840 not found\n");
877 v4l_info(client
, "cx25%3x-2%x found @ 0x%x (%s)\n",
878 (device_id
& 0xfff0) >> 4,
879 (device_id
& 0x0f) < 3 ? (device_id
& 0x0f) + 1 : 3,
880 address
<< 1, adapter
->name
);
882 state
= kmalloc(sizeof(struct cx25840_state
), GFP_KERNEL
);
888 i2c_set_clientdata(client
, state
);
889 memset(state
, 0, sizeof(struct cx25840_state
));
890 state
->vid_input
= CX25840_COMPOSITE7
;
891 state
->aud_input
= CX25840_AUDIO8
;
892 state
->audclk_freq
= 48000;
893 state
->pvr150_workaround
= 0;
895 cx25840_initialize(client
, 1);
897 i2c_attach_client(client
);
902 static int cx25840_attach_adapter(struct i2c_adapter
*adapter
)
904 if (adapter
->class & I2C_CLASS_TV_ANALOG
)
905 return i2c_probe(adapter
, &addr_data
, &cx25840_detect_client
);
909 static int cx25840_detach_client(struct i2c_client
*client
)
911 struct cx25840_state
*state
= i2c_get_clientdata(client
);
914 err
= i2c_detach_client(client
);
925 /* ----------------------------------------------------------------------- */
927 static struct i2c_driver i2c_driver_cx25840
= {
931 .id
= I2C_DRIVERID_CX25840
,
932 .attach_adapter
= cx25840_attach_adapter
,
933 .detach_client
= cx25840_detach_client
,
934 .command
= cx25840_command
,
938 static int __init
m__init(void)
940 return i2c_add_driver(&i2c_driver_cx25840
);
943 static void __exit
m__exit(void)
945 i2c_del_driver(&i2c_driver_cx25840
);
948 module_init(m__init
);
949 module_exit(m__exit
);
951 /* ----------------------------------------------------------------------- */
953 static void log_status(struct i2c_client
*client
)
955 static const char *const fmt_strs
[] = {
957 "NTSC-M", "NTSC-J", "NTSC-4.43",
958 "PAL-BDGHI", "PAL-M", "PAL-N", "PAL-Nc", "PAL-60",
964 struct cx25840_state
*state
= i2c_get_clientdata(client
);
965 u8 microctrl_vidfmt
= cx25840_read(client
, 0x80a);
966 u8 vidfmt_sel
= cx25840_read(client
, 0x400) & 0xf;
967 u8 gen_stat1
= cx25840_read(client
, 0x40d);
968 u8 download_ctl
= cx25840_read(client
, 0x803);
969 u8 mod_det_stat0
= cx25840_read(client
, 0x804);
970 u8 mod_det_stat1
= cx25840_read(client
, 0x805);
971 u8 audio_config
= cx25840_read(client
, 0x808);
972 u8 pref_mode
= cx25840_read(client
, 0x809);
973 u8 afc0
= cx25840_read(client
, 0x80b);
974 u8 mute_ctl
= cx25840_read(client
, 0x8d3);
975 int vid_input
= state
->vid_input
;
976 int aud_input
= state
->aud_input
;
979 v4l_info(client
, "Video signal: %spresent\n",
980 (microctrl_vidfmt
& 0x10) ? "" : "not ");
981 v4l_info(client
, "Detected format: %s\n",
982 fmt_strs
[gen_stat1
& 0xf]);
984 switch (mod_det_stat0
) {
985 case 0x00: p
= "mono"; break;
986 case 0x01: p
= "stereo"; break;
987 case 0x02: p
= "dual"; break;
988 case 0x04: p
= "tri"; break;
989 case 0x10: p
= "mono with SAP"; break;
990 case 0x11: p
= "stereo with SAP"; break;
991 case 0x12: p
= "dual with SAP"; break;
992 case 0x14: p
= "tri with SAP"; break;
993 case 0xfe: p
= "forced mode"; break;
994 default: p
= "not defined";
996 v4l_info(client
, "Detected audio mode: %s\n", p
);
998 switch (mod_det_stat1
) {
999 case 0x00: p
= "not defined"; break;
1000 case 0x01: p
= "EIAJ"; break;
1001 case 0x02: p
= "A2-M"; break;
1002 case 0x03: p
= "A2-BG"; break;
1003 case 0x04: p
= "A2-DK1"; break;
1004 case 0x05: p
= "A2-DK2"; break;
1005 case 0x06: p
= "A2-DK3"; break;
1006 case 0x07: p
= "A1 (6.0 MHz FM Mono)"; break;
1007 case 0x08: p
= "AM-L"; break;
1008 case 0x09: p
= "NICAM-BG"; break;
1009 case 0x0a: p
= "NICAM-DK"; break;
1010 case 0x0b: p
= "NICAM-I"; break;
1011 case 0x0c: p
= "NICAM-L"; break;
1012 case 0x0d: p
= "BTSC/EIAJ/A2-M Mono (4.5 MHz FMMono)"; break;
1013 case 0x0e: p
= "IF FM Radio"; break;
1014 case 0x0f: p
= "BTSC"; break;
1015 case 0x10: p
= "high-deviation FM"; break;
1016 case 0x11: p
= "very high-deviation FM"; break;
1017 case 0xfd: p
= "unknown audio standard"; break;
1018 case 0xfe: p
= "forced audio standard"; break;
1019 case 0xff: p
= "no detected audio standard"; break;
1020 default: p
= "not defined";
1022 v4l_info(client
, "Detected audio standard: %s\n", p
);
1023 v4l_info(client
, "Audio muted: %s\n",
1024 (mute_ctl
& 0x2) ? "yes" : "no");
1025 v4l_info(client
, "Audio microcontroller: %s\n",
1026 (download_ctl
& 0x10) ? "running" : "stopped");
1028 switch (audio_config
>> 4) {
1029 case 0x00: p
= "undefined"; break;
1030 case 0x01: p
= "BTSC"; break;
1031 case 0x02: p
= "EIAJ"; break;
1032 case 0x03: p
= "A2-M"; break;
1033 case 0x04: p
= "A2-BG"; break;
1034 case 0x05: p
= "A2-DK1"; break;
1035 case 0x06: p
= "A2-DK2"; break;
1036 case 0x07: p
= "A2-DK3"; break;
1037 case 0x08: p
= "A1 (6.0 MHz FM Mono)"; break;
1038 case 0x09: p
= "AM-L"; break;
1039 case 0x0a: p
= "NICAM-BG"; break;
1040 case 0x0b: p
= "NICAM-DK"; break;
1041 case 0x0c: p
= "NICAM-I"; break;
1042 case 0x0d: p
= "NICAM-L"; break;
1043 case 0x0e: p
= "FM radio"; break;
1044 case 0x0f: p
= "automatic detection"; break;
1045 default: p
= "undefined";
1047 v4l_info(client
, "Configured audio standard: %s\n", p
);
1049 if ((audio_config
>> 4) < 0xF) {
1050 switch (audio_config
& 0xF) {
1051 case 0x00: p
= "MONO1 (LANGUAGE A/Mono L+R channel for BTSC, EIAJ, A2)"; break;
1052 case 0x01: p
= "MONO2 (LANGUAGE B)"; break;
1053 case 0x02: p
= "MONO3 (STEREO forced MONO)"; break;
1054 case 0x03: p
= "MONO4 (NICAM ANALOG-Language C/Analog Fallback)"; break;
1055 case 0x04: p
= "STEREO"; break;
1056 case 0x05: p
= "DUAL1 (AB)"; break;
1057 case 0x06: p
= "DUAL2 (AC) (FM)"; break;
1058 case 0x07: p
= "DUAL3 (BC) (FM)"; break;
1059 case 0x08: p
= "DUAL4 (AC) (AM)"; break;
1060 case 0x09: p
= "DUAL5 (BC) (AM)"; break;
1061 case 0x0a: p
= "SAP"; break;
1062 default: p
= "undefined";
1064 v4l_info(client
, "Configured audio mode: %s\n", p
);
1066 switch (audio_config
& 0xF) {
1067 case 0x00: p
= "BG"; break;
1068 case 0x01: p
= "DK1"; break;
1069 case 0x02: p
= "DK2"; break;
1070 case 0x03: p
= "DK3"; break;
1071 case 0x04: p
= "I"; break;
1072 case 0x05: p
= "L"; break;
1073 case 0x06: p
= "BTSC"; break;
1074 case 0x07: p
= "EIAJ"; break;
1075 case 0x08: p
= "A2-M"; break;
1076 case 0x09: p
= "FM Radio"; break;
1077 case 0x0f: p
= "automatic standard and mode detection"; break;
1078 default: p
= "undefined";
1080 v4l_info(client
, "Configured audio system: %s\n", p
);
1083 v4l_info(client
, "Specified standard: %s\n",
1084 vidfmt_sel
? fmt_strs
[vidfmt_sel
] : "automatic detection");
1086 if (vid_input
>= CX25840_COMPOSITE1
&&
1087 vid_input
<= CX25840_COMPOSITE8
) {
1088 v4l_info(client
, "Specified video input: Composite %d\n",
1089 vid_input
- CX25840_COMPOSITE1
+ 1);
1091 v4l_info(client
, "Specified video input: S-Video (Luma In%d, Chroma In%d)\n",
1092 (vid_input
& 0xf0) >> 4, (vid_input
& 0xf00) >> 8);
1095 v4l_info(client
, "Specified audio input: Tuner (In%d)\n", aud_input
);
1097 v4l_info(client
, "Specified audio input: External\n");
1100 v4l_info(client
, "Specified audioclock freq: %d Hz\n", state
->audclk_freq
);
1102 switch (pref_mode
& 0xf) {
1103 case 0: p
= "mono/language A"; break;
1104 case 1: p
= "language B"; break;
1105 case 2: p
= "language C"; break;
1106 case 3: p
= "analog fallback"; break;
1107 case 4: p
= "stereo"; break;
1108 case 5: p
= "language AC"; break;
1109 case 6: p
= "language BC"; break;
1110 case 7: p
= "language AB"; break;
1111 default: p
= "undefined";
1113 v4l_info(client
, "Preferred audio mode: %s\n", p
);
1115 if ((audio_config
& 0xf) == 0xf) {
1116 switch ((afc0
>> 3) & 0x3) {
1117 case 0: p
= "system DK"; break;
1118 case 1: p
= "system L"; break;
1119 case 2: p
= "autodetect"; break;
1120 default: p
= "undefined";
1122 v4l_info(client
, "Selected 65 MHz format: %s\n", p
);
1124 switch (afc0
& 0x7) {
1125 case 0: p
= "chroma"; break;
1126 case 1: p
= "BTSC"; break;
1127 case 2: p
= "EIAJ"; break;
1128 case 3: p
= "A2-M"; break;
1129 case 4: p
= "autodetect"; break;
1130 default: p
= "undefined";
1132 v4l_info(client
, "Selected 45 MHz format: %s\n", p
);