[media] hdpvr: Fix memory leak in debug
[deliverable/linux.git] / drivers / media / usb / hdpvr / hdpvr-core.c
CommitLineData
9aba42ef 1/*
e86da6f0 2 * Hauppauge HD PVR USB driver
9aba42ef
JG
3 *
4 * Copyright (C) 2001-2004 Greg Kroah-Hartman (greg@kroah.com)
5 * Copyright (C) 2008 Janne Grunau (j@jannau.net)
6 * Copyright (C) 2008 John Poet
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation, version 2.
11 *
12 */
13
14#include <linux/kernel.h>
15#include <linux/errno.h>
16#include <linux/init.h>
17#include <linux/slab.h>
18#include <linux/module.h>
19#include <linux/uaccess.h>
60063497 20#include <linux/atomic.h>
9aba42ef
JG
21#include <linux/usb.h>
22#include <linux/mutex.h>
23#include <linux/i2c.h>
24
25#include <linux/videodev2.h>
26#include <media/v4l2-dev.h>
27#include <media/v4l2-common.h>
28
29#include "hdpvr.h"
30
31static int video_nr[HDPVR_MAX] = {[0 ... (HDPVR_MAX - 1)] = UNSET};
32module_param_array(video_nr, int, NULL, 0);
33MODULE_PARM_DESC(video_nr, "video device number (-1=Auto)");
34
35/* holds the number of currently registered devices */
36static atomic_t dev_nr = ATOMIC_INIT(-1);
37
38int hdpvr_debug;
39module_param(hdpvr_debug, int, S_IRUGO|S_IWUSR);
40MODULE_PARM_DESC(hdpvr_debug, "enable debugging output");
41
b38aa09d 42static uint default_video_input = HDPVR_VIDEO_INPUTS;
9aba42ef
JG
43module_param(default_video_input, uint, S_IRUGO|S_IWUSR);
44MODULE_PARM_DESC(default_video_input, "default video input: 0=Component / "
45 "1=S-Video / 2=Composite");
46
b38aa09d 47static uint default_audio_input = HDPVR_AUDIO_INPUTS;
9aba42ef
JG
48module_param(default_audio_input, uint, S_IRUGO|S_IWUSR);
49MODULE_PARM_DESC(default_audio_input, "default audio input: 0=RCA back / "
50 "1=RCA front / 2=S/PDIF");
51
90ab5ee9 52static bool boost_audio;
9aba42ef
JG
53module_param(boost_audio, bool, S_IRUGO|S_IWUSR);
54MODULE_PARM_DESC(boost_audio, "boost the audio signal");
55
56
57/* table of devices that work with this driver */
58static struct usb_device_id hdpvr_table[] = {
59 { USB_DEVICE(HD_PVR_VENDOR_ID, HD_PVR_PRODUCT_ID) },
60 { USB_DEVICE(HD_PVR_VENDOR_ID, HD_PVR_PRODUCT_ID1) },
61 { USB_DEVICE(HD_PVR_VENDOR_ID, HD_PVR_PRODUCT_ID2) },
c22425ff 62 { USB_DEVICE(HD_PVR_VENDOR_ID, HD_PVR_PRODUCT_ID3) },
e902a68b 63 { USB_DEVICE(HD_PVR_VENDOR_ID, HD_PVR_PRODUCT_ID4) },
9aba42ef
JG
64 { } /* Terminating entry */
65};
66MODULE_DEVICE_TABLE(usb, hdpvr_table);
67
68
69void hdpvr_delete(struct hdpvr_device *dev)
70{
71 hdpvr_free_buffers(dev);
72
73 if (dev->video_dev)
74 video_device_release(dev->video_dev);
75
76 usb_put_dev(dev->udev);
77}
78
79static void challenge(u8 *bytes)
80{
c8e479c4
HV
81 __le64 *i64P;
82 u64 tmp64;
9aba42ef
JG
83 uint i, idx;
84
85 for (idx = 0; idx < 32; ++idx) {
86
87 if (idx & 0x3)
88 bytes[(idx >> 3) + 3] = bytes[(idx >> 2) & 0x3];
89
90 switch (idx & 0x3) {
91 case 0x3:
92 bytes[2] += bytes[3] * 4 + bytes[4] + bytes[5];
93 bytes[4] += bytes[(idx & 0x1) * 2] * 9 + 9;
94 break;
95 case 0x1:
96 bytes[0] *= 8;
97 bytes[0] += 7*idx + 4;
98 bytes[6] += bytes[3] * 3;
99 break;
100 case 0x0:
101 bytes[3 - (idx >> 3)] = bytes[idx >> 2];
102 bytes[5] += bytes[6] * 3;
103 for (i = 0; i < 3; i++)
104 bytes[3] *= bytes[3] + 1;
105 break;
106 case 0x2:
107 for (i = 0; i < 3; i++)
108 bytes[1] *= bytes[6] + 1;
109 for (i = 0; i < 3; i++) {
c8e479c4 110 i64P = (__le64 *)bytes;
9aba42ef 111 tmp64 = le64_to_cpup(i64P);
c8e479c4
HV
112 tmp64 = tmp64 + (tmp64 << (bytes[7] & 0x0f));
113 *i64P = cpu_to_le64(tmp64);
9aba42ef
JG
114 }
115 break;
116 }
117 }
118}
119
120/* try to init the device like the windows driver */
121static int device_authorization(struct hdpvr_device *dev)
122{
123
124 int ret, retval = -ENOMEM;
125 char request_type = 0x38, rcv_request = 0x81;
126 char *response;
127#ifdef HDPVR_DEBUG
128 size_t buf_size = 46;
129 char *print_buf = kzalloc(5*buf_size+1, GFP_KERNEL);
130 if (!print_buf) {
9ef77adf 131 v4l2_err(&dev->v4l2_dev, "Out of memory\n");
00c1e216 132 return retval;
9aba42ef
JG
133 }
134#endif
135
136 mutex_lock(&dev->usbc_mutex);
137 ret = usb_control_msg(dev->udev,
138 usb_rcvctrlpipe(dev->udev, 0),
139 rcv_request, 0x80 | request_type,
140 0x0400, 0x0003,
141 dev->usbc_buf, 46,
142 10000);
143 if (ret != 46) {
9ef77adf
JG
144 v4l2_err(&dev->v4l2_dev,
145 "unexpected answer of status request, len %d\n", ret);
00c1e216 146 goto unlock;
9aba42ef
JG
147 }
148#ifdef HDPVR_DEBUG
149 else {
150 hex_dump_to_buffer(dev->usbc_buf, 46, 16, 1, print_buf,
9518f179 151 5*buf_size+1, 0);
9ef77adf
JG
152 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
153 "Status request returned, len %d: %s\n",
154 ret, print_buf);
9aba42ef
JG
155 }
156#endif
74a558b1 157
fda27874
TR
158 dev->fw_ver = dev->usbc_buf[1];
159
74a558b1 160 v4l2_info(&dev->v4l2_dev, "firmware version 0x%x dated %s\n",
fda27874
TR
161 dev->fw_ver, &dev->usbc_buf[2]);
162
163 if (dev->fw_ver > 0x15) {
164 dev->options.brightness = 0x80;
165 dev->options.contrast = 0x40;
166 dev->options.hue = 0xf;
167 dev->options.saturation = 0x40;
168 dev->options.sharpness = 0x80;
169 }
74a558b1 170
fda27874 171 switch (dev->fw_ver) {
35b53664 172 case HDPVR_FIRMWARE_VERSION:
9aba42ef 173 dev->flags &= ~HDPVR_FLAG_AC3_CAP;
35b53664
JG
174 break;
175 case HDPVR_FIRMWARE_VERSION_AC3:
176 case HDPVR_FIRMWARE_VERSION_0X12:
177 case HDPVR_FIRMWARE_VERSION_0X15:
c7a2c84a 178 case HDPVR_FIRMWARE_VERSION_0X1E:
9aba42ef 179 dev->flags |= HDPVR_FLAG_AC3_CAP;
35b53664
JG
180 break;
181 default:
182 v4l2_info(&dev->v4l2_dev, "untested firmware, the driver might"
183 " not work.\n");
fda27874 184 if (dev->fw_ver >= HDPVR_FIRMWARE_VERSION_AC3)
35b53664
JG
185 dev->flags |= HDPVR_FLAG_AC3_CAP;
186 else
187 dev->flags &= ~HDPVR_FLAG_AC3_CAP;
9aba42ef
JG
188 }
189
190 response = dev->usbc_buf+38;
191#ifdef HDPVR_DEBUG
9518f179 192 hex_dump_to_buffer(response, 8, 16, 1, print_buf, 5*buf_size+1, 0);
9ef77adf
JG
193 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev, "challenge: %s\n",
194 print_buf);
9aba42ef
JG
195#endif
196 challenge(response);
197#ifdef HDPVR_DEBUG
9518f179 198 hex_dump_to_buffer(response, 8, 16, 1, print_buf, 5*buf_size+1, 0);
9ef77adf
JG
199 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev, " response: %s\n",
200 print_buf);
9aba42ef
JG
201#endif
202
203 msleep(100);
204 ret = usb_control_msg(dev->udev,
205 usb_sndctrlpipe(dev->udev, 0),
206 0xd1, 0x00 | request_type,
207 0x0000, 0x0000,
208 response, 8,
209 10000);
9ef77adf
JG
210 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
211 "magic request returned %d\n", ret);
9aba42ef
JG
212
213 retval = ret != 8;
00c1e216
JS
214unlock:
215 mutex_unlock(&dev->usbc_mutex);
1ba6c901
MI
216#ifdef HDPVR_DEBUG
217 kfree(print_buf);
218#endif
9aba42ef
JG
219 return retval;
220}
221
222static int hdpvr_device_init(struct hdpvr_device *dev)
223{
224 int ret;
225 u8 *buf;
9aba42ef
JG
226
227 if (device_authorization(dev))
228 return -EACCES;
229
230 /* default options for init */
231 hdpvr_set_options(dev);
232
233 /* set filter options */
234 mutex_lock(&dev->usbc_mutex);
235 buf = dev->usbc_buf;
236 buf[0] = 0x03; buf[1] = 0x03; buf[2] = 0x00; buf[3] = 0x00;
237 ret = usb_control_msg(dev->udev,
238 usb_sndctrlpipe(dev->udev, 0),
239 0x01, 0x38,
240 CTRL_LOW_PASS_FILTER_VALUE, CTRL_DEFAULT_INDEX,
241 buf, 4,
242 1000);
9ef77adf
JG
243 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
244 "control request returned %d\n", ret);
9aba42ef
JG
245 mutex_unlock(&dev->usbc_mutex);
246
9aba42ef
JG
247 /* enable fan and bling leds */
248 mutex_lock(&dev->usbc_mutex);
249 buf[0] = 0x1;
250 ret = usb_control_msg(dev->udev,
251 usb_sndctrlpipe(dev->udev, 0),
252 0xd4, 0x38, 0, 0, buf, 1,
253 1000);
9ef77adf
JG
254 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
255 "control request returned %d\n", ret);
9aba42ef
JG
256
257 /* boost analog audio */
258 buf[0] = boost_audio;
259 ret = usb_control_msg(dev->udev,
260 usb_sndctrlpipe(dev->udev, 0),
261 0xd5, 0x38, 0, 0, buf, 1,
262 1000);
9ef77adf
JG
263 v4l2_dbg(MSG_INFO, hdpvr_debug, &dev->v4l2_dev,
264 "control request returned %d\n", ret);
9aba42ef
JG
265 mutex_unlock(&dev->usbc_mutex);
266
267 dev->status = STATUS_IDLE;
268 return 0;
269}
270
271static const struct hdpvr_options hdpvr_default_options = {
272 .video_std = HDPVR_60HZ,
273 .video_input = HDPVR_COMPONENT,
274 .audio_input = HDPVR_RCA_BACK,
275 .bitrate = 65, /* 6 mbps */
276 .peak_bitrate = 90, /* 9 mbps */
277 .bitrate_mode = HDPVR_CONSTANT,
278 .gop_mode = HDPVR_SIMPLE_IDR_GOP,
279 .audio_codec = V4L2_MPEG_AUDIO_ENCODING_AAC,
fda27874
TR
280 /* original picture controls for firmware version <= 0x15 */
281 /* updated in device_authorization() for newer firmware */
9aba42ef
JG
282 .brightness = 0x86,
283 .contrast = 0x80,
284 .hue = 0x80,
285 .saturation = 0x80,
286 .sharpness = 0x80,
287};
288
289static int hdpvr_probe(struct usb_interface *interface,
290 const struct usb_device_id *id)
291{
292 struct hdpvr_device *dev;
293 struct usb_host_interface *iface_desc;
294 struct usb_endpoint_descriptor *endpoint;
7f2a06de 295 struct i2c_client *client;
9aba42ef
JG
296 size_t buffer_size;
297 int i;
298 int retval = -ENOMEM;
299
300 /* allocate memory for our device state and initialize it */
301 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
302 if (!dev) {
d372c419 303 dev_err(&interface->dev, "Out of memory\n");
9aba42ef
JG
304 goto error;
305 }
06630aec 306
2e923a05
AK
307 /* init video transfer queues first of all */
308 /* to prevent oops in hdpvr_delete() on error paths */
309 INIT_LIST_HEAD(&dev->free_buff_list);
310 INIT_LIST_HEAD(&dev->rec_buff_list);
311
06630aec
JG
312 /* register v4l2_device early so it can be used for printks */
313 if (v4l2_device_register(&interface->dev, &dev->v4l2_dev)) {
d372c419 314 dev_err(&interface->dev, "v4l2_device_register failed\n");
06630aec
JG
315 goto error;
316 }
317
9aba42ef
JG
318 mutex_init(&dev->io_mutex);
319 mutex_init(&dev->i2c_mutex);
320 mutex_init(&dev->usbc_mutex);
321 dev->usbc_buf = kmalloc(64, GFP_KERNEL);
322 if (!dev->usbc_buf) {
9ef77adf 323 v4l2_err(&dev->v4l2_dev, "Out of memory\n");
9aba42ef
JG
324 goto error;
325 }
326
327 init_waitqueue_head(&dev->wait_buffer);
328 init_waitqueue_head(&dev->wait_data);
329
330 dev->workqueue = create_singlethread_workqueue("hdpvr_buffer");
331 if (!dev->workqueue)
332 goto error;
333
9aba42ef
JG
334 dev->options = hdpvr_default_options;
335
336 if (default_video_input < HDPVR_VIDEO_INPUTS)
337 dev->options.video_input = default_video_input;
338
d4533332 339 if (default_audio_input < HDPVR_AUDIO_INPUTS) {
9aba42ef 340 dev->options.audio_input = default_audio_input;
d4533332
JG
341 if (default_audio_input == HDPVR_SPDIF)
342 dev->options.audio_codec =
343 V4L2_MPEG_AUDIO_ENCODING_AC3;
344 }
9aba42ef
JG
345
346 dev->udev = usb_get_dev(interface_to_usbdev(interface));
347
348 /* set up the endpoint information */
349 /* use only the first bulk-in and bulk-out endpoints */
350 iface_desc = interface->cur_altsetting;
351 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
352 endpoint = &iface_desc->endpoint[i].desc;
353
354 if (!dev->bulk_in_endpointAddr &&
355 usb_endpoint_is_bulk_in(endpoint)) {
356 /* USB interface description is buggy, reported max
357 * packet size is 512 bytes, windows driver uses 8192 */
358 buffer_size = 8192;
359 dev->bulk_in_size = buffer_size;
360 dev->bulk_in_endpointAddr = endpoint->bEndpointAddress;
361 }
362
363 }
364 if (!dev->bulk_in_endpointAddr) {
9ef77adf 365 v4l2_err(&dev->v4l2_dev, "Could not find bulk-in endpoint\n");
9aba42ef
JG
366 goto error;
367 }
368
369 /* init the device */
370 if (hdpvr_device_init(dev)) {
9ef77adf 371 v4l2_err(&dev->v4l2_dev, "device init failed\n");
9aba42ef
JG
372 goto error;
373 }
374
375 mutex_lock(&dev->io_mutex);
376 if (hdpvr_alloc_buffers(dev, NUM_BUFFERS)) {
00c1e216 377 mutex_unlock(&dev->io_mutex);
9ef77adf
JG
378 v4l2_err(&dev->v4l2_dev,
379 "allocating transfer buffers failed\n");
9aba42ef
JG
380 goto error;
381 }
382 mutex_unlock(&dev->io_mutex);
383
9ecf9b08 384#if IS_ENABLED(CONFIG_I2C)
324b04ba 385 retval = hdpvr_register_i2c_adapter(dev);
c457377a 386 if (retval < 0) {
7f2a06de 387 v4l2_err(&dev->v4l2_dev, "i2c adapter register failed\n");
c457377a
JG
388 goto error;
389 }
ea6c0603 390
7f2a06de
JW
391 client = hdpvr_register_ir_rx_i2c(dev);
392 if (!client) {
393 v4l2_err(&dev->v4l2_dev, "i2c IR RX device register failed\n");
304a0807 394 retval = -ENODEV;
7f2a06de
JW
395 goto reg_fail;
396 }
397
398 client = hdpvr_register_ir_tx_i2c(dev);
399 if (!client) {
400 v4l2_err(&dev->v4l2_dev, "i2c IR TX device register failed\n");
304a0807 401 retval = -ENODEV;
7f2a06de
JW
402 goto reg_fail;
403 }
324b04ba 404#endif
9aba42ef 405
280847b5
HV
406 retval = hdpvr_register_videodev(dev, &interface->dev,
407 video_nr[atomic_inc_return(&dev_nr)]);
408 if (retval < 0) {
409 v4l2_err(&dev->v4l2_dev, "registering videodev failed\n");
2e923a05 410 goto reg_fail;
280847b5
HV
411 }
412
9aba42ef 413 /* let the user know what node this device is now attached to */
38c7c036
LP
414 v4l2_info(&dev->v4l2_dev, "device now attached to %s\n",
415 video_device_node_name(dev->video_dev));
9aba42ef
JG
416 return 0;
417
7f2a06de 418reg_fail:
9ecf9b08 419#if IS_ENABLED(CONFIG_I2C)
7f2a06de
JW
420 i2c_del_adapter(&dev->i2c_adapter);
421#endif
9aba42ef
JG
422error:
423 if (dev) {
07204aea
PA
424 /* Destroy single thread */
425 if (dev->workqueue)
426 destroy_workqueue(dev->workqueue);
9aba42ef
JG
427 /* this frees allocated memory */
428 hdpvr_delete(dev);
429 }
430 return retval;
431}
432
433static void hdpvr_disconnect(struct usb_interface *interface)
434{
f2b305cd 435 struct hdpvr_device *dev = to_hdpvr_dev(usb_get_intfdata(interface));
9aba42ef 436
f2b305cd
HV
437 v4l2_info(&dev->v4l2_dev, "device %s disconnected\n",
438 video_device_node_name(dev->video_dev));
9aba42ef
JG
439 /* prevent more I/O from starting and stop any ongoing */
440 mutex_lock(&dev->io_mutex);
441 dev->status = STATUS_DISCONNECTED;
9aba42ef
JG
442 wake_up_interruptible(&dev->wait_data);
443 wake_up_interruptible(&dev->wait_buffer);
48f98f75 444 mutex_unlock(&dev->io_mutex);
f2b305cd 445 v4l2_device_disconnect(&dev->v4l2_dev);
9aba42ef
JG
446 msleep(100);
447 flush_workqueue(dev->workqueue);
48f98f75 448 mutex_lock(&dev->io_mutex);
9aba42ef 449 hdpvr_cancel_queue(dev);
9aba42ef 450 mutex_unlock(&dev->io_mutex);
9ecf9b08 451#if IS_ENABLED(CONFIG_I2C)
7f2a06de
JW
452 i2c_del_adapter(&dev->i2c_adapter);
453#endif
f2b305cd 454 video_unregister_device(dev->video_dev);
9aba42ef 455 atomic_dec(&dev_nr);
9aba42ef
JG
456}
457
458
459static struct usb_driver hdpvr_usb_driver = {
460 .name = "hdpvr",
461 .probe = hdpvr_probe,
462 .disconnect = hdpvr_disconnect,
463 .id_table = hdpvr_table,
464};
465
ecb3b2b3 466module_usb_driver(hdpvr_usb_driver);
9aba42ef
JG
467
468MODULE_LICENSE("GPL");
1990d50b 469MODULE_VERSION("0.2.1");
9aba42ef
JG
470MODULE_AUTHOR("Janne Grunau");
471MODULE_DESCRIPTION("Hauppauge HD PVR driver");
This page took 0.397216 seconds and 5 git commands to generate.