This source file includes following definitions.
- tda665x_read
- tda665x_write
- tda665x_get_frequency
- tda665x_get_status
- tda665x_set_frequency
- tda665x_set_params
- tda665x_release
- tda665x_attach
1
2
3
4
5
6
7
8 #include <linux/init.h>
9 #include <linux/kernel.h>
10 #include <linux/module.h>
11 #include <linux/slab.h>
12
13 #include <media/dvb_frontend.h>
14 #include "tda665x.h"
15
16 struct tda665x_state {
17 struct dvb_frontend *fe;
18 struct i2c_adapter *i2c;
19 const struct tda665x_config *config;
20
21 u32 frequency;
22 u32 bandwidth;
23 };
24
25 static int tda665x_read(struct tda665x_state *state, u8 *buf)
26 {
27 const struct tda665x_config *config = state->config;
28 int err = 0;
29 struct i2c_msg msg = { .addr = config->addr, .flags = I2C_M_RD, .buf = buf, .len = 2 };
30
31 err = i2c_transfer(state->i2c, &msg, 1);
32 if (err != 1)
33 goto exit;
34
35 return err;
36 exit:
37 printk(KERN_ERR "%s: I/O Error err=<%d>\n", __func__, err);
38 return err;
39 }
40
41 static int tda665x_write(struct tda665x_state *state, u8 *buf, u8 length)
42 {
43 const struct tda665x_config *config = state->config;
44 int err = 0;
45 struct i2c_msg msg = { .addr = config->addr, .flags = 0, .buf = buf, .len = length };
46
47 err = i2c_transfer(state->i2c, &msg, 1);
48 if (err != 1)
49 goto exit;
50
51 return err;
52 exit:
53 printk(KERN_ERR "%s: I/O Error err=<%d>\n", __func__, err);
54 return err;
55 }
56
57 static int tda665x_get_frequency(struct dvb_frontend *fe, u32 *frequency)
58 {
59 struct tda665x_state *state = fe->tuner_priv;
60
61 *frequency = state->frequency;
62
63 return 0;
64 }
65
66 static int tda665x_get_status(struct dvb_frontend *fe, u32 *status)
67 {
68 struct tda665x_state *state = fe->tuner_priv;
69 u8 result = 0;
70 int err = 0;
71
72 *status = 0;
73
74 err = tda665x_read(state, &result);
75 if (err < 0)
76 goto exit;
77
78 if ((result >> 6) & 0x01) {
79 printk(KERN_DEBUG "%s: Tuner Phase Locked\n", __func__);
80 *status = 1;
81 }
82
83 return err;
84 exit:
85 printk(KERN_ERR "%s: I/O Error\n", __func__);
86 return err;
87 }
88
89 static int tda665x_set_frequency(struct dvb_frontend *fe,
90 u32 new_frequency)
91 {
92 struct tda665x_state *state = fe->tuner_priv;
93 const struct tda665x_config *config = state->config;
94 u32 frequency, status = 0;
95 u8 buf[4];
96 int err = 0;
97
98 if ((new_frequency < config->frequency_max)
99 || (new_frequency > config->frequency_min)) {
100 printk(KERN_ERR "%s: Frequency beyond limits, frequency=%d\n",
101 __func__, new_frequency);
102 return -EINVAL;
103 }
104
105 frequency = new_frequency;
106
107 frequency += config->frequency_offst;
108 frequency *= config->ref_multiplier;
109 frequency += config->ref_divider >> 1;
110 frequency /= config->ref_divider;
111
112 buf[0] = (u8) ((frequency & 0x7f00) >> 8);
113 buf[1] = (u8) (frequency & 0x00ff) >> 0;
114 buf[2] = 0x80 | 0x40 | 0x02;
115 buf[3] = 0x00;
116
117
118 frequency = new_frequency;
119
120 if (frequency < 153000000) {
121
122 buf[3] |= 0x01;
123 if (frequency < 68000000)
124 buf[3] |= 0x40;
125 if (frequency < 1040000000)
126 buf[3] |= 0x60;
127 if (frequency < 1250000000)
128 buf[3] |= 0x80;
129 else
130 buf[3] |= 0xa0;
131 } else if (frequency < 438000000) {
132
133 buf[3] |= 0x02;
134 if (frequency < 230000000)
135 buf[3] |= 0x40;
136 if (frequency < 300000000)
137 buf[3] |= 0x60;
138 else
139 buf[3] |= 0x80;
140 } else {
141
142 buf[3] |= 0x04;
143 if (frequency < 470000000)
144 buf[3] |= 0x60;
145 if (frequency < 526000000)
146 buf[3] |= 0x80;
147 else
148 buf[3] |= 0xa0;
149 }
150
151
152 err = tda665x_write(state, buf, 5);
153 if (err < 0)
154 goto exit;
155
156
157 printk(KERN_DEBUG "%s: Waiting to Phase LOCK\n", __func__);
158 msleep(20);
159
160 err = tda665x_get_status(fe, &status);
161 if (err < 0)
162 goto exit;
163
164 if (status == 1) {
165 printk(KERN_DEBUG "%s: Tuner Phase locked: status=%d\n",
166 __func__, status);
167 state->frequency = frequency;
168 } else {
169 printk(KERN_ERR "%s: No Phase lock: status=%d\n",
170 __func__, status);
171 }
172
173 return 0;
174 exit:
175 printk(KERN_ERR "%s: I/O Error\n", __func__);
176 return err;
177 }
178
179 static int tda665x_set_params(struct dvb_frontend *fe)
180 {
181 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
182
183 tda665x_set_frequency(fe, c->frequency);
184
185 return 0;
186 }
187
188 static void tda665x_release(struct dvb_frontend *fe)
189 {
190 struct tda665x_state *state = fe->tuner_priv;
191
192 fe->tuner_priv = NULL;
193 kfree(state);
194 }
195
196 static const struct dvb_tuner_ops tda665x_ops = {
197 .get_status = tda665x_get_status,
198 .set_params = tda665x_set_params,
199 .get_frequency = tda665x_get_frequency,
200 .release = tda665x_release
201 };
202
203 struct dvb_frontend *tda665x_attach(struct dvb_frontend *fe,
204 const struct tda665x_config *config,
205 struct i2c_adapter *i2c)
206 {
207 struct tda665x_state *state = NULL;
208 struct dvb_tuner_info *info;
209
210 state = kzalloc(sizeof(struct tda665x_state), GFP_KERNEL);
211 if (!state)
212 return NULL;
213
214 state->config = config;
215 state->i2c = i2c;
216 state->fe = fe;
217 fe->tuner_priv = state;
218 fe->ops.tuner_ops = tda665x_ops;
219 info = &fe->ops.tuner_ops.info;
220
221 memcpy(info->name, config->name, sizeof(config->name));
222 info->frequency_min_hz = config->frequency_min;
223 info->frequency_max_hz = config->frequency_max;
224 info->frequency_step_hz = config->frequency_offst;
225
226 printk(KERN_DEBUG "%s: Attaching TDA665x (%s) tuner\n", __func__, info->name);
227
228 return fe;
229 }
230 EXPORT_SYMBOL(tda665x_attach);
231
232 MODULE_DESCRIPTION("TDA665x driver");
233 MODULE_AUTHOR("Manu Abraham");
234 MODULE_LICENSE("GPL");