[PATCH] drivers cris: return on NULL dev_alloc_skb()
[linux-2.6] / drivers / bluetooth / bcm203x.c
1 /*
2  *
3  *  Broadcom Blutonium firmware driver
4  *
5  *  Copyright (C) 2003  Maxim Krasnyansky <maxk@qualcomm.com>
6  *  Copyright (C) 2003  Marcel Holtmann <marcel@holtmann.org>
7  *
8  *
9  *  This program is free software; you can redistribute it and/or modify
10  *  it under the terms of the GNU General Public License as published by
11  *  the Free Software Foundation; either version 2 of the License, or
12  *  (at your option) any later version.
13  *
14  *  This program is distributed in the hope that it will be useful,
15  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
16  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  *  GNU General Public License for more details.
18  *
19  *  You should have received a copy of the GNU General Public License
20  *  along with this program; if not, write to the Free Software
21  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
22  *
23  */
24
25 #include <linux/module.h>
26
27 #include <linux/kernel.h>
28 #include <linux/init.h>
29 #include <linux/slab.h>
30 #include <linux/types.h>
31 #include <linux/errno.h>
32
33 #include <linux/device.h>
34 #include <linux/firmware.h>
35
36 #include <linux/usb.h>
37
38 #include <net/bluetooth/bluetooth.h>
39
40 #ifndef CONFIG_BT_HCIBCM203X_DEBUG
41 #undef  BT_DBG
42 #define BT_DBG(D...)
43 #endif
44
45 #define VERSION "1.1"
46
47 static int ignore = 0;
48
49 static struct usb_device_id bcm203x_table[] = {
50         /* Broadcom Blutonium (BCM2033) */
51         { USB_DEVICE(0x0a5c, 0x2033) },
52
53         { }     /* Terminating entry */
54 };
55
56 MODULE_DEVICE_TABLE(usb, bcm203x_table);
57
58 #define BCM203X_ERROR           0
59 #define BCM203X_RESET           1
60 #define BCM203X_LOAD_MINIDRV    2
61 #define BCM203X_SELECT_MEMORY   3
62 #define BCM203X_CHECK_MEMORY    4
63 #define BCM203X_LOAD_FIRMWARE   5
64 #define BCM203X_CHECK_FIRMWARE  6
65
66 #define BCM203X_IN_EP           0x81
67 #define BCM203X_OUT_EP          0x02
68
69 struct bcm203x_data {
70         struct usb_device       *udev;
71
72         unsigned long           state;
73
74         struct work_struct      work;
75
76         struct urb              *urb;
77         unsigned char           *buffer;
78
79         unsigned char           *fw_data;
80         unsigned int            fw_size;
81         unsigned int            fw_sent;
82 };
83
84 static void bcm203x_complete(struct urb *urb)
85 {
86         struct bcm203x_data *data = urb->context;
87         struct usb_device *udev = urb->dev;
88         int len;
89
90         BT_DBG("udev %p urb %p", udev, urb);
91
92         if (urb->status) {
93                 BT_ERR("URB failed with status %d", urb->status);
94                 data->state = BCM203X_ERROR;
95                 return;
96         }
97
98         switch (data->state) {
99         case BCM203X_LOAD_MINIDRV:
100                 memcpy(data->buffer, "#", 1);
101
102                 usb_fill_bulk_urb(urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),
103                                 data->buffer, 1, bcm203x_complete, data);
104
105                 data->state = BCM203X_SELECT_MEMORY;
106
107                 schedule_work(&data->work);
108                 break;
109
110         case BCM203X_SELECT_MEMORY:
111                 usb_fill_int_urb(urb, udev, usb_rcvintpipe(udev, BCM203X_IN_EP),
112                                 data->buffer, 32, bcm203x_complete, data, 1);
113
114                 data->state = BCM203X_CHECK_MEMORY;
115
116                 if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)
117                         BT_ERR("Can't submit URB");
118                 break;
119
120         case BCM203X_CHECK_MEMORY:
121                 if (data->buffer[0] != '#') {
122                         BT_ERR("Memory select failed");
123                         data->state = BCM203X_ERROR;
124                         break;
125                 }
126
127                 data->state = BCM203X_LOAD_FIRMWARE;
128
129         case BCM203X_LOAD_FIRMWARE:
130                 if (data->fw_sent == data->fw_size) {
131                         usb_fill_int_urb(urb, udev, usb_rcvintpipe(udev, BCM203X_IN_EP),
132                                 data->buffer, 32, bcm203x_complete, data, 1);
133
134                         data->state = BCM203X_CHECK_FIRMWARE;
135                 } else {
136                         len = min_t(uint, data->fw_size - data->fw_sent, 4096);
137
138                         usb_fill_bulk_urb(urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),
139                                 data->fw_data + data->fw_sent, len, bcm203x_complete, data);
140
141                         data->fw_sent += len;
142                 }
143
144                 if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)
145                         BT_ERR("Can't submit URB");
146                 break;
147
148         case BCM203X_CHECK_FIRMWARE:
149                 if (data->buffer[0] != '.') {
150                         BT_ERR("Firmware loading failed");
151                         data->state = BCM203X_ERROR;
152                         break;
153                 }
154
155                 data->state = BCM203X_RESET;
156                 break;
157         }
158 }
159
160 static void bcm203x_work(void *user_data)
161 {
162         struct bcm203x_data *data = user_data;
163
164         if (usb_submit_urb(data->urb, GFP_ATOMIC) < 0)
165                 BT_ERR("Can't submit URB");
166 }
167
168 static int bcm203x_probe(struct usb_interface *intf, const struct usb_device_id *id)
169 {
170         const struct firmware *firmware;
171         struct usb_device *udev = interface_to_usbdev(intf);
172         struct bcm203x_data *data;
173         int size;
174
175         BT_DBG("intf %p id %p", intf, id);
176
177         if (ignore || (intf->cur_altsetting->desc.bInterfaceNumber != 0))
178                 return -ENODEV;
179
180         data = kzalloc(sizeof(*data), GFP_KERNEL);
181         if (!data) {
182                 BT_ERR("Can't allocate memory for data structure");
183                 return -ENOMEM;
184         }
185
186         data->udev  = udev;
187         data->state = BCM203X_LOAD_MINIDRV;
188
189         data->urb = usb_alloc_urb(0, GFP_KERNEL);
190         if (!data->urb) {
191                 BT_ERR("Can't allocate URB");
192                 kfree(data);
193                 return -ENOMEM;
194         }
195
196         if (request_firmware(&firmware, "BCM2033-MD.hex", &udev->dev) < 0) {
197                 BT_ERR("Mini driver request failed");
198                 usb_free_urb(data->urb);
199                 kfree(data);
200                 return -EIO;
201         }
202
203         BT_DBG("minidrv data %p size %d", firmware->data, firmware->size);
204
205         size = max_t(uint, firmware->size, 4096);
206
207         data->buffer = kmalloc(size, GFP_KERNEL);
208         if (!data->buffer) {
209                 BT_ERR("Can't allocate memory for mini driver");
210                 release_firmware(firmware);
211                 usb_free_urb(data->urb);
212                 kfree(data);
213                 return -ENOMEM;
214         }
215
216         memcpy(data->buffer, firmware->data, firmware->size);
217
218         usb_fill_bulk_urb(data->urb, udev, usb_sndbulkpipe(udev, BCM203X_OUT_EP),
219                         data->buffer, firmware->size, bcm203x_complete, data);
220
221         release_firmware(firmware);
222
223         if (request_firmware(&firmware, "BCM2033-FW.bin", &udev->dev) < 0) {
224                 BT_ERR("Firmware request failed");
225                 usb_free_urb(data->urb);
226                 kfree(data->buffer);
227                 kfree(data);
228                 return -EIO;
229         }
230
231         BT_DBG("firmware data %p size %d", firmware->data, firmware->size);
232
233         data->fw_data = kmalloc(firmware->size, GFP_KERNEL);
234         if (!data->fw_data) {
235                 BT_ERR("Can't allocate memory for firmware image");
236                 release_firmware(firmware);
237                 usb_free_urb(data->urb);
238                 kfree(data->buffer);
239                 kfree(data);
240                 return -ENOMEM;
241         }
242
243         memcpy(data->fw_data, firmware->data, firmware->size);
244         data->fw_size = firmware->size;
245         data->fw_sent = 0;
246
247         release_firmware(firmware);
248
249         INIT_WORK(&data->work, bcm203x_work, (void *) data);
250
251         usb_set_intfdata(intf, data);
252
253         schedule_work(&data->work);
254
255         return 0;
256 }
257
258 static void bcm203x_disconnect(struct usb_interface *intf)
259 {
260         struct bcm203x_data *data = usb_get_intfdata(intf);
261
262         BT_DBG("intf %p", intf);
263
264         usb_kill_urb(data->urb);
265
266         usb_set_intfdata(intf, NULL);
267
268         usb_free_urb(data->urb);
269         kfree(data->fw_data);
270         kfree(data->buffer);
271         kfree(data);
272 }
273
274 static struct usb_driver bcm203x_driver = {
275         .name           = "bcm203x",
276         .probe          = bcm203x_probe,
277         .disconnect     = bcm203x_disconnect,
278         .id_table       = bcm203x_table,
279 };
280
281 static int __init bcm203x_init(void)
282 {
283         int err;
284
285         BT_INFO("Broadcom Blutonium firmware driver ver %s", VERSION);
286
287         err = usb_register(&bcm203x_driver);
288         if (err < 0)
289                 BT_ERR("Failed to register USB driver");
290
291         return err;
292 }
293
294 static void __exit bcm203x_exit(void)
295 {
296         usb_deregister(&bcm203x_driver);
297 }
298
299 module_init(bcm203x_init);
300 module_exit(bcm203x_exit);
301
302 module_param(ignore, bool, 0644);
303 MODULE_PARM_DESC(ignore, "Ignore devices from the matching table");
304
305 MODULE_AUTHOR("Marcel Holtmann <marcel@holtmann.org>");
306 MODULE_DESCRIPTION("Broadcom Blutonium firmware driver ver " VERSION);
307 MODULE_VERSION(VERSION);
308 MODULE_LICENSE("GPL");