diff options
author | Hans Verkuil <hverkuil@xs4all.nl> | 2009-03-30 05:26:40 -0400 |
---|---|---|
committer | Mauro Carvalho Chehab <mchehab@redhat.com> | 2009-03-30 11:43:49 -0400 |
commit | df1d5ed8a81565b78d45fbdffb6561c75c75ec0d (patch) | |
tree | d153ca216a5a7633e741a2240ad2391ff61202ed /drivers/media/video | |
parent | 2c26976d726838878eb8dd1bc91f84df38a05143 (diff) |
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>
Diffstat (limited to 'drivers/media/video')
-rw-r--r-- | drivers/media/video/cx25840/cx25840-audio.c | 121 | ||||
-rw-r--r-- | drivers/media/video/cx25840/cx25840-core.c | 24 | ||||
-rw-r--r-- | drivers/media/video/cx25840/cx25840-core.h | 8 | ||||
-rw-r--r-- | drivers/media/video/cx25840/cx25840-vbi.c | 314 |
4 files changed, 219 insertions, 248 deletions
diff --git a/drivers/media/video/cx25840/cx25840-audio.c b/drivers/media/video/cx25840/cx25840-audio.c index d199d80ea0a3..93d74bee292a 100644 --- a/drivers/media/video/cx25840/cx25840-audio.c +++ b/drivers/media/video/cx25840/cx25840-audio.c | |||
@@ -363,75 +363,74 @@ static void set_mute(struct i2c_client *client, int mute) | |||
363 | } | 363 | } |
364 | } | 364 | } |
365 | 365 | ||
366 | int cx25840_audio(struct i2c_client *client, unsigned int cmd, void *arg) | 366 | int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq) |
367 | { | 367 | { |
368 | struct cx25840_state *state = to_state(i2c_get_clientdata(client)); | 368 | struct i2c_client *client = v4l2_get_subdevdata(sd); |
369 | struct v4l2_control *ctrl = arg; | 369 | struct cx25840_state *state = to_state(sd); |
370 | int retval; | 370 | int retval; |
371 | 371 | ||
372 | switch (cmd) { | 372 | if (!state->is_cx25836) |
373 | case VIDIOC_INT_AUDIO_CLOCK_FREQ: | 373 | cx25840_and_or(client, 0x810, ~0x1, 1); |
374 | if (!state->is_cx25836) | 374 | if (state->aud_input != CX25840_AUDIO_SERIAL) { |
375 | cx25840_and_or(client, 0x810, ~0x1, 1); | 375 | cx25840_and_or(client, 0x803, ~0x10, 0); |
376 | if (state->aud_input != CX25840_AUDIO_SERIAL) { | 376 | cx25840_write(client, 0x8d3, 0x1f); |
377 | cx25840_and_or(client, 0x803, ~0x10, 0); | 377 | } |
378 | cx25840_write(client, 0x8d3, 0x1f); | 378 | retval = set_audclk_freq(client, freq); |
379 | } | 379 | if (state->aud_input != CX25840_AUDIO_SERIAL) |
380 | retval = set_audclk_freq(client, *(u32 *)arg); | 380 | cx25840_and_or(client, 0x803, ~0x10, 0x10); |
381 | if (state->aud_input != CX25840_AUDIO_SERIAL) { | 381 | if (!state->is_cx25836) |
382 | cx25840_and_or(client, 0x803, ~0x10, 0x10); | 382 | cx25840_and_or(client, 0x810, ~0x1, 0); |
383 | } | 383 | return retval; |
384 | if (!state->is_cx25836) | 384 | } |
385 | cx25840_and_or(client, 0x810, ~0x1, 0); | ||
386 | return retval; | ||
387 | |||
388 | case VIDIOC_G_CTRL: | ||
389 | switch (ctrl->id) { | ||
390 | case V4L2_CID_AUDIO_VOLUME: | ||
391 | ctrl->value = get_volume(client); | ||
392 | break; | ||
393 | case V4L2_CID_AUDIO_BASS: | ||
394 | ctrl->value = get_bass(client); | ||
395 | break; | ||
396 | case V4L2_CID_AUDIO_TREBLE: | ||
397 | ctrl->value = get_treble(client); | ||
398 | break; | ||
399 | case V4L2_CID_AUDIO_BALANCE: | ||
400 | ctrl->value = get_balance(client); | ||
401 | break; | ||
402 | case V4L2_CID_AUDIO_MUTE: | ||
403 | ctrl->value = get_mute(client); | ||
404 | break; | ||
405 | default: | ||
406 | return -EINVAL; | ||
407 | } | ||
408 | break; | ||
409 | 385 | ||
410 | case VIDIOC_S_CTRL: | 386 | int cx25840_audio_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) |
411 | switch (ctrl->id) { | 387 | { |
412 | case V4L2_CID_AUDIO_VOLUME: | 388 | struct i2c_client *client = v4l2_get_subdevdata(sd); |
413 | set_volume(client, ctrl->value); | ||
414 | break; | ||
415 | case V4L2_CID_AUDIO_BASS: | ||
416 | set_bass(client, ctrl->value); | ||
417 | break; | ||
418 | case V4L2_CID_AUDIO_TREBLE: | ||
419 | set_treble(client, ctrl->value); | ||
420 | break; | ||
421 | case V4L2_CID_AUDIO_BALANCE: | ||
422 | set_balance(client, ctrl->value); | ||
423 | break; | ||
424 | case V4L2_CID_AUDIO_MUTE: | ||
425 | set_mute(client, ctrl->value); | ||
426 | break; | ||
427 | default: | ||
428 | return -EINVAL; | ||
429 | } | ||
430 | break; | ||
431 | 389 | ||
390 | switch (ctrl->id) { | ||
391 | case V4L2_CID_AUDIO_VOLUME: | ||
392 | ctrl->value = get_volume(client); | ||
393 | break; | ||
394 | case V4L2_CID_AUDIO_BASS: | ||
395 | ctrl->value = get_bass(client); | ||
396 | break; | ||
397 | case V4L2_CID_AUDIO_TREBLE: | ||
398 | ctrl->value = get_treble(client); | ||
399 | break; | ||
400 | case V4L2_CID_AUDIO_BALANCE: | ||
401 | ctrl->value = get_balance(client); | ||
402 | break; | ||
403 | case V4L2_CID_AUDIO_MUTE: | ||
404 | ctrl->value = get_mute(client); | ||
405 | break; | ||
432 | default: | 406 | default: |
433 | return -EINVAL; | 407 | return -EINVAL; |
434 | } | 408 | } |
409 | return 0; | ||
410 | } | ||
435 | 411 | ||
412 | int cx25840_audio_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) | ||
413 | { | ||
414 | struct i2c_client *client = v4l2_get_subdevdata(sd); | ||
415 | |||
416 | switch (ctrl->id) { | ||
417 | case V4L2_CID_AUDIO_VOLUME: | ||
418 | set_volume(client, ctrl->value); | ||
419 | break; | ||
420 | case V4L2_CID_AUDIO_BASS: | ||
421 | set_bass(client, ctrl->value); | ||
422 | break; | ||
423 | case V4L2_CID_AUDIO_TREBLE: | ||
424 | set_treble(client, ctrl->value); | ||
425 | break; | ||
426 | case V4L2_CID_AUDIO_BALANCE: | ||
427 | set_balance(client, ctrl->value); | ||
428 | break; | ||
429 | case V4L2_CID_AUDIO_MUTE: | ||
430 | set_mute(client, ctrl->value); | ||
431 | break; | ||
432 | default: | ||
433 | return -EINVAL; | ||
434 | } | ||
436 | return 0; | 435 | return 0; |
437 | } | 436 | } |
diff --git a/drivers/media/video/cx25840/cx25840-core.c b/drivers/media/video/cx25840/cx25840-core.c index a9b8e520ae57..ec67aea0cdb8 100644 --- a/drivers/media/video/cx25840/cx25840-core.c +++ b/drivers/media/video/cx25840/cx25840-core.c | |||
@@ -775,7 +775,7 @@ static int cx25840_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) | |||
775 | case V4L2_CID_AUDIO_MUTE: | 775 | case V4L2_CID_AUDIO_MUTE: |
776 | if (state->is_cx25836) | 776 | if (state->is_cx25836) |
777 | return -EINVAL; | 777 | return -EINVAL; |
778 | return cx25840_audio(client, VIDIOC_S_CTRL, ctrl); | 778 | return cx25840_audio_s_ctrl(sd, ctrl); |
779 | 779 | ||
780 | default: | 780 | default: |
781 | return -EINVAL; | 781 | return -EINVAL; |
@@ -812,7 +812,7 @@ static int cx25840_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl) | |||
812 | case V4L2_CID_AUDIO_MUTE: | 812 | case V4L2_CID_AUDIO_MUTE: |
813 | if (state->is_cx25836) | 813 | if (state->is_cx25836) |
814 | return -EINVAL; | 814 | return -EINVAL; |
815 | return cx25840_audio(client, VIDIOC_G_CTRL, ctrl); | 815 | return cx25840_audio_g_ctrl(sd, ctrl); |
816 | default: | 816 | default: |
817 | return -EINVAL; | 817 | return -EINVAL; |
818 | } | 818 | } |
@@ -828,7 +828,7 @@ static int cx25840_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt) | |||
828 | 828 | ||
829 | switch (fmt->type) { | 829 | switch (fmt->type) { |
830 | case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: | 830 | case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: |
831 | return cx25840_vbi(client, VIDIOC_G_FMT, fmt); | 831 | return cx25840_vbi_g_fmt(sd, fmt); |
832 | default: | 832 | default: |
833 | return -EINVAL; | 833 | return -EINVAL; |
834 | } | 834 | } |
@@ -890,10 +890,10 @@ static int cx25840_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt) | |||
890 | break; | 890 | break; |
891 | 891 | ||
892 | case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: | 892 | case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: |
893 | return cx25840_vbi(client, VIDIOC_S_FMT, fmt); | 893 | return cx25840_vbi_s_fmt(sd, fmt); |
894 | 894 | ||
895 | case V4L2_BUF_TYPE_VBI_CAPTURE: | 895 | case V4L2_BUF_TYPE_VBI_CAPTURE: |
896 | return cx25840_vbi(client, VIDIOC_S_FMT, fmt); | 896 | return cx25840_vbi_s_fmt(sd, fmt); |
897 | 897 | ||
898 | default: | 898 | default: |
899 | return -EINVAL; | 899 | return -EINVAL; |
@@ -1153,20 +1153,6 @@ static int cx25840_s_register(struct v4l2_subdev *sd, struct v4l2_dbg_register * | |||
1153 | } | 1153 | } |
1154 | #endif | 1154 | #endif |
1155 | 1155 | ||
1156 | static int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi) | ||
1157 | { | ||
1158 | struct i2c_client *client = v4l2_get_subdevdata(sd); | ||
1159 | |||
1160 | return cx25840_vbi(client, VIDIOC_INT_DECODE_VBI_LINE, vbi); | ||
1161 | } | ||
1162 | |||
1163 | static int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq) | ||
1164 | { | ||
1165 | struct i2c_client *client = v4l2_get_subdevdata(sd); | ||
1166 | |||
1167 | return cx25840_audio(client, VIDIOC_INT_AUDIO_CLOCK_FREQ, &freq); | ||
1168 | } | ||
1169 | |||
1170 | static int cx25840_s_stream(struct v4l2_subdev *sd, int enable) | 1156 | static int cx25840_s_stream(struct v4l2_subdev *sd, int enable) |
1171 | { | 1157 | { |
1172 | struct cx25840_state *state = to_state(sd); | 1158 | struct cx25840_state *state = to_state(sd); |
diff --git a/drivers/media/video/cx25840/cx25840-core.h b/drivers/media/video/cx25840/cx25840-core.h index be0558277ca3..9ad0eb86ecfd 100644 --- a/drivers/media/video/cx25840/cx25840-core.h +++ b/drivers/media/video/cx25840/cx25840-core.h | |||
@@ -75,11 +75,15 @@ int cx25840_loadfw(struct i2c_client *client); | |||
75 | 75 | ||
76 | /* ----------------------------------------------------------------------- */ | 76 | /* ----------------------------------------------------------------------- */ |
77 | /* cx25850-audio.c */ | 77 | /* cx25850-audio.c */ |
78 | int cx25840_audio(struct i2c_client *client, unsigned int cmd, void *arg); | ||
79 | void cx25840_audio_set_path(struct i2c_client *client); | 78 | void cx25840_audio_set_path(struct i2c_client *client); |
79 | int cx25840_s_clock_freq(struct v4l2_subdev *sd, u32 freq); | ||
80 | int cx25840_audio_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl); | ||
81 | int cx25840_audio_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl); | ||
80 | 82 | ||
81 | /* ----------------------------------------------------------------------- */ | 83 | /* ----------------------------------------------------------------------- */ |
82 | /* cx25850-vbi.c */ | 84 | /* cx25850-vbi.c */ |
83 | int cx25840_vbi(struct i2c_client *client, unsigned int cmd, void *arg); | 85 | int cx25840_vbi_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt); |
86 | int cx25840_vbi_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt); | ||
87 | int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi); | ||
84 | 88 | ||
85 | #endif | 89 | #endif |
diff --git a/drivers/media/video/cx25840/cx25840-vbi.c b/drivers/media/video/cx25840/cx25840-vbi.c index 03f09b288eb8..35f6592f6c47 100644 --- a/drivers/media/video/cx25840/cx25840-vbi.c +++ b/drivers/media/video/cx25840/cx25840-vbi.c | |||
@@ -82,199 +82,181 @@ static int decode_vps(u8 * dst, u8 * p) | |||
82 | return err & 0xf0; | 82 | return err & 0xf0; |
83 | } | 83 | } |
84 | 84 | ||
85 | int cx25840_vbi(struct i2c_client *client, unsigned int cmd, void *arg) | 85 | int cx25840_vbi_g_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt) |
86 | { | 86 | { |
87 | struct cx25840_state *state = to_state(i2c_get_clientdata(client)); | 87 | struct i2c_client *client = v4l2_get_subdevdata(sd); |
88 | struct v4l2_format *fmt; | 88 | struct cx25840_state *state = to_state(sd); |
89 | struct v4l2_sliced_vbi_format *svbi; | 89 | struct v4l2_sliced_vbi_format *svbi; |
90 | static const u16 lcr2vbi[] = { | ||
91 | 0, V4L2_SLICED_TELETEXT_B, 0, /* 1 */ | ||
92 | 0, V4L2_SLICED_WSS_625, 0, /* 4 */ | ||
93 | V4L2_SLICED_CAPTION_525, /* 6 */ | ||
94 | 0, 0, V4L2_SLICED_VPS, 0, 0, /* 9 */ | ||
95 | 0, 0, 0, 0 | ||
96 | }; | ||
97 | int is_pal = !(state->std & V4L2_STD_525_60); | ||
98 | int i; | ||
90 | 99 | ||
91 | switch (cmd) { | 100 | if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE) |
92 | case VIDIOC_G_FMT: | 101 | return -EINVAL; |
93 | { | 102 | svbi = &fmt->fmt.sliced; |
94 | static u16 lcr2vbi[] = { | 103 | memset(svbi, 0, sizeof(*svbi)); |
95 | 0, V4L2_SLICED_TELETEXT_B, 0, /* 1 */ | 104 | /* we're done if raw VBI is active */ |
96 | 0, V4L2_SLICED_WSS_625, 0, /* 4 */ | 105 | if ((cx25840_read(client, 0x404) & 0x10) == 0) |
97 | V4L2_SLICED_CAPTION_525, /* 6 */ | 106 | return 0; |
98 | 0, 0, V4L2_SLICED_VPS, 0, 0, /* 9 */ | ||
99 | 0, 0, 0, 0 | ||
100 | }; | ||
101 | int is_pal = !(state->std & V4L2_STD_525_60); | ||
102 | int i; | ||
103 | |||
104 | fmt = arg; | ||
105 | if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE) | ||
106 | return -EINVAL; | ||
107 | svbi = &fmt->fmt.sliced; | ||
108 | memset(svbi, 0, sizeof(*svbi)); | ||
109 | /* we're done if raw VBI is active */ | ||
110 | if ((cx25840_read(client, 0x404) & 0x10) == 0) | ||
111 | break; | ||
112 | 107 | ||
113 | if (is_pal) { | 108 | if (is_pal) { |
114 | for (i = 7; i <= 23; i++) { | 109 | for (i = 7; i <= 23; i++) { |
115 | u8 v = cx25840_read(client, 0x424 + i - 7); | 110 | u8 v = cx25840_read(client, 0x424 + i - 7); |
116 | 111 | ||
117 | svbi->service_lines[0][i] = lcr2vbi[v >> 4]; | 112 | svbi->service_lines[0][i] = lcr2vbi[v >> 4]; |
118 | svbi->service_lines[1][i] = lcr2vbi[v & 0xf]; | 113 | svbi->service_lines[1][i] = lcr2vbi[v & 0xf]; |
119 | svbi->service_set |= | 114 | svbi->service_set |= svbi->service_lines[0][i] | |
120 | svbi->service_lines[0][i] | svbi->service_lines[1][i]; | 115 | svbi->service_lines[1][i]; |
121 | } | ||
122 | } | 116 | } |
123 | else { | 117 | } else { |
124 | for (i = 10; i <= 21; i++) { | 118 | for (i = 10; i <= 21; i++) { |
125 | u8 v = cx25840_read(client, 0x424 + i - 10); | 119 | u8 v = cx25840_read(client, 0x424 + i - 10); |
126 | 120 | ||
127 | svbi->service_lines[0][i] = lcr2vbi[v >> 4]; | 121 | svbi->service_lines[0][i] = lcr2vbi[v >> 4]; |
128 | svbi->service_lines[1][i] = lcr2vbi[v & 0xf]; | 122 | svbi->service_lines[1][i] = lcr2vbi[v & 0xf]; |
129 | svbi->service_set |= | 123 | svbi->service_set |= svbi->service_lines[0][i] | |
130 | svbi->service_lines[0][i] | svbi->service_lines[1][i]; | 124 | svbi->service_lines[1][i]; |
131 | } | ||
132 | } | 125 | } |
133 | break; | ||
134 | } | 126 | } |
127 | return 0; | ||
128 | } | ||
135 | 129 | ||
136 | case VIDIOC_S_FMT: | 130 | int cx25840_vbi_s_fmt(struct v4l2_subdev *sd, struct v4l2_format *fmt) |
137 | { | 131 | { |
138 | int is_pal = !(state->std & V4L2_STD_525_60); | 132 | struct i2c_client *client = v4l2_get_subdevdata(sd); |
139 | int vbi_offset = is_pal ? 1 : 0; | 133 | struct cx25840_state *state = to_state(sd); |
140 | int i, x; | 134 | struct v4l2_sliced_vbi_format *svbi; |
141 | u8 lcr[24]; | 135 | int is_pal = !(state->std & V4L2_STD_525_60); |
142 | 136 | int vbi_offset = is_pal ? 1 : 0; | |
143 | fmt = arg; | 137 | int i, x; |
144 | if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE && | 138 | u8 lcr[24]; |
145 | fmt->type != V4L2_BUF_TYPE_VBI_CAPTURE) | 139 | |
146 | return -EINVAL; | 140 | if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE && |
147 | svbi = &fmt->fmt.sliced; | 141 | fmt->type != V4L2_BUF_TYPE_VBI_CAPTURE) |
148 | if (fmt->type == V4L2_BUF_TYPE_VBI_CAPTURE) { | 142 | return -EINVAL; |
149 | /* raw VBI */ | 143 | svbi = &fmt->fmt.sliced; |
150 | memset(svbi, 0, sizeof(*svbi)); | 144 | if (fmt->type == V4L2_BUF_TYPE_VBI_CAPTURE) { |
151 | 145 | /* raw VBI */ | |
152 | /* Setup standard */ | 146 | memset(svbi, 0, sizeof(*svbi)); |
153 | cx25840_std_setup(client); | ||
154 | |||
155 | /* VBI Offset */ | ||
156 | cx25840_write(client, 0x47f, vbi_offset); | ||
157 | cx25840_write(client, 0x404, 0x2e); | ||
158 | break; | ||
159 | } | ||
160 | |||
161 | for (x = 0; x <= 23; x++) | ||
162 | lcr[x] = 0x00; | ||
163 | 147 | ||
164 | /* Setup standard */ | 148 | /* Setup standard */ |
165 | cx25840_std_setup(client); | 149 | cx25840_std_setup(client); |
166 | 150 | ||
167 | /* Sliced VBI */ | 151 | /* VBI Offset */ |
168 | cx25840_write(client, 0x404, 0x32); /* Ancillary data */ | ||
169 | cx25840_write(client, 0x406, 0x13); | ||
170 | cx25840_write(client, 0x47f, vbi_offset); | 152 | cx25840_write(client, 0x47f, vbi_offset); |
153 | cx25840_write(client, 0x404, 0x2e); | ||
154 | return 0; | ||
155 | } | ||
171 | 156 | ||
172 | if (is_pal) { | 157 | for (x = 0; x <= 23; x++) |
173 | for (i = 0; i <= 6; i++) | 158 | lcr[x] = 0x00; |
174 | svbi->service_lines[0][i] = | 159 | |
175 | svbi->service_lines[1][i] = 0; | 160 | /* Setup standard */ |
176 | } else { | 161 | cx25840_std_setup(client); |
177 | for (i = 0; i <= 9; i++) | 162 | |
178 | svbi->service_lines[0][i] = | 163 | /* Sliced VBI */ |
179 | svbi->service_lines[1][i] = 0; | 164 | cx25840_write(client, 0x404, 0x32); /* Ancillary data */ |
180 | 165 | cx25840_write(client, 0x406, 0x13); | |
181 | for (i = 22; i <= 23; i++) | 166 | cx25840_write(client, 0x47f, vbi_offset); |
182 | svbi->service_lines[0][i] = | 167 | |
183 | svbi->service_lines[1][i] = 0; | 168 | if (is_pal) { |
184 | } | 169 | for (i = 0; i <= 6; i++) |
185 | 170 | svbi->service_lines[0][i] = | |
186 | for (i = 7; i <= 23; i++) { | 171 | svbi->service_lines[1][i] = 0; |
187 | for (x = 0; x <= 1; x++) { | 172 | } else { |
188 | switch (svbi->service_lines[1-x][i]) { | 173 | for (i = 0; i <= 9; i++) |
189 | case V4L2_SLICED_TELETEXT_B: | 174 | svbi->service_lines[0][i] = |
190 | lcr[i] |= 1 << (4 * x); | 175 | svbi->service_lines[1][i] = 0; |
191 | break; | 176 | |
192 | case V4L2_SLICED_WSS_625: | 177 | for (i = 22; i <= 23; i++) |
193 | lcr[i] |= 4 << (4 * x); | 178 | svbi->service_lines[0][i] = |
194 | break; | 179 | svbi->service_lines[1][i] = 0; |
195 | case V4L2_SLICED_CAPTION_525: | 180 | } |
196 | lcr[i] |= 6 << (4 * x); | ||
197 | break; | ||
198 | case V4L2_SLICED_VPS: | ||
199 | lcr[i] |= 9 << (4 * x); | ||
200 | break; | ||
201 | } | ||
202 | } | ||
203 | } | ||
204 | 181 | ||
205 | if (is_pal) { | 182 | for (i = 7; i <= 23; i++) { |
206 | for (x = 1, i = 0x424; i <= 0x434; i++, x++) { | 183 | for (x = 0; x <= 1; x++) { |
207 | cx25840_write(client, i, lcr[6 + x]); | 184 | switch (svbi->service_lines[1-x][i]) { |
208 | } | 185 | case V4L2_SLICED_TELETEXT_B: |
209 | } | 186 | lcr[i] |= 1 << (4 * x); |
210 | else { | 187 | break; |
211 | for (x = 1, i = 0x424; i <= 0x430; i++, x++) { | 188 | case V4L2_SLICED_WSS_625: |
212 | cx25840_write(client, i, lcr[9 + x]); | 189 | lcr[i] |= 4 << (4 * x); |
213 | } | 190 | break; |
214 | for (i = 0x431; i <= 0x434; i++) { | 191 | case V4L2_SLICED_CAPTION_525: |
215 | cx25840_write(client, i, 0); | 192 | lcr[i] |= 6 << (4 * x); |
193 | break; | ||
194 | case V4L2_SLICED_VPS: | ||
195 | lcr[i] |= 9 << (4 * x); | ||
196 | break; | ||
216 | } | 197 | } |
217 | } | 198 | } |
199 | } | ||
218 | 200 | ||
219 | cx25840_write(client, 0x43c, 0x16); | 201 | if (is_pal) { |
220 | 202 | for (x = 1, i = 0x424; i <= 0x434; i++, x++) | |
221 | if (is_pal) { | 203 | cx25840_write(client, i, lcr[6 + x]); |
222 | cx25840_write(client, 0x474, 0x2a); | 204 | } else { |
223 | } else { | 205 | for (x = 1, i = 0x424; i <= 0x430; i++, x++) |
224 | cx25840_write(client, 0x474, 0x22); | 206 | cx25840_write(client, i, lcr[9 + x]); |
225 | } | 207 | for (i = 0x431; i <= 0x434; i++) |
226 | break; | 208 | cx25840_write(client, i, 0); |
227 | } | 209 | } |
228 | 210 | ||
229 | case VIDIOC_INT_DECODE_VBI_LINE: | 211 | cx25840_write(client, 0x43c, 0x16); |
230 | { | 212 | cx25840_write(client, 0x474, is_pal ? 0x2a : 0x22); |
231 | struct v4l2_decode_vbi_line *vbi = arg; | 213 | return 0; |
232 | u8 *p = vbi->p; | 214 | } |
233 | int id1, id2, l, err = 0; | ||
234 | 215 | ||
235 | if (p[0] || p[1] != 0xff || p[2] != 0xff || | 216 | int cx25840_decode_vbi_line(struct v4l2_subdev *sd, struct v4l2_decode_vbi_line *vbi) |
236 | (p[3] != 0x55 && p[3] != 0x91)) { | 217 | { |
237 | vbi->line = vbi->type = 0; | 218 | struct cx25840_state *state = to_state(sd); |
238 | break; | 219 | u8 *p = vbi->p; |
239 | } | 220 | int id1, id2, l, err = 0; |
221 | |||
222 | if (p[0] || p[1] != 0xff || p[2] != 0xff || | ||
223 | (p[3] != 0x55 && p[3] != 0x91)) { | ||
224 | vbi->line = vbi->type = 0; | ||
225 | return 0; | ||
226 | } | ||
240 | 227 | ||
241 | p += 4; | 228 | p += 4; |
242 | id1 = p[-1]; | 229 | id1 = p[-1]; |
243 | id2 = p[0] & 0xf; | 230 | id2 = p[0] & 0xf; |
244 | l = p[2] & 0x3f; | 231 | l = p[2] & 0x3f; |
245 | l += state->vbi_line_offset; | 232 | l += state->vbi_line_offset; |
246 | p += 4; | 233 | p += 4; |
247 | 234 | ||
248 | switch (id2) { | 235 | switch (id2) { |
249 | case 1: | 236 | case 1: |
250 | id2 = V4L2_SLICED_TELETEXT_B; | 237 | id2 = V4L2_SLICED_TELETEXT_B; |
251 | break; | 238 | break; |
252 | case 4: | 239 | case 4: |
253 | id2 = V4L2_SLICED_WSS_625; | 240 | id2 = V4L2_SLICED_WSS_625; |
254 | break; | 241 | break; |
255 | case 6: | 242 | case 6: |
256 | id2 = V4L2_SLICED_CAPTION_525; | 243 | id2 = V4L2_SLICED_CAPTION_525; |
257 | err = !odd_parity(p[0]) || !odd_parity(p[1]); | 244 | err = !odd_parity(p[0]) || !odd_parity(p[1]); |
258 | break; | 245 | break; |
259 | case 9: | 246 | case 9: |
260 | id2 = V4L2_SLICED_VPS; | 247 | id2 = V4L2_SLICED_VPS; |
261 | if (decode_vps(p, p) != 0) { | 248 | if (decode_vps(p, p) != 0) |
262 | err = 1; | ||
263 | } | ||
264 | break; | ||
265 | default: | ||
266 | id2 = 0; | ||
267 | err = 1; | 249 | err = 1; |
268 | break; | ||
269 | } | ||
270 | |||
271 | vbi->type = err ? 0 : id2; | ||
272 | vbi->line = err ? 0 : l; | ||
273 | vbi->is_second_field = err ? 0 : (id1 == 0x55); | ||
274 | vbi->p = p; | ||
275 | break; | 250 | break; |
276 | } | 251 | default: |
252 | id2 = 0; | ||
253 | err = 1; | ||
254 | break; | ||
277 | } | 255 | } |
278 | 256 | ||
257 | vbi->type = err ? 0 : id2; | ||
258 | vbi->line = err ? 0 : l; | ||
259 | vbi->is_second_field = err ? 0 : (id1 == 0x55); | ||
260 | vbi->p = p; | ||
279 | return 0; | 261 | return 0; |
280 | } | 262 | } |