📄 cx25840-core.c
字号:
/* cx25840 - Conexant CX25840 audio/video decoder driver * * Copyright (C) 2004 Ulf Eklund * * Based on the saa7115 driver and on the first verison of Chris Kennedy's * cx25840 driver. * * Changes by Tyler Trafford <tatrafford@comcast.net> * - cleanup/rewrite for V4L2 API (2005) * * VBI support by Hans Verkuil <hverkuil@xs4all.nl>. * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version 2 * of the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. */#include <linux/kernel.h>#include <linux/module.h>#include <linux/slab.h>#include <linux/videodev2.h>#include <linux/i2c.h>#include <media/audiochip.h>#include <media/v4l2-common.h>#include "cx25840.h"MODULE_DESCRIPTION("Conexant CX25840 audio/video decoder driver");MODULE_AUTHOR("Ulf Eklund, Chris Kennedy, Hans Verkuil, Tyler Trafford");MODULE_LICENSE("GPL");static unsigned short normal_i2c[] = { 0x88 >> 1, I2C_CLIENT_END };int cx25840_debug = 0;module_param(cx25840_debug, bool, 0644);MODULE_PARM_DESC(cx25840_debug, "Debugging messages [0=Off (default) 1=On]");I2C_CLIENT_INSMOD;/* ----------------------------------------------------------------------- */int cx25840_write(struct i2c_client *client, u16 addr, u8 value){ u8 buffer[3]; buffer[0] = addr >> 8; buffer[1] = addr & 0xff; buffer[2] = value; return i2c_master_send(client, buffer, 3);}int cx25840_write4(struct i2c_client *client, u16 addr, u32 value){ u8 buffer[6]; buffer[0] = addr >> 8; buffer[1] = addr & 0xff; buffer[2] = value >> 24; buffer[3] = (value >> 16) & 0xff; buffer[4] = (value >> 8) & 0xff; buffer[5] = value & 0xff; return i2c_master_send(client, buffer, 6);}u8 cx25840_read(struct i2c_client * client, u16 addr){ u8 buffer[2]; buffer[0] = addr >> 8; buffer[1] = addr & 0xff; if (i2c_master_send(client, buffer, 2) < 2) return 0; if (i2c_master_recv(client, buffer, 1) < 1) return 0; return buffer[0];}u32 cx25840_read4(struct i2c_client * client, u16 addr){ u8 buffer[4]; buffer[0] = addr >> 8; buffer[1] = addr & 0xff; if (i2c_master_send(client, buffer, 2) < 2) return 0; if (i2c_master_recv(client, buffer, 4) < 4) return 0; return (buffer[0] << 24) | (buffer[1] << 16) | (buffer[2] << 8) | buffer[3];}int cx25840_and_or(struct i2c_client *client, u16 addr, u8 and_mask, u8 or_value){ return cx25840_write(client, addr, (cx25840_read(client, addr) & and_mask) | or_value);}/* ----------------------------------------------------------------------- */static int set_input(struct i2c_client *, enum cx25840_input);static void input_change(struct i2c_client *);static void log_status(struct i2c_client *client);/* ----------------------------------------------------------------------- */static inline void init_dll1(struct i2c_client *client){ /* This is the Hauppauge sequence used to * initialize the Delay Lock Loop 1 (ADC DLL). */ cx25840_write(client, 0x159, 0x23); cx25840_write(client, 0x15a, 0x87); cx25840_write(client, 0x15b, 0x06); cx25840_write(client, 0x159, 0xe1); cx25840_write(client, 0x15a, 0x86); cx25840_write(client, 0x159, 0xe0); cx25840_write(client, 0x159, 0xe1); cx25840_write(client, 0x15b, 0x10);}static inline void init_dll2(struct i2c_client *client){ /* This is the Hauppauge sequence used to * initialize the Delay Lock Loop 2 (ADC DLL). */ cx25840_write(client, 0x15d, 0xe3); cx25840_write(client, 0x15e, 0x86); cx25840_write(client, 0x15f, 0x06); cx25840_write(client, 0x15d, 0xe1); cx25840_write(client, 0x15d, 0xe0); cx25840_write(client, 0x15d, 0xe1);}static void cx25840_initialize(struct i2c_client *client, int loadfw){ struct cx25840_state *state = i2c_get_clientdata(client); /* datasheet startup in numbered steps, refer to page 3-77 */ /* 2. */ cx25840_and_or(client, 0x803, ~0x10, 0x00); /* The default of this register should be 4, but I get 0 instead. * Set this register to 4 manually. */ cx25840_write(client, 0x000, 0x04); /* 3. */ init_dll1(client); init_dll2(client); cx25840_write(client, 0x136, 0x0a); /* 4. */ cx25840_write(client, 0x13c, 0x01); cx25840_write(client, 0x13c, 0x00); /* 5. */ if (loadfw) cx25840_loadfw(client); /* 6. */ cx25840_write(client, 0x115, 0x8c); cx25840_write(client, 0x116, 0x07); cx25840_write(client, 0x118, 0x02); /* 7. */ cx25840_write(client, 0x4a5, 0x80); cx25840_write(client, 0x4a5, 0x00); cx25840_write(client, 0x402, 0x00); /* 8. */ cx25840_write(client, 0x401, 0x18); cx25840_write(client, 0x4a2, 0x10); cx25840_write(client, 0x402, 0x04); /* 10. */ cx25840_write(client, 0x8d3, 0x1f); cx25840_write(client, 0x8e3, 0x03); cx25840_vbi_setup(client); /* trial and error says these are needed to get audio */ cx25840_write(client, 0x914, 0xa0); cx25840_write(client, 0x918, 0xa0); cx25840_write(client, 0x919, 0x01); /* stereo prefered */ cx25840_write(client, 0x809, 0x04); /* AC97 shift */ cx25840_write(client, 0x8cf, 0x0f); /* (re)set video input */ set_input(client, state->input); /* (re)set audio input */ cx25840_audio(client, AUDC_SET_INPUT, &state->audio_input); /* start microcontroller */ cx25840_and_or(client, 0x803, ~0x10, 0x10);}/* ----------------------------------------------------------------------- */static void input_change(struct i2c_client *client){ struct cx25840_state *state = i2c_get_clientdata(client); v4l2_std_id std = cx25840_get_v4lstd(client); /* Note: perhaps V4L2_STD_PAL_M should be handled as V4L2_STD_NTSC instead of V4L2_STD_PAL. Someone needs to test this. */ if (std & V4L2_STD_PAL) { /* Follow tuner change procedure for PAL */ cx25840_write(client, 0x808, 0xff); cx25840_write(client, 0x80b, 0x10); } else if (std & V4L2_STD_SECAM) { /* Select autodetect for SECAM */ cx25840_write(client, 0x808, 0xff); cx25840_write(client, 0x80b, 0x10); } else if (std & V4L2_STD_NTSC) { /* NTSC */ if (state->cardtype == CARDTYPE_PVR150_WORKAROUND) { /* Certain Hauppauge PVR150 models have a hardware bug that causes audio to drop out. For these models the audio standard must be set explicitly. To be precise: it affects cards with tuner models 85, 99 and 112 (model numbers from tveeprom). */ if (std == V4L2_STD_NTSC_M_JP) { /* Japan uses EIAJ audio standard */ cx25840_write(client, 0x808, 0x2f); } else { /* Others use the BTSC audio standard */ cx25840_write(client, 0x808, 0x1f); } /* South Korea uses the A2-M (aka Zweiton M) audio standard, and should set 0x808 to 0x3f, but I don't know how to detect this. */ } else if (std == V4L2_STD_NTSC_M_JP) { /* Japan uses EIAJ audio standard */ cx25840_write(client, 0x808, 0xf7); } else { /* Others use the BTSC audio standard */ cx25840_write(client, 0x808, 0xf6); } /* South Korea uses the A2-M (aka Zweiton M) audio standard, and should set 0x808 to 0xf8, but I don't know how to detect this. */ cx25840_write(client, 0x80b, 0x00); } if (cx25840_read(client, 0x803) & 0x10) { /* restart audio decoder microcontroller */ cx25840_and_or(client, 0x803, ~0x10, 0x00); cx25840_and_or(client, 0x803, ~0x10, 0x10); }}static int set_input(struct i2c_client *client, enum cx25840_input input){ struct cx25840_state *state = i2c_get_clientdata(client); cx25840_dbg("decoder set input (%d)\n", input); switch (input) { case CX25840_TUNER: cx25840_dbg("now setting Tuner input\n"); if (state->cardtype == CARDTYPE_PVR150 || state->cardtype == CARDTYPE_PVR150_WORKAROUND) { /* CH_SEL_ADC2=1 */ cx25840_and_or(client, 0x102, ~0x2, 0x02); } /* Video Input Control */ if (state->cardtype == CARDTYPE_PG600) { cx25840_write(client, 0x103, 0x11); } else { cx25840_write(client, 0x103, 0x46); } /* INPUT_MODE=0 */ cx25840_and_or(client, 0x401, ~0x6, 0x00); break; case CX25840_COMPOSITE0: case CX25840_COMPOSITE1: cx25840_dbg("now setting Composite input\n"); /* Video Input Control */ if (state->cardtype == CARDTYPE_PG600) { cx25840_write(client, 0x103, 0x00); } else { cx25840_write(client, 0x103, 0x02); } /* INPUT_MODE=0 */ cx25840_and_or(client, 0x401, ~0x6, 0x00); break; case CX25840_SVIDEO0: case CX25840_SVIDEO1: cx25840_dbg("now setting S-Video input\n"); /* CH_SEL_ADC2=0 */ cx25840_and_or(client, 0x102, ~0x2, 0x00); /* Video Input Control */ if (state->cardtype == CARDTYPE_PG600) { cx25840_write(client, 0x103, 0x02); } else { cx25840_write(client, 0x103, 0x10); } /* INPUT_MODE=1 */ cx25840_and_or(client, 0x401, ~0x6, 0x02); break; default: cx25840_err("%d is not a valid input!\n", input); return -EINVAL; } state->input = input; input_change(client); return 0;}/* ----------------------------------------------------------------------- */static int set_v4lstd(struct i2c_client *client, v4l2_std_id std){ u8 fmt=0; /* zero is autodetect */ /* First tests should be against specific std */ if (std & V4L2_STD_NTSC_M_JP) { fmt=0x2; } else if (std & V4L2_STD_NTSC_443) { fmt=0x3; } else if (std & V4L2_STD_PAL_M) { fmt=0x5; } else if (std & V4L2_STD_PAL_N) { fmt=0x6; } else if (std & V4L2_STD_PAL_Nc) { fmt=0x7; } else if (std & V4L2_STD_PAL_60) { fmt=0x8; } else { /* Then, test against generic ones */ if (std & V4L2_STD_NTSC) { fmt=0x1; } else if (std & V4L2_STD_PAL) { fmt=0x4; } else if (std & V4L2_STD_SECAM) { fmt=0xc; } } cx25840_and_or(client, 0x400, ~0xf, fmt); cx25840_vbi_setup(client); return 0;}v4l2_std_id cx25840_get_v4lstd(struct i2c_client * client){ /* check VID_FMT_SEL first */ u8 fmt = cx25840_read(client, 0x400) & 0xf; if (!fmt) { /* check AFD_FMT_STAT if set to autodetect */ fmt = cx25840_read(client, 0x40d) & 0xf; } switch (fmt) { case 0x1: return V4L2_STD_NTSC_M; case 0x2: return V4L2_STD_NTSC_M_JP; case 0x3: return V4L2_STD_NTSC_443; case 0x4: return V4L2_STD_PAL; case 0x5: return V4L2_STD_PAL_M; case 0x6: return V4L2_STD_PAL_N; case 0x7: return V4L2_STD_PAL_Nc; case 0x8: return V4L2_STD_PAL_60; case 0xc: return V4L2_STD_SECAM; default: return V4L2_STD_UNKNOWN; }}/* ----------------------------------------------------------------------- */static int set_v4lctrl(struct i2c_client *client, struct v4l2_control *ctrl){ struct cx25840_state *state = i2c_get_clientdata(client); switch (ctrl->id) { case CX25840_CID_CARDTYPE: switch (ctrl->value) { case CARDTYPE_PVR150: case CARDTYPE_PVR150_WORKAROUND: case CARDTYPE_PG600: state->cardtype = ctrl->value; break; default: return -ERANGE; } set_input(client, state->input); break; case V4L2_CID_BRIGHTNESS: if (ctrl->value < 0 || ctrl->value > 255) { cx25840_err("invalid brightness setting %d\n", ctrl->value); return -ERANGE; } cx25840_write(client, 0x414, ctrl->value - 128); break; case V4L2_CID_CONTRAST: if (ctrl->value < 0 || ctrl->value > 127) { cx25840_err("invalid contrast setting %d\n", ctrl->value); return -ERANGE; } cx25840_write(client, 0x415, ctrl->value << 1); break; case V4L2_CID_SATURATION: if (ctrl->value < 0 || ctrl->value > 127) { cx25840_err("invalid saturation setting %d\n", ctrl->value); return -ERANGE; } cx25840_write(client, 0x420, ctrl->value << 1); cx25840_write(client, 0x421, ctrl->value << 1); break; case V4L2_CID_HUE: if (ctrl->value < -127 || ctrl->value > 127) { cx25840_err("invalid hue setting %d\n", ctrl->value); return -ERANGE; } cx25840_write(client, 0x422, ctrl->value); break; case V4L2_CID_AUDIO_VOLUME: case V4L2_CID_AUDIO_BASS: case V4L2_CID_AUDIO_TREBLE: case V4L2_CID_AUDIO_BALANCE: case V4L2_CID_AUDIO_MUTE: return cx25840_audio(client, VIDIOC_S_CTRL, ctrl); } return 0;}static int get_v4lctrl(struct i2c_client *client, struct v4l2_control *ctrl){ struct cx25840_state *state = i2c_get_clientdata(client); switch (ctrl->id) { case CX25840_CID_CARDTYPE: ctrl->value = state->cardtype; break; case V4L2_CID_BRIGHTNESS: ctrl->value = cx25840_read(client, 0x414) + 128; break; case V4L2_CID_CONTRAST: ctrl->value = cx25840_read(client, 0x415) >> 1; break; case V4L2_CID_SATURATION: ctrl->value = cx25840_read(client, 0x420) >> 1; break; case V4L2_CID_HUE: ctrl->value = cx25840_read(client, 0x422); break; case V4L2_CID_AUDIO_VOLUME: case V4L2_CID_AUDIO_BASS: case V4L2_CID_AUDIO_TREBLE: case V4L2_CID_AUDIO_BALANCE: case V4L2_CID_AUDIO_MUTE: return cx25840_audio(client, VIDIOC_G_CTRL, ctrl); default: return -EINVAL; } return 0;}/* ----------------------------------------------------------------------- */static int get_v4lfmt(struct i2c_client *client, struct v4l2_format *fmt){ switch (fmt->type) { case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: return cx25840_vbi(client, VIDIOC_G_FMT, fmt); default: return -EINVAL; } return 0;}static int set_v4lfmt(struct i2c_client *client, struct v4l2_format *fmt){ struct v4l2_pix_format *pix; int HSC, VSC, Vsrc, Hsrc, filter, Vlines; int is_pal = !(cx25840_get_v4lstd(client) & V4L2_STD_NTSC); switch (fmt->type) { case V4L2_BUF_TYPE_VIDEO_CAPTURE: pix = &(fmt->fmt.pix); Vsrc = (cx25840_read(client, 0x476) & 0x3f) << 4; Vsrc |= (cx25840_read(client, 0x475) & 0xf0) >> 4; Hsrc = (cx25840_read(client, 0x472) & 0x3f) << 4; Hsrc |= (cx25840_read(client, 0x471) & 0xf0) >> 4; Vlines = pix->height + (is_pal ? 4 : 7); if ((pix->width * 16 < Hsrc) || (Hsrc < pix->width) || (Vlines * 8 < Vsrc) || (Vsrc < Vlines)) {
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -