?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / media / usb / tm6000 / tm6000-core.c
blob2c723706f8c8c91f898f40bf762c9f5535d66b1a
1 // SPDX-License-Identifier: GPL-2.0
2 // tm6000-core.c - driver for TM5600/TM6000/TM6010 USB video capture devices
3 //
4 // Copyright (c) 2006-2007 Mauro Carvalho Chehab <mchehab@kernel.org>
5 //
6 // Copyright (c) 2007 Michel Ludwig <michel.ludwig@gmail.com>
7 // - DVB-T support
8
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/slab.h>
12 #include <linux/usb.h>
13 #include <linux/i2c.h>
14 #include "tm6000.h"
15 #include "tm6000-regs.h"
16 #include <media/v4l2-common.h>
17 #include <media/tuner.h>
18
19 #define USB_TIMEOUT (5 * HZ) /* ms */
20
21 int tm6000_read_write_usb(struct tm6000_core *dev, u8 req_type, u8 req,
22 u16 value, u16 index, u8 *buf, u16 len)
23 {
24 int ret, i;
25 unsigned int pipe;
26 u8 *data = NULL;
27 int delay = 5000;
28
29 if (len) {
30 data = kzalloc(len, GFP_KERNEL);
31 if (!data)
32 return -ENOMEM;
33 }
34
35 mutex_lock(&dev->usb_lock);
36
37 if (req_type & USB_DIR_IN)
38 pipe = usb_rcvctrlpipe(dev->udev, 0);
39 else {
40 pipe = usb_sndctrlpipe(dev->udev, 0);
41 memcpy(data, buf, len);
42 }
43
44 if (tm6000_debug & V4L2_DEBUG_I2C) {
45 printk(KERN_DEBUG "(dev %p, pipe %08x): ", dev->udev, pipe);
46
47 printk(KERN_CONT "%s: %02x %02x %02x %02x %02x %02x %02x %02x ",
48 (req_type & USB_DIR_IN) ? " IN" : "OUT",
49 req_type, req, value&0xff, value>>8, index&0xff,
50 index>>8, len&0xff, len>>8);
51
52 if (!(req_type & USB_DIR_IN)) {
53 printk(KERN_CONT ">>> ");
54 for (i = 0; i < len; i++)
55 printk(KERN_CONT " %02x", buf[i]);
56 printk(KERN_CONT "\n");
57 }
58 }
59
60 ret = usb_control_msg(dev->udev, pipe, req, req_type, value, index,
61 data, len, USB_TIMEOUT);
62
63 if (req_type & USB_DIR_IN)
64 memcpy(buf, data, len);
65
66 if (tm6000_debug & V4L2_DEBUG_I2C) {
67 if (ret < 0) {
68 if (req_type & USB_DIR_IN)
69 printk(KERN_DEBUG "<<< (len=%d)\n", len);
70
71 printk(KERN_CONT "%s: Error #%d\n", __func__, ret);
72 } else if (req_type & USB_DIR_IN) {
73 printk(KERN_CONT "<<< ");
74 for (i = 0; i < len; i++)
75 printk(KERN_CONT " %02x", buf[i]);
76 printk(KERN_CONT "\n");
77 }
78 }
79
80 kfree(data);
81
82 if (dev->quirks & TM6000_QUIRK_NO_USB_DELAY)
83 delay = 0;
84
85 if (req == REQ_16_SET_GET_I2C_WR1_RDN && !(req_type & USB_DIR_IN)) {
86 unsigned int tsleep;
87 /* Calculate delay time, 14000us for 64 bytes */
88 tsleep = (len * 200) + 200;
89 if (tsleep < delay)
90 tsleep = delay;
91 usleep_range(tsleep, tsleep + 1000);
92 }
93 else if (delay)
94 usleep_range(delay, delay + 1000);
95
96 mutex_unlock(&dev->usb_lock);
97 return ret;
98 }
99
100 int tm6000_set_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
101 {
102 return
103 tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR,
104 req, value, index, NULL, 0);
105 }
106 EXPORT_SYMBOL_GPL(tm6000_set_reg);
107
108 int tm6000_get_reg(struct tm6000_core *dev, u8 req, u16 value, u16 index)
109 {
110 int rc;
111 u8 buf[1];
112
113 rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
114 value, index, buf, 1);
115
116 if (rc < 0)
117 return rc;
118
119 return *buf;
120 }
121 EXPORT_SYMBOL_GPL(tm6000_get_reg);
122
123 int tm6000_set_reg_mask(struct tm6000_core *dev, u8 req, u16 value,
124 u16 index, u16 mask)
125 {
126 int rc;
127 u8 buf[1];
128 u8 new_index;
129
130 rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
131 value, 0, buf, 1);
132
133 if (rc < 0)
134 return rc;
135
136 new_index = (buf[0] & ~mask) | (index & mask);
137
138 if (new_index == buf[0])
139 return 0;
140
141 return tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR,
142 req, value, new_index, NULL, 0);
143 }
144 EXPORT_SYMBOL_GPL(tm6000_set_reg_mask);
145
146 int tm6000_get_reg16(struct tm6000_core *dev, u8 req, u16 value, u16 index)
147 {
148 int rc;
149 u8 buf[2];
150
151 rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
152 value, index, buf, 2);
153
154 if (rc < 0)
155 return rc;
156
157 return buf[1]|buf[0]<<8;
158 }
159
160 int tm6000_get_reg32(struct tm6000_core *dev, u8 req, u16 value, u16 index)
161 {
162 int rc;
163 u8 buf[4];
164
165 rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR, req,
166 value, index, buf, 4);
167
168 if (rc < 0)
169 return rc;
170
171 return buf[3] | buf[2] << 8 | buf[1] << 16 | buf[0] << 24;
172 }
173
174 int tm6000_i2c_reset(struct tm6000_core *dev, u16 tsleep)
175 {
176 int rc;
177
178 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 0);
179 if (rc < 0)
180 return rc;
181
182 msleep(tsleep);
183
184 rc = tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN, TM6000_GPIO_CLK, 1);
185 msleep(tsleep);
186
187 return rc;
188 }
189
190 void tm6000_set_fourcc_format(struct tm6000_core *dev)
191 {
192 if (dev->dev_type == TM6010) {
193 int val;
194
195 val = tm6000_get_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, 0) & 0xfc;
196 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
197 tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val);
198 else
199 tm6000_set_reg(dev, TM6010_REQ07_RCC_ACTIVE_IF, val | 1);
200 } else {
201 if (dev->fourcc == V4L2_PIX_FMT_UYVY)
202 tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
203 else
204 tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0x90);
205 }
206 }
207
208 static void tm6000_set_vbi(struct tm6000_core *dev)
209 {
210 /*
211 * FIXME:
212 * VBI lines and start/end are different between 60Hz and 50Hz
213 * So, it is very likely that we need to change the config to
214 * something that takes it into account, doing something different
215 * if (dev->norm & V4L2_STD_525_60)
216 */
217
218 if (dev->dev_type == TM6010) {
219 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
220 tm6000_set_reg(dev, TM6010_REQ07_R41_TELETEXT_VBI_CODE1, 0x27);
221 tm6000_set_reg(dev, TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55);
222 tm6000_set_reg(dev, TM6010_REQ07_R43_VBI_DATA_TYPE_LINE7, 0x66);
223 tm6000_set_reg(dev, TM6010_REQ07_R44_VBI_DATA_TYPE_LINE8, 0x66);
224 tm6000_set_reg(dev, TM6010_REQ07_R45_VBI_DATA_TYPE_LINE9, 0x66);
225 tm6000_set_reg(dev,
226 TM6010_REQ07_R46_VBI_DATA_TYPE_LINE10, 0x66);
227 tm6000_set_reg(dev,
228 TM6010_REQ07_R47_VBI_DATA_TYPE_LINE11, 0x66);
229 tm6000_set_reg(dev,
230 TM6010_REQ07_R48_VBI_DATA_TYPE_LINE12, 0x66);
231 tm6000_set_reg(dev,
232 TM6010_REQ07_R49_VBI_DATA_TYPE_LINE13, 0x66);
233 tm6000_set_reg(dev,
234 TM6010_REQ07_R4A_VBI_DATA_TYPE_LINE14, 0x66);
235 tm6000_set_reg(dev,
236 TM6010_REQ07_R4B_VBI_DATA_TYPE_LINE15, 0x66);
237 tm6000_set_reg(dev,
238 TM6010_REQ07_R4C_VBI_DATA_TYPE_LINE16, 0x66);
239 tm6000_set_reg(dev,
240 TM6010_REQ07_R4D_VBI_DATA_TYPE_LINE17, 0x66);
241 tm6000_set_reg(dev,
242 TM6010_REQ07_R4E_VBI_DATA_TYPE_LINE18, 0x66);
243 tm6000_set_reg(dev,
244 TM6010_REQ07_R4F_VBI_DATA_TYPE_LINE19, 0x66);
245 tm6000_set_reg(dev,
246 TM6010_REQ07_R50_VBI_DATA_TYPE_LINE20, 0x66);
247 tm6000_set_reg(dev,
248 TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x66);
249 tm6000_set_reg(dev,
250 TM6010_REQ07_R52_VBI_DATA_TYPE_LINE22, 0x66);
251 tm6000_set_reg(dev,
252 TM6010_REQ07_R53_VBI_DATA_TYPE_LINE23, 0x00);
253 tm6000_set_reg(dev,
254 TM6010_REQ07_R54_VBI_DATA_TYPE_RLINES, 0x00);
255 tm6000_set_reg(dev,
256 TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01);
257 tm6000_set_reg(dev,
258 TM6010_REQ07_R56_VBI_LOOP_FILTER_I_GAIN, 0x00);
259 tm6000_set_reg(dev,
260 TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02);
261 tm6000_set_reg(dev, TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35);
262 tm6000_set_reg(dev, TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0);
263 tm6000_set_reg(dev, TM6010_REQ07_R5A_VBI_TELETEXT_DTO1, 0x11);
264 tm6000_set_reg(dev, TM6010_REQ07_R5B_VBI_TELETEXT_DTO0, 0x4c);
265 tm6000_set_reg(dev, TM6010_REQ07_R40_TELETEXT_VBI_CODE0, 0x01);
266 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
267 }
268 }
269
270 int tm6000_init_analog_mode(struct tm6000_core *dev)
271 {
272 struct v4l2_frequency f;
273
274 if (dev->dev_type == TM6010) {
275 u8 active = TM6010_REQ07_RCC_ACTIVE_IF_AUDIO_ENABLE;
276
277 if (!dev->radio)
278 active |= TM6010_REQ07_RCC_ACTIVE_IF_VIDEO_ENABLE;
279
280 /* Enable video and audio */
281 tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF,
282 active, 0x60);
283 /* Disable TS input */
284 tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE,
285 0x00, 0x40);
286 } else {
287 /* Enables soft reset */
288 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
289
290 if (dev->scaler)
291 /* Disable Hfilter and Enable TS Drop err */
292 tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x20);
293 else /* Enable Hfilter and disable TS Drop err */
294 tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x80);
295
296 tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x88);
297 tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x23);
298 tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xc0);
299 tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xd8);
300 tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x06);
301 tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f);
302
303 /* AP Software reset */
304 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
305 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
306
307 tm6000_set_fourcc_format(dev);
308
309 /* Disables soft reset */
310 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x00);
311 }
312 msleep(20);
313
314 /* Tuner firmware can now be loaded */
315
316 /*
317 * FIXME: This is a hack! xc3028 "sleeps" when no channel is detected
318 * for more than a few seconds. Not sure why, as this behavior does
319 * not happen on other devices with xc3028. So, I suspect that it
320 * is yet another bug at tm6000. After start sleeping, decoding
321 * doesn't start automatically. Instead, it requires some
322 * I2C commands to wake it up. As we want to have image at the
323 * beginning, we needed to add this hack. The better would be to
324 * discover some way to make tm6000 to wake up without this hack.
325 */
326 f.frequency = dev->freq;
327 v4l2_device_call_all(&dev->v4l2_dev, 0, tuner, s_frequency, &f);
328
329 msleep(100);
330 tm6000_set_standard(dev);
331 tm6000_set_vbi(dev);
332 tm6000_set_audio_bitrate(dev, 48000);
333
334 /* switch dvb led off */
335 if (dev->gpio.dvb_led) {
336 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
337 dev->gpio.dvb_led, 0x01);
338 }
339
340 return 0;
341 }
342
343 int tm6000_init_digital_mode(struct tm6000_core *dev)
344 {
345 if (dev->dev_type == TM6010) {
346 /* Disable video and audio */
347 tm6000_set_reg_mask(dev, TM6010_REQ07_RCC_ACTIVE_IF,
348 0x00, 0x60);
349 /* Enable TS input */
350 tm6000_set_reg_mask(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE,
351 0x40, 0x40);
352 /* all power down, but not the digital data port */
353 tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0x28);
354 tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xfc);
355 tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0xff);
356 } else {
357 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x08);
358 tm6000_set_reg(dev, TM6010_REQ07_RFF_SOFT_RESET, 0x00);
359 tm6000_set_reg(dev, TM6010_REQ07_R3F_RESET, 0x01);
360 tm6000_set_reg(dev, TM6000_REQ07_RDF_PWDOWN_ACLK, 0x08);
361 tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
362 tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
363 tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0xd8);
364 tm6000_set_reg(dev, TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x40);
365 tm6000_set_reg(dev, TM6010_REQ07_RC1_TRESHOLD, 0xd0);
366 tm6000_set_reg(dev, TM6010_REQ07_RC3_HSTART1, 0x09);
367 tm6000_set_reg(dev, TM6000_REQ07_RDA_CLK_SEL, 0x37);
368 tm6000_set_reg(dev, TM6010_REQ07_RD1_ADDR_FOR_REQ1, 0xd8);
369 tm6000_set_reg(dev, TM6010_REQ07_RD2_ADDR_FOR_REQ2, 0xc0);
370 tm6000_set_reg(dev, TM6010_REQ07_RD6_ENDP_REQ1_REQ2, 0x60);
371
372 tm6000_set_reg(dev, TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x0c);
373 tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0xff);
374 tm6000_set_reg(dev, TM6000_REQ07_REB_VADC_AADC_MODE, 0x08);
375 msleep(50);
376
377 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
378 msleep(50);
379 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x01);
380 msleep(50);
381 tm6000_set_reg(dev, REQ_04_EN_DISABLE_MCU_INT, 0x0020, 0x00);
382 msleep(100);
383 }
384
385 /* switch dvb led on */
386 if (dev->gpio.dvb_led) {
387 tm6000_set_reg(dev, REQ_03_SET_GET_MCU_PIN,
388 dev->gpio.dvb_led, 0x00);
389 }
390
391 return 0;
392 }
393 EXPORT_SYMBOL(tm6000_init_digital_mode);
394
395 struct reg_init {
396 u8 req;
397 u8 reg;
398 u8 val;
399 };
400
401 /* The meaning of those initializations are unknown */
402 static struct reg_init tm6000_init_tab[] = {
403 /* REG VALUE */
404 { TM6000_REQ07_RDF_PWDOWN_ACLK, 0x1f },
405 { TM6010_REQ07_RFF_SOFT_RESET, 0x08 },
406 { TM6010_REQ07_RFF_SOFT_RESET, 0x00 },
407 { TM6010_REQ07_RD5_POWERSAVE, 0x4f },
408 { TM6000_REQ07_RDA_CLK_SEL, 0x23 },
409 { TM6000_REQ07_RDB_OUT_SEL, 0x08 },
410 { TM6000_REQ07_RE2_VADC_STATUS_CTL, 0x00 },
411 { TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10 },
412 { TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00 },
413 { TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00 },
414 { TM6000_REQ07_REB_VADC_AADC_MODE, 0x64 }, /* 48000 bits/sample, external input */
415 { TM6000_REQ07_REE_VADC_CTRL_SEL_CONTROL, 0xc2 },
416
417 { TM6010_REQ07_R3F_RESET, 0x01 }, /* Start of soft reset */
418 { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
419 { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
420 { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
421 { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
422 { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
423 { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
424 { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
425 { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
426 { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
427 { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
428 { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
429 { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
430 { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
431 { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
432 { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
433 { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
434 { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
435 { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
436 { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
437 { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
438 { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
439 { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
440 { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
441 { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
442 { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
443 { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
444 { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
445 { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
446 { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
447 { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
448 { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
449 { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
450 { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
451 { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
452 { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
453 { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
454 { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
455 { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
456 { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
457 { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
458 { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
459 { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
460 { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
461 { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
462 { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
463 { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
464 { TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
465 { TM6010_REQ07_RC3_HSTART1, 0x88 },
466 { TM6010_REQ07_R3F_RESET, 0x00 }, /* End of the soft reset */
467 { TM6010_REQ05_R18_IMASK7, 0x00 },
468 };
469
470 static struct reg_init tm6010_init_tab[] = {
471 { TM6010_REQ07_RC0_ACTIVE_VIDEO_SOURCE, 0x00 },
472 { TM6010_REQ07_RC4_HSTART0, 0xa0 },
473 { TM6010_REQ07_RC6_HEND0, 0x40 },
474 { TM6010_REQ07_RCA_VEND0, 0x31 },
475 { TM6010_REQ07_RCC_ACTIVE_IF, 0xe1 },
476 { TM6010_REQ07_RE0_DVIDEO_SOURCE, 0x03 },
477 { TM6010_REQ07_RFE_POWER_DOWN, 0x7f },
478
479 { TM6010_REQ08_RE2_POWER_DOWN_CTRL1, 0xf0 },
480 { TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4 },
481 { TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8 },
482 { TM6010_REQ08_RE6_POWER_DOWN_CTRL2, 0x00 },
483 { TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2 },
484 { TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0 },
485 { TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2 },
486 { TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG, 0x60 },
487 { TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfc },
488
489 { TM6010_REQ07_R3F_RESET, 0x01 },
490 { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
491 { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x07 },
492 { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
493 { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
494 { TM6010_REQ07_R05_NOISE_THRESHOLD, 0x64 },
495 { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x01 },
496 { TM6010_REQ07_R08_LUMA_CONTRAST_ADJ, 0x82 },
497 { TM6010_REQ07_R09_LUMA_BRIGHTNESS_ADJ, 0x36 },
498 { TM6010_REQ07_R0A_CHROMA_SATURATION_ADJ, 0x50 },
499 { TM6010_REQ07_R0C_CHROMA_AGC_CONTROL, 0x6a },
500 { TM6010_REQ07_R11_AGC_PEAK_CONTROL, 0xc9 },
501 { TM6010_REQ07_R12_AGC_GATE_STARTH, 0x07 },
502 { TM6010_REQ07_R13_AGC_GATE_STARTL, 0x3b },
503 { TM6010_REQ07_R14_AGC_GATE_WIDTH, 0x47 },
504 { TM6010_REQ07_R15_AGC_BP_DELAY, 0x6f },
505 { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0xcd },
506 { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
507 { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
508 { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
509 { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
510 { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
511 { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
512 { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
513 { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
514 { TM6010_REQ07_R20_HSYNC_RISING_EDGE_TIME, 0x3c },
515 { TM6010_REQ07_R21_HSYNC_PHASE_OFFSET, 0x3c },
516 { TM6010_REQ07_R2D_CHROMA_BURST_END, 0x48 },
517 { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
518 { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
519 { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
520 { TM6010_REQ07_R32_VSYNC_HLOCK_MIN, 0x74 },
521 { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
522 { TM6010_REQ07_R34_VSYNC_AGC_MIN, 0x74 },
523 { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
524 { TM6010_REQ07_R36_VSYNC_VBI_MIN, 0x7a },
525 { TM6010_REQ07_R37_VSYNC_VBI_MAX, 0x26 },
526 { TM6010_REQ07_R38_VSYNC_THRESHOLD, 0x40 },
527 { TM6010_REQ07_R39_VSYNC_TIME_CONSTANT, 0x0a },
528 { TM6010_REQ07_R42_VBI_DATA_HIGH_LEVEL, 0x55 },
529 { TM6010_REQ07_R51_VBI_DATA_TYPE_LINE21, 0x11 },
530 { TM6010_REQ07_R55_VBI_LOOP_FILTER_GAIN, 0x01 },
531 { TM6010_REQ07_R57_VBI_LOOP_FILTER_P_GAIN, 0x02 },
532 { TM6010_REQ07_R58_VBI_CAPTION_DTO1, 0x35 },
533 { TM6010_REQ07_R59_VBI_CAPTION_DTO0, 0xa0 },
534 { TM6010_REQ07_R80_COMB_FILTER_TRESHOLD, 0x15 },
535 { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
536 { TM6010_REQ07_RC1_TRESHOLD, 0xd0 },
537 { TM6010_REQ07_RC3_HSTART1, 0x88 },
538 { TM6010_REQ07_R3F_RESET, 0x00 },
539
540 { TM6010_REQ05_R18_IMASK7, 0x00 },
541
542 { TM6010_REQ07_RDC_IR_LEADER1, 0xaa },
543 { TM6010_REQ07_RDD_IR_LEADER0, 0x30 },
544 { TM6010_REQ07_RDE_IR_PULSE_CNT1, 0x20 },
545 { TM6010_REQ07_RDF_IR_PULSE_CNT0, 0xd0 },
546 { REQ_04_EN_DISABLE_MCU_INT, 0x02, 0x00 },
547 { TM6010_REQ07_RD8_IR, 0x0f },
548
549 /* set remote wakeup key:any key wakeup */
550 { TM6010_REQ07_RE5_REMOTE_WAKEUP, 0xfe },
551 { TM6010_REQ07_RDA_IR_WAKEUP_SEL, 0xff },
552 };
553
554 int tm6000_init(struct tm6000_core *dev)
555 {
556 int board, rc = 0, i, size;
557 struct reg_init *tab;
558
559 /* Check board revision */
560 board = tm6000_get_reg32(dev, REQ_40_GET_VERSION, 0, 0);
561 if (board >= 0) {
562 switch (board & 0xff) {
563 case 0xf3:
564 printk(KERN_INFO "Found tm6000\n");
565 if (dev->dev_type != TM6000)
566 dev->dev_type = TM6000;
567 break;
568 case 0xf4:
569 printk(KERN_INFO "Found tm6010\n");
570 if (dev->dev_type != TM6010)
571 dev->dev_type = TM6010;
572 break;
573 default:
574 printk(KERN_INFO "Unknown board version = 0x%08x\n", board);
575 }
576 } else
577 printk(KERN_ERR "Error %i while retrieving board version\n", board);
578
579 if (dev->dev_type == TM6010) {
580 tab = tm6010_init_tab;
581 size = ARRAY_SIZE(tm6010_init_tab);
582 } else {
583 tab = tm6000_init_tab;
584 size = ARRAY_SIZE(tm6000_init_tab);
585 }
586
587 /* Load board's initialization table */
588 for (i = 0; i < size; i++) {
589 rc = tm6000_set_reg(dev, tab[i].req, tab[i].reg, tab[i].val);
590 if (rc < 0) {
591 printk(KERN_ERR "Error %i while setting req %d, reg %d to value %d\n",
592 rc,
593 tab[i].req, tab[i].reg, tab[i].val);
594 return rc;
595 }
596 }
597
598 msleep(5); /* Just to be conservative */
599
600 rc = tm6000_cards_setup(dev);
601
602 return rc;
603 }
604
605
606 int tm6000_set_audio_bitrate(struct tm6000_core *dev, int bitrate)
607 {
608 int val = 0;
609 u8 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */
610 u8 areg_0a = 0x91; /* SIF 48KHz */
611
612 switch (bitrate) {
613 case 48000:
614 areg_f0 = 0x60; /* ADC MCLK = 250 Fs */
615 areg_0a = 0x91; /* SIF 48KHz */
616 dev->audio_bitrate = bitrate;
617 break;
618 case 32000:
619 areg_f0 = 0x00; /* ADC MCLK = 375 Fs */
620 areg_0a = 0x90; /* SIF 32KHz */
621 dev->audio_bitrate = bitrate;
622 break;
623 default:
624 return -EINVAL;
625 }
626
627
628 /* enable I2S, if we use sif or external I2S device */
629 if (dev->dev_type == TM6010) {
630 val = tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, areg_0a);
631 if (val < 0)
632 return val;
633
634 val = tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
635 areg_f0, 0xf0);
636 if (val < 0)
637 return val;
638 } else {
639 val = tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE,
640 areg_f0, 0xf0);
641 if (val < 0)
642 return val;
643 }
644 return 0;
645 }
646 EXPORT_SYMBOL_GPL(tm6000_set_audio_bitrate);
647
648 int tm6000_set_audio_rinput(struct tm6000_core *dev)
649 {
650 if (dev->dev_type == TM6010) {
651 /* Audio crossbar setting, default SIF1 */
652 u8 areg_f0;
653 u8 areg_07 = 0x10;
654
655 switch (dev->rinput.amux) {
656 case TM6000_AMUX_SIF1:
657 case TM6000_AMUX_SIF2:
658 areg_f0 = 0x03;
659 areg_07 = 0x30;
660 break;
661 case TM6000_AMUX_ADC1:
662 areg_f0 = 0x00;
663 break;
664 case TM6000_AMUX_ADC2:
665 areg_f0 = 0x08;
666 break;
667 case TM6000_AMUX_I2S:
668 areg_f0 = 0x04;
669 break;
670 default:
671 printk(KERN_INFO "%s: audio input doesn't support\n",
672 dev->name);
673 return 0;
674 break;
675 }
676 /* Set audio input crossbar */
677 tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
678 areg_f0, 0x0f);
679 /* Mux overflow workaround */
680 tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
681 areg_07, 0xf0);
682 } else {
683 u8 areg_eb;
684 /* Audio setting, default LINE1 */
685 switch (dev->rinput.amux) {
686 case TM6000_AMUX_ADC1:
687 areg_eb = 0x00;
688 break;
689 case TM6000_AMUX_ADC2:
690 areg_eb = 0x04;
691 break;
692 default:
693 printk(KERN_INFO "%s: audio input doesn't support\n",
694 dev->name);
695 return 0;
696 break;
697 }
698 /* Set audio input */
699 tm6000_set_reg_mask(dev, TM6000_REQ07_REB_VADC_AADC_MODE,
700 areg_eb, 0x0f);
701 }
702 return 0;
703 }
704
705 static void tm6010_set_mute_sif(struct tm6000_core *dev, u8 mute)
706 {
707 u8 mute_reg = 0;
708
709 if (mute)
710 mute_reg = 0x08;
711
712 tm6000_set_reg_mask(dev, TM6010_REQ08_R0A_A_I2S_MOD, mute_reg, 0x08);
713 }
714
715 static void tm6010_set_mute_adc(struct tm6000_core *dev, u8 mute)
716 {
717 u8 mute_reg = 0;
718
719 if (mute)
720 mute_reg = 0x20;
721
722 if (dev->dev_type == TM6010) {
723 tm6000_set_reg_mask(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL,
724 mute_reg, 0x20);
725 tm6000_set_reg_mask(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL,
726 mute_reg, 0x20);
727 } else {
728 tm6000_set_reg_mask(dev, TM6000_REQ07_REC_VADC_AADC_LVOL,
729 mute_reg, 0x20);
730 tm6000_set_reg_mask(dev, TM6000_REQ07_RED_VADC_AADC_RVOL,
731 mute_reg, 0x20);
732 }
733 }
734
735 int tm6000_tvaudio_set_mute(struct tm6000_core *dev, u8 mute)
736 {
737 enum tm6000_mux mux;
738
739 if (dev->radio)
740 mux = dev->rinput.amux;
741 else
742 mux = dev->vinput[dev->input].amux;
743
744 switch (mux) {
745 case TM6000_AMUX_SIF1:
746 case TM6000_AMUX_SIF2:
747 if (dev->dev_type == TM6010)
748 tm6010_set_mute_sif(dev, mute);
749 else {
750 printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has SIF audio inputs. Please check the %s configuration.\n",
751 dev->name);
752 return -EINVAL;
753 }
754 break;
755 case TM6000_AMUX_ADC1:
756 case TM6000_AMUX_ADC2:
757 tm6010_set_mute_adc(dev, mute);
758 break;
759 default:
760 return -EINVAL;
761 break;
762 }
763 return 0;
764 }
765
766 static void tm6010_set_volume_sif(struct tm6000_core *dev, int vol)
767 {
768 u8 vol_reg;
769
770 vol_reg = vol & 0x0F;
771
772 if (vol < 0)
773 vol_reg |= 0x40;
774
775 tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, vol_reg);
776 tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, vol_reg);
777 }
778
779 static void tm6010_set_volume_adc(struct tm6000_core *dev, int vol)
780 {
781 u8 vol_reg;
782
783 vol_reg = (vol + 0x10) & 0x1f;
784
785 if (dev->dev_type == TM6010) {
786 tm6000_set_reg(dev, TM6010_REQ08_RF2_LEFT_CHANNEL_VOL, vol_reg);
787 tm6000_set_reg(dev, TM6010_REQ08_RF3_RIGHT_CHANNEL_VOL, vol_reg);
788 } else {
789 tm6000_set_reg(dev, TM6000_REQ07_REC_VADC_AADC_LVOL, vol_reg);
790 tm6000_set_reg(dev, TM6000_REQ07_RED_VADC_AADC_RVOL, vol_reg);
791 }
792 }
793
794 void tm6000_set_volume(struct tm6000_core *dev, int vol)
795 {
796 enum tm6000_mux mux;
797
798 if (dev->radio) {
799 mux = dev->rinput.amux;
800 vol += 8; /* Offset to 0 dB */
801 } else
802 mux = dev->vinput[dev->input].amux;
803
804 switch (mux) {
805 case TM6000_AMUX_SIF1:
806 case TM6000_AMUX_SIF2:
807 if (dev->dev_type == TM6010)
808 tm6010_set_volume_sif(dev, vol);
809 else
810 printk(KERN_INFO "ERROR: TM5600 and TM6000 don't has SIF audio inputs. Please check the %s configuration.\n",
811 dev->name);
812 break;
813 case TM6000_AMUX_ADC1:
814 case TM6000_AMUX_ADC2:
815 tm6010_set_volume_adc(dev, vol);
816 break;
817 default:
818 break;
819 }
820 }
821
822 static LIST_HEAD(tm6000_devlist);
823 static DEFINE_MUTEX(tm6000_devlist_mutex);
824
825 /*
826 * tm6000_realease_resource()
827 */
828
829 void tm6000_remove_from_devlist(struct tm6000_core *dev)
830 {
831 mutex_lock(&tm6000_devlist_mutex);
832 list_del(&dev->devlist);
833 mutex_unlock(&tm6000_devlist_mutex);
834 };
835
836 void tm6000_add_into_devlist(struct tm6000_core *dev)
837 {
838 mutex_lock(&tm6000_devlist_mutex);
839 list_add_tail(&dev->devlist, &tm6000_devlist);
840 mutex_unlock(&tm6000_devlist_mutex);
841 };
842
843 /*
844 * Extension interface
845 */
846
847 static LIST_HEAD(tm6000_extension_devlist);
848
849 int tm6000_call_fillbuf(struct tm6000_core *dev, enum tm6000_ops_type type,
850 char *buf, int size)
851 {
852 struct tm6000_ops *ops = NULL;
853
854 /* FIXME: tm6000_extension_devlist_lock should be a spinlock */
855
856 if (!list_empty(&tm6000_extension_devlist)) {
857 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
858 if (ops->fillbuf && ops->type == type)
859 ops->fillbuf(dev, buf, size);
860 }
861 }
862
863 return 0;
864 }
865
866 int tm6000_register_extension(struct tm6000_ops *ops)
867 {
868 struct tm6000_core *dev = NULL;
869
870 mutex_lock(&tm6000_devlist_mutex);
871 list_add_tail(&ops->next, &tm6000_extension_devlist);
872 list_for_each_entry(dev, &tm6000_devlist, devlist) {
873 ops->init(dev);
874 printk(KERN_INFO "%s: Initialized (%s) extension\n",
875 dev->name, ops->name);
876 }
877 mutex_unlock(&tm6000_devlist_mutex);
878 return 0;
879 }
880 EXPORT_SYMBOL(tm6000_register_extension);
881
882 void tm6000_unregister_extension(struct tm6000_ops *ops)
883 {
884 struct tm6000_core *dev = NULL;
885
886 mutex_lock(&tm6000_devlist_mutex);
887 list_for_each_entry(dev, &tm6000_devlist, devlist)
888 ops->fini(dev);
889
890 printk(KERN_INFO "tm6000: Remove (%s) extension\n", ops->name);
891 list_del(&ops->next);
892 mutex_unlock(&tm6000_devlist_mutex);
893 }
894 EXPORT_SYMBOL(tm6000_unregister_extension);
895
896 void tm6000_init_extension(struct tm6000_core *dev)
897 {
898 struct tm6000_ops *ops = NULL;
899
900 mutex_lock(&tm6000_devlist_mutex);
901 if (!list_empty(&tm6000_extension_devlist)) {
902 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
903 if (ops->init)
904 ops->init(dev);
905 }
906 }
907 mutex_unlock(&tm6000_devlist_mutex);
908 }
909
910 void tm6000_close_extension(struct tm6000_core *dev)
911 {
912 struct tm6000_ops *ops = NULL;
913
914 mutex_lock(&tm6000_devlist_mutex);
915 if (!list_empty(&tm6000_extension_devlist)) {
916 list_for_each_entry(ops, &tm6000_extension_devlist, next) {
917 if (ops->fini)
918 ops->fini(dev);
919 }
920 }
921 mutex_unlock(&tm6000_devlist_mutex);
922 }
Linux with added FPC-III support