projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (3344a): Conversions from kmalloc+memset to k(z|c)alloc
[deliverable/linux.git] / drivers / media / video / saa7127.c
CommitLineData
cfbb5b8c
HV		 1/*
2 * saa7127 - Philips SAA7127/SAA7129 video encoder driver
3 *
4 * Copyright (C) 2003 Roy Bulter <rbulter@hetnet.nl>
5 *
6 * Based on SAA7126 video encoder driver by Gillem & Andreas Oberritter
7 *
8 * Copyright (C) 2000-2001 Gillem <htoa@gmx.net>
9 * Copyright (C) 2002 Andreas Oberritter <obi@saftware.de>
10 *
11 * Based on Stadis 4:2:2 MPEG-2 Decoder Driver by Nathan Laredo
12 *
13 * Copyright (C) 1999 Nathan Laredo <laredo@gnu.org>
14 *
15 * This driver is designed for the Hauppauge 250/350 Linux driver
16 * from the ivtv Project
17 *
18 * Copyright (C) 2003 Kevin Thayer <nufan_wfk@yahoo.com>
19 *
20 * Dual output support:
21 * Copyright (C) 2004 Eric Varsanyi
22 *
23 * NTSC Tuning and 7.5 IRE Setup
24 * Copyright (C) 2004 Chris Kennedy <c@groovy.org>
25 *
26 * VBI additions & cleanup:
27 * Copyright (C) 2004, 2005 Hans Verkuil <hverkuil@xs4all.nl>
28 *
29 * Note: the saa7126 is identical to the saa7127, and the saa7128 is
30 * identical to the saa7129, except that the saa7126 and saa7128 have
31 * macrovision anti-taping support. This driver will almost certainly
32 * work find for those chips, except of course for the missing anti-taping
33 * support.
34 *
35 * This program is free software; you can redistribute it and/or modify
36 * it under the terms of the GNU General Public License as published by
37 * the Free Software Foundation; either version 2 of the License, or
38 * (at your option) any later version.
39 *
40 * This program is distributed in the hope that it will be useful,
41 * but WITHOUT ANY WARRANTY; without even the implied warranty of
42 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
43 * GNU General Public License for more details.
44 *
45 * You should have received a copy of the GNU General Public License
46 * along with this program; if not, write to the Free Software
47 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
48 */
49
50
51#include <linux/kernel.h>
52#include <linux/module.h>
53#include <linux/slab.h>
54#include <linux/i2c.h>
55#include <linux/videodev2.h>
cfbb5b8c
HV		 56#include <media/v4l2-common.h>
57
58static int debug = 0;
59static int test_image = 0;
60
61MODULE_DESCRIPTION("Philips SAA7127/9 video encoder driver");
1f4b3365 62MODULE_AUTHOR("Kevin Thayer, Chris Kennedy, Hans Verkuil");
cfbb5b8c
HV		 63MODULE_LICENSE("GPL");
64module_param(debug, int, 0644);
65module_param(test_image, int, 0644);
66MODULE_PARM_DESC(debug, "debug level (0-2)");
67MODULE_PARM_DESC(test_image, "test_image (0-1)");
68
cfbb5b8c
HV		 69static unsigned short normal_i2c[] = { 0x88 >> 1, I2C_CLIENT_END };
70
71
72I2C_CLIENT_INSMOD;
73
74/*
75 * SAA7127 registers
76 */
77
78#define SAA7127_REG_STATUS 0x00
79#define SAA7127_REG_WIDESCREEN_CONFIG 0x26
80#define SAA7127_REG_WIDESCREEN_ENABLE 0x27
81#define SAA7127_REG_BURST_START 0x28
82#define SAA7127_REG_BURST_END 0x29
83#define SAA7127_REG_COPYGEN_0 0x2a
84#define SAA7127_REG_COPYGEN_1 0x2b
85#define SAA7127_REG_COPYGEN_2 0x2c
86#define SAA7127_REG_OUTPUT_PORT_CONTROL 0x2d
87#define SAA7127_REG_GAIN_LUMINANCE_RGB 0x38
88#define SAA7127_REG_GAIN_COLORDIFF_RGB 0x39
89#define SAA7127_REG_INPUT_PORT_CONTROL_1 0x3a
90#define SAA7129_REG_FADE_KEY_COL2 0x4f
91#define SAA7127_REG_CHROMA_PHASE 0x5a
92#define SAA7127_REG_GAINU 0x5b
93#define SAA7127_REG_GAINV 0x5c
94#define SAA7127_REG_BLACK_LEVEL 0x5d
95#define SAA7127_REG_BLANKING_LEVEL 0x5e
96#define SAA7127_REG_VBI_BLANKING 0x5f
97#define SAA7127_REG_DAC_CONTROL 0x61
98#define SAA7127_REG_BURST_AMP 0x62
99#define SAA7127_REG_SUBC3 0x63
100#define SAA7127_REG_SUBC2 0x64
101#define SAA7127_REG_SUBC1 0x65
102#define SAA7127_REG_SUBC0 0x66
103#define SAA7127_REG_LINE_21_ODD_0 0x67
104#define SAA7127_REG_LINE_21_ODD_1 0x68
105#define SAA7127_REG_LINE_21_EVEN_0 0x69
106#define SAA7127_REG_LINE_21_EVEN_1 0x6a
107#define SAA7127_REG_RCV_PORT_CONTROL 0x6b
108#define SAA7127_REG_VTRIG 0x6c
109#define SAA7127_REG_HTRIG_HI 0x6d
110#define SAA7127_REG_MULTI 0x6e
111#define SAA7127_REG_CLOSED_CAPTION 0x6f
112#define SAA7127_REG_RCV2_OUTPUT_START 0x70
113#define SAA7127_REG_RCV2_OUTPUT_END 0x71
114#define SAA7127_REG_RCV2_OUTPUT_MSBS 0x72
115#define SAA7127_REG_TTX_REQUEST_H_START 0x73
116#define SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH 0x74
117#define SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT 0x75
118#define SAA7127_REG_TTX_ODD_REQ_VERT_START 0x76
119#define SAA7127_REG_TTX_ODD_REQ_VERT_END 0x77
120#define SAA7127_REG_TTX_EVEN_REQ_VERT_START 0x78
121#define SAA7127_REG_TTX_EVEN_REQ_VERT_END 0x79
122#define SAA7127_REG_FIRST_ACTIVE 0x7a
123#define SAA7127_REG_LAST_ACTIVE 0x7b
124#define SAA7127_REG_MSB_VERTICAL 0x7c
125#define SAA7127_REG_DISABLE_TTX_LINE_LO_0 0x7e
126#define SAA7127_REG_DISABLE_TTX_LINE_LO_1 0x7f
127
128/*
129 **********************************************************************
130 *
131 * Arrays with configuration parameters for the SAA7127
132 *
133 **********************************************************************
134 */
135
136struct i2c_reg_value {
137 unsigned char reg;
138 unsigned char value;
139};
140
141static const struct i2c_reg_value saa7129_init_config_extra[] = {
142 { SAA7127_REG_OUTPUT_PORT_CONTROL, 0x38 },
143 { SAA7127_REG_VTRIG, 0xfa },
144};
145
146static const struct i2c_reg_value saa7127_init_config_common[] = {
147 { SAA7127_REG_WIDESCREEN_CONFIG, 0x0d },
148 { SAA7127_REG_WIDESCREEN_ENABLE, 0x00 },
149 { SAA7127_REG_COPYGEN_0, 0x77 },
150 { SAA7127_REG_COPYGEN_1, 0x41 },
151 { SAA7127_REG_COPYGEN_2, 0x00 }, /* Macrovision enable/disable */
152 { SAA7127_REG_OUTPUT_PORT_CONTROL, 0x9e },
153 { SAA7127_REG_GAIN_LUMINANCE_RGB, 0x00 },
154 { SAA7127_REG_GAIN_COLORDIFF_RGB, 0x00 },
155 { SAA7127_REG_INPUT_PORT_CONTROL_1, 0x80 }, /* for color bars */
156 { SAA7127_REG_LINE_21_ODD_0, 0x77 },
157 { SAA7127_REG_LINE_21_ODD_1, 0x41 },
158 { SAA7127_REG_LINE_21_EVEN_0, 0x88 },
159 { SAA7127_REG_LINE_21_EVEN_1, 0x41 },
160 { SAA7127_REG_RCV_PORT_CONTROL, 0x12 },
161 { SAA7127_REG_VTRIG, 0xf9 },
162 { SAA7127_REG_HTRIG_HI, 0x00 },
163 { SAA7127_REG_RCV2_OUTPUT_START, 0x41 },
164 { SAA7127_REG_RCV2_OUTPUT_END, 0xc3 },
165 { SAA7127_REG_RCV2_OUTPUT_MSBS, 0x00 },
166 { SAA7127_REG_TTX_REQUEST_H_START, 0x3e },
167 { SAA7127_REG_TTX_REQUEST_H_DELAY_LENGTH, 0xb8 },
168 { SAA7127_REG_CSYNC_ADVANCE_VSYNC_SHIFT, 0x03 },
169 { SAA7127_REG_TTX_ODD_REQ_VERT_START, 0x15 },
170 { SAA7127_REG_TTX_ODD_REQ_VERT_END, 0x16 },
171 { SAA7127_REG_TTX_EVEN_REQ_VERT_START, 0x15 },
172 { SAA7127_REG_TTX_EVEN_REQ_VERT_END, 0x16 },
173 { SAA7127_REG_FIRST_ACTIVE, 0x1a },
174 { SAA7127_REG_LAST_ACTIVE, 0x01 },
175 { SAA7127_REG_MSB_VERTICAL, 0xc0 },
176 { SAA7127_REG_DISABLE_TTX_LINE_LO_0, 0x00 },
177 { SAA7127_REG_DISABLE_TTX_LINE_LO_1, 0x00 },
178 { 0, 0 }
179};
180
181#define SAA7127_60HZ_DAC_CONTROL 0x15
182static const struct i2c_reg_value saa7127_init_config_60hz[] = {
183 { SAA7127_REG_BURST_START, 0x19 },
184 /* BURST_END is also used as a chip ID in saa7127_detect_client */
185 { SAA7127_REG_BURST_END, 0x1d },
186 { SAA7127_REG_CHROMA_PHASE, 0xa3 },
187 { SAA7127_REG_GAINU, 0x98 },
188 { SAA7127_REG_GAINV, 0xd3 },
189 { SAA7127_REG_BLACK_LEVEL, 0x39 },
190 { SAA7127_REG_BLANKING_LEVEL, 0x2e },
191 { SAA7127_REG_VBI_BLANKING, 0x2e },
192 { SAA7127_REG_DAC_CONTROL, 0x15 },
193 { SAA7127_REG_BURST_AMP, 0x4d },
194 { SAA7127_REG_SUBC3, 0x1f },
195 { SAA7127_REG_SUBC2, 0x7c },
196 { SAA7127_REG_SUBC1, 0xf0 },
197 { SAA7127_REG_SUBC0, 0x21 },
198 { SAA7127_REG_MULTI, 0x90 },
199 { SAA7127_REG_CLOSED_CAPTION, 0x11 },
200 { 0, 0 }
201};
202
203#define SAA7127_50HZ_DAC_CONTROL 0x02
769e2438 204static struct i2c_reg_value saa7127_init_config_50hz[] = {
cfbb5b8c
HV		 205 { SAA7127_REG_BURST_START, 0x21 },
206 /* BURST_END is also used as a chip ID in saa7127_detect_client */
207 { SAA7127_REG_BURST_END, 0x1d },
208 { SAA7127_REG_CHROMA_PHASE, 0x3f },
209 { SAA7127_REG_GAINU, 0x7d },
210 { SAA7127_REG_GAINV, 0xaf },
211 { SAA7127_REG_BLACK_LEVEL, 0x33 },
212 { SAA7127_REG_BLANKING_LEVEL, 0x35 },
213 { SAA7127_REG_VBI_BLANKING, 0x35 },
214 { SAA7127_REG_DAC_CONTROL, 0x02 },
215 { SAA7127_REG_BURST_AMP, 0x2f },
216 { SAA7127_REG_SUBC3, 0xcb },
217 { SAA7127_REG_SUBC2, 0x8a },
218 { SAA7127_REG_SUBC1, 0x09 },
219 { SAA7127_REG_SUBC0, 0x2a },
220 { SAA7127_REG_MULTI, 0xa0 },
221 { SAA7127_REG_CLOSED_CAPTION, 0x00 },
222 { 0, 0 }
223};
224
225/* Enumeration for the Supported input types */
226enum saa7127_input_type {
227 SAA7127_INPUT_TYPE_NORMAL,
228 SAA7127_INPUT_TYPE_TEST_IMAGE
229};
230
231/* Enumeration for the Supported Output signal types */
232enum saa7127_output_type {
233 SAA7127_OUTPUT_TYPE_BOTH,
234 SAA7127_OUTPUT_TYPE_COMPOSITE,
235 SAA7127_OUTPUT_TYPE_SVIDEO,
236 SAA7127_OUTPUT_TYPE_RGB,
237 SAA7127_OUTPUT_TYPE_YUV_C,
238 SAA7127_OUTPUT_TYPE_YUV_V
239};
240
241/*
242 **********************************************************************
243 *
244 * Encoder Struct, holds the configuration state of the encoder
245 *
246 **********************************************************************
247 */
248
249struct saa7127_state {
250 v4l2_std_id std;
251 enum v4l2_chip_ident ident;
252 enum saa7127_input_type input_type;
253 enum saa7127_output_type output_type;
254 int video_enable;
255 int wss_enable;
256 u16 wss_mode;
257 int cc_enable;
258 u16 cc_data;
259 int xds_enable;
260 u16 xds_data;
261 int vps_enable;
262 u8 vps_data[5];
263 u8 reg_2d;
264 u8 reg_3a;
265 u8 reg_3a_cb; /* colorbar bit */
266 u8 reg_61;
267};
268
269static const char * const output_strs[] =
270{
271 "S-Video + Composite",
272 "Composite",
273 "S-Video",
274 "RGB",
275 "YUV C",
276 "YUV V"
277};
278
279static const char * const wss_strs[] = {
280 "invalid",
281 "letterbox 14:9 center",
282 "letterbox 14:9 top",
283 "invalid",
284 "letterbox 16:9 top",
285 "invalid",
286 "invalid",
287 "16:9 full format anamorphic"
288 "4:3 full format",
289 "invalid",
290 "invalid",
291 "letterbox 16:9 center",
292 "invalid",
293 "letterbox >16:9 center",
294 "14:9 full format center",
295 "invalid",
296};
297
298/* ----------------------------------------------------------------------- */
299
300static int saa7127_read(struct i2c_client *client, u8 reg)
301{
302 return i2c_smbus_read_byte_data(client, reg);
303}
304
305/* ----------------------------------------------------------------------- */
306
307static int saa7127_write(struct i2c_client *client, u8 reg, u8 val)
308{
309 int i;
310
311 for (i = 0; i < 3; i++) {
312 if (i2c_smbus_write_byte_data(client, reg, val) == 0)
313 return 0;
314 }
fac9e899 315 v4l_err(client, "I2C Write Problem\n");
cfbb5b8c
HV		 316 return -1;
317}
318
319/* ----------------------------------------------------------------------- */
320
321static int saa7127_write_inittab(struct i2c_client *client,
322 const struct i2c_reg_value *regs)
323{
324 while (regs->reg != 0) {
325 saa7127_write(client, regs->reg, regs->value);
326 regs++;
327 }
328 return 0;
329}
330
331/* ----------------------------------------------------------------------- */
332
333static int saa7127_set_vps(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
334{
419d4e75 335 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 336 int enable = (data->line != 0);
337
338 if (enable && (data->field != 0 || data->line != 16))
339 return -EINVAL;
340 if (state->vps_enable != enable) {
fac9e899 341 v4l_dbg(1, client, "Turn VPS Signal %s\n", enable ? "on" : "off");
cfbb5b8c
HV		 342 saa7127_write(client, 0x54, enable << 7);
343 state->vps_enable = enable;
344 }
345 if (!enable)
346 return 0;
347
348 state->vps_data[0] = data->data[4];
349 state->vps_data[1] = data->data[10];
350 state->vps_data[2] = data->data[11];
351 state->vps_data[3] = data->data[12];
352 state->vps_data[4] = data->data[13];
fac9e899 353 v4l_dbg(1, client, "Set VPS data %02x %02x %02x %02x %02x\n",
cfbb5b8c
HV		 354 state->vps_data[0], state->vps_data[1],
355 state->vps_data[2], state->vps_data[3],
356 state->vps_data[4]);
357 saa7127_write(client, 0x55, state->vps_data[0]);
358 saa7127_write(client, 0x56, state->vps_data[1]);
359 saa7127_write(client, 0x57, state->vps_data[2]);
360 saa7127_write(client, 0x58, state->vps_data[3]);
361 saa7127_write(client, 0x59, state->vps_data[4]);
362 return 0;
363}
364
365/* ----------------------------------------------------------------------- */
366
367static int saa7127_set_cc(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
368{
419d4e75 369 struct saa7127_state *state = i2c_get_clientdata(client);
515432aa 370 u16 cc = data->data[1] << 8 | data->data[0];
cfbb5b8c
HV		 371 int enable = (data->line != 0);
372
373 if (enable && (data->field != 0 || data->line != 21))
374 return -EINVAL;
375 if (state->cc_enable != enable) {
fac9e899 376 v4l_dbg(1, client, "Turn CC %s\n", enable ? "on" : "off");
cfbb5b8c 377 saa7127_write(client, SAA7127_REG_CLOSED_CAPTION,
515432aa 378 (state->xds_enable << 7) | (enable << 6) | 0x11);
cfbb5b8c
HV		 379 state->cc_enable = enable;
380 }
381 if (!enable)
382 return 0;
383
fac9e899 384 v4l_dbg(2, client, "CC data: %04x\n", cc);
cfbb5b8c
HV		 385 saa7127_write(client, SAA7127_REG_LINE_21_ODD_0, cc & 0xff);
386 saa7127_write(client, SAA7127_REG_LINE_21_ODD_1, cc >> 8);
387 state->cc_data = cc;
388 return 0;
389}
390
391/* ----------------------------------------------------------------------- */
392
393static int saa7127_set_xds(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
394{
419d4e75 395 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 396 u16 xds = data->data[1] << 8 | data->data[0];
397 int enable = (data->line != 0);
398
399 if (enable && (data->field != 1 || data->line != 21))
400 return -EINVAL;
401 if (state->xds_enable != enable) {
fac9e899 402 v4l_dbg(1, client, "Turn XDS %s\n", enable ? "on" : "off");
cfbb5b8c 403 saa7127_write(client, SAA7127_REG_CLOSED_CAPTION,
515432aa 404 (enable << 7) | (state->cc_enable << 6) | 0x11);
cfbb5b8c
HV		 405 state->xds_enable = enable;
406 }
407 if (!enable)
408 return 0;
409
fac9e899 410 v4l_dbg(2, client, "XDS data: %04x\n", xds);
cfbb5b8c
HV		 411 saa7127_write(client, SAA7127_REG_LINE_21_EVEN_0, xds & 0xff);
412 saa7127_write(client, SAA7127_REG_LINE_21_EVEN_1, xds >> 8);
413 state->xds_data = xds;
414 return 0;
415}
416
417/* ----------------------------------------------------------------------- */
418
419static int saa7127_set_wss(struct i2c_client *client, struct v4l2_sliced_vbi_data *data)
420{
419d4e75 421 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 422 int enable = (data->line != 0);
423
424 if (enable && (data->field != 0 || data->line != 23))
425 return -EINVAL;
426 if (state->wss_enable != enable) {
fac9e899 427 v4l_dbg(1, client, "Turn WSS %s\n", enable ? "on" : "off");
cfbb5b8c
HV		 428 saa7127_write(client, 0x27, enable << 7);
429 state->wss_enable = enable;
430 }
431 if (!enable)
432 return 0;
433
434 saa7127_write(client, 0x26, data->data[0]);
435 saa7127_write(client, 0x27, 0x80 | (data->data[1] & 0x3f));
fac9e899 436 v4l_dbg(1, client, "WSS mode: %s\n", wss_strs[data->data[0] & 0xf]);
cfbb5b8c
HV		 437 state->wss_mode = (data->data[1] & 0x3f) << 8 | data->data[0];
438 return 0;
439}
440
441/* ----------------------------------------------------------------------- */
442
443static int saa7127_set_video_enable(struct i2c_client *client, int enable)
444{
419d4e75 445 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 446
447 if (enable) {
fac9e899 448 v4l_dbg(1, client, "Enable Video Output\n");
cfbb5b8c
HV		 449 saa7127_write(client, 0x2d, state->reg_2d);
450 saa7127_write(client, 0x61, state->reg_61);
451 } else {
fac9e899 452 v4l_dbg(1, client, "Disable Video Output\n");
cfbb5b8c
HV		 453 saa7127_write(client, 0x2d, (state->reg_2d & 0xf0));
454 saa7127_write(client, 0x61, (state->reg_61 | 0xc0));
455 }
456 state->video_enable = enable;
457 return 0;
458}
459
460/* ----------------------------------------------------------------------- */
461
462static int saa7127_set_std(struct i2c_client *client, v4l2_std_id std)
463{
419d4e75 464 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 465 const struct i2c_reg_value *inittab;
466
467 if (std & V4L2_STD_525_60) {
fac9e899 468 v4l_dbg(1, client, "Selecting 60 Hz video Standard\n");
cfbb5b8c
HV		 469 inittab = saa7127_init_config_60hz;
470 state->reg_61 = SAA7127_60HZ_DAC_CONTROL;
471 } else {
fac9e899 472 v4l_dbg(1, client, "Selecting 50 Hz video Standard\n");
cfbb5b8c
HV		 473 inittab = saa7127_init_config_50hz;
474 state->reg_61 = SAA7127_50HZ_DAC_CONTROL;
475 }
476
477 /* Write Table */
478 saa7127_write_inittab(client, inittab);
479 state->std = std;
480 return 0;
481}
482
483/* ----------------------------------------------------------------------- */
484
485static int saa7127_set_output_type(struct i2c_client *client, int output)
486{
419d4e75 487 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 488
489 switch (output) {
490 case SAA7127_OUTPUT_TYPE_RGB:
491 state->reg_2d = 0x0f; /* RGB + CVBS (for sync) */
492 state->reg_3a = 0x13; /* by default switch YUV to RGB-matrix on */
493 break;
494
495 case SAA7127_OUTPUT_TYPE_COMPOSITE:
496 state->reg_2d = 0x08; /* 00001000 CVBS only, RGB DAC's off (high impedance mode) */
497 state->reg_3a = 0x13; /* by default switch YUV to RGB-matrix on */
498 break;
499
500 case SAA7127_OUTPUT_TYPE_SVIDEO:
501 state->reg_2d = 0xff; /* 11111111 croma -> R, luma -> CVBS + G + B */
502 state->reg_3a = 0x13; /* by default switch YUV to RGB-matrix on */
503 break;
504
505 case SAA7127_OUTPUT_TYPE_YUV_V:
506 state->reg_2d = 0x4f; /* reg 2D = 01001111, all DAC's on, RGB + VBS */
507 state->reg_3a = 0x0b; /* reg 3A = 00001011, bypass RGB-matrix */
508 break;
509
510 case SAA7127_OUTPUT_TYPE_YUV_C:
511 state->reg_2d = 0x0f; /* reg 2D = 00001111, all DAC's on, RGB + CVBS */
512 state->reg_3a = 0x0b; /* reg 3A = 00001011, bypass RGB-matrix */
513 break;
514
515 case SAA7127_OUTPUT_TYPE_BOTH:
516 state->reg_2d = 0xbf;
517 state->reg_3a = 0x13; /* by default switch YUV to RGB-matrix on */
518 break;
519
520 default:
521 return -EINVAL;
522 }
fac9e899 523 v4l_dbg(1, client, "Selecting %s output type\n", output_strs[output]);
cfbb5b8c
HV		 524
525 /* Configure Encoder */
526 saa7127_write(client, 0x2d, state->reg_2d);
527 saa7127_write(client, 0x3a, state->reg_3a | state->reg_3a_cb);
528 state->output_type = output;
529 return 0;
530}
531
532/* ----------------------------------------------------------------------- */
533
534static int saa7127_set_input_type(struct i2c_client *client, int input)
535{
419d4e75 536 struct saa7127_state *state = i2c_get_clientdata(client);
cfbb5b8c
HV		 537
538 switch (input) {
539 case SAA7127_INPUT_TYPE_NORMAL: /* avia */
fac9e899 540 v4l_dbg(1, client, "Selecting Normal Encoder Input\n");
cfbb5b8c
HV		 541 state->reg_3a_cb = 0;
542 break;
543
544 case SAA7127_INPUT_TYPE_TEST_IMAGE: /* color bar */
fac9e899 545 v4l_dbg(1, client, "Selecting Color Bar generator\n");
cfbb5b8c
HV		 546 state->reg_3a_cb = 0x80;
547 break;
548
549 default:
550 return -EINVAL;
551 }
552 saa7127_write(client, 0x3a, state->reg_3a | state->reg_3a_cb);
553 state->input_type = input;
554 return 0;
555}
556
557/* ----------------------------------------------------------------------- */
558
559static int saa7127_command(struct i2c_client *client,
560 unsigned int cmd, void *arg)
561{
562 struct saa7127_state *state = i2c_get_clientdata(client);
563 struct v4l2_format *fmt = arg;
564 int *iarg = arg;
565
566 switch (cmd) {
567 case VIDIOC_S_STD:
568 if (state->std == *(v4l2_std_id *)arg)
569 break;
570 return saa7127_set_std(client, *(v4l2_std_id *)arg);
571
572 case VIDIOC_G_STD:
573 *(v4l2_std_id *)arg = state->std;
574 break;
575
576 case VIDIOC_S_INPUT:
577 if (state->input_type == *iarg)
578 break;
579 return saa7127_set_input_type(client, *iarg);
580
581 case VIDIOC_S_OUTPUT:
582 if (state->output_type == *iarg)
583 break;
584 return saa7127_set_output_type(client, *iarg);
585
586 case VIDIOC_STREAMON:
587 case VIDIOC_STREAMOFF:
588 if (state->video_enable == (cmd == VIDIOC_STREAMON))
589 break;
590 return saa7127_set_video_enable(client, cmd == VIDIOC_STREAMON);
591
592 case VIDIOC_G_FMT:
593 if (fmt->type != V4L2_BUF_TYPE_SLICED_VBI_CAPTURE)
594 return -EINVAL;
595
596 memset(&fmt->fmt.sliced, 0, sizeof(fmt->fmt.sliced));
597 if (state->vps_enable)
598 fmt->fmt.sliced.service_lines[0][16] = V4L2_SLICED_VPS;
599 if (state->wss_enable)
600 fmt->fmt.sliced.service_lines[0][23] = V4L2_SLICED_WSS_625;
601 if (state->cc_enable) {
602 fmt->fmt.sliced.service_lines[0][21] = V4L2_SLICED_CAPTION_525;
603 fmt->fmt.sliced.service_lines[1][21] = V4L2_SLICED_CAPTION_525;
604 }
605 fmt->fmt.sliced.service_set =
606 (state->vps_enable ? V4L2_SLICED_VPS : 0) |
607 (state->wss_enable ? V4L2_SLICED_WSS_625 : 0) |
608 (state->cc_enable ? V4L2_SLICED_CAPTION_525 : 0);
609 break;
610
611 case VIDIOC_LOG_STATUS:
fac9e899
HV		 612 v4l_info(client, "Standard: %s\n", (state->std & V4L2_STD_525_60) ? "60 Hz" : "50 Hz");
613 v4l_info(client, "Input: %s\n", state->input_type ? "color bars" : "normal");
614 v4l_info(client, "Output: %s\n", state->video_enable ?
cfbb5b8c 615 output_strs[state->output_type] : "disabled");
fac9e899 616 v4l_info(client, "WSS: %s\n", state->wss_enable ?
cfbb5b8c 617 wss_strs[state->wss_mode] : "disabled");
fac9e899
HV		 618 v4l_info(client, "VPS: %s\n", state->vps_enable ? "enabled" : "disabled");
619 v4l_info(client, "CC: %s\n", state->cc_enable ? "enabled" : "disabled");
cfbb5b8c
HV		 620 break;
621
622#ifdef CONFIG_VIDEO_ADV_DEBUG
623 case VIDIOC_INT_G_REGISTER:
624 {
625 struct v4l2_register *reg = arg;
626
627 if (reg->i2c_id != I2C_DRIVERID_SAA7127)
628 return -EINVAL;
629 reg->val = saa7127_read(client, reg->reg & 0xff);
630 break;
631 }
632
633 case VIDIOC_INT_S_REGISTER:
634 {
635 struct v4l2_register *reg = arg;
636
637 if (reg->i2c_id != I2C_DRIVERID_SAA7127)
638 return -EINVAL;
639 if (!capable(CAP_SYS_ADMIN))
640 return -EPERM;
641 saa7127_write(client, reg->reg & 0xff, reg->val & 0xff);
642 break;
643 }
644#endif
645
646 case VIDIOC_INT_S_VBI_DATA:
647 {
648 struct v4l2_sliced_vbi_data *data = arg;
649
650 switch (data->id) {
651 case V4L2_SLICED_WSS_625:
652 return saa7127_set_wss(client, data);
653 case V4L2_SLICED_VPS:
654 return saa7127_set_vps(client, data);
655 case V4L2_SLICED_CAPTION_525:
656 if (data->field == 0)
657 return saa7127_set_cc(client, data);
658 return saa7127_set_xds(client, data);
659 default:
660 return -EINVAL;
661 }
662 break;
663 }
664
665 case VIDIOC_INT_G_CHIP_IDENT:
666 *(enum v4l2_chip_ident *)arg = state->ident;
667 break;
668
669 default:
670 return -EINVAL;
671 }
672 return 0;
673}
674
675/* ----------------------------------------------------------------------- */
676
769e2438 677static struct i2c_driver i2c_driver_saa7127;
cfbb5b8c
HV		 678
679/* ----------------------------------------------------------------------- */
680
681static int saa7127_attach(struct i2c_adapter *adapter, int address, int kind)
682{
683 struct i2c_client *client;
684 struct saa7127_state *state;
685 struct v4l2_sliced_vbi_data vbi = { 0, 0, 0, 0 }; /* set to disabled */
686 int read_result = 0;
687
688 /* Check if the adapter supports the needed features */
689 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_BYTE_DATA))
690 return 0;
691
7408187d 692 client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
cfbb5b8c
HV		 693 if (client == 0)
694 return -ENOMEM;
695
cfbb5b8c
HV		 696 client->addr = address;
697 client->adapter = adapter;
698 client->driver = &i2c_driver_saa7127;
cfbb5b8c
HV		 699 snprintf(client->name, sizeof(client->name) - 1, "saa7127");
700
fac9e899 701 v4l_dbg(1, client, "detecting saa7127 client on address 0x%x\n", address << 1);
cfbb5b8c
HV		 702
703 /* First test register 0: Bits 5-7 are a version ID (should be 0),
704 and bit 2 should also be 0.
705 This is rather general, so the second test is more specific and
706 looks at the 'ending point of burst in clock cycles' which is
707 0x1d after a reset and not expected to ever change. */
708 if ((saa7127_read(client, 0) & 0xe4) != 0 ||
709 (saa7127_read(client, 0x29) & 0x3f) != 0x1d) {
fac9e899 710 v4l_dbg(1, client, "saa7127 not found\n");
cfbb5b8c
HV		 711 kfree(client);
712 return 0;
713 }
7408187d 714 state = kzalloc(sizeof(struct saa7127_state), GFP_KERNEL);
cfbb5b8c
HV		 715
716 if (state == NULL) {
717 kfree(client);
718 return (-ENOMEM);
719 }
720
721 i2c_set_clientdata(client, state);
cfbb5b8c
HV		 722
723 /* Configure Encoder */
724
fac9e899 725 v4l_dbg(1, client, "Configuring encoder\n");
cfbb5b8c
HV		 726 saa7127_write_inittab(client, saa7127_init_config_common);
727 saa7127_set_std(client, V4L2_STD_NTSC);
728 saa7127_set_output_type(client, SAA7127_OUTPUT_TYPE_BOTH);
729 saa7127_set_vps(client, &vbi);
730 saa7127_set_wss(client, &vbi);
731 saa7127_set_cc(client, &vbi);
732 saa7127_set_xds(client, &vbi);
733 if (test_image == 1) {
734 /* The Encoder has an internal Colorbar generator */
735 /* This can be used for debugging */
736 saa7127_set_input_type(client, SAA7127_INPUT_TYPE_TEST_IMAGE);
737 } else {
738 saa7127_set_input_type(client, SAA7127_INPUT_TYPE_NORMAL);
739 }
740 saa7127_set_video_enable(client, 1);
741
742 /* Detect if it's an saa7129 */
743 read_result = saa7127_read(client, SAA7129_REG_FADE_KEY_COL2);
744 saa7127_write(client, SAA7129_REG_FADE_KEY_COL2, 0xaa);
745 if (saa7127_read(client, SAA7129_REG_FADE_KEY_COL2) == 0xaa) {
fac9e899 746 v4l_info(client, "saa7129 found @ 0x%x (%s)\n", address << 1, adapter->name);
cfbb5b8c
HV		 747 saa7127_write(client, SAA7129_REG_FADE_KEY_COL2, read_result);
748 saa7127_write_inittab(client, saa7129_init_config_extra);
749 state->ident = V4L2_IDENT_SAA7129;
750 } else {
fac9e899 751 v4l_info(client, "saa7127 found @ 0x%x (%s)\n", address << 1, adapter->name);
cfbb5b8c
HV		 752 state->ident = V4L2_IDENT_SAA7127;
753 }
754
755 i2c_attach_client(client);
756
757 return 0;
758}
759
760/* ----------------------------------------------------------------------- */
761
762static int saa7127_probe(struct i2c_adapter *adapter)
763{
cfbb5b8c 764 if (adapter->class & I2C_CLASS_TV_ANALOG)
cfbb5b8c
HV		 765 return i2c_probe(adapter, &addr_data, saa7127_attach);
766 return 0;
767}
768
769/* ----------------------------------------------------------------------- */
770
771static int saa7127_detach(struct i2c_client *client)
772{
773 struct saa7127_state *state = i2c_get_clientdata(client);
774 int err;
775
776 /* Turn off TV output */
777 saa7127_set_video_enable(client, 0);
778
779 err = i2c_detach_client(client);
780
781 if (err) {
782 return err;
783 }
784
785 kfree(state);
786 kfree(client);
787 return 0;
788}
789
790/* ----------------------------------------------------------------------- */
791
769e2438 792static struct i2c_driver i2c_driver_saa7127 = {
604f28e2 793 .driver = {
604f28e2
LR		 794 .name = "saa7127",
795 },
cfbb5b8c 796 .id = I2C_DRIVERID_SAA7127,
cfbb5b8c
HV		 797 .attach_adapter = saa7127_probe,
798 .detach_client = saa7127_detach,
799 .command = saa7127_command,
cfbb5b8c
HV		 800};
801
802
803/* ----------------------------------------------------------------------- */
804
805static int __init saa7127_init_module(void)
806{
807 return i2c_add_driver(&i2c_driver_saa7127);
808}
809
810/* ----------------------------------------------------------------------- */
811
812static void __exit saa7127_cleanup_module(void)
813{
814 i2c_del_driver(&i2c_driver_saa7127);
815}
816
817/* ----------------------------------------------------------------------- */
818
819module_init(saa7127_init_module);
820module_exit(saa7127_cleanup_module);
Linux kernel - Deliverables
This page took 0.144483 seconds and 5 git commands to generate.