[PATCH] dvb: nxt200x: remove null check before kfree()
[linux-2.6] / drivers / media / dvb / dvb-usb / dibusb-common.c
1 /* Common methods for dibusb-based-receivers.
2  *
3  * Copyright (C) 2004-5 Patrick Boettcher (patrick.boettcher@desy.de)
4  *
5  *      This program is free software; you can redistribute it and/or modify it
6  *      under the terms of the GNU General Public License as published by the Free
7  *      Software Foundation, version 2.
8  *
9  * see Documentation/dvb/README.dvb-usb for more information
10  */
11 #include "dibusb.h"
12
13 static int debug;
14 module_param(debug, int, 0644);
15 MODULE_PARM_DESC(debug, "set debugging level (1=info (|-able))." DVB_USB_DEBUG_STATUS);
16 MODULE_LICENSE("GPL");
17
18 #define deb_info(args...) dprintk(debug,0x01,args)
19
20 /* common stuff used by the different dibusb modules */
21 int dibusb_streaming_ctrl(struct dvb_usb_device *d, int onoff)
22 {
23         if (d->priv != NULL) {
24                 struct dib_fe_xfer_ops *ops = d->priv;
25                 if (ops->fifo_ctrl != NULL)
26                         if (ops->fifo_ctrl(d->fe,onoff)) {
27                                 err("error while controlling the fifo of the demod.");
28                                 return -ENODEV;
29                         }
30         }
31         return 0;
32 }
33 EXPORT_SYMBOL(dibusb_streaming_ctrl);
34
35 int dibusb_pid_filter(struct dvb_usb_device *d, int index, u16 pid, int onoff)
36 {
37         if (d->priv != NULL) {
38                 struct dib_fe_xfer_ops *ops = d->priv;
39                 if (d->pid_filtering && ops->pid_ctrl != NULL)
40                         ops->pid_ctrl(d->fe,index,pid,onoff);
41         }
42         return 0;
43 }
44 EXPORT_SYMBOL(dibusb_pid_filter);
45
46 int dibusb_pid_filter_ctrl(struct dvb_usb_device *d, int onoff)
47 {
48         if (d->priv != NULL) {
49                 struct dib_fe_xfer_ops *ops = d->priv;
50                 if (ops->pid_parse != NULL)
51                         if (ops->pid_parse(d->fe,onoff) < 0)
52                                 err("could not handle pid_parser");
53         }
54         return 0;
55 }
56 EXPORT_SYMBOL(dibusb_pid_filter_ctrl);
57
58 int dibusb_power_ctrl(struct dvb_usb_device *d, int onoff)
59 {
60         u8 b[3];
61         int ret;
62         b[0] = DIBUSB_REQ_SET_IOCTL;
63         b[1] = DIBUSB_IOCTL_CMD_POWER_MODE;
64         b[2] = onoff ? DIBUSB_IOCTL_POWER_WAKEUP : DIBUSB_IOCTL_POWER_SLEEP;
65         ret = dvb_usb_generic_write(d,b,3);
66         msleep(10);
67         return ret;
68 }
69 EXPORT_SYMBOL(dibusb_power_ctrl);
70
71 int dibusb2_0_streaming_ctrl(struct dvb_usb_device *d, int onoff)
72 {
73         u8 b[3] = { 0 };
74         int ret;
75
76         if ((ret = dibusb_streaming_ctrl(d,onoff)) < 0)
77                 return ret;
78
79         if (onoff) {
80                 b[0] = DIBUSB_REQ_SET_STREAMING_MODE;
81                 b[1] = 0x00;
82                 if ((ret = dvb_usb_generic_write(d,b,2)) < 0)
83                         return ret;
84         }
85
86         b[0] = DIBUSB_REQ_SET_IOCTL;
87         b[1] = onoff ? DIBUSB_IOCTL_CMD_ENABLE_STREAM : DIBUSB_IOCTL_CMD_DISABLE_STREAM;
88         return dvb_usb_generic_write(d,b,3);
89 }
90 EXPORT_SYMBOL(dibusb2_0_streaming_ctrl);
91
92 int dibusb2_0_power_ctrl(struct dvb_usb_device *d, int onoff)
93 {
94         if (onoff) {
95                 u8 b[3] = { DIBUSB_REQ_SET_IOCTL, DIBUSB_IOCTL_CMD_POWER_MODE, DIBUSB_IOCTL_POWER_WAKEUP };
96                 return dvb_usb_generic_write(d,b,3);
97         } else
98                 return 0;
99 }
100 EXPORT_SYMBOL(dibusb2_0_power_ctrl);
101
102 static int dibusb_i2c_msg(struct dvb_usb_device *d, u8 addr,
103                           u8 *wbuf, u16 wlen, u8 *rbuf, u16 rlen)
104 {
105         u8 sndbuf[wlen+4]; /* lead(1) devaddr,direction(1) addr(2) data(wlen) (len(2) (when reading)) */
106         /* write only ? */
107         int wo = (rbuf == NULL || rlen == 0),
108                 len = 2 + wlen + (wo ? 0 : 2);
109
110         sndbuf[0] = wo ? DIBUSB_REQ_I2C_WRITE : DIBUSB_REQ_I2C_READ;
111         sndbuf[1] = (addr << 1) | (wo ? 0 : 1);
112
113         memcpy(&sndbuf[2],wbuf,wlen);
114
115         if (!wo) {
116                 sndbuf[wlen+2] = (rlen >> 8) & 0xff;
117                 sndbuf[wlen+3] = rlen & 0xff;
118         }
119
120         return dvb_usb_generic_rw(d,sndbuf,len,rbuf,rlen,0);
121 }
122
123 /*
124  * I2C master xfer function
125  */
126 static int dibusb_i2c_xfer(struct i2c_adapter *adap,struct i2c_msg msg[],int num)
127 {
128         struct dvb_usb_device *d = i2c_get_adapdata(adap);
129         int i;
130
131         if (down_interruptible(&d->i2c_sem) < 0)
132                 return -EAGAIN;
133
134         if (num > 2)
135                 warn("more than 2 i2c messages at a time is not handled yet. TODO.");
136
137         for (i = 0; i < num; i++) {
138                 /* write/read request */
139                 if (i+1 < num && (msg[i+1].flags & I2C_M_RD)) {
140                         if (dibusb_i2c_msg(d, msg[i].addr, msg[i].buf,msg[i].len,
141                                                 msg[i+1].buf,msg[i+1].len) < 0)
142                                 break;
143                         i++;
144                 } else
145                         if (dibusb_i2c_msg(d, msg[i].addr, msg[i].buf,msg[i].len,NULL,0) < 0)
146                                 break;
147         }
148
149         up(&d->i2c_sem);
150         return i;
151 }
152
153 static u32 dibusb_i2c_func(struct i2c_adapter *adapter)
154 {
155         return I2C_FUNC_I2C;
156 }
157
158 struct i2c_algorithm dibusb_i2c_algo = {
159         .master_xfer   = dibusb_i2c_xfer,
160         .functionality = dibusb_i2c_func,
161 };
162 EXPORT_SYMBOL(dibusb_i2c_algo);
163
164 int dibusb_read_eeprom_byte(struct dvb_usb_device *d, u8 offs, u8 *val)
165 {
166         u8 wbuf[1] = { offs };
167         return dibusb_i2c_msg(d, 0x50, wbuf, 1, val, 1);
168 }
169 EXPORT_SYMBOL(dibusb_read_eeprom_byte);
170
171 int dibusb_dib3000mc_frontend_attach(struct dvb_usb_device *d)
172 {
173         struct dib3000_config demod_cfg;
174         struct dibusb_state *st = d->priv;
175
176         demod_cfg.pll_set = dvb_usb_pll_set_i2c;
177         demod_cfg.pll_init = dvb_usb_pll_init_i2c;
178
179         for (demod_cfg.demod_address = 0x8; demod_cfg.demod_address < 0xd; demod_cfg.demod_address++)
180                 if ((d->fe = dib3000mc_attach(&demod_cfg,&d->i2c_adap,&st->ops)) != NULL) {
181                         d->tuner_pass_ctrl = st->ops.tuner_pass_ctrl;
182                         return 0;
183                 }
184
185         return -ENODEV;
186 }
187 EXPORT_SYMBOL(dibusb_dib3000mc_frontend_attach);
188
189 int dibusb_dib3000mc_tuner_attach (struct dvb_usb_device *d)
190 {
191         d->pll_addr = 0x60;
192         d->pll_desc = &dvb_pll_env57h1xd5;
193         return 0;
194 }
195 EXPORT_SYMBOL(dibusb_dib3000mc_tuner_attach);
196
197 /*
198  * common remote control stuff
199  */
200 struct dvb_usb_rc_key dibusb_rc_keys[] = {
201         /* Key codes for the little Artec T1/Twinhan/HAMA/ remote. */
202         { 0x00, 0x16, KEY_POWER },
203         { 0x00, 0x10, KEY_MUTE },
204         { 0x00, 0x03, KEY_1 },
205         { 0x00, 0x01, KEY_2 },
206         { 0x00, 0x06, KEY_3 },
207         { 0x00, 0x09, KEY_4 },
208         { 0x00, 0x1d, KEY_5 },
209         { 0x00, 0x1f, KEY_6 },
210         { 0x00, 0x0d, KEY_7 },
211         { 0x00, 0x19, KEY_8 },
212         { 0x00, 0x1b, KEY_9 },
213         { 0x00, 0x15, KEY_0 },
214         { 0x00, 0x05, KEY_CHANNELUP },
215         { 0x00, 0x02, KEY_CHANNELDOWN },
216         { 0x00, 0x1e, KEY_VOLUMEUP },
217         { 0x00, 0x0a, KEY_VOLUMEDOWN },
218         { 0x00, 0x11, KEY_RECORD },
219         { 0x00, 0x17, KEY_FAVORITES }, /* Heart symbol - Channel list. */
220         { 0x00, 0x14, KEY_PLAY },
221         { 0x00, 0x1a, KEY_STOP },
222         { 0x00, 0x40, KEY_REWIND },
223         { 0x00, 0x12, KEY_FASTFORWARD },
224         { 0x00, 0x0e, KEY_PREVIOUS }, /* Recall - Previous channel. */
225         { 0x00, 0x4c, KEY_PAUSE },
226         { 0x00, 0x4d, KEY_SCREEN }, /* Full screen mode. */
227         { 0x00, 0x54, KEY_AUDIO }, /* MTS - Switch to secondary audio. */
228         /* additional keys TwinHan VisionPlus, the Artec seemingly not have */
229         { 0x00, 0x0c, KEY_CANCEL }, /* Cancel */
230         { 0x00, 0x1c, KEY_EPG }, /* EPG */
231         { 0x00, 0x00, KEY_TAB }, /* Tab */
232         { 0x00, 0x48, KEY_INFO }, /* Preview */
233         { 0x00, 0x04, KEY_LIST }, /* RecordList */
234         { 0x00, 0x0f, KEY_TEXT }, /* Teletext */
235         /* Key codes for the KWorld/ADSTech/JetWay remote. */
236         { 0x86, 0x12, KEY_POWER },
237         { 0x86, 0x0f, KEY_SELECT }, /* source */
238         { 0x86, 0x0c, KEY_UNKNOWN }, /* scan */
239         { 0x86, 0x0b, KEY_EPG },
240         { 0x86, 0x10, KEY_MUTE },
241         { 0x86, 0x01, KEY_1 },
242         { 0x86, 0x02, KEY_2 },
243         { 0x86, 0x03, KEY_3 },
244         { 0x86, 0x04, KEY_4 },
245         { 0x86, 0x05, KEY_5 },
246         { 0x86, 0x06, KEY_6 },
247         { 0x86, 0x07, KEY_7 },
248         { 0x86, 0x08, KEY_8 },
249         { 0x86, 0x09, KEY_9 },
250         { 0x86, 0x0a, KEY_0 },
251         { 0x86, 0x18, KEY_ZOOM },
252         { 0x86, 0x1c, KEY_UNKNOWN }, /* preview */
253         { 0x86, 0x13, KEY_UNKNOWN }, /* snap */
254         { 0x86, 0x00, KEY_UNDO },
255         { 0x86, 0x1d, KEY_RECORD },
256         { 0x86, 0x0d, KEY_STOP },
257         { 0x86, 0x0e, KEY_PAUSE },
258         { 0x86, 0x16, KEY_PLAY },
259         { 0x86, 0x11, KEY_BACK },
260         { 0x86, 0x19, KEY_FORWARD },
261         { 0x86, 0x14, KEY_UNKNOWN }, /* pip */
262         { 0x86, 0x15, KEY_ESC },
263         { 0x86, 0x1a, KEY_UP },
264         { 0x86, 0x1e, KEY_DOWN },
265         { 0x86, 0x1f, KEY_LEFT },
266         { 0x86, 0x1b, KEY_RIGHT },
267 };
268 EXPORT_SYMBOL(dibusb_rc_keys);
269
270 int dibusb_rc_query(struct dvb_usb_device *d, u32 *event, int *state)
271 {
272         u8 key[5],cmd = DIBUSB_REQ_POLL_REMOTE;
273         dvb_usb_generic_rw(d,&cmd,1,key,5,0);
274         dvb_usb_nec_rc_key_to_event(d,key,event,state);
275         if (key[0] != 0)
276                 deb_info("key: %x %x %x %x %x\n",key[0],key[1],key[2],key[3],key[4]);
277         return 0;
278 }
279 EXPORT_SYMBOL(dibusb_rc_query);