]> bbs.cooldavid.org Git - net-next-2.6.git/blame - drivers/usb/atm/cxacru.c
git://bbs.cooldavid.org / net-next-2.6.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
IRQ: Maintain regs pointer globally rather than passing to IRQ handlers
[net-next-2.6.git] / drivers / usb / atm / cxacru.c
CommitLineData
1b0e6146
DS		 1/******************************************************************************
2 * cxacru.c - driver for USB ADSL modems based on
3 * Conexant AccessRunner chipset
4 *
5 * Copyright (C) 2004 David Woodhouse, Duncan Sands, Roman Kagan
6 * Copyright (C) 2005 Duncan Sands, Roman Kagan (rkagan % mail ! ru)
7 *
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the Free
10 * Software Foundation; either version 2 of the License, or (at your option)
11 * any later version.
12 *
13 * This program is distributed in the hope that it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * more details.
17 *
18 * You should have received a copy of the GNU General Public License along with
19 * this program; if not, write to the Free Software Foundation, Inc., 59
20 * Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 *
22 ******************************************************************************/
23
24/*
25 * Credit is due for Josep Comas, who created the original patch to speedtch.c
26 * to support the different padding used by the AccessRunner (now generalized
27 * into usbatm), and the userspace firmware loading utility.
28 */
29
30#include <linux/module.h>
31#include <linux/moduleparam.h>
32#include <linux/kernel.h>
33#include <linux/timer.h>
34#include <linux/errno.h>
35#include <linux/slab.h>
36#include <linux/init.h>
37#include <linux/device.h> /* FIXME: linux/firmware.h should include it itself */
38#include <linux/firmware.h>
ab3c81ff 39#include <linux/mutex.h>
1b0e6146
DS		 40
41#include "usbatm.h"
42
43#define DRIVER_AUTHOR "Roman Kagan, David Woodhouse, Duncan Sands"
44#define DRIVER_VERSION "0.2"
45#define DRIVER_DESC "Conexant AccessRunner ADSL USB modem driver"
46
47static const char cxacru_driver_name[] = "cxacru";
48
49#define CXACRU_EP_CMD 0x01 /* Bulk/interrupt in/out */
50#define CXACRU_EP_DATA 0x02 /* Bulk in/out */
51
52#define CMD_PACKET_SIZE 64 /* Should be maxpacket(ep)? */
53
54/* Addresses */
55#define PLLFCLK_ADDR 0x00350068
56#define PLLBCLK_ADDR 0x0035006c
57#define SDRAMEN_ADDR 0x00350010
58#define FW_ADDR 0x00801000
59#define BR_ADDR 0x00180600
60#define SIG_ADDR 0x00180500
61#define BR_STACK_ADDR 0x00187f10
62
63/* Values */
64#define SDRAM_ENA 0x1
65
66#define CMD_TIMEOUT 2000 /* msecs */
67#define POLL_INTERVAL 5000 /* msecs */
68
69/* commands for interaction with the modem through the control channel before
70 * firmware is loaded */
71enum cxacru_fw_request {
72 FW_CMD_ERR,
73 FW_GET_VER,
74 FW_READ_MEM,
75 FW_WRITE_MEM,
76 FW_RMW_MEM,
77 FW_CHECKSUM_MEM,
78 FW_GOTO_MEM,
79};
80
81/* commands for interaction with the modem through the control channel once
82 * firmware is loaded */
83enum cxacru_cm_request {
84 CM_REQUEST_UNDEFINED = 0x80,
85 CM_REQUEST_TEST,
86 CM_REQUEST_CHIP_GET_MAC_ADDRESS,
87 CM_REQUEST_CHIP_GET_DP_VERSIONS,
88 CM_REQUEST_CHIP_ADSL_LINE_START,
89 CM_REQUEST_CHIP_ADSL_LINE_STOP,
90 CM_REQUEST_CHIP_ADSL_LINE_GET_STATUS,
91 CM_REQUEST_CHIP_ADSL_LINE_GET_SPEED,
92 CM_REQUEST_CARD_INFO_GET,
93 CM_REQUEST_CARD_DATA_GET,
94 CM_REQUEST_CARD_DATA_SET,
95 CM_REQUEST_COMMAND_HW_IO,
96 CM_REQUEST_INTERFACE_HW_IO,
97 CM_REQUEST_CARD_SERIAL_DATA_PATH_GET,
98 CM_REQUEST_CARD_SERIAL_DATA_PATH_SET,
99 CM_REQUEST_CARD_CONTROLLER_VERSION_GET,
100 CM_REQUEST_CARD_GET_STATUS,
101 CM_REQUEST_CARD_GET_MAC_ADDRESS,
102 CM_REQUEST_CARD_GET_DATA_LINK_STATUS,
103 CM_REQUEST_MAX,
104};
105
106/* reply codes to the commands above */
107enum cxacru_cm_status {
108 CM_STATUS_UNDEFINED,
109 CM_STATUS_SUCCESS,
110 CM_STATUS_ERROR,
111 CM_STATUS_UNSUPPORTED,
112 CM_STATUS_UNIMPLEMENTED,
113 CM_STATUS_PARAMETER_ERROR,
114 CM_STATUS_DBG_LOOPBACK,
115 CM_STATUS_MAX,
116};
117
118/* indices into CARD_INFO_GET return array */
119enum cxacru_info_idx {
120 CXINF_DOWNSTREAM_RATE,
121 CXINF_UPSTREAM_RATE,
122 CXINF_LINK_STATUS,
123 CXINF_LINE_STATUS,
124 CXINF_MAC_ADDRESS_HIGH,
125 CXINF_MAC_ADDRESS_LOW,
126 CXINF_UPSTREAM_SNR_MARGIN,
127 CXINF_DOWNSTREAM_SNR_MARGIN,
128 CXINF_UPSTREAM_ATTENUATION,
129 CXINF_DOWNSTREAM_ATTENUATION,
130 CXINF_TRANSMITTER_POWER,
131 CXINF_UPSTREAM_BITS_PER_FRAME,
132 CXINF_DOWNSTREAM_BITS_PER_FRAME,
133 CXINF_STARTUP_ATTEMPTS,
134 CXINF_UPSTREAM_CRC_ERRORS,
135 CXINF_DOWNSTREAM_CRC_ERRORS,
136 CXINF_UPSTREAM_FEC_ERRORS,
137 CXINF_DOWNSTREAM_FEC_ERRORS,
138 CXINF_UPSTREAM_HEC_ERRORS,
139 CXINF_DOWNSTREAM_HEC_ERRORS,
140 CXINF_LINE_STARTABLE,
141 CXINF_MODULATION,
142 CXINF_ADSL_HEADEND,
143 CXINF_ADSL_HEADEND_ENVIRONMENT,
144 CXINF_CONTROLLER_VERSION,
145 /* dunno what the missing two mean */
146 CXINF_MAX = 0x1c,
147};
148
149struct cxacru_modem_type {
150 u32 pll_f_clk;
151 u32 pll_b_clk;
152 int boot_rom_patch;
153};
154
155struct cxacru_data {
156 struct usbatm_data *usbatm;
157
158 const struct cxacru_modem_type *modem_type;
159
160 int line_status;
161 struct work_struct poll_work;
162
163 /* contol handles */
ab3c81ff 164 struct mutex cm_serialize;
1b0e6146
DS		 165 u8 *rcv_buf;
166 u8 *snd_buf;
167 struct urb *rcv_urb;
168 struct urb *snd_urb;
169 struct completion rcv_done;
170 struct completion snd_done;
171};
172
173/* the following three functions are stolen from drivers/usb/core/message.c */
7d12e780 174static void cxacru_blocking_completion(struct urb *urb)
1b0e6146
DS		 175{
176 complete((struct completion *)urb->context);
177}
178
179static void cxacru_timeout_kill(unsigned long data)
180{
181 usb_unlink_urb((struct urb *) data);
182}
183
184static int cxacru_start_wait_urb(struct urb *urb, struct completion *done,
185 int* actual_length)
186{
187 struct timer_list timer;
188 int status;
189
190 init_timer(&timer);
191 timer.expires = jiffies + msecs_to_jiffies(CMD_TIMEOUT);
192 timer.data = (unsigned long) urb;
193 timer.function = cxacru_timeout_kill;
194 add_timer(&timer);
195 wait_for_completion(done);
196 status = urb->status;
197 if (status == -ECONNRESET)
198 status = -ETIMEDOUT;
199 del_timer_sync(&timer);
200
201 if (actual_length)
202 *actual_length = urb->actual_length;
203 return status;
204}
205
206static int cxacru_cm(struct cxacru_data *instance, enum cxacru_cm_request cm,
207 u8 *wdata, int wsize, u8 *rdata, int rsize)
208{
209 int ret, actlen;
210 int offb, offd;
211 const int stride = CMD_PACKET_SIZE - 4;
212 u8 *wbuf = instance->snd_buf;
213 u8 *rbuf = instance->rcv_buf;
214 int wbuflen = ((wsize - 1) / stride + 1) * CMD_PACKET_SIZE;
215 int rbuflen = ((rsize - 1) / stride + 1) * CMD_PACKET_SIZE;
216
217 if (wbuflen > PAGE_SIZE || rbuflen > PAGE_SIZE) {
218 dbg("too big transfer requested");
219 ret = -ENOMEM;
220 goto fail;
221 }
222
ab3c81ff 223 mutex_lock(&instance->cm_serialize);
1b0e6146
DS		 224
225 /* submit reading urb before the writing one */
226 init_completion(&instance->rcv_done);
227 ret = usb_submit_urb(instance->rcv_urb, GFP_KERNEL);
228 if (ret < 0) {
229 dbg("submitting read urb for cm %#x failed", cm);
230 ret = ret;
231 goto fail;
232 }
233
234 memset(wbuf, 0, wbuflen);
235 /* handle wsize == 0 */
236 wbuf[0] = cm;
237 for (offb = offd = 0; offd < wsize; offd += stride, offb += CMD_PACKET_SIZE) {
238 wbuf[offb] = cm;
239 memcpy(wbuf + offb + 4, wdata + offd, min_t(int, stride, wsize - offd));
240 }
241
242 instance->snd_urb->transfer_buffer_length = wbuflen;
243 init_completion(&instance->snd_done);
244 ret = usb_submit_urb(instance->snd_urb, GFP_KERNEL);
245 if (ret < 0) {
246 dbg("submitting write urb for cm %#x failed", cm);
247 ret = ret;
248 goto fail;
249 }
250
251 ret = cxacru_start_wait_urb(instance->snd_urb, &instance->snd_done, NULL);
252 if (ret < 0) {
253 dbg("sending cm %#x failed", cm);
254 ret = ret;
255 goto fail;
256 }
257
258 ret = cxacru_start_wait_urb(instance->rcv_urb, &instance->rcv_done, &actlen);
259 if (ret < 0) {
260 dbg("receiving cm %#x failed", cm);
261 ret = ret;
262 goto fail;
263 }
264 if (actlen % CMD_PACKET_SIZE || !actlen) {
265 dbg("response is not a positive multiple of %d: %#x",
266 CMD_PACKET_SIZE, actlen);
267 ret = -EIO;
268 goto fail;
269 }
270
271 /* check the return status and copy the data to the output buffer, if needed */
272 for (offb = offd = 0; offd < rsize && offb < actlen; offb += CMD_PACKET_SIZE) {
273 if (rbuf[offb] != cm) {
274 dbg("wrong cm %#x in response", rbuf[offb]);
275 ret = -EIO;
276 goto fail;
277 }
278 if (rbuf[offb + 1] != CM_STATUS_SUCCESS) {
279 dbg("response failed: %#x", rbuf[offb + 1]);
280 ret = -EIO;
281 goto fail;
282 }
283 if (offd >= rsize)
284 break;
285 memcpy(rdata + offd, rbuf + offb + 4, min_t(int, stride, rsize - offd));
286 offd += stride;
287 }
288
289 ret = offd;
290 dbg("cm %#x", cm);
291fail:
ab3c81ff 292 mutex_unlock(&instance->cm_serialize);
1b0e6146
DS		 293 return ret;
294}
295
296static int cxacru_cm_get_array(struct cxacru_data *instance, enum cxacru_cm_request cm,
297 u32 *data, int size)
298{
299 int ret, len;
300 u32 *buf;
301 int offb, offd;
302 const int stride = CMD_PACKET_SIZE / (4 * 2) - 1;
303 int buflen = ((size - 1) / stride + 1 + size * 2) * 4;
304
305 buf = kmalloc(buflen, GFP_KERNEL);
306 if (!buf)
307 return -ENOMEM;
308
309 ret = cxacru_cm(instance, cm, NULL, 0, (u8 *) buf, buflen);
310 if (ret < 0)
311 goto cleanup;
312
313 /* len > 0 && len % 4 == 0 guaranteed by cxacru_cm() */
314 len = ret / 4;
315 for (offb = 0; offb < len; ) {
316 int l = le32_to_cpu(buf[offb++]);
317 if (l > stride || l > (len - offb) / 2) {
318 dbg("wrong data length %#x in response", l);
319 ret = -EIO;
320 goto cleanup;
321 }
322 while (l--) {
323 offd = le32_to_cpu(buf[offb++]);
324 if (offd >= size) {
325 dbg("wrong index %#x in response", offd);
326 ret = -EIO;
327 goto cleanup;
328 }
329 data[offd] = le32_to_cpu(buf[offb++]);
330 }
331 }
332
333 ret = 0;
334
335cleanup:
336 kfree(buf);
337 return ret;
338}
339
340static int cxacru_card_status(struct cxacru_data *instance)
341{
342 int ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_STATUS, NULL, 0, NULL, 0);
343 if (ret < 0) { /* firmware not loaded */
344 dbg("cxacru_adsl_start: CARD_GET_STATUS returned %d", ret);
345 return ret;
346 }
347 return 0;
348}
349
350static void cxacru_poll_status(struct cxacru_data *instance);
351
352static int cxacru_atm_start(struct usbatm_data *usbatm_instance,
353 struct atm_dev *atm_dev)
354{
355 struct cxacru_data *instance = usbatm_instance->driver_data;
1b0e6146
DS		 356 /*
357 struct atm_dev *atm_dev = usbatm_instance->atm_dev;
358 */
359 int ret;
360
361 dbg("cxacru_atm_start");
362
363 /* Read MAC address */
364 ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_MAC_ADDRESS, NULL, 0,
365 atm_dev->esi, sizeof(atm_dev->esi));
366 if (ret < 0) {
0ec3c7e8 367 atm_err(usbatm_instance, "cxacru_atm_start: CARD_GET_MAC_ADDRESS returned %d\n", ret);
1b0e6146
DS		 368 return ret;
369 }
370
371 /* start ADSL */
372 ret = cxacru_cm(instance, CM_REQUEST_CHIP_ADSL_LINE_START, NULL, 0, NULL, 0);
373 if (ret < 0) {
0ec3c7e8 374 atm_err(usbatm_instance, "cxacru_atm_start: CHIP_ADSL_LINE_START returned %d\n", ret);
1b0e6146
DS		 375 return ret;
376 }
377
378 /* Start status polling */
379 cxacru_poll_status(instance);
380 return 0;
381}
382
383static void cxacru_poll_status(struct cxacru_data *instance)
384{
385 u32 buf[CXINF_MAX] = {};
0ec3c7e8
DS		 386 struct usbatm_data *usbatm = instance->usbatm;
387 struct atm_dev *atm_dev = usbatm->atm_dev;
1b0e6146
DS		 388 int ret;
389
390 ret = cxacru_cm_get_array(instance, CM_REQUEST_CARD_INFO_GET, buf, CXINF_MAX);
391 if (ret < 0) {
0ec3c7e8 392 atm_warn(usbatm, "poll status: error %d\n", ret);
1b0e6146
DS		 393 goto reschedule;
394 }
395
396 if (instance->line_status == buf[CXINF_LINE_STATUS])
397 goto reschedule;
398
399 instance->line_status = buf[CXINF_LINE_STATUS];
400 switch (instance->line_status) {
401 case 0:
402 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 403 atm_info(usbatm, "ADSL line: down\n");
1b0e6146
DS		 404 break;
405
406 case 1:
407 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 408 atm_info(usbatm, "ADSL line: attempting to activate\n");
1b0e6146
DS		 409 break;
410
411 case 2:
412 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 413 atm_info(usbatm, "ADSL line: training\n");
1b0e6146
DS		 414 break;
415
416 case 3:
417 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 418 atm_info(usbatm, "ADSL line: channel analysis\n");
1b0e6146
DS		 419 break;
420
421 case 4:
422 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 423 atm_info(usbatm, "ADSL line: exchange\n");
1b0e6146
DS		 424 break;
425
426 case 5:
427 atm_dev->link_rate = buf[CXINF_DOWNSTREAM_RATE] * 1000 / 424;
428 atm_dev->signal = ATM_PHY_SIG_FOUND;
429
0ec3c7e8 430 atm_info(usbatm, "ADSL line: up (%d kb/s down | %d kb/s up)\n",
1b0e6146
DS		 431 buf[CXINF_DOWNSTREAM_RATE], buf[CXINF_UPSTREAM_RATE]);
432 break;
433
434 case 6:
435 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 436 atm_info(usbatm, "ADSL line: waiting\n");
1b0e6146
DS		 437 break;
438
439 case 7:
440 atm_dev->signal = ATM_PHY_SIG_LOST;
0ec3c7e8 441 atm_info(usbatm, "ADSL line: initializing\n");
1b0e6146
DS		 442 break;
443
444 default:
445 atm_dev->signal = ATM_PHY_SIG_UNKNOWN;
0ec3c7e8 446 atm_info(usbatm, "Unknown line state %02x\n", instance->line_status);
1b0e6146
DS		 447 break;
448 }
449reschedule:
450 schedule_delayed_work(&instance->poll_work, msecs_to_jiffies(POLL_INTERVAL));
451}
452
453static int cxacru_fw(struct usb_device *usb_dev, enum cxacru_fw_request fw,
454 u8 code1, u8 code2, u32 addr, u8 *data, int size)
455{
456 int ret;
457 u8 *buf;
458 int offd, offb;
459 const int stride = CMD_PACKET_SIZE - 8;
460
461 buf = (u8 *) __get_free_page(GFP_KERNEL);
462 if (!buf)
463 return -ENOMEM;
464
465 offb = offd = 0;
466 do {
467 int l = min_t(int, stride, size - offd);
468 buf[offb++] = fw;
469 buf[offb++] = l;
470 buf[offb++] = code1;
471 buf[offb++] = code2;
472 *((u32 *) (buf + offb)) = cpu_to_le32(addr);
473 offb += 4;
474 addr += l;
475 if(l)
476 memcpy(buf + offb, data + offd, l);
477 if (l < stride)
478 memset(buf + offb + l, 0, stride - l);
479 offb += stride;
480 offd += stride;
481 if ((offb >= PAGE_SIZE) || (offd >= size)) {
482 ret = usb_bulk_msg(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_CMD),
483 buf, offb, NULL, CMD_TIMEOUT);
484 if (ret < 0) {
485 dbg("sending fw %#x failed", fw);
486 goto cleanup;
487 }
488 offb = 0;
489 }
490 } while(offd < size);
491 dbg("sent fw %#x", fw);
492
493 ret = 0;
494
495cleanup:
496 free_page((unsigned long) buf);
497 return ret;
498}
499
500static void cxacru_upload_firmware(struct cxacru_data *instance,
501 const struct firmware *fw,
502 const struct firmware *bp,
503 const struct firmware *cf)
504{
505 int ret;
506 int off;
0ec3c7e8
DS		 507 struct usbatm_data *usbatm = instance->usbatm;
508 struct usb_device *usb_dev = usbatm->usb_dev;
1b0e6146
DS		 509 u16 signature[] = { usb_dev->descriptor.idVendor, usb_dev->descriptor.idProduct };
510 u32 val;
511
512 dbg("cxacru_upload_firmware");
513
514 /* FirmwarePllFClkValue */
515 val = cpu_to_le32(instance->modem_type->pll_f_clk);
516 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, PLLFCLK_ADDR, (u8 *) &val, 4);
517 if (ret) {
0ec3c7e8 518 usb_err(usbatm, "FirmwarePllFClkValue failed: %d\n", ret);
1b0e6146
DS		 519 return;
520 }
521
522 /* FirmwarePllBClkValue */
523 val = cpu_to_le32(instance->modem_type->pll_b_clk);
524 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, PLLBCLK_ADDR, (u8 *) &val, 4);
525 if (ret) {
0ec3c7e8 526 usb_err(usbatm, "FirmwarePllBClkValue failed: %d\n", ret);
1b0e6146
DS		 527 return;
528 }
529
530 /* Enable SDRAM */
531 val = cpu_to_le32(SDRAM_ENA);
532 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, SDRAMEN_ADDR, (u8 *) &val, 4);
533 if (ret) {
0ec3c7e8 534 usb_err(usbatm, "Enable SDRAM failed: %d\n", ret);
1b0e6146
DS		 535 return;
536 }
537
538 /* Firmware */
539 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, FW_ADDR, fw->data, fw->size);
540 if (ret) {
0ec3c7e8 541 usb_err(usbatm, "Firmware upload failed: %d\n", ret);
1b0e6146
DS		 542 return;
543 }
544
545 /* Boot ROM patch */
546 if (instance->modem_type->boot_rom_patch) {
547 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, BR_ADDR, bp->data, bp->size);
548 if (ret) {
0ec3c7e8 549 usb_err(usbatm, "Boot ROM patching failed: %d\n", ret);
1b0e6146
DS		 550 return;
551 }
552 }
553
554 /* Signature */
555 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, SIG_ADDR, (u8 *) signature, 4);
556 if (ret) {
0ec3c7e8 557 usb_err(usbatm, "Signature storing failed: %d\n", ret);
1b0e6146
DS		 558 return;
559 }
560
561 if (instance->modem_type->boot_rom_patch) {
562 val = cpu_to_le32(BR_ADDR);
563 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, BR_STACK_ADDR, (u8 *) &val, 4);
564 }
565 else {
566 ret = cxacru_fw(usb_dev, FW_GOTO_MEM, 0x0, 0x0, FW_ADDR, NULL, 0);
567 }
568 if (ret) {
0ec3c7e8 569 usb_err(usbatm, "Passing control to firmware failed: %d\n", ret);
1b0e6146
DS		 570 return;
571 }
572
573 /* Delay to allow firmware to start up. */
574 msleep_interruptible(1000);
575
576 usb_clear_halt(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_CMD));
577 usb_clear_halt(usb_dev, usb_rcvbulkpipe(usb_dev, CXACRU_EP_CMD));
578 usb_clear_halt(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_DATA));
579 usb_clear_halt(usb_dev, usb_rcvbulkpipe(usb_dev, CXACRU_EP_DATA));
580
581 ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_STATUS, NULL, 0, NULL, 0);
582 if (ret < 0) {
0ec3c7e8 583 usb_err(usbatm, "modem failed to initialize: %d\n", ret);
1b0e6146
DS		 584 return;
585 }
586
587 /* Load config data (le32), doing one packet at a time */
588 if (cf)
589 for (off = 0; off < cf->size / 4; ) {
590 u32 buf[CMD_PACKET_SIZE / 4 - 1];
591 int i, len = min_t(int, cf->size / 4 - off, CMD_PACKET_SIZE / 4 / 2 - 1);
592 buf[0] = cpu_to_le32(len);
593 for (i = 0; i < len; i++, off++) {
594 buf[i * 2 + 1] = cpu_to_le32(off);
595 memcpy(buf + i * 2 + 2, cf->data + off * 4, 4);
596 }
597 ret = cxacru_cm(instance, CM_REQUEST_CARD_DATA_SET,
598 (u8 *) buf, len, NULL, 0);
599 if (ret < 0) {
0ec3c7e8 600 usb_err(usbatm, "load config data failed: %d\n", ret);
1b0e6146
DS		 601 return;
602 }
603 }
604
605 msleep_interruptible(4000);
606}
607
608static int cxacru_find_firmware(struct cxacru_data *instance,
609 char* phase, const struct firmware **fw_p)
610{
0ec3c7e8
DS		 611 struct usbatm_data *usbatm = instance->usbatm;
612 struct device *dev = &usbatm->usb_intf->dev;
1b0e6146
DS		 613 char buf[16];
614
615 sprintf(buf, "cxacru-%s.bin", phase);
616 dbg("cxacru_find_firmware: looking for %s", buf);
617
618 if (request_firmware(fw_p, buf, dev)) {
0ec3c7e8 619 usb_dbg(usbatm, "no stage %s firmware found\n", phase);
1b0e6146
DS		 620 return -ENOENT;
621 }
622
0ec3c7e8 623 usb_info(usbatm, "found firmware %s\n", buf);
1b0e6146
DS		 624
625 return 0;
626}
627
628static int cxacru_heavy_init(struct usbatm_data *usbatm_instance,
629 struct usb_interface *usb_intf)
630{
1b0e6146
DS		 631 const struct firmware *fw, *bp, *cf;
632 struct cxacru_data *instance = usbatm_instance->driver_data;
633
634 int ret = cxacru_find_firmware(instance, "fw", &fw);
635 if (ret) {
0ec3c7e8 636 usb_warn(usbatm_instance, "firmware (cxacru-fw.bin) unavailable (system misconfigured?)\n");
1b0e6146
DS		 637 return ret;
638 }
639
640 if (instance->modem_type->boot_rom_patch) {
641 ret = cxacru_find_firmware(instance, "bp", &bp);
642 if (ret) {
0ec3c7e8 643 usb_warn(usbatm_instance, "boot ROM patch (cxacru-bp.bin) unavailable (system misconfigured?)\n");
1b0e6146
DS		 644 release_firmware(fw);
645 return ret;
646 }
647 }
648
649 if (cxacru_find_firmware(instance, "cf", &cf)) /* optional */
650 cf = NULL;
651
652 cxacru_upload_firmware(instance, fw, bp, cf);
653
654 if (cf)
655 release_firmware(cf);
656 if (instance->modem_type->boot_rom_patch)
657 release_firmware(bp);
658 release_firmware(fw);
659
660 ret = cxacru_card_status(instance);
661 if (ret)
662 dbg("modem initialisation failed");
663 else
664 dbg("done setting up the modem");
665
666 return ret;
667}
668
669static int cxacru_bind(struct usbatm_data *usbatm_instance,
35644b0c 670 struct usb_interface *intf, const struct usb_device_id *id)
1b0e6146
DS		 671{
672 struct cxacru_data *instance;
673 struct usb_device *usb_dev = interface_to_usbdev(intf);
674 int ret;
675
676 /* instance init */
9a734efe 677 instance = kzalloc(sizeof(*instance), GFP_KERNEL);
1b0e6146
DS		 678 if (!instance) {
679 dbg("cxacru_bind: no memory for instance data");
680 return -ENOMEM;
681 }
682
1b0e6146
DS		 683 instance->usbatm = usbatm_instance;
684 instance->modem_type = (struct cxacru_modem_type *) id->driver_info;
685
686 instance->rcv_buf = (u8 *) __get_free_page(GFP_KERNEL);
687 if (!instance->rcv_buf) {
688 dbg("cxacru_bind: no memory for rcv_buf");
689 ret = -ENOMEM;
690 goto fail;
691 }
692 instance->snd_buf = (u8 *) __get_free_page(GFP_KERNEL);
693 if (!instance->snd_buf) {
694 dbg("cxacru_bind: no memory for snd_buf");
695 ret = -ENOMEM;
696 goto fail;
697 }
698 instance->rcv_urb = usb_alloc_urb(0, GFP_KERNEL);
699 if (!instance->rcv_urb) {
700 dbg("cxacru_bind: no memory for rcv_urb");
701 ret = -ENOMEM;
702 goto fail;
703 }
704 instance->snd_urb = usb_alloc_urb(0, GFP_KERNEL);
705 if (!instance->snd_urb) {
706 dbg("cxacru_bind: no memory for snd_urb");
707 ret = -ENOMEM;
708 goto fail;
709 }
710
711 usb_fill_int_urb(instance->rcv_urb,
712 usb_dev, usb_rcvintpipe(usb_dev, CXACRU_EP_CMD),
713 instance->rcv_buf, PAGE_SIZE,
714 cxacru_blocking_completion, &instance->rcv_done, 1);
1b0e6146
DS		 715
716 usb_fill_int_urb(instance->snd_urb,
717 usb_dev, usb_sndintpipe(usb_dev, CXACRU_EP_CMD),
718 instance->snd_buf, PAGE_SIZE,
719 cxacru_blocking_completion, &instance->snd_done, 4);
1b0e6146 720
ab3c81ff 721 mutex_init(&instance->cm_serialize);
1b0e6146
DS		 722
723 INIT_WORK(&instance->poll_work, (void *)cxacru_poll_status, instance);
724
725 usbatm_instance->driver_data = instance;
726
35644b0c 727 usbatm_instance->flags = (cxacru_card_status(instance) ? 0 : UDSL_SKIP_HEAVY_INIT);
1b0e6146
DS		 728
729 return 0;
730
731 fail:
732 free_page((unsigned long) instance->snd_buf);
733 free_page((unsigned long) instance->rcv_buf);
734 usb_free_urb(instance->snd_urb);
735 usb_free_urb(instance->rcv_urb);
736 kfree(instance);
737
738 return ret;
739}
740
741static void cxacru_unbind(struct usbatm_data *usbatm_instance,
742 struct usb_interface *intf)
743{
744 struct cxacru_data *instance = usbatm_instance->driver_data;
745
746 dbg("cxacru_unbind entered");
747
748 if (!instance) {
749 dbg("cxacru_unbind: NULL instance!");
750 return;
751 }
752
753 while (!cancel_delayed_work(&instance->poll_work))
754 flush_scheduled_work();
755
756 usb_kill_urb(instance->snd_urb);
757 usb_kill_urb(instance->rcv_urb);
758 usb_free_urb(instance->snd_urb);
759 usb_free_urb(instance->rcv_urb);
760
761 free_page((unsigned long) instance->snd_buf);
762 free_page((unsigned long) instance->rcv_buf);
763 kfree(instance);
764
765 usbatm_instance->driver_data = NULL;
766}
767
768static const struct cxacru_modem_type cxacru_cafe = {
769 .pll_f_clk = 0x02d874df,
770 .pll_b_clk = 0x0196a51a,
771 .boot_rom_patch = 1,
772};
773
774static const struct cxacru_modem_type cxacru_cb00 = {
775 .pll_f_clk = 0x5,
776 .pll_b_clk = 0x3,
777 .boot_rom_patch = 0,
778};
779
780static const struct usb_device_id cxacru_usb_ids[] = {
781 { /* V = Conexant P = ADSL modem (Euphrates project) */
782 USB_DEVICE(0x0572, 0xcafe), .driver_info = (unsigned long) &cxacru_cafe
783 },
784 { /* V = Conexant P = ADSL modem (Hasbani project) */
785 USB_DEVICE(0x0572, 0xcb00), .driver_info = (unsigned long) &cxacru_cb00
786 },
787 { /* V = Conexant P = ADSL modem */
788 USB_DEVICE(0x0572, 0xcb01), .driver_info = (unsigned long) &cxacru_cb00
789 },
0ec3c7e8
DS		 790 { /* V = Conexant P = ADSL modem (Well PTI-800) */
791 USB_DEVICE(0x0572, 0xcb02), .driver_info = (unsigned long) &cxacru_cb00
792 },
1b0e6146
DS		 793 { /* V = Conexant P = ADSL modem */
794 USB_DEVICE(0x0572, 0xcb06), .driver_info = (unsigned long) &cxacru_cb00
795 },
796 { /* V = Olitec P = ADSL modem version 2 */
797 USB_DEVICE(0x08e3, 0x0100), .driver_info = (unsigned long) &cxacru_cafe
798 },
799 { /* V = Olitec P = ADSL modem version 3 */
800 USB_DEVICE(0x08e3, 0x0102), .driver_info = (unsigned long) &cxacru_cb00
801 },
802 { /* V = Trust/Amigo Technology Co. P = AMX-CA86U */
803 USB_DEVICE(0x0eb0, 0x3457), .driver_info = (unsigned long) &cxacru_cafe
804 },
805 { /* V = Zoom P = 5510 */
806 USB_DEVICE(0x1803, 0x5510), .driver_info = (unsigned long) &cxacru_cb00
807 },
808 { /* V = Draytek P = Vigor 318 */
809 USB_DEVICE(0x0675, 0x0200), .driver_info = (unsigned long) &cxacru_cb00
810 },
811 { /* V = Zyxel P = 630-C1 aka OMNI ADSL USB (Annex A) */
812 USB_DEVICE(0x0586, 0x330a), .driver_info = (unsigned long) &cxacru_cb00
813 },
814 { /* V = Zyxel P = 630-C3 aka OMNI ADSL USB (Annex B) */
815 USB_DEVICE(0x0586, 0x330b), .driver_info = (unsigned long) &cxacru_cb00
816 },
817 { /* V = Aethra P = Starmodem UM1020 */
818 USB_DEVICE(0x0659, 0x0020), .driver_info = (unsigned long) &cxacru_cb00
819 },
820 { /* V = Aztech Systems P = ? AKA Pirelli AUA-010 */
821 USB_DEVICE(0x0509, 0x0812), .driver_info = (unsigned long) &cxacru_cb00
822 },
823 { /* V = Netopia P = Cayman 3341(Annex A)/3351(Annex B) */
824 USB_DEVICE(0x100d, 0xcb01), .driver_info = (unsigned long) &cxacru_cb00
825 },
826 { /* V = Netopia P = Cayman 3342(Annex A)/3352(Annex B) */
827 USB_DEVICE(0x100d, 0x3342), .driver_info = (unsigned long) &cxacru_cb00
828 },
829 {}
830};
831
832MODULE_DEVICE_TABLE(usb, cxacru_usb_ids);
833
834static struct usbatm_driver cxacru_driver = {
1b0e6146
DS		 835 .driver_name = cxacru_driver_name,
836 .bind = cxacru_bind,
837 .heavy_init = cxacru_heavy_init,
838 .unbind = cxacru_unbind,
839 .atm_start = cxacru_atm_start,
80aae7a1
DS		 840 .bulk_in = CXACRU_EP_DATA,
841 .bulk_out = CXACRU_EP_DATA,
1b0e6146
DS		 842 .rx_padding = 3,
843 .tx_padding = 11,
844};
845
846static int cxacru_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
847{
848 return usbatm_usb_probe(intf, id, &cxacru_driver);
849}
850
851static struct usb_driver cxacru_usb_driver = {
1b0e6146
DS		 852 .name = cxacru_driver_name,
853 .probe = cxacru_usb_probe,
854 .disconnect = usbatm_usb_disconnect,
855 .id_table = cxacru_usb_ids
856};
857
858static int __init cxacru_init(void)
859{
860 return usb_register(&cxacru_usb_driver);
861}
862
863static void __exit cxacru_cleanup(void)
864{
865 usb_deregister(&cxacru_usb_driver);
866}
867
868module_init(cxacru_init);
869module_exit(cxacru_cleanup);
870
871MODULE_AUTHOR(DRIVER_AUTHOR);
872MODULE_DESCRIPTION(DRIVER_DESC);
873MODULE_LICENSE("GPL");
874MODULE_VERSION(DRIVER_VERSION);
Clone of davem's net-next-2.6 tree