1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include "vp702x.h"
18
19
20int dvb_usb_vp702x_debug;
21module_param_named(debug,dvb_usb_vp702x_debug, int, 0644);
22MODULE_PARM_DESC(debug, "set debugging level (1=info,xfer=2,rc=4 (or-able))." DVB_USB_DEBUG_STATUS);
23
24DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
25
26struct vp702x_state {
27 int pid_filter_count;
28 int pid_filter_can_bypass;
29 u8 pid_filter_state;
30};
31
32struct vp702x_device_state {
33 u8 power_state;
34};
35
36
37int vp702x_usb_in_op(struct dvb_usb_device *d, u8 req, u16 value, u16 index, u8 *b, int blen)
38{
39 int ret = -1;
40
41 ret = usb_control_msg(d->udev,
42 usb_rcvctrlpipe(d->udev,0),
43 req,
44 USB_TYPE_VENDOR | USB_DIR_IN,
45 value,index,b,blen,
46 2000);
47
48 if (ret < 0) {
49 warn("usb in operation failed. (%d)", ret);
50 ret = -EIO;
51 } else
52 ret = 0;
53
54
55 deb_xfer("in: req. %02x, val: %04x, ind: %04x, buffer: ",req,value,index);
56 debug_dump(b,blen,deb_xfer);
57
58 return ret;
59}
60
61static int vp702x_usb_out_op(struct dvb_usb_device *d, u8 req, u16 value,
62 u16 index, u8 *b, int blen)
63{
64 int ret;
65 deb_xfer("out: req. %02x, val: %04x, ind: %04x, buffer: ",req,value,index);
66 debug_dump(b,blen,deb_xfer);
67
68 if ((ret = usb_control_msg(d->udev,
69 usb_sndctrlpipe(d->udev,0),
70 req,
71 USB_TYPE_VENDOR | USB_DIR_OUT,
72 value,index,b,blen,
73 2000)) != blen) {
74 warn("usb out operation failed. (%d)",ret);
75 return -EIO;
76 } else
77 return 0;
78}
79
80int vp702x_usb_inout_op(struct dvb_usb_device *d, u8 *o, int olen, u8 *i, int ilen, int msec)
81{
82 int ret;
83
84 if ((ret = mutex_lock_interruptible(&d->usb_mutex)))
85 return ret;
86
87 ret = vp702x_usb_out_op(d,REQUEST_OUT,0,0,o,olen);
88 msleep(msec);
89 ret = vp702x_usb_in_op(d,REQUEST_IN,0,0,i,ilen);
90
91 mutex_unlock(&d->usb_mutex);
92
93 return ret;
94}
95
96static int vp702x_usb_inout_cmd(struct dvb_usb_device *d, u8 cmd, u8 *o,
97 int olen, u8 *i, int ilen, int msec)
98{
99 u8 bout[olen+2];
100 u8 bin[ilen+1];
101 int ret = 0;
102
103 bout[0] = 0x00;
104 bout[1] = cmd;
105 memcpy(&bout[2],o,olen);
106
107 ret = vp702x_usb_inout_op(d, bout, olen+2, bin, ilen+1,msec);
108
109 if (ret == 0)
110 memcpy(i,&bin[1],ilen);
111
112 return ret;
113}
114
115static int vp702x_set_pld_mode(struct dvb_usb_adapter *adap, u8 bypass)
116{
117 u8 buf[16] = { 0 };
118 return vp702x_usb_in_op(adap->dev, 0xe0, (bypass << 8) | 0x0e, 0, buf, 16);
119}
120
121static int vp702x_set_pld_state(struct dvb_usb_adapter *adap, u8 state)
122{
123 u8 buf[16] = { 0 };
124 return vp702x_usb_in_op(adap->dev, 0xe0, (state << 8) | 0x0f, 0, buf, 16);
125}
126
127static int vp702x_set_pid(struct dvb_usb_adapter *adap, u16 pid, u8 id, int onoff)
128{
129 struct vp702x_state *st = adap->priv;
130 u8 buf[16] = { 0 };
131
132 if (onoff)
133 st->pid_filter_state |= (1 << id);
134 else {
135 st->pid_filter_state &= ~(1 << id);
136 pid = 0xffff;
137 }
138
139 id = 0x10 + id*2;
140
141 vp702x_set_pld_state(adap, st->pid_filter_state);
142 vp702x_usb_in_op(adap->dev, 0xe0, (((pid >> 8) & 0xff) << 8) | (id), 0, buf, 16);
143 vp702x_usb_in_op(adap->dev, 0xe0, (((pid ) & 0xff) << 8) | (id+1), 0, buf, 16);
144 return 0;
145}
146
147
148static int vp702x_init_pid_filter(struct dvb_usb_adapter *adap)
149{
150 struct vp702x_state *st = adap->priv;
151 int i;
152 u8 b[10] = { 0 };
153
154 st->pid_filter_count = 8;
155 st->pid_filter_can_bypass = 1;
156 st->pid_filter_state = 0x00;
157
158 vp702x_set_pld_mode(adap, 1);
159
160 for (i = 0; i < st->pid_filter_count; i++)
161 vp702x_set_pid(adap, 0xffff, i, 1);
162
163 vp702x_usb_in_op(adap->dev, 0xb5, 3, 0, b, 10);
164 vp702x_usb_in_op(adap->dev, 0xb5, 0, 0, b, 10);
165 vp702x_usb_in_op(adap->dev, 0xb5, 1, 0, b, 10);
166
167
168 return 0;
169}
170
171static int vp702x_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
172{
173 return 0;
174}
175
176
177static struct dvb_usb_rc_key vp702x_rc_keys[] = {
178 { 0x0001, KEY_1 },
179 { 0x0002, KEY_2 },
180};
181
182
183static int vp702x_rc_query(struct dvb_usb_device *d, u32 *event, int *state)
184{
185 u8 key[10];
186 int i;
187
188
189 return 0;
190
191 vp702x_usb_in_op(d,READ_REMOTE_REQ,0,0,key,10);
192
193 deb_rc("remote query key: %x %d\n",key[1],key[1]);
194
195 if (key[1] == 0x44) {
196 *state = REMOTE_NO_KEY_PRESSED;
197 return 0;
198 }
199
200 for (i = 0; i < ARRAY_SIZE(vp702x_rc_keys); i++)
201 if (rc5_custom(&vp702x_rc_keys[i]) == key[1]) {
202 *state = REMOTE_KEY_PRESSED;
203 *event = vp702x_rc_keys[i].event;
204 break;
205 }
206 return 0;
207}
208
209
210static int vp702x_read_mac_addr(struct dvb_usb_device *d,u8 mac[6])
211{
212 u8 i;
213 for (i = 6; i < 12; i++)
214 vp702x_usb_in_op(d, READ_EEPROM_REQ, i, 1, &mac[i - 6], 1);
215 return 0;
216}
217
218static int vp702x_frontend_attach(struct dvb_usb_adapter *adap)
219{
220 u8 buf[10] = { 0 };
221
222 vp702x_usb_out_op(adap->dev, SET_TUNER_POWER_REQ, 0, 7, NULL, 0);
223
224 if (vp702x_usb_inout_cmd(adap->dev, GET_SYSTEM_STRING, NULL, 0, buf, 10, 10))
225 return -EIO;
226
227 buf[9] = '\0';
228 info("system string: %s",&buf[1]);
229
230 vp702x_init_pid_filter(adap);
231
232 adap->fe = vp702x_fe_attach(adap->dev);
233 vp702x_usb_out_op(adap->dev, SET_TUNER_POWER_REQ, 1, 7, NULL, 0);
234
235 return 0;
236}
237
238static struct dvb_usb_device_properties vp702x_properties;
239
240static int vp702x_usb_probe(struct usb_interface *intf,
241 const struct usb_device_id *id)
242{
243 return dvb_usb_device_init(intf, &vp702x_properties,
244 THIS_MODULE, NULL, adapter_nr);
245}
246
247static struct usb_device_id vp702x_usb_table [] = {
248 { USB_DEVICE(USB_VID_VISIONPLUS, USB_PID_TWINHAN_VP7021_COLD) },
249
250
251 { 0 },
252};
253MODULE_DEVICE_TABLE(usb, vp702x_usb_table);
254
255static struct dvb_usb_device_properties vp702x_properties = {
256 .usb_ctrl = CYPRESS_FX2,
257 .firmware = "dvb-usb-vp702x-02.fw",
258 .no_reconnect = 1,
259
260 .size_of_priv = sizeof(struct vp702x_device_state),
261
262 .num_adapters = 1,
263 .adapter = {
264 {
265 .caps = DVB_USB_ADAP_RECEIVES_204_BYTE_TS,
266
267 .streaming_ctrl = vp702x_streaming_ctrl,
268 .frontend_attach = vp702x_frontend_attach,
269
270
271 .stream = {
272 .type = USB_BULK,
273 .count = 10,
274 .endpoint = 0x02,
275 .u = {
276 .bulk = {
277 .buffersize = 4096,
278 }
279 }
280 },
281 .size_of_priv = sizeof(struct vp702x_state),
282 }
283 },
284 .read_mac_address = vp702x_read_mac_addr,
285
286 .rc_key_map = vp702x_rc_keys,
287 .rc_key_map_size = ARRAY_SIZE(vp702x_rc_keys),
288 .rc_interval = 400,
289 .rc_query = vp702x_rc_query,
290
291 .num_device_descs = 1,
292 .devices = {
293 { .name = "TwinhanDTV StarBox DVB-S USB2.0 (VP7021)",
294 .cold_ids = { &vp702x_usb_table[0], NULL },
295 .warm_ids = { NULL },
296 },
297
298
299
300
301 { NULL },
302 }
303};
304
305
306static struct usb_driver vp702x_usb_driver = {
307 .name = "dvb_usb_vp702x",
308 .probe = vp702x_usb_probe,
309 .disconnect = dvb_usb_device_exit,
310 .id_table = vp702x_usb_table,
311};
312
313
314static int __init vp702x_usb_module_init(void)
315{
316 int result;
317 if ((result = usb_register(&vp702x_usb_driver))) {
318 err("usb_register failed. (%d)",result);
319 return result;
320 }
321
322 return 0;
323}
324
325static void __exit vp702x_usb_module_exit(void)
326{
327
328 usb_deregister(&vp702x_usb_driver);
329}
330
331module_init(vp702x_usb_module_init);
332module_exit(vp702x_usb_module_exit);
333
334MODULE_AUTHOR("Patrick Boettcher <patrick.boettcher@desy.de>");
335MODULE_DESCRIPTION("Driver for Twinhan StarBox DVB-S USB2.0 and clones");
336MODULE_VERSION("1.0");
337MODULE_LICENSE("GPL");
338