13c01ad20SDaniel Scheller // SPDX-License-Identifier: GPL-2.0
244173fdaSDaniel Scheller /*
344173fdaSDaniel Scheller * Driver for the ST STV6111 tuner
444173fdaSDaniel Scheller *
544173fdaSDaniel Scheller * Copyright (C) 2014 Digital Devices GmbH
644173fdaSDaniel Scheller */
744173fdaSDaniel Scheller
844173fdaSDaniel Scheller #include <linux/kernel.h>
944173fdaSDaniel Scheller #include <linux/module.h>
1044173fdaSDaniel Scheller #include <linux/moduleparam.h>
1144173fdaSDaniel Scheller #include <linux/init.h>
1244173fdaSDaniel Scheller #include <linux/delay.h>
1344173fdaSDaniel Scheller #include <linux/firmware.h>
1444173fdaSDaniel Scheller #include <linux/i2c.h>
1544173fdaSDaniel Scheller #include <asm/div64.h>
1644173fdaSDaniel Scheller
1744173fdaSDaniel Scheller #include "stv6111.h"
1844173fdaSDaniel Scheller
19fada1935SMauro Carvalho Chehab #include <media/dvb_frontend.h>
2044173fdaSDaniel Scheller
2144173fdaSDaniel Scheller struct stv {
2244173fdaSDaniel Scheller struct i2c_adapter *i2c;
2344173fdaSDaniel Scheller u8 adr;
2444173fdaSDaniel Scheller
2544173fdaSDaniel Scheller u8 reg[11];
2644173fdaSDaniel Scheller u32 ref_freq;
2744173fdaSDaniel Scheller u32 frequency;
2844173fdaSDaniel Scheller };
2944173fdaSDaniel Scheller
3044173fdaSDaniel Scheller struct slookup {
3144173fdaSDaniel Scheller s16 value;
3244173fdaSDaniel Scheller u16 reg_value;
3344173fdaSDaniel Scheller };
3444173fdaSDaniel Scheller
3520e671dfSDaniel Scheller static const struct slookup lnagain_nf_lookup[] = {
3685e36b47SDaniel Scheller /* Gain *100dB // Reg */
3744173fdaSDaniel Scheller { 2572, 0 },
3844173fdaSDaniel Scheller { 2575, 1 },
3944173fdaSDaniel Scheller { 2580, 2 },
4044173fdaSDaniel Scheller { 2588, 3 },
4144173fdaSDaniel Scheller { 2596, 4 },
4244173fdaSDaniel Scheller { 2611, 5 },
4344173fdaSDaniel Scheller { 2633, 6 },
4444173fdaSDaniel Scheller { 2664, 7 },
4544173fdaSDaniel Scheller { 2701, 8 },
4644173fdaSDaniel Scheller { 2753, 9 },
4744173fdaSDaniel Scheller { 2816, 10 },
4844173fdaSDaniel Scheller { 2902, 11 },
4944173fdaSDaniel Scheller { 2995, 12 },
5044173fdaSDaniel Scheller { 3104, 13 },
5144173fdaSDaniel Scheller { 3215, 14 },
5244173fdaSDaniel Scheller { 3337, 15 },
5344173fdaSDaniel Scheller { 3492, 16 },
5444173fdaSDaniel Scheller { 3614, 17 },
5544173fdaSDaniel Scheller { 3731, 18 },
5644173fdaSDaniel Scheller { 3861, 19 },
5744173fdaSDaniel Scheller { 3988, 20 },
5844173fdaSDaniel Scheller { 4124, 21 },
5944173fdaSDaniel Scheller { 4253, 22 },
6044173fdaSDaniel Scheller { 4386, 23 },
6144173fdaSDaniel Scheller { 4505, 24 },
6244173fdaSDaniel Scheller { 4623, 25 },
6344173fdaSDaniel Scheller { 4726, 26 },
6444173fdaSDaniel Scheller { 4821, 27 },
6544173fdaSDaniel Scheller { 4903, 28 },
6644173fdaSDaniel Scheller { 4979, 29 },
6744173fdaSDaniel Scheller { 5045, 30 },
6844173fdaSDaniel Scheller { 5102, 31 }
6944173fdaSDaniel Scheller };
7044173fdaSDaniel Scheller
7120e671dfSDaniel Scheller static const struct slookup lnagain_iip3_lookup[] = {
7285e36b47SDaniel Scheller /* Gain *100dB // reg */
7344173fdaSDaniel Scheller { 1548, 0 },
7444173fdaSDaniel Scheller { 1552, 1 },
7544173fdaSDaniel Scheller { 1569, 2 },
7644173fdaSDaniel Scheller { 1565, 3 },
7744173fdaSDaniel Scheller { 1577, 4 },
7844173fdaSDaniel Scheller { 1594, 5 },
7944173fdaSDaniel Scheller { 1627, 6 },
8044173fdaSDaniel Scheller { 1656, 7 },
8144173fdaSDaniel Scheller { 1700, 8 },
8244173fdaSDaniel Scheller { 1748, 9 },
8344173fdaSDaniel Scheller { 1805, 10 },
8444173fdaSDaniel Scheller { 1896, 11 },
8544173fdaSDaniel Scheller { 1995, 12 },
8644173fdaSDaniel Scheller { 2113, 13 },
8744173fdaSDaniel Scheller { 2233, 14 },
8844173fdaSDaniel Scheller { 2366, 15 },
8944173fdaSDaniel Scheller { 2543, 16 },
9044173fdaSDaniel Scheller { 2687, 17 },
9144173fdaSDaniel Scheller { 2842, 18 },
9244173fdaSDaniel Scheller { 2999, 19 },
9344173fdaSDaniel Scheller { 3167, 20 },
9444173fdaSDaniel Scheller { 3342, 21 },
9544173fdaSDaniel Scheller { 3507, 22 },
9644173fdaSDaniel Scheller { 3679, 23 },
9744173fdaSDaniel Scheller { 3827, 24 },
9844173fdaSDaniel Scheller { 3970, 25 },
9944173fdaSDaniel Scheller { 4094, 26 },
10044173fdaSDaniel Scheller { 4210, 27 },
10144173fdaSDaniel Scheller { 4308, 28 },
10244173fdaSDaniel Scheller { 4396, 29 },
10344173fdaSDaniel Scheller { 4468, 30 },
10444173fdaSDaniel Scheller { 4535, 31 }
10544173fdaSDaniel Scheller };
10644173fdaSDaniel Scheller
10720e671dfSDaniel Scheller static const struct slookup gain_rfagc_lookup[] = {
10885e36b47SDaniel Scheller /* Gain *100dB // reg */
10944173fdaSDaniel Scheller { 4870, 0x3000 },
11044173fdaSDaniel Scheller { 4850, 0x3C00 },
11144173fdaSDaniel Scheller { 4800, 0x4500 },
11244173fdaSDaniel Scheller { 4750, 0x4800 },
11344173fdaSDaniel Scheller { 4700, 0x4B00 },
11444173fdaSDaniel Scheller { 4650, 0x4D00 },
11544173fdaSDaniel Scheller { 4600, 0x4F00 },
11644173fdaSDaniel Scheller { 4550, 0x5100 },
11744173fdaSDaniel Scheller { 4500, 0x5200 },
11844173fdaSDaniel Scheller { 4420, 0x5500 },
11944173fdaSDaniel Scheller { 4316, 0x5800 },
12044173fdaSDaniel Scheller { 4200, 0x5B00 },
12144173fdaSDaniel Scheller { 4119, 0x5D00 },
12244173fdaSDaniel Scheller { 3999, 0x6000 },
12344173fdaSDaniel Scheller { 3950, 0x6100 },
12444173fdaSDaniel Scheller { 3876, 0x6300 },
12544173fdaSDaniel Scheller { 3755, 0x6600 },
12644173fdaSDaniel Scheller { 3641, 0x6900 },
12744173fdaSDaniel Scheller { 3567, 0x6B00 },
12844173fdaSDaniel Scheller { 3425, 0x6F00 },
12944173fdaSDaniel Scheller { 3350, 0x7100 },
13044173fdaSDaniel Scheller { 3236, 0x7400 },
13144173fdaSDaniel Scheller { 3118, 0x7700 },
13244173fdaSDaniel Scheller { 3004, 0x7A00 },
13344173fdaSDaniel Scheller { 2917, 0x7C00 },
13444173fdaSDaniel Scheller { 2776, 0x7F00 },
13544173fdaSDaniel Scheller { 2635, 0x8200 },
13644173fdaSDaniel Scheller { 2516, 0x8500 },
13744173fdaSDaniel Scheller { 2406, 0x8800 },
13844173fdaSDaniel Scheller { 2290, 0x8B00 },
13944173fdaSDaniel Scheller { 2170, 0x8E00 },
14044173fdaSDaniel Scheller { 2073, 0x9100 },
14144173fdaSDaniel Scheller { 1949, 0x9400 },
14244173fdaSDaniel Scheller { 1836, 0x9700 },
14344173fdaSDaniel Scheller { 1712, 0x9A00 },
14444173fdaSDaniel Scheller { 1631, 0x9C00 },
14544173fdaSDaniel Scheller { 1515, 0x9F00 },
14644173fdaSDaniel Scheller { 1400, 0xA200 },
14744173fdaSDaniel Scheller { 1323, 0xA400 },
14844173fdaSDaniel Scheller { 1203, 0xA700 },
14944173fdaSDaniel Scheller { 1091, 0xAA00 },
15044173fdaSDaniel Scheller { 1011, 0xAC00 },
15144173fdaSDaniel Scheller { 904, 0xAF00 },
15244173fdaSDaniel Scheller { 787, 0xB200 },
15344173fdaSDaniel Scheller { 685, 0xB500 },
15444173fdaSDaniel Scheller { 571, 0xB800 },
15544173fdaSDaniel Scheller { 464, 0xBB00 },
15644173fdaSDaniel Scheller { 374, 0xBE00 },
15744173fdaSDaniel Scheller { 275, 0xC200 },
15844173fdaSDaniel Scheller { 181, 0xC600 },
15944173fdaSDaniel Scheller { 102, 0xCC00 },
16044173fdaSDaniel Scheller { 49, 0xD900 }
16144173fdaSDaniel Scheller };
16244173fdaSDaniel Scheller
16344173fdaSDaniel Scheller /*
16444173fdaSDaniel Scheller * This table is 6 dB too low comapred to the others (probably created with
16544173fdaSDaniel Scheller * a different BB_MAG setting)
16644173fdaSDaniel Scheller */
16720e671dfSDaniel Scheller static const struct slookup gain_channel_agc_nf_lookup[] = {
16885e36b47SDaniel Scheller /* Gain *100dB // reg */
16944173fdaSDaniel Scheller { 7082, 0x3000 },
17044173fdaSDaniel Scheller { 7052, 0x4000 },
17144173fdaSDaniel Scheller { 7007, 0x4600 },
17244173fdaSDaniel Scheller { 6954, 0x4A00 },
17344173fdaSDaniel Scheller { 6909, 0x4D00 },
17444173fdaSDaniel Scheller { 6833, 0x5100 },
17544173fdaSDaniel Scheller { 6753, 0x5400 },
17644173fdaSDaniel Scheller { 6659, 0x5700 },
17744173fdaSDaniel Scheller { 6561, 0x5A00 },
17844173fdaSDaniel Scheller { 6472, 0x5C00 },
17944173fdaSDaniel Scheller { 6366, 0x5F00 },
18044173fdaSDaniel Scheller { 6259, 0x6100 },
18144173fdaSDaniel Scheller { 6151, 0x6400 },
18244173fdaSDaniel Scheller { 6026, 0x6700 },
18344173fdaSDaniel Scheller { 5920, 0x6900 },
18444173fdaSDaniel Scheller { 5835, 0x6B00 },
18544173fdaSDaniel Scheller { 5770, 0x6C00 },
18644173fdaSDaniel Scheller { 5681, 0x6E00 },
18744173fdaSDaniel Scheller { 5596, 0x7000 },
18844173fdaSDaniel Scheller { 5503, 0x7200 },
18944173fdaSDaniel Scheller { 5429, 0x7300 },
19044173fdaSDaniel Scheller { 5319, 0x7500 },
19144173fdaSDaniel Scheller { 5220, 0x7700 },
19244173fdaSDaniel Scheller { 5111, 0x7900 },
19344173fdaSDaniel Scheller { 4983, 0x7B00 },
19444173fdaSDaniel Scheller { 4876, 0x7D00 },
19544173fdaSDaniel Scheller { 4755, 0x7F00 },
19644173fdaSDaniel Scheller { 4635, 0x8100 },
19744173fdaSDaniel Scheller { 4499, 0x8300 },
19844173fdaSDaniel Scheller { 4405, 0x8500 },
19944173fdaSDaniel Scheller { 4323, 0x8600 },
20044173fdaSDaniel Scheller { 4233, 0x8800 },
20144173fdaSDaniel Scheller { 4156, 0x8A00 },
20244173fdaSDaniel Scheller { 4038, 0x8C00 },
20344173fdaSDaniel Scheller { 3935, 0x8E00 },
20444173fdaSDaniel Scheller { 3823, 0x9000 },
20544173fdaSDaniel Scheller { 3712, 0x9200 },
20644173fdaSDaniel Scheller { 3601, 0x9500 },
20744173fdaSDaniel Scheller { 3511, 0x9700 },
20844173fdaSDaniel Scheller { 3413, 0x9900 },
20944173fdaSDaniel Scheller { 3309, 0x9B00 },
21044173fdaSDaniel Scheller { 3213, 0x9D00 },
21144173fdaSDaniel Scheller { 3088, 0x9F00 },
21244173fdaSDaniel Scheller { 2992, 0xA100 },
21344173fdaSDaniel Scheller { 2878, 0xA400 },
21444173fdaSDaniel Scheller { 2769, 0xA700 },
21544173fdaSDaniel Scheller { 2645, 0xAA00 },
21644173fdaSDaniel Scheller { 2538, 0xAD00 },
21744173fdaSDaniel Scheller { 2441, 0xB000 },
21844173fdaSDaniel Scheller { 2350, 0xB600 },
21944173fdaSDaniel Scheller { 2237, 0xBA00 },
22044173fdaSDaniel Scheller { 2137, 0xBF00 },
22144173fdaSDaniel Scheller { 2039, 0xC500 },
22244173fdaSDaniel Scheller { 1938, 0xDF00 },
22344173fdaSDaniel Scheller { 1927, 0xFF00 }
22444173fdaSDaniel Scheller };
22544173fdaSDaniel Scheller
22620e671dfSDaniel Scheller static const struct slookup gain_channel_agc_iip3_lookup[] = {
22785e36b47SDaniel Scheller /* Gain *100dB // reg */
22844173fdaSDaniel Scheller { 7070, 0x3000 },
22944173fdaSDaniel Scheller { 7028, 0x4000 },
23044173fdaSDaniel Scheller { 7019, 0x4600 },
23144173fdaSDaniel Scheller { 6900, 0x4A00 },
23244173fdaSDaniel Scheller { 6811, 0x4D00 },
23344173fdaSDaniel Scheller { 6763, 0x5100 },
23444173fdaSDaniel Scheller { 6690, 0x5400 },
23544173fdaSDaniel Scheller { 6644, 0x5700 },
23644173fdaSDaniel Scheller { 6617, 0x5A00 },
23744173fdaSDaniel Scheller { 6598, 0x5C00 },
23844173fdaSDaniel Scheller { 6462, 0x5F00 },
23944173fdaSDaniel Scheller { 6348, 0x6100 },
24044173fdaSDaniel Scheller { 6197, 0x6400 },
24144173fdaSDaniel Scheller { 6154, 0x6700 },
24244173fdaSDaniel Scheller { 6098, 0x6900 },
24344173fdaSDaniel Scheller { 5893, 0x6B00 },
24444173fdaSDaniel Scheller { 5812, 0x6C00 },
24544173fdaSDaniel Scheller { 5773, 0x6E00 },
24644173fdaSDaniel Scheller { 5723, 0x7000 },
24744173fdaSDaniel Scheller { 5661, 0x7200 },
24844173fdaSDaniel Scheller { 5579, 0x7300 },
24944173fdaSDaniel Scheller { 5460, 0x7500 },
25044173fdaSDaniel Scheller { 5308, 0x7700 },
25144173fdaSDaniel Scheller { 5099, 0x7900 },
25244173fdaSDaniel Scheller { 4910, 0x7B00 },
25344173fdaSDaniel Scheller { 4800, 0x7D00 },
25444173fdaSDaniel Scheller { 4785, 0x7F00 },
25544173fdaSDaniel Scheller { 4635, 0x8100 },
25644173fdaSDaniel Scheller { 4466, 0x8300 },
25744173fdaSDaniel Scheller { 4314, 0x8500 },
25844173fdaSDaniel Scheller { 4295, 0x8600 },
25944173fdaSDaniel Scheller { 4144, 0x8800 },
26044173fdaSDaniel Scheller { 3920, 0x8A00 },
26144173fdaSDaniel Scheller { 3889, 0x8C00 },
26244173fdaSDaniel Scheller { 3771, 0x8E00 },
26344173fdaSDaniel Scheller { 3655, 0x9000 },
26444173fdaSDaniel Scheller { 3446, 0x9200 },
26544173fdaSDaniel Scheller { 3298, 0x9500 },
26644173fdaSDaniel Scheller { 3083, 0x9700 },
26744173fdaSDaniel Scheller { 3015, 0x9900 },
26844173fdaSDaniel Scheller { 2833, 0x9B00 },
26944173fdaSDaniel Scheller { 2746, 0x9D00 },
27044173fdaSDaniel Scheller { 2632, 0x9F00 },
27144173fdaSDaniel Scheller { 2598, 0xA100 },
27244173fdaSDaniel Scheller { 2480, 0xA400 },
27344173fdaSDaniel Scheller { 2236, 0xA700 },
27444173fdaSDaniel Scheller { 2171, 0xAA00 },
27544173fdaSDaniel Scheller { 2060, 0xAD00 },
27644173fdaSDaniel Scheller { 1999, 0xB000 },
27744173fdaSDaniel Scheller { 1974, 0xB600 },
27844173fdaSDaniel Scheller { 1820, 0xBA00 },
27944173fdaSDaniel Scheller { 1741, 0xBF00 },
28044173fdaSDaniel Scheller { 1655, 0xC500 },
28144173fdaSDaniel Scheller { 1444, 0xDF00 },
28244173fdaSDaniel Scheller { 1325, 0xFF00 },
28344173fdaSDaniel Scheller };
28444173fdaSDaniel Scheller
muldiv32(u32 a,u32 b,u32 c)28544173fdaSDaniel Scheller static inline u32 muldiv32(u32 a, u32 b, u32 c)
28644173fdaSDaniel Scheller {
28744173fdaSDaniel Scheller u64 tmp64;
28844173fdaSDaniel Scheller
28944173fdaSDaniel Scheller tmp64 = (u64)a * (u64)b;
29044173fdaSDaniel Scheller do_div(tmp64, c);
29144173fdaSDaniel Scheller
29244173fdaSDaniel Scheller return (u32)tmp64;
29344173fdaSDaniel Scheller }
29444173fdaSDaniel Scheller
i2c_read(struct i2c_adapter * adap,u8 adr,u8 * msg,int len,u8 * answ,int alen)29544173fdaSDaniel Scheller static int i2c_read(struct i2c_adapter *adap,
29644173fdaSDaniel Scheller u8 adr, u8 *msg, int len, u8 *answ, int alen)
29744173fdaSDaniel Scheller {
29844173fdaSDaniel Scheller struct i2c_msg msgs[2] = { { .addr = adr, .flags = 0,
29944173fdaSDaniel Scheller .buf = msg, .len = len},
30044173fdaSDaniel Scheller { .addr = adr, .flags = I2C_M_RD,
30144173fdaSDaniel Scheller .buf = answ, .len = alen } };
30244173fdaSDaniel Scheller if (i2c_transfer(adap, msgs, 2) != 2) {
30344173fdaSDaniel Scheller dev_err(&adap->dev, "i2c read error\n");
30444173fdaSDaniel Scheller return -EIO;
30544173fdaSDaniel Scheller }
30644173fdaSDaniel Scheller return 0;
30744173fdaSDaniel Scheller }
30844173fdaSDaniel Scheller
i2c_write(struct i2c_adapter * adap,u8 adr,u8 * data,int len)30944173fdaSDaniel Scheller static int i2c_write(struct i2c_adapter *adap, u8 adr, u8 *data, int len)
31044173fdaSDaniel Scheller {
31144173fdaSDaniel Scheller struct i2c_msg msg = {.addr = adr, .flags = 0,
31244173fdaSDaniel Scheller .buf = data, .len = len};
31344173fdaSDaniel Scheller
31444173fdaSDaniel Scheller if (i2c_transfer(adap, &msg, 1) != 1) {
31544173fdaSDaniel Scheller dev_err(&adap->dev, "i2c write error\n");
31644173fdaSDaniel Scheller return -EIO;
31744173fdaSDaniel Scheller }
31844173fdaSDaniel Scheller return 0;
31944173fdaSDaniel Scheller }
32044173fdaSDaniel Scheller
write_regs(struct stv * state,int reg,int len)32144173fdaSDaniel Scheller static int write_regs(struct stv *state, int reg, int len)
32244173fdaSDaniel Scheller {
32344173fdaSDaniel Scheller u8 d[12];
32444173fdaSDaniel Scheller
32544173fdaSDaniel Scheller memcpy(&d[1], &state->reg[reg], len);
32644173fdaSDaniel Scheller d[0] = reg;
32744173fdaSDaniel Scheller return i2c_write(state->i2c, state->adr, d, len + 1);
32844173fdaSDaniel Scheller }
32944173fdaSDaniel Scheller
write_reg(struct stv * state,u8 reg,u8 val)33044173fdaSDaniel Scheller static int write_reg(struct stv *state, u8 reg, u8 val)
33144173fdaSDaniel Scheller {
33244173fdaSDaniel Scheller u8 d[2] = {reg, val};
33344173fdaSDaniel Scheller
33444173fdaSDaniel Scheller return i2c_write(state->i2c, state->adr, d, 2);
33544173fdaSDaniel Scheller }
33644173fdaSDaniel Scheller
read_reg(struct stv * state,u8 reg,u8 * val)33744173fdaSDaniel Scheller static int read_reg(struct stv *state, u8 reg, u8 *val)
33844173fdaSDaniel Scheller {
33944173fdaSDaniel Scheller return i2c_read(state->i2c, state->adr, ®, 1, val, 1);
34044173fdaSDaniel Scheller }
34144173fdaSDaniel Scheller
wait_for_call_done(struct stv * state,u8 mask)34244173fdaSDaniel Scheller static int wait_for_call_done(struct stv *state, u8 mask)
34344173fdaSDaniel Scheller {
34444173fdaSDaniel Scheller int status = 0;
34544173fdaSDaniel Scheller u32 lock_retry_count = 10;
34644173fdaSDaniel Scheller
34744173fdaSDaniel Scheller while (lock_retry_count > 0) {
34844173fdaSDaniel Scheller u8 regval;
34944173fdaSDaniel Scheller
35044173fdaSDaniel Scheller status = read_reg(state, 9, ®val);
35144173fdaSDaniel Scheller if (status < 0)
35244173fdaSDaniel Scheller return status;
35344173fdaSDaniel Scheller
35444173fdaSDaniel Scheller if ((regval & mask) == 0)
35544173fdaSDaniel Scheller break;
35644173fdaSDaniel Scheller usleep_range(4000, 6000);
35744173fdaSDaniel Scheller lock_retry_count -= 1;
35844173fdaSDaniel Scheller
35944173fdaSDaniel Scheller status = -EIO;
36044173fdaSDaniel Scheller }
36144173fdaSDaniel Scheller return status;
36244173fdaSDaniel Scheller }
36344173fdaSDaniel Scheller
init_state(struct stv * state)36444173fdaSDaniel Scheller static void init_state(struct stv *state)
36544173fdaSDaniel Scheller {
36644173fdaSDaniel Scheller u32 clkdiv = 0;
36744173fdaSDaniel Scheller u32 agcmode = 0;
36844173fdaSDaniel Scheller u32 agcref = 2;
36944173fdaSDaniel Scheller u32 agcset = 0xffffffff;
37044173fdaSDaniel Scheller u32 bbmode = 0xffffffff;
37144173fdaSDaniel Scheller
37244173fdaSDaniel Scheller state->reg[0] = 0x08;
37344173fdaSDaniel Scheller state->reg[1] = 0x41;
37444173fdaSDaniel Scheller state->reg[2] = 0x8f;
37544173fdaSDaniel Scheller state->reg[3] = 0x00;
37644173fdaSDaniel Scheller state->reg[4] = 0xce;
37744173fdaSDaniel Scheller state->reg[5] = 0x54;
37844173fdaSDaniel Scheller state->reg[6] = 0x55;
37944173fdaSDaniel Scheller state->reg[7] = 0x45;
38044173fdaSDaniel Scheller state->reg[8] = 0x46;
38144173fdaSDaniel Scheller state->reg[9] = 0xbd;
38244173fdaSDaniel Scheller state->reg[10] = 0x11;
38344173fdaSDaniel Scheller
38444173fdaSDaniel Scheller state->ref_freq = 16000;
38544173fdaSDaniel Scheller
38644173fdaSDaniel Scheller if (clkdiv <= 3)
38744173fdaSDaniel Scheller state->reg[0x00] |= (clkdiv & 0x03);
38844173fdaSDaniel Scheller if (agcmode <= 3) {
38944173fdaSDaniel Scheller state->reg[0x03] |= (agcmode << 5);
39044173fdaSDaniel Scheller if (agcmode == 0x01)
39144173fdaSDaniel Scheller state->reg[0x01] |= 0x30;
39244173fdaSDaniel Scheller }
39344173fdaSDaniel Scheller if (bbmode <= 3)
39444173fdaSDaniel Scheller state->reg[0x01] = (state->reg[0x01] & ~0x30) | (bbmode << 4);
39544173fdaSDaniel Scheller if (agcref <= 7)
39644173fdaSDaniel Scheller state->reg[0x03] |= agcref;
39744173fdaSDaniel Scheller if (agcset <= 31)
39844173fdaSDaniel Scheller state->reg[0x02] = (state->reg[0x02] & ~0x1F) | agcset | 0x40;
39944173fdaSDaniel Scheller }
40044173fdaSDaniel Scheller
attach_init(struct stv * state)40144173fdaSDaniel Scheller static int attach_init(struct stv *state)
40244173fdaSDaniel Scheller {
40344173fdaSDaniel Scheller if (write_regs(state, 0, 11))
40444173fdaSDaniel Scheller return -ENODEV;
40544173fdaSDaniel Scheller return 0;
40644173fdaSDaniel Scheller }
40744173fdaSDaniel Scheller
release(struct dvb_frontend * fe)40844173fdaSDaniel Scheller static void release(struct dvb_frontend *fe)
40944173fdaSDaniel Scheller {
41044173fdaSDaniel Scheller kfree(fe->tuner_priv);
41144173fdaSDaniel Scheller fe->tuner_priv = NULL;
41244173fdaSDaniel Scheller }
41344173fdaSDaniel Scheller
set_bandwidth(struct dvb_frontend * fe,u32 cutoff_frequency)41444173fdaSDaniel Scheller static int set_bandwidth(struct dvb_frontend *fe, u32 cutoff_frequency)
41544173fdaSDaniel Scheller {
41644173fdaSDaniel Scheller struct stv *state = fe->tuner_priv;
41744173fdaSDaniel Scheller u32 index = (cutoff_frequency + 999999) / 1000000;
418fd7849d7SDaniel Scheller int stat = 0;
41944173fdaSDaniel Scheller
42044173fdaSDaniel Scheller if (index < 6)
42144173fdaSDaniel Scheller index = 6;
42244173fdaSDaniel Scheller if (index > 50)
42344173fdaSDaniel Scheller index = 50;
42444173fdaSDaniel Scheller if ((state->reg[0x08] & ~0xFC) == ((index - 6) << 2))
42544173fdaSDaniel Scheller return 0;
42644173fdaSDaniel Scheller
42744173fdaSDaniel Scheller state->reg[0x08] = (state->reg[0x08] & ~0xFC) | ((index - 6) << 2);
42844173fdaSDaniel Scheller state->reg[0x09] = (state->reg[0x09] & ~0x0C) | 0x08;
42944173fdaSDaniel Scheller if (fe->ops.i2c_gate_ctrl)
430fd7849d7SDaniel Scheller stat = fe->ops.i2c_gate_ctrl(fe, 1);
431fd7849d7SDaniel Scheller if (!stat) {
43244173fdaSDaniel Scheller write_regs(state, 0x08, 2);
43344173fdaSDaniel Scheller wait_for_call_done(state, 0x08);
434fd7849d7SDaniel Scheller }
435fd7849d7SDaniel Scheller if (fe->ops.i2c_gate_ctrl && !stat)
43644173fdaSDaniel Scheller fe->ops.i2c_gate_ctrl(fe, 0);
437fd7849d7SDaniel Scheller return stat;
43844173fdaSDaniel Scheller }
43944173fdaSDaniel Scheller
set_lof(struct stv * state,u32 local_frequency,u32 cutoff_frequency)44044173fdaSDaniel Scheller static int set_lof(struct stv *state, u32 local_frequency, u32 cutoff_frequency)
44144173fdaSDaniel Scheller {
44244173fdaSDaniel Scheller u32 index = (cutoff_frequency + 999999) / 1000000;
44344173fdaSDaniel Scheller u32 frequency = (local_frequency + 500) / 1000;
44444173fdaSDaniel Scheller u32 p = 1, psel = 0, fvco, div, frac;
44544173fdaSDaniel Scheller u8 icp, tmp;
44644173fdaSDaniel Scheller
44744173fdaSDaniel Scheller if (index < 6)
44844173fdaSDaniel Scheller index = 6;
44944173fdaSDaniel Scheller if (index > 50)
45044173fdaSDaniel Scheller index = 50;
45144173fdaSDaniel Scheller
45244173fdaSDaniel Scheller if (frequency <= 1300000) {
45344173fdaSDaniel Scheller p = 4;
45444173fdaSDaniel Scheller psel = 1;
45544173fdaSDaniel Scheller } else {
45644173fdaSDaniel Scheller p = 2;
45744173fdaSDaniel Scheller psel = 0;
45844173fdaSDaniel Scheller }
45944173fdaSDaniel Scheller fvco = frequency * p;
46044173fdaSDaniel Scheller div = fvco / state->ref_freq;
46144173fdaSDaniel Scheller frac = fvco % state->ref_freq;
46244173fdaSDaniel Scheller frac = muldiv32(frac, 0x40000, state->ref_freq);
46344173fdaSDaniel Scheller
46444173fdaSDaniel Scheller icp = 0;
46544173fdaSDaniel Scheller if (fvco < 2700000)
46644173fdaSDaniel Scheller icp = 0;
46744173fdaSDaniel Scheller else if (fvco < 2950000)
46844173fdaSDaniel Scheller icp = 1;
46944173fdaSDaniel Scheller else if (fvco < 3300000)
47044173fdaSDaniel Scheller icp = 2;
47144173fdaSDaniel Scheller else if (fvco < 3700000)
47244173fdaSDaniel Scheller icp = 3;
47344173fdaSDaniel Scheller else if (fvco < 4200000)
47444173fdaSDaniel Scheller icp = 5;
47544173fdaSDaniel Scheller else if (fvco < 4800000)
47644173fdaSDaniel Scheller icp = 6;
47744173fdaSDaniel Scheller else
47844173fdaSDaniel Scheller icp = 7;
47944173fdaSDaniel Scheller
48044173fdaSDaniel Scheller state->reg[0x02] |= 0x80; /* LNA IIP3 Mode */
48144173fdaSDaniel Scheller
48244173fdaSDaniel Scheller state->reg[0x03] = (state->reg[0x03] & ~0x80) | (psel << 7);
48344173fdaSDaniel Scheller state->reg[0x04] = (div & 0xFF);
48444173fdaSDaniel Scheller state->reg[0x05] = (((div >> 8) & 0x01) | ((frac & 0x7F) << 1)) & 0xff;
48544173fdaSDaniel Scheller state->reg[0x06] = ((frac >> 7) & 0xFF);
48644173fdaSDaniel Scheller state->reg[0x07] = (state->reg[0x07] & ~0x07) | ((frac >> 15) & 0x07);
48744173fdaSDaniel Scheller state->reg[0x07] = (state->reg[0x07] & ~0xE0) | (icp << 5);
48844173fdaSDaniel Scheller
48944173fdaSDaniel Scheller state->reg[0x08] = (state->reg[0x08] & ~0xFC) | ((index - 6) << 2);
49044173fdaSDaniel Scheller /* Start cal vco,CF */
49144173fdaSDaniel Scheller state->reg[0x09] = (state->reg[0x09] & ~0x0C) | 0x0C;
49244173fdaSDaniel Scheller write_regs(state, 2, 8);
49344173fdaSDaniel Scheller
49444173fdaSDaniel Scheller wait_for_call_done(state, 0x0C);
49544173fdaSDaniel Scheller
49644173fdaSDaniel Scheller usleep_range(10000, 12000);
49744173fdaSDaniel Scheller
49844173fdaSDaniel Scheller read_reg(state, 0x03, &tmp);
49944173fdaSDaniel Scheller if (tmp & 0x10) {
50044173fdaSDaniel Scheller state->reg[0x02] &= ~0x80; /* LNA NF Mode */
50144173fdaSDaniel Scheller write_regs(state, 2, 1);
50244173fdaSDaniel Scheller }
50344173fdaSDaniel Scheller read_reg(state, 0x08, &tmp);
50444173fdaSDaniel Scheller
50544173fdaSDaniel Scheller state->frequency = frequency;
50644173fdaSDaniel Scheller
50744173fdaSDaniel Scheller return 0;
50844173fdaSDaniel Scheller }
50944173fdaSDaniel Scheller
set_params(struct dvb_frontend * fe)51044173fdaSDaniel Scheller static int set_params(struct dvb_frontend *fe)
51144173fdaSDaniel Scheller {
51244173fdaSDaniel Scheller struct stv *state = fe->tuner_priv;
51344173fdaSDaniel Scheller struct dtv_frontend_properties *p = &fe->dtv_property_cache;
51444173fdaSDaniel Scheller u32 freq, cutoff;
515fd7849d7SDaniel Scheller int stat = 0;
51644173fdaSDaniel Scheller
51744173fdaSDaniel Scheller if (p->delivery_system != SYS_DVBS && p->delivery_system != SYS_DVBS2)
51844173fdaSDaniel Scheller return -EINVAL;
51944173fdaSDaniel Scheller
52044173fdaSDaniel Scheller freq = p->frequency * 1000;
52144173fdaSDaniel Scheller cutoff = 5000000 + muldiv32(p->symbol_rate, 135, 200);
52244173fdaSDaniel Scheller
52344173fdaSDaniel Scheller if (fe->ops.i2c_gate_ctrl)
524fd7849d7SDaniel Scheller stat = fe->ops.i2c_gate_ctrl(fe, 1);
525fd7849d7SDaniel Scheller if (!stat)
52644173fdaSDaniel Scheller set_lof(state, freq, cutoff);
527fd7849d7SDaniel Scheller if (fe->ops.i2c_gate_ctrl && !stat)
52844173fdaSDaniel Scheller fe->ops.i2c_gate_ctrl(fe, 0);
52944173fdaSDaniel Scheller return 0;
53044173fdaSDaniel Scheller }
53144173fdaSDaniel Scheller
table_lookup(const struct slookup * table,int table_size,u16 reg_value)53220e671dfSDaniel Scheller static s32 table_lookup(const struct slookup *table,
53320e671dfSDaniel Scheller int table_size, u16 reg_value)
53444173fdaSDaniel Scheller {
53544173fdaSDaniel Scheller s32 gain;
53644173fdaSDaniel Scheller s32 reg_diff;
53744173fdaSDaniel Scheller int imin = 0;
53844173fdaSDaniel Scheller int imax = table_size - 1;
53944173fdaSDaniel Scheller int i;
54044173fdaSDaniel Scheller
54144173fdaSDaniel Scheller /* Assumes Table[0].RegValue < Table[imax].RegValue */
5422af07a49SDaniel Scheller if (reg_value <= table[0].reg_value) {
54344173fdaSDaniel Scheller gain = table[0].value;
5442af07a49SDaniel Scheller } else if (reg_value >= table[imax].reg_value) {
54544173fdaSDaniel Scheller gain = table[imax].value;
5462af07a49SDaniel Scheller } else {
5472af07a49SDaniel Scheller while ((imax - imin) > 1) {
54844173fdaSDaniel Scheller i = (imax + imin) / 2;
54944173fdaSDaniel Scheller if ((table[imin].reg_value <= reg_value) &&
55044173fdaSDaniel Scheller (reg_value <= table[i].reg_value))
55144173fdaSDaniel Scheller imax = i;
55244173fdaSDaniel Scheller else
55344173fdaSDaniel Scheller imin = i;
55444173fdaSDaniel Scheller }
55544173fdaSDaniel Scheller reg_diff = table[imax].reg_value - table[imin].reg_value;
55644173fdaSDaniel Scheller gain = table[imin].value;
55744173fdaSDaniel Scheller if (reg_diff != 0)
55844173fdaSDaniel Scheller gain += ((s32)(reg_value - table[imin].reg_value) *
55944173fdaSDaniel Scheller (s32)(table[imax].value
5602af07a49SDaniel Scheller - table[imin].value)) / reg_diff;
56144173fdaSDaniel Scheller }
56244173fdaSDaniel Scheller return gain;
56344173fdaSDaniel Scheller }
56444173fdaSDaniel Scheller
get_rf_strength(struct dvb_frontend * fe,u16 * st)56544173fdaSDaniel Scheller static int get_rf_strength(struct dvb_frontend *fe, u16 *st)
56644173fdaSDaniel Scheller {
56744173fdaSDaniel Scheller struct stv *state = fe->tuner_priv;
56844173fdaSDaniel Scheller u16 rfagc = *st;
56944173fdaSDaniel Scheller s32 gain;
57044173fdaSDaniel Scheller
57144173fdaSDaniel Scheller if ((state->reg[0x03] & 0x60) == 0) {
57244173fdaSDaniel Scheller /* RF Mode, Read AGC ADC */
57344173fdaSDaniel Scheller u8 reg = 0;
574fd7849d7SDaniel Scheller int stat = 0;
57544173fdaSDaniel Scheller
57644173fdaSDaniel Scheller if (fe->ops.i2c_gate_ctrl)
577fd7849d7SDaniel Scheller stat = fe->ops.i2c_gate_ctrl(fe, 1);
578fd7849d7SDaniel Scheller if (!stat) {
57944173fdaSDaniel Scheller write_reg(state, 0x02, state->reg[0x02] | 0x20);
58044173fdaSDaniel Scheller read_reg(state, 2, ®);
58144173fdaSDaniel Scheller if (reg & 0x20)
58244173fdaSDaniel Scheller read_reg(state, 2, ®);
583fd7849d7SDaniel Scheller }
584fd7849d7SDaniel Scheller if (fe->ops.i2c_gate_ctrl && !stat)
58544173fdaSDaniel Scheller fe->ops.i2c_gate_ctrl(fe, 0);
58644173fdaSDaniel Scheller
58744173fdaSDaniel Scheller if ((state->reg[0x02] & 0x80) == 0)
58844173fdaSDaniel Scheller /* NF */
58944173fdaSDaniel Scheller gain = table_lookup(lnagain_nf_lookup,
5902af07a49SDaniel Scheller ARRAY_SIZE(lnagain_nf_lookup),
5912af07a49SDaniel Scheller reg & 0x1F);
59244173fdaSDaniel Scheller else
59344173fdaSDaniel Scheller /* IIP3 */
59444173fdaSDaniel Scheller gain = table_lookup(lnagain_iip3_lookup,
5952af07a49SDaniel Scheller ARRAY_SIZE(lnagain_iip3_lookup),
5962af07a49SDaniel Scheller reg & 0x1F);
59744173fdaSDaniel Scheller
59844173fdaSDaniel Scheller gain += table_lookup(gain_rfagc_lookup,
59944173fdaSDaniel Scheller ARRAY_SIZE(gain_rfagc_lookup), rfagc);
6002af07a49SDaniel Scheller
60144173fdaSDaniel Scheller gain -= 2400;
60244173fdaSDaniel Scheller } else {
60344173fdaSDaniel Scheller /* Channel Mode */
60444173fdaSDaniel Scheller if ((state->reg[0x02] & 0x80) == 0) {
60544173fdaSDaniel Scheller /* NF */
6062af07a49SDaniel Scheller gain = table_lookup(
6072af07a49SDaniel Scheller gain_channel_agc_nf_lookup,
60844173fdaSDaniel Scheller ARRAY_SIZE(gain_channel_agc_nf_lookup), rfagc);
6092af07a49SDaniel Scheller
61044173fdaSDaniel Scheller gain += 600;
61144173fdaSDaniel Scheller } else {
61244173fdaSDaniel Scheller /* IIP3 */
6132af07a49SDaniel Scheller gain = table_lookup(
6142af07a49SDaniel Scheller gain_channel_agc_iip3_lookup,
61544173fdaSDaniel Scheller ARRAY_SIZE(gain_channel_agc_iip3_lookup),
61644173fdaSDaniel Scheller rfagc);
61744173fdaSDaniel Scheller }
61844173fdaSDaniel Scheller }
61944173fdaSDaniel Scheller
62044173fdaSDaniel Scheller if (state->frequency > 0)
62144173fdaSDaniel Scheller /* Tilt correction ( 0.00016 dB/MHz ) */
62244173fdaSDaniel Scheller gain -= ((((s32)(state->frequency / 1000) - 1550) * 2) / 12);
62344173fdaSDaniel Scheller
62444173fdaSDaniel Scheller /* + (BBGain * 10); */
62544173fdaSDaniel Scheller gain += (s32)((state->reg[0x01] & 0xC0) >> 6) * 600 - 1300;
62644173fdaSDaniel Scheller
62744173fdaSDaniel Scheller if (gain < 0)
62844173fdaSDaniel Scheller gain = 0;
62944173fdaSDaniel Scheller else if (gain > 10000)
63044173fdaSDaniel Scheller gain = 10000;
63144173fdaSDaniel Scheller
63244173fdaSDaniel Scheller *st = 10000 - gain;
63344173fdaSDaniel Scheller
63444173fdaSDaniel Scheller return 0;
63544173fdaSDaniel Scheller }
63644173fdaSDaniel Scheller
63720e671dfSDaniel Scheller static const struct dvb_tuner_ops tuner_ops = {
63844173fdaSDaniel Scheller .info = {
63920e671dfSDaniel Scheller .name = "ST STV6111",
640a3f90c75SMauro Carvalho Chehab .frequency_min_hz = 950 * MHz,
641a3f90c75SMauro Carvalho Chehab .frequency_max_hz = 2150 * MHz,
64244173fdaSDaniel Scheller },
64344173fdaSDaniel Scheller .set_params = set_params,
64444173fdaSDaniel Scheller .release = release,
64544173fdaSDaniel Scheller .get_rf_strength = get_rf_strength,
64644173fdaSDaniel Scheller .set_bandwidth = set_bandwidth,
64744173fdaSDaniel Scheller };
64844173fdaSDaniel Scheller
stv6111_attach(struct dvb_frontend * fe,struct i2c_adapter * i2c,u8 adr)64944173fdaSDaniel Scheller struct dvb_frontend *stv6111_attach(struct dvb_frontend *fe,
65044173fdaSDaniel Scheller struct i2c_adapter *i2c, u8 adr)
65144173fdaSDaniel Scheller {
65244173fdaSDaniel Scheller struct stv *state;
653fd7849d7SDaniel Scheller int stat = -ENODEV;
654fd7849d7SDaniel Scheller int gatestat = 0;
65544173fdaSDaniel Scheller
6562af07a49SDaniel Scheller state = kzalloc(sizeof(*state), GFP_KERNEL);
65744173fdaSDaniel Scheller if (!state)
65844173fdaSDaniel Scheller return NULL;
65944173fdaSDaniel Scheller state->adr = adr;
66044173fdaSDaniel Scheller state->i2c = i2c;
66144173fdaSDaniel Scheller memcpy(&fe->ops.tuner_ops, &tuner_ops, sizeof(struct dvb_tuner_ops));
66244173fdaSDaniel Scheller init_state(state);
66344173fdaSDaniel Scheller
66444173fdaSDaniel Scheller if (fe->ops.i2c_gate_ctrl)
665fd7849d7SDaniel Scheller gatestat = fe->ops.i2c_gate_ctrl(fe, 1);
666fd7849d7SDaniel Scheller if (!gatestat)
66744173fdaSDaniel Scheller stat = attach_init(state);
668fd7849d7SDaniel Scheller if (fe->ops.i2c_gate_ctrl && !gatestat)
66944173fdaSDaniel Scheller fe->ops.i2c_gate_ctrl(fe, 0);
67044173fdaSDaniel Scheller if (stat < 0) {
67144173fdaSDaniel Scheller kfree(state);
6727112b490SDaniel Scheller return NULL;
67344173fdaSDaniel Scheller }
67444173fdaSDaniel Scheller fe->tuner_priv = state;
67544173fdaSDaniel Scheller return fe;
67644173fdaSDaniel Scheller }
67744173fdaSDaniel Scheller EXPORT_SYMBOL_GPL(stv6111_attach);
67844173fdaSDaniel Scheller
67920e671dfSDaniel Scheller MODULE_DESCRIPTION("ST STV6111 satellite tuner driver");
68044173fdaSDaniel Scheller MODULE_AUTHOR("Ralph Metzler, Manfred Voelkel");
681229b6ea6SDaniel Scheller MODULE_LICENSE("GPL v2");
682