V4L/DVB (11309): cx25840: cleanup: remove intermediate 'ioctl' step
The audio and vbi functions where still called through an ioctl-like interface, even though this is no longer needed with v4l2-subdev. Just change each 'case' into a proper function and call that directly. Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Hans Verkuil
Mauro Carvalho Chehab
Родитель
2c26976d72
Коммит
df1d5ed8a8
|
|
@ -363,75 +363,74 @@ static void set_mute(struct i2c_client *client, int mute)
|
|||
}
|
||||
}
|
||||
|
||||
int cx25840_audio(struct i2c_client *client, unsigned int cmd, void *arg)
|
||||
int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq)
|
||||
{
|
||||
struct cx25840_state *state = to_state(i2c_get_clientdata(client));
|
||||
struct v4l2_control *ctrl = arg;
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
struct cx25840_state *state = to_state(sd);
|
||||
int retval;
|
||||
|
||||
switch (cmd) {
|
||||
case VIDIOC_INT_AUDIO_CLOCK_FREQ:
|
||||
if (!state->is_cx25836)
|
||||
cx25840_and_or(client, 0x810, ~0x1, 1);
|
||||
if (state->aud_input != CX25840_AUDIO_SERIAL) {
|
||||
cx25840_and_or(client, 0x803, ~0x10, 0);
|
||||
cx25840_write(client, 0x8d3, 0x1f);
|
||||
}
|
||||
retval = set_audclk_freq(client, *(u32 *)arg);
|
||||
if (state->aud_input != CX25840_AUDIO_SERIAL) {
|
||||
cx25840_and_or(client, 0x803, ~0x10, 0x10);
|
||||
}
|
||||
if (!state->is_cx25836)
|
||||
cx25840_and_or(client, 0x810, ~0x1, 0);
|
||||
return retval;
|
||||
if (!state->is_cx25836)
|
||||
cx25840_and_or(client, 0x810, ~0x1, 1);
|
||||
if (state->aud_input != CX25840_AUDIO_SERIAL) {
|
||||
cx25840_and_or(client, 0x803, ~0x10, 0);
|
||||
cx25840_write(client, 0x8d3, 0x1f);
|
||||
}
|
||||
retval = set_audclk_freq(client, freq);
|
||||
if (state->aud_input != CX25840_AUDIO_SERIAL)
|
||||
cx25840_and_or(client, 0x803, ~0x10, 0x10);
|
||||
if (!state->is_cx25836)
|
||||
cx25840_and_or(client, 0x810, ~0x1, 0);
|
||||
return retval;
|
||||
}
|
||||
|
||||
case VIDIOC_G_CTRL:
|
||||
switch (ctrl->id) {
|
||||
case V4L2_CID_AUDIO_VOLUME:
|
||||
ctrl->value = get_volume(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BASS:
|
||||
ctrl->value = get_bass(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_TREBLE:
|
||||
ctrl->value = get_treble(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BALANCE:
|
||||
ctrl->value = get_balance(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_MUTE:
|
||||
ctrl->value = get_mute(client);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
int cx25840_audio_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
|
||||
switch (ctrl->id) {
|
||||
case V4L2_CID_AUDIO_VOLUME:
|
||||
ctrl->value = get_volume(client);
|
||||
break;
|
||||
|
||||
case VIDIOC_S_CTRL:
|
||||
switch (ctrl->id) {
|
||||
case V4L2_CID_AUDIO_VOLUME:
|
||||
set_volume(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BASS:
|
||||
set_bass(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_TREBLE:
|
||||
set_treble(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BALANCE:
|
||||
set_balance(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_MUTE:
|
||||
set_mute(client, ctrl->value);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
case V4L2_CID_AUDIO_BASS:
|
||||
ctrl->value = get_bass(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_TREBLE:
|
||||
ctrl->value = get_treble(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BALANCE:
|
||||
ctrl->value = get_balance(client);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_MUTE:
|
||||
ctrl->value = get_mute(client);
|
||||
break;
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cx25840_audio_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
|
||||
switch (ctrl->id) {
|
||||
case V4L2_CID_AUDIO_VOLUME:
|
||||
set_volume(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BASS:
|
||||
set_bass(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_TREBLE:
|
||||
set_treble(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_BALANCE:
|
||||
set_balance(client, ctrl->value);
|
||||
break;
|
||||
case V4L2_CID_AUDIO_MUTE:
|
||||
set_mute(client, ctrl->value);
|
||||
break;
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -775,7 +775,7 @@ static int cx25840_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
|
|||
case V4L2_CID_AUDIO_MUTE:
|
||||
if (state->is_cx25836)
|
||||
return -EINVAL;
|
||||
return cx25840_audio(client, VIDIOC_S_CTRL, ctrl);
|
||||
return cx25840_audio_s_ctrl(sd, ctrl);
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
|
|
@ -812,7 +812,7 @@ static int cx25840_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
|
|||
case V4L2_CID_AUDIO_MUTE:
|
||||
if (state->is_cx25836)
|
||||
return -EINVAL;
|
||||
return cx25840_audio(client, VIDIOC_G_CTRL, ctrl);
|
||||
return cx25840_audio_g_ctrl(sd, ctrl);
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
|
@ -828,7 +828,7 @@ static int cx25840_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt)
|
|||
|
||||
switch (fmt->type) {
|
||||
case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
|
||||
return cx25840_vbi(client, VIDIOC_G_FMT, fmt);
|
||||
return cx25840_vbi_g_fmt(sd, fmt);
|
||||
default:
|
||||
return -EINVAL;
|
||||
}
|
||||
|
|
@ -890,10 +890,10 @@ static int cx25840_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt)
|
|||
break;
|
||||
|
||||
case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
|
||||
return cx25840_vbi(client, VIDIOC_S_FMT, fmt);
|
||||
return cx25840_vbi_s_fmt(sd, fmt);
|
||||
|
||||
case V4L2_BUF_TYPE_VBI_CAPTURE:
|
||||
return cx25840_vbi(client, VIDIOC_S_FMT, fmt);
|
||||
return cx25840_vbi_s_fmt(sd, fmt);
|
||||
|
||||
default:
|
||||
return -EINVAL;
|
||||
|
|
@ -1153,20 +1153,6 @@ static int cx25840_s_register(struct v4l2_subdev *sd, struct v4l2_dbg_register *
|
|||
}
|
||||
#endif
|
||||
|
||||
static int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
|
||||
return cx25840_vbi(client, VIDIOC_INT_DECODE_VBI_LINE, vbi);
|
||||
}
|
||||
|
||||
static int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
|
||||
return cx25840_audio(client, VIDIOC_INT_AUDIO_CLOCK_FREQ, &freq);
|
||||
}
|
||||
|
||||
static int cx25840_s_stream(struct v4l2_subdev *sd, int enable)
|
||||
{
|
||||
struct cx25840_state *state = to_state(sd);
|
||||
|
|
|
|||
|
|
@ -75,11 +75,15 @@ int cx25840_loadfw(struct i2c_client *client);
|
|||
|
||||
/* ----------------------------------------------------------------------- */
|
||||
/* cx25850-audio.c */
|
||||
int cx25840_audio(struct i2c_client *client, unsigned int cmd, void *arg);
|
||||
void cx25840_audio_set_path(struct i2c_client *client);
|
||||
int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq);
|
||||
int cx25840_audio_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl);
|
||||
int cx25840_audio_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl);
|
||||
|
||||
/* ----------------------------------------------------------------------- */
|
||||
/* cx25850-vbi.c */
|
||||
int cx25840_vbi(struct i2c_client *client, unsigned int cmd, void *arg);
|
||||
int cx25840_vbi_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt);
|
||||
int cx25840_vbi_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt);
|
||||
int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi);
|
||||
|
||||
#endif
|
||||
|
|
|
|||
|
|
@ -82,199 +82,181 @@ static int decode_vps(u8 * dst, u8 * p)
|
|||
return err & 0xf0;
|
||||
}
|
||||
|
||||
int cx25840_vbi(struct i2c_client *client, unsigned int cmd, void *arg)
|
||||
int cx25840_vbi_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt)
|
||||
{
|
||||
struct cx25840_state *state = to_state(i2c_get_clientdata(client));
|
||||
struct v4l2_format *fmt;
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
struct cx25840_state *state = to_state(sd);
|
||||
struct v4l2_sliced_vbi_format *svbi;
|
||||
static const u16 lcr2vbi[] = {
|
||||
0, V4L2_SLICED_TELETEXT_B, 0, /* 1 */
|
||||
0, V4L2_SLICED_WSS_625, 0, /* 4 */
|
||||
V4L2_SLICED_CAPTION_525, /* 6 */
|
||||
0, 0, V4L2_SLICED_VPS, 0, 0, /* 9 */
|
||||
0, 0, 0, 0
|
||||
};
|
||||
int is_pal = !(state->std & V4L2_STD_525_60);
|
||||
int i;
|
||||
|
||||
switch (cmd) {
|
||||
case VIDIOC_G_FMT:
|
||||
{
|
||||
static u16 lcr2vbi[] = {
|
||||
0, V4L2_SLICED_TELETEXT_B, 0, /* 1 */
|
||||
0, V4L2_SLICED_WSS_625, 0, /* 4 */
|
||||
V4L2_SLICED_CAPTION_525, /* 6 */
|
||||
0, 0, V4L2_SLICED_VPS, 0, 0, /* 9 */
|
||||
0, 0, 0, 0
|
||||
};
|
||||
int is_pal = !(state->std & V4L2_STD_525_60);
|
||||
int i;
|
||||
if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
|
||||
return -EINVAL;
|
||||
svbi = &fmt->fmt.sliced;
|
||||
memset(svbi, 0, sizeof(*svbi));
|
||||
/* we're done if raw VBI is active */
|
||||
if ((cx25840_read(client, 0x404) & 0x10) == 0)
|
||||
return 0;
|
||||
|
||||
fmt = arg;
|
||||
if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
|
||||
return -EINVAL;
|
||||
svbi = &fmt->fmt.sliced;
|
||||
memset(svbi, 0, sizeof(*svbi));
|
||||
/* we're done if raw VBI is active */
|
||||
if ((cx25840_read(client, 0x404) & 0x10) == 0)
|
||||
break;
|
||||
if (is_pal) {
|
||||
for (i = 7; i <= 23; i++) {
|
||||
u8 v = cx25840_read(client, 0x424 + i - 7);
|
||||
|
||||
if (is_pal) {
|
||||
for (i = 7; i <= 23; i++) {
|
||||
u8 v = cx25840_read(client, 0x424 + i - 7);
|
||||
|
||||
svbi->service_lines[0][i] = lcr2vbi[v >> 4];
|
||||
svbi->service_lines[1][i] = lcr2vbi[v & 0xf];
|
||||
svbi->service_set |=
|
||||
svbi->service_lines[0][i] | svbi->service_lines[1][i];
|
||||
}
|
||||
svbi->service_lines[0][i] = lcr2vbi[v >> 4];
|
||||
svbi->service_lines[1][i] = lcr2vbi[v & 0xf];
|
||||
svbi->service_set |= svbi->service_lines[0][i] |
|
||||
svbi->service_lines[1][i];
|
||||
}
|
||||
else {
|
||||
for (i = 10; i <= 21; i++) {
|
||||
u8 v = cx25840_read(client, 0x424 + i - 10);
|
||||
} else {
|
||||
for (i = 10; i <= 21; i++) {
|
||||
u8 v = cx25840_read(client, 0x424 + i - 10);
|
||||
|
||||
svbi->service_lines[0][i] = lcr2vbi[v >> 4];
|
||||
svbi->service_lines[1][i] = lcr2vbi[v & 0xf];
|
||||
svbi->service_set |=
|
||||
svbi->service_lines[0][i] | svbi->service_lines[1][i];
|
||||
}
|
||||
svbi->service_lines[0][i] = lcr2vbi[v >> 4];
|
||||
svbi->service_lines[1][i] = lcr2vbi[v & 0xf];
|
||||
svbi->service_set |= svbi->service_lines[0][i] |
|
||||
svbi->service_lines[1][i];
|
||||
}
|
||||
break;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
case VIDIOC_S_FMT:
|
||||
{
|
||||
int is_pal = !(state->std & V4L2_STD_525_60);
|
||||
int vbi_offset = is_pal ? 1 : 0;
|
||||
int i, x;
|
||||
u8 lcr[24];
|
||||
int cx25840_vbi_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt)
|
||||
{
|
||||
struct i2c_client *client = v4l2_get_subdevdata(sd);
|
||||
struct cx25840_state *state = to_state(sd);
|
||||
struct v4l2_sliced_vbi_format *svbi;
|
||||
int is_pal = !(state->std & V4L2_STD_525_60);
|
||||
int vbi_offset = is_pal ? 1 : 0;
|
||||
int i, x;
|
||||
u8 lcr[24];
|
||||
|
||||
fmt = arg;
|
||||
if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE &&
|
||||
fmt->type != V4L2_BUF_TYPE_VBI_CAPTURE)
|
||||
return -EINVAL;
|
||||
svbi = &fmt->fmt.sliced;
|
||||
if (fmt->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
|
||||
/* raw VBI */
|
||||
memset(svbi, 0, sizeof(*svbi));
|
||||
|
||||
/* Setup standard */
|
||||
cx25840_std_setup(client);
|
||||
|
||||
/* VBI Offset */
|
||||
cx25840_write(client, 0x47f, vbi_offset);
|
||||
cx25840_write(client, 0x404, 0x2e);
|
||||
break;
|
||||
}
|
||||
|
||||
for (x = 0; x <= 23; x++)
|
||||
lcr[x] = 0x00;
|
||||
if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE &&
|
||||
fmt->type != V4L2_BUF_TYPE_VBI_CAPTURE)
|
||||
return -EINVAL;
|
||||
svbi = &fmt->fmt.sliced;
|
||||
if (fmt->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
|
||||
/* raw VBI */
|
||||
memset(svbi, 0, sizeof(*svbi));
|
||||
|
||||
/* Setup standard */
|
||||
cx25840_std_setup(client);
|
||||
|
||||
/* Sliced VBI */
|
||||
cx25840_write(client, 0x404, 0x32); /* Ancillary data */
|
||||
cx25840_write(client, 0x406, 0x13);
|
||||
/* VBI Offset */
|
||||
cx25840_write(client, 0x47f, vbi_offset);
|
||||
|
||||
if (is_pal) {
|
||||
for (i = 0; i <= 6; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
} else {
|
||||
for (i = 0; i <= 9; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
|
||||
for (i = 22; i <= 23; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
}
|
||||
|
||||
for (i = 7; i <= 23; i++) {
|
||||
for (x = 0; x <= 1; x++) {
|
||||
switch (svbi->service_lines[1-x][i]) {
|
||||
case V4L2_SLICED_TELETEXT_B:
|
||||
lcr[i] |= 1 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_WSS_625:
|
||||
lcr[i] |= 4 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_CAPTION_525:
|
||||
lcr[i] |= 6 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_VPS:
|
||||
lcr[i] |= 9 << (4 * x);
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (is_pal) {
|
||||
for (x = 1, i = 0x424; i <= 0x434; i++, x++) {
|
||||
cx25840_write(client, i, lcr[6 + x]);
|
||||
}
|
||||
}
|
||||
else {
|
||||
for (x = 1, i = 0x424; i <= 0x430; i++, x++) {
|
||||
cx25840_write(client, i, lcr[9 + x]);
|
||||
}
|
||||
for (i = 0x431; i <= 0x434; i++) {
|
||||
cx25840_write(client, i, 0);
|
||||
}
|
||||
}
|
||||
|
||||
cx25840_write(client, 0x43c, 0x16);
|
||||
|
||||
if (is_pal) {
|
||||
cx25840_write(client, 0x474, 0x2a);
|
||||
} else {
|
||||
cx25840_write(client, 0x474, 0x22);
|
||||
}
|
||||
break;
|
||||
cx25840_write(client, 0x404, 0x2e);
|
||||
return 0;
|
||||
}
|
||||
|
||||
case VIDIOC_INT_DECODE_VBI_LINE:
|
||||
{
|
||||
struct v4l2_decode_vbi_line *vbi = arg;
|
||||
u8 *p = vbi->p;
|
||||
int id1, id2, l, err = 0;
|
||||
for (x = 0; x <= 23; x++)
|
||||
lcr[x] = 0x00;
|
||||
|
||||
if (p[0] || p[1] != 0xff || p[2] != 0xff ||
|
||||
(p[3] != 0x55 && p[3] != 0x91)) {
|
||||
vbi->line = vbi->type = 0;
|
||||
break;
|
||||
}
|
||||
/* Setup standard */
|
||||
cx25840_std_setup(client);
|
||||
|
||||
p += 4;
|
||||
id1 = p[-1];
|
||||
id2 = p[0] & 0xf;
|
||||
l = p[2] & 0x3f;
|
||||
l += state->vbi_line_offset;
|
||||
p += 4;
|
||||
/* Sliced VBI */
|
||||
cx25840_write(client, 0x404, 0x32); /* Ancillary data */
|
||||
cx25840_write(client, 0x406, 0x13);
|
||||
cx25840_write(client, 0x47f, vbi_offset);
|
||||
|
||||
switch (id2) {
|
||||
case 1:
|
||||
id2 = V4L2_SLICED_TELETEXT_B;
|
||||
break;
|
||||
case 4:
|
||||
id2 = V4L2_SLICED_WSS_625;
|
||||
break;
|
||||
case 6:
|
||||
id2 = V4L2_SLICED_CAPTION_525;
|
||||
err = !odd_parity(p[0]) || !odd_parity(p[1]);
|
||||
break;
|
||||
case 9:
|
||||
id2 = V4L2_SLICED_VPS;
|
||||
if (decode_vps(p, p) != 0) {
|
||||
err = 1;
|
||||
if (is_pal) {
|
||||
for (i = 0; i <= 6; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
} else {
|
||||
for (i = 0; i <= 9; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
|
||||
for (i = 22; i <= 23; i++)
|
||||
svbi->service_lines[0][i] =
|
||||
svbi->service_lines[1][i] = 0;
|
||||
}
|
||||
|
||||
for (i = 7; i <= 23; i++) {
|
||||
for (x = 0; x <= 1; x++) {
|
||||
switch (svbi->service_lines[1-x][i]) {
|
||||
case V4L2_SLICED_TELETEXT_B:
|
||||
lcr[i] |= 1 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_WSS_625:
|
||||
lcr[i] |= 4 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_CAPTION_525:
|
||||
lcr[i] |= 6 << (4 * x);
|
||||
break;
|
||||
case V4L2_SLICED_VPS:
|
||||
lcr[i] |= 9 << (4 * x);
|
||||
break;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
id2 = 0;
|
||||
err = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
vbi->type = err ? 0 : id2;
|
||||
vbi->line = err ? 0 : l;
|
||||
vbi->is_second_field = err ? 0 : (id1 == 0x55);
|
||||
vbi->p = p;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
if (is_pal) {
|
||||
for (x = 1, i = 0x424; i <= 0x434; i++, x++)
|
||||
cx25840_write(client, i, lcr[6 + x]);
|
||||
} else {
|
||||
for (x = 1, i = 0x424; i <= 0x430; i++, x++)
|
||||
cx25840_write(client, i, lcr[9 + x]);
|
||||
for (i = 0x431; i <= 0x434; i++)
|
||||
cx25840_write(client, i, 0);
|
||||
}
|
||||
|
||||
cx25840_write(client, 0x43c, 0x16);
|
||||
cx25840_write(client, 0x474, is_pal ? 0x2a : 0x22);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi)
|
||||
{
|
||||
struct cx25840_state *state = to_state(sd);
|
||||
u8 *p = vbi->p;
|
||||
int id1, id2, l, err = 0;
|
||||
|
||||
if (p[0] || p[1] != 0xff || p[2] != 0xff ||
|
||||
(p[3] != 0x55 && p[3] != 0x91)) {
|
||||
vbi->line = vbi->type = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
p += 4;
|
||||
id1 = p[-1];
|
||||
id2 = p[0] & 0xf;
|
||||
l = p[2] & 0x3f;
|
||||
l += state->vbi_line_offset;
|
||||
p += 4;
|
||||
|
||||
switch (id2) {
|
||||
case 1:
|
||||
id2 = V4L2_SLICED_TELETEXT_B;
|
||||
break;
|
||||
case 4:
|
||||
id2 = V4L2_SLICED_WSS_625;
|
||||
break;
|
||||
case 6:
|
||||
id2 = V4L2_SLICED_CAPTION_525;
|
||||
err = !odd_parity(p[0]) || !odd_parity(p[1]);
|
||||
break;
|
||||
case 9:
|
||||
id2 = V4L2_SLICED_VPS;
|
||||
if (decode_vps(p, p) != 0)
|
||||
err = 1;
|
||||
break;
|
||||
default:
|
||||
id2 = 0;
|
||||
err = 1;
|
||||
break;
|
||||
}
|
||||
|
||||
vbi->type = err ? 0 : id2;
|
||||
vbi->line = err ? 0 : l;
|
||||
vbi->is_second_field = err ? 0 : (id1 == 0x55);
|
||||
vbi->p = p;
|
||||
return 0;
|
||||
}
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче