1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31#include <linux/module.h>
32#include <linux/moduleparam.h>
33#include <linux/kernel.h>
34#include <linux/timer.h>
35#include <linux/errno.h>
36#include <linux/slab.h>
37#include <linux/init.h>
38#include <linux/device.h>
39#include <linux/firmware.h>
40#include <linux/mutex.h>
41#include <asm/unaligned.h>
42
43#include "usbatm.h"
44
45#define DRIVER_AUTHOR "Roman Kagan, David Woodhouse, Duncan Sands, Simon Arlott"
46#define DRIVER_VERSION "0.3"
47#define DRIVER_DESC "Conexant AccessRunner ADSL USB modem driver"
48
49static const char cxacru_driver_name[] = "cxacru";
50
51#define CXACRU_EP_CMD 0x01
52#define CXACRU_EP_DATA 0x02
53
54#define CMD_PACKET_SIZE 64
55
56
57#define PLLFCLK_ADDR 0x00350068
58#define PLLBCLK_ADDR 0x0035006c
59#define SDRAMEN_ADDR 0x00350010
60#define FW_ADDR 0x00801000
61#define BR_ADDR 0x00180600
62#define SIG_ADDR 0x00180500
63#define BR_STACK_ADDR 0x00187f10
64
65
66#define SDRAM_ENA 0x1
67
68#define CMD_TIMEOUT 2000
69#define POLL_INTERVAL 1
70
71
72
73enum cxacru_fw_request {
74 FW_CMD_ERR,
75 FW_GET_VER,
76 FW_READ_MEM,
77 FW_WRITE_MEM,
78 FW_RMW_MEM,
79 FW_CHECKSUM_MEM,
80 FW_GOTO_MEM,
81};
82
83
84
85enum cxacru_cm_request {
86 CM_REQUEST_UNDEFINED = 0x80,
87 CM_REQUEST_TEST,
88 CM_REQUEST_CHIP_GET_MAC_ADDRESS,
89 CM_REQUEST_CHIP_GET_DP_VERSIONS,
90 CM_REQUEST_CHIP_ADSL_LINE_START,
91 CM_REQUEST_CHIP_ADSL_LINE_STOP,
92 CM_REQUEST_CHIP_ADSL_LINE_GET_STATUS,
93 CM_REQUEST_CHIP_ADSL_LINE_GET_SPEED,
94 CM_REQUEST_CARD_INFO_GET,
95 CM_REQUEST_CARD_DATA_GET,
96 CM_REQUEST_CARD_DATA_SET,
97 CM_REQUEST_COMMAND_HW_IO,
98 CM_REQUEST_INTERFACE_HW_IO,
99 CM_REQUEST_CARD_SERIAL_DATA_PATH_GET,
100 CM_REQUEST_CARD_SERIAL_DATA_PATH_SET,
101 CM_REQUEST_CARD_CONTROLLER_VERSION_GET,
102 CM_REQUEST_CARD_GET_STATUS,
103 CM_REQUEST_CARD_GET_MAC_ADDRESS,
104 CM_REQUEST_CARD_GET_DATA_LINK_STATUS,
105 CM_REQUEST_MAX,
106};
107
108
109enum cxacru_cm_status {
110 CM_STATUS_UNDEFINED,
111 CM_STATUS_SUCCESS,
112 CM_STATUS_ERROR,
113 CM_STATUS_UNSUPPORTED,
114 CM_STATUS_UNIMPLEMENTED,
115 CM_STATUS_PARAMETER_ERROR,
116 CM_STATUS_DBG_LOOPBACK,
117 CM_STATUS_MAX,
118};
119
120
121enum cxacru_info_idx {
122 CXINF_DOWNSTREAM_RATE,
123 CXINF_UPSTREAM_RATE,
124 CXINF_LINK_STATUS,
125 CXINF_LINE_STATUS,
126 CXINF_MAC_ADDRESS_HIGH,
127 CXINF_MAC_ADDRESS_LOW,
128 CXINF_UPSTREAM_SNR_MARGIN,
129 CXINF_DOWNSTREAM_SNR_MARGIN,
130 CXINF_UPSTREAM_ATTENUATION,
131 CXINF_DOWNSTREAM_ATTENUATION,
132 CXINF_TRANSMITTER_POWER,
133 CXINF_UPSTREAM_BITS_PER_FRAME,
134 CXINF_DOWNSTREAM_BITS_PER_FRAME,
135 CXINF_STARTUP_ATTEMPTS,
136 CXINF_UPSTREAM_CRC_ERRORS,
137 CXINF_DOWNSTREAM_CRC_ERRORS,
138 CXINF_UPSTREAM_FEC_ERRORS,
139 CXINF_DOWNSTREAM_FEC_ERRORS,
140 CXINF_UPSTREAM_HEC_ERRORS,
141 CXINF_DOWNSTREAM_HEC_ERRORS,
142 CXINF_LINE_STARTABLE,
143 CXINF_MODULATION,
144 CXINF_ADSL_HEADEND,
145 CXINF_ADSL_HEADEND_ENVIRONMENT,
146 CXINF_CONTROLLER_VERSION,
147
148 CXINF_MAX = 0x1c,
149};
150
151enum cxacru_poll_state {
152 CXPOLL_STOPPING,
153 CXPOLL_STOPPED,
154 CXPOLL_POLLING,
155 CXPOLL_SHUTDOWN
156};
157
158struct cxacru_modem_type {
159 u32 pll_f_clk;
160 u32 pll_b_clk;
161 int boot_rom_patch;
162};
163
164struct cxacru_data {
165 struct usbatm_data *usbatm;
166
167 const struct cxacru_modem_type *modem_type;
168
169 int line_status;
170 struct mutex adsl_state_serialize;
171 int adsl_status;
172 struct delayed_work poll_work;
173 u32 card_info[CXINF_MAX];
174 struct mutex poll_state_serialize;
175 enum cxacru_poll_state poll_state;
176
177
178 struct mutex cm_serialize;
179 u8 *rcv_buf;
180 u8 *snd_buf;
181 struct urb *rcv_urb;
182 struct urb *snd_urb;
183 struct completion rcv_done;
184 struct completion snd_done;
185};
186
187static int cxacru_cm(struct cxacru_data *instance, enum cxacru_cm_request cm,
188 u8 *wdata, int wsize, u8 *rdata, int rsize);
189static void cxacru_poll_status(struct work_struct *work);
190
191
192#define CXACRU__ATTR_INIT(_name) \
193static DEVICE_ATTR(_name, S_IRUGO, cxacru_sysfs_show_##_name, NULL)
194
195#define CXACRU_CMD_INIT(_name) \
196static DEVICE_ATTR(_name, S_IWUSR | S_IRUGO, \
197 cxacru_sysfs_show_##_name, cxacru_sysfs_store_##_name)
198
199#define CXACRU_ATTR_INIT(_value, _type, _name) \
200static ssize_t cxacru_sysfs_show_##_name(struct device *dev, \
201 struct device_attribute *attr, char *buf) \
202{ \
203 struct usb_interface *intf = to_usb_interface(dev); \
204 struct usbatm_data *usbatm_instance = usb_get_intfdata(intf); \
205 struct cxacru_data *instance = usbatm_instance->driver_data; \
206 return cxacru_sysfs_showattr_##_type(instance->card_info[_value], buf); \
207} \
208CXACRU__ATTR_INIT(_name)
209
210#define CXACRU_ATTR_CREATE(_v, _t, _name) CXACRU_DEVICE_CREATE_FILE(_name)
211#define CXACRU_CMD_CREATE(_name) CXACRU_DEVICE_CREATE_FILE(_name)
212#define CXACRU__ATTR_CREATE(_name) CXACRU_DEVICE_CREATE_FILE(_name)
213
214#define CXACRU_ATTR_REMOVE(_v, _t, _name) CXACRU_DEVICE_REMOVE_FILE(_name)
215#define CXACRU_CMD_REMOVE(_name) CXACRU_DEVICE_REMOVE_FILE(_name)
216#define CXACRU__ATTR_REMOVE(_name) CXACRU_DEVICE_REMOVE_FILE(_name)
217
218static ssize_t cxacru_sysfs_showattr_u32(u32 value, char *buf)
219{
220 return snprintf(buf, PAGE_SIZE, "%u\n", value);
221}
222
223static ssize_t cxacru_sysfs_showattr_s8(s8 value, char *buf)
224{
225 return snprintf(buf, PAGE_SIZE, "%d\n", value);
226}
227
228static ssize_t cxacru_sysfs_showattr_dB(s16 value, char *buf)
229{
230 if (likely(value >= 0)) {
231 return snprintf(buf, PAGE_SIZE, "%u.%02u\n",
232 value / 100, value % 100);
233 } else {
234 value = -value;
235 return snprintf(buf, PAGE_SIZE, "-%u.%02u\n",
236 value / 100, value % 100);
237 }
238}
239
240static ssize_t cxacru_sysfs_showattr_bool(u32 value, char *buf)
241{
242 static char *str[] = { "no", "yes" };
243 if (unlikely(value >= ARRAY_SIZE(str)))
244 return snprintf(buf, PAGE_SIZE, "%u\n", value);
245 return snprintf(buf, PAGE_SIZE, "%s\n", str[value]);
246}
247
248static ssize_t cxacru_sysfs_showattr_LINK(u32 value, char *buf)
249{
250 static char *str[] = { NULL, "not connected", "connected", "lost" };
251 if (unlikely(value >= ARRAY_SIZE(str) || str[value] == NULL))
252 return snprintf(buf, PAGE_SIZE, "%u\n", value);
253 return snprintf(buf, PAGE_SIZE, "%s\n", str[value]);
254}
255
256static ssize_t cxacru_sysfs_showattr_LINE(u32 value, char *buf)
257{
258 static char *str[] = { "down", "attempting to activate",
259 "training", "channel analysis", "exchange", "up",
260 "waiting", "initialising"
261 };
262 if (unlikely(value >= ARRAY_SIZE(str)))
263 return snprintf(buf, PAGE_SIZE, "%u\n", value);
264 return snprintf(buf, PAGE_SIZE, "%s\n", str[value]);
265}
266
267static ssize_t cxacru_sysfs_showattr_MODU(u32 value, char *buf)
268{
269 static char *str[] = {
270 NULL,
271 "ANSI T1.413",
272 "ITU-T G.992.1 (G.DMT)",
273 "ITU-T G.992.2 (G.LITE)"
274 };
275 if (unlikely(value >= ARRAY_SIZE(str) || str[value] == NULL))
276 return snprintf(buf, PAGE_SIZE, "%u\n", value);
277 return snprintf(buf, PAGE_SIZE, "%s\n", str[value]);
278}
279
280
281
282
283
284
285
286
287
288static ssize_t cxacru_sysfs_show_mac_address(struct device *dev,
289 struct device_attribute *attr, char *buf)
290{
291 struct usb_interface *intf = to_usb_interface(dev);
292 struct usbatm_data *usbatm_instance = usb_get_intfdata(intf);
293 struct atm_dev *atm_dev = usbatm_instance->atm_dev;
294
295 return snprintf(buf, PAGE_SIZE, "%pM\n", atm_dev->esi);
296}
297
298static ssize_t cxacru_sysfs_show_adsl_state(struct device *dev,
299 struct device_attribute *attr, char *buf)
300{
301 struct usb_interface *intf = to_usb_interface(dev);
302 struct usbatm_data *usbatm_instance = usb_get_intfdata(intf);
303 struct cxacru_data *instance = usbatm_instance->driver_data;
304 u32 value = instance->card_info[CXINF_LINE_STARTABLE];
305
306 static char *str[] = { "running", "stopped" };
307 if (unlikely(value >= ARRAY_SIZE(str)))
308 return snprintf(buf, PAGE_SIZE, "%u\n", value);
309 return snprintf(buf, PAGE_SIZE, "%s\n", str[value]);
310}
311
312static ssize_t cxacru_sysfs_store_adsl_state(struct device *dev,
313 struct device_attribute *attr, const char *buf, size_t count)
314{
315 struct usb_interface *intf = to_usb_interface(dev);
316 struct usbatm_data *usbatm_instance = usb_get_intfdata(intf);
317 struct cxacru_data *instance = usbatm_instance->driver_data;
318 int ret;
319 int poll = -1;
320 char str_cmd[8];
321 int len = strlen(buf);
322
323 if (!capable(CAP_NET_ADMIN))
324 return -EACCES;
325
326 ret = sscanf(buf, "%7s", str_cmd);
327 if (ret != 1)
328 return -EINVAL;
329 ret = 0;
330
331 if (mutex_lock_interruptible(&instance->adsl_state_serialize))
332 return -ERESTARTSYS;
333
334 if (!strcmp(str_cmd, "stop") || !strcmp(str_cmd, "restart")) {
335 ret = cxacru_cm(instance, CM_REQUEST_CHIP_ADSL_LINE_STOP, NULL, 0, NULL, 0);
336 if (ret < 0) {
337 atm_err(usbatm_instance, "change adsl state:"
338 " CHIP_ADSL_LINE_STOP returned %d\n", ret);
339
340 ret = -EIO;
341 } else {
342 ret = len;
343 poll = CXPOLL_STOPPED;
344 }
345 }
346
347
348
349
350
351 if (!strcmp(str_cmd, "restart"))
352 msleep(1500);
353
354 if (!strcmp(str_cmd, "start") || !strcmp(str_cmd, "restart")) {
355 ret = cxacru_cm(instance, CM_REQUEST_CHIP_ADSL_LINE_START, NULL, 0, NULL, 0);
356 if (ret < 0) {
357 atm_err(usbatm_instance, "change adsl state:"
358 " CHIP_ADSL_LINE_START returned %d\n", ret);
359
360 ret = -EIO;
361 } else {
362 ret = len;
363 poll = CXPOLL_POLLING;
364 }
365 }
366
367 if (!strcmp(str_cmd, "poll")) {
368 ret = len;
369 poll = CXPOLL_POLLING;
370 }
371
372 if (ret == 0) {
373 ret = -EINVAL;
374 poll = -1;
375 }
376
377 if (poll == CXPOLL_POLLING) {
378 mutex_lock(&instance->poll_state_serialize);
379 switch (instance->poll_state) {
380 case CXPOLL_STOPPED:
381
382 instance->poll_state = CXPOLL_POLLING;
383 break;
384
385 case CXPOLL_STOPPING:
386
387 instance->poll_state = CXPOLL_POLLING;
388 case CXPOLL_POLLING:
389 case CXPOLL_SHUTDOWN:
390
391 poll = -1;
392 }
393 mutex_unlock(&instance->poll_state_serialize);
394 } else if (poll == CXPOLL_STOPPED) {
395 mutex_lock(&instance->poll_state_serialize);
396
397 if (instance->poll_state == CXPOLL_POLLING)
398 instance->poll_state = CXPOLL_STOPPING;
399 mutex_unlock(&instance->poll_state_serialize);
400 }
401
402 mutex_unlock(&instance->adsl_state_serialize);
403
404 if (poll == CXPOLL_POLLING)
405 cxacru_poll_status(&instance->poll_work.work);
406
407 return ret;
408}
409
410
411
412
413
414
415
416
417
418
419
420#define CXACRU_ALL_FILES(_action) \
421CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_RATE, u32, downstream_rate); \
422CXACRU_ATTR_##_action(CXINF_UPSTREAM_RATE, u32, upstream_rate); \
423CXACRU_ATTR_##_action(CXINF_LINK_STATUS, LINK, link_status); \
424CXACRU_ATTR_##_action(CXINF_LINE_STATUS, LINE, line_status); \
425CXACRU__ATTR_##_action( mac_address); \
426CXACRU_ATTR_##_action(CXINF_UPSTREAM_SNR_MARGIN, dB, upstream_snr_margin); \
427CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_SNR_MARGIN, dB, downstream_snr_margin); \
428CXACRU_ATTR_##_action(CXINF_UPSTREAM_ATTENUATION, dB, upstream_attenuation); \
429CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_ATTENUATION, dB, downstream_attenuation); \
430CXACRU_ATTR_##_action(CXINF_TRANSMITTER_POWER, s8, transmitter_power); \
431CXACRU_ATTR_##_action(CXINF_UPSTREAM_BITS_PER_FRAME, u32, upstream_bits_per_frame); \
432CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_BITS_PER_FRAME, u32, downstream_bits_per_frame); \
433CXACRU_ATTR_##_action(CXINF_STARTUP_ATTEMPTS, u32, startup_attempts); \
434CXACRU_ATTR_##_action(CXINF_UPSTREAM_CRC_ERRORS, u32, upstream_crc_errors); \
435CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_CRC_ERRORS, u32, downstream_crc_errors); \
436CXACRU_ATTR_##_action(CXINF_UPSTREAM_FEC_ERRORS, u32, upstream_fec_errors); \
437CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_FEC_ERRORS, u32, downstream_fec_errors); \
438CXACRU_ATTR_##_action(CXINF_UPSTREAM_HEC_ERRORS, u32, upstream_hec_errors); \
439CXACRU_ATTR_##_action(CXINF_DOWNSTREAM_HEC_ERRORS, u32, downstream_hec_errors); \
440CXACRU_ATTR_##_action(CXINF_LINE_STARTABLE, bool, line_startable); \
441CXACRU_ATTR_##_action(CXINF_MODULATION, MODU, modulation); \
442CXACRU_ATTR_##_action(CXINF_ADSL_HEADEND, u32, adsl_headend); \
443CXACRU_ATTR_##_action(CXINF_ADSL_HEADEND_ENVIRONMENT, u32, adsl_headend_environment); \
444CXACRU_ATTR_##_action(CXINF_CONTROLLER_VERSION, u32, adsl_controller_version); \
445CXACRU_CMD_##_action( adsl_state);
446
447CXACRU_ALL_FILES(INIT);
448
449
450static void cxacru_blocking_completion(struct urb *urb)
451{
452 complete(urb->context);
453}
454
455static void cxacru_timeout_kill(unsigned long data)
456{
457 usb_unlink_urb((struct urb *) data);
458}
459
460static int cxacru_start_wait_urb(struct urb *urb, struct completion *done,
461 int* actual_length)
462{
463 struct timer_list timer;
464
465 init_timer(&timer);
466 timer.expires = jiffies + msecs_to_jiffies(CMD_TIMEOUT);
467 timer.data = (unsigned long) urb;
468 timer.function = cxacru_timeout_kill;
469 add_timer(&timer);
470 wait_for_completion(done);
471 del_timer_sync(&timer);
472
473 if (actual_length)
474 *actual_length = urb->actual_length;
475 return urb->status;
476}
477
478static int cxacru_cm(struct cxacru_data *instance, enum cxacru_cm_request cm,
479 u8 *wdata, int wsize, u8 *rdata, int rsize)
480{
481 int ret, actlen;
482 int offb, offd;
483 const int stride = CMD_PACKET_SIZE - 4;
484 u8 *wbuf = instance->snd_buf;
485 u8 *rbuf = instance->rcv_buf;
486 int wbuflen = ((wsize - 1) / stride + 1) * CMD_PACKET_SIZE;
487 int rbuflen = ((rsize - 1) / stride + 1) * CMD_PACKET_SIZE;
488
489 if (wbuflen > PAGE_SIZE || rbuflen > PAGE_SIZE) {
490 if (printk_ratelimit())
491 usb_err(instance->usbatm, "requested transfer size too large (%d, %d)\n",
492 wbuflen, rbuflen);
493 ret = -ENOMEM;
494 goto err;
495 }
496
497 mutex_lock(&instance->cm_serialize);
498
499
500 init_completion(&instance->rcv_done);
501 ret = usb_submit_urb(instance->rcv_urb, GFP_KERNEL);
502 if (ret < 0) {
503 if (printk_ratelimit())
504 usb_err(instance->usbatm, "submit of read urb for cm %#x failed (%d)\n",
505 cm, ret);
506 goto fail;
507 }
508
509 memset(wbuf, 0, wbuflen);
510
511 wbuf[0] = cm;
512 for (offb = offd = 0; offd < wsize; offd += stride, offb += CMD_PACKET_SIZE) {
513 wbuf[offb] = cm;
514 memcpy(wbuf + offb + 4, wdata + offd, min_t(int, stride, wsize - offd));
515 }
516
517 instance->snd_urb->transfer_buffer_length = wbuflen;
518 init_completion(&instance->snd_done);
519 ret = usb_submit_urb(instance->snd_urb, GFP_KERNEL);
520 if (ret < 0) {
521 if (printk_ratelimit())
522 usb_err(instance->usbatm, "submit of write urb for cm %#x failed (%d)\n",
523 cm, ret);
524 goto fail;
525 }
526
527 ret = cxacru_start_wait_urb(instance->snd_urb, &instance->snd_done, NULL);
528 if (ret < 0) {
529 if (printk_ratelimit())
530 usb_err(instance->usbatm, "send of cm %#x failed (%d)\n", cm, ret);
531 goto fail;
532 }
533
534 ret = cxacru_start_wait_urb(instance->rcv_urb, &instance->rcv_done, &actlen);
535 if (ret < 0) {
536 if (printk_ratelimit())
537 usb_err(instance->usbatm, "receive of cm %#x failed (%d)\n", cm, ret);
538 goto fail;
539 }
540 if (actlen % CMD_PACKET_SIZE || !actlen) {
541 if (printk_ratelimit())
542 usb_err(instance->usbatm, "invalid response length to cm %#x: %d\n",
543 cm, actlen);
544 ret = -EIO;
545 goto fail;
546 }
547
548
549 for (offb = offd = 0; offd < rsize && offb < actlen; offb += CMD_PACKET_SIZE) {
550 if (rbuf[offb] != cm) {
551 if (printk_ratelimit())
552 usb_err(instance->usbatm, "wrong cm %#x in response to cm %#x\n",
553 rbuf[offb], cm);
554 ret = -EIO;
555 goto fail;
556 }
557 if (rbuf[offb + 1] != CM_STATUS_SUCCESS) {
558 if (printk_ratelimit())
559 usb_err(instance->usbatm, "response to cm %#x failed: %#x\n",
560 cm, rbuf[offb + 1]);
561 ret = -EIO;
562 goto fail;
563 }
564 if (offd >= rsize)
565 break;
566 memcpy(rdata + offd, rbuf + offb + 4, min_t(int, stride, rsize - offd));
567 offd += stride;
568 }
569
570 ret = offd;
571 dbg("cm %#x", cm);
572fail:
573 mutex_unlock(&instance->cm_serialize);
574err:
575 return ret;
576}
577
578static int cxacru_cm_get_array(struct cxacru_data *instance, enum cxacru_cm_request cm,
579 u32 *data, int size)
580{
581 int ret, len;
582 __le32 *buf;
583 int offb, offd;
584 const int stride = CMD_PACKET_SIZE / (4 * 2) - 1;
585 int buflen = ((size - 1) / stride + 1 + size * 2) * 4;
586
587 buf = kmalloc(buflen, GFP_KERNEL);
588 if (!buf)
589 return -ENOMEM;
590
591 ret = cxacru_cm(instance, cm, NULL, 0, (u8 *) buf, buflen);
592 if (ret < 0)
593 goto cleanup;
594
595
596 len = ret / 4;
597 for (offb = 0; offb < len; ) {
598 int l = le32_to_cpu(buf[offb++]);
599 if (l > stride || l > (len - offb) / 2) {
600 if (printk_ratelimit())
601 usb_err(instance->usbatm, "invalid data length from cm %#x: %d\n",
602 cm, l);
603 ret = -EIO;
604 goto cleanup;
605 }
606 while (l--) {
607 offd = le32_to_cpu(buf[offb++]);
608 if (offd >= size) {
609 if (printk_ratelimit())
610 usb_err(instance->usbatm, "wrong index %#x in response to cm %#x\n",
611 offd, cm);
612 ret = -EIO;
613 goto cleanup;
614 }
615 data[offd] = le32_to_cpu(buf[offb++]);
616 }
617 }
618
619 ret = 0;
620
621cleanup:
622 kfree(buf);
623 return ret;
624}
625
626static int cxacru_card_status(struct cxacru_data *instance)
627{
628 int ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_STATUS, NULL, 0, NULL, 0);
629 if (ret < 0) {
630 dbg("cxacru_adsl_start: CARD_GET_STATUS returned %d", ret);
631 return ret;
632 }
633 return 0;
634}
635
636static void cxacru_remove_device_files(struct usbatm_data *usbatm_instance,
637 struct atm_dev *atm_dev)
638{
639 struct usb_interface *intf = usbatm_instance->usb_intf;
640
641 #define CXACRU_DEVICE_REMOVE_FILE(_name) \
642 device_remove_file(&intf->dev, &dev_attr_##_name);
643 CXACRU_ALL_FILES(REMOVE);
644 #undef CXACRU_DEVICE_REMOVE_FILE
645}
646
647static int cxacru_atm_start(struct usbatm_data *usbatm_instance,
648 struct atm_dev *atm_dev)
649{
650 struct cxacru_data *instance = usbatm_instance->driver_data;
651 struct usb_interface *intf = usbatm_instance->usb_intf;
652
653
654
655 int ret;
656 int start_polling = 1;
657
658 dbg("cxacru_atm_start");
659
660
661 ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_MAC_ADDRESS, NULL, 0,
662 atm_dev->esi, sizeof(atm_dev->esi));
663 if (ret < 0) {
664 atm_err(usbatm_instance, "cxacru_atm_start: CARD_GET_MAC_ADDRESS returned %d\n", ret);
665 return ret;
666 }
667
668 #define CXACRU_DEVICE_CREATE_FILE(_name) \
669 ret = device_create_file(&intf->dev, &dev_attr_##_name); \
670 if (unlikely(ret)) \
671 goto fail_sysfs;
672 CXACRU_ALL_FILES(CREATE);
673 #undef CXACRU_DEVICE_CREATE_FILE
674
675
676 mutex_lock(&instance->adsl_state_serialize);
677 ret = cxacru_cm(instance, CM_REQUEST_CHIP_ADSL_LINE_START, NULL, 0, NULL, 0);
678 if (ret < 0)
679 atm_err(usbatm_instance, "cxacru_atm_start: CHIP_ADSL_LINE_START returned %d\n", ret);
680
681
682 mutex_lock(&instance->poll_state_serialize);
683 switch (instance->poll_state) {
684 case CXPOLL_STOPPED:
685
686 instance->poll_state = CXPOLL_POLLING;
687 break;
688
689 case CXPOLL_STOPPING:
690
691 instance->poll_state = CXPOLL_POLLING;
692 case CXPOLL_POLLING:
693 case CXPOLL_SHUTDOWN:
694
695 start_polling = 0;
696 }
697 mutex_unlock(&instance->poll_state_serialize);
698 mutex_unlock(&instance->adsl_state_serialize);
699
700 if (start_polling)
701 cxacru_poll_status(&instance->poll_work.work);
702 return 0;
703
704fail_sysfs:
705 usb_err(usbatm_instance, "cxacru_atm_start: device_create_file failed (%d)\n", ret);
706 cxacru_remove_device_files(usbatm_instance, atm_dev);
707 return ret;
708}
709
710static void cxacru_poll_status(struct work_struct *work)
711{
712 struct cxacru_data *instance =
713 container_of(work, struct cxacru_data, poll_work.work);
714 u32 buf[CXINF_MAX] = {};
715 struct usbatm_data *usbatm = instance->usbatm;
716 struct atm_dev *atm_dev = usbatm->atm_dev;
717 int keep_polling = 1;
718 int ret;
719
720 ret = cxacru_cm_get_array(instance, CM_REQUEST_CARD_INFO_GET, buf, CXINF_MAX);
721 if (ret < 0) {
722 if (ret != -ESHUTDOWN)
723 atm_warn(usbatm, "poll status: error %d\n", ret);
724
725 mutex_lock(&instance->poll_state_serialize);
726 if (instance->poll_state != CXPOLL_SHUTDOWN) {
727 instance->poll_state = CXPOLL_STOPPED;
728
729 if (ret != -ESHUTDOWN)
730 atm_warn(usbatm, "polling disabled, set adsl_state"
731 " to 'start' or 'poll' to resume\n");
732 }
733 mutex_unlock(&instance->poll_state_serialize);
734 goto reschedule;
735 }
736
737 memcpy(instance->card_info, buf, sizeof(instance->card_info));
738
739 if (instance->adsl_status != buf[CXINF_LINE_STARTABLE]) {
740 instance->adsl_status = buf[CXINF_LINE_STARTABLE];
741
742 switch (instance->adsl_status) {
743 case 0:
744 atm_printk(KERN_INFO, usbatm, "ADSL state: running\n");
745 break;
746
747 case 1:
748 atm_printk(KERN_INFO, usbatm, "ADSL state: stopped\n");
749 break;
750
751 default:
752 atm_printk(KERN_INFO, usbatm, "Unknown adsl status %02x\n", instance->adsl_status);
753 break;
754 }
755 }
756
757 if (instance->line_status == buf[CXINF_LINE_STATUS])
758 goto reschedule;
759
760 instance->line_status = buf[CXINF_LINE_STATUS];
761 switch (instance->line_status) {
762 case 0:
763 atm_dev->signal = ATM_PHY_SIG_LOST;
764 atm_info(usbatm, "ADSL line: down\n");
765 break;
766
767 case 1:
768 atm_dev->signal = ATM_PHY_SIG_LOST;
769 atm_info(usbatm, "ADSL line: attempting to activate\n");
770 break;
771
772 case 2:
773 atm_dev->signal = ATM_PHY_SIG_LOST;
774 atm_info(usbatm, "ADSL line: training\n");
775 break;
776
777 case 3:
778 atm_dev->signal = ATM_PHY_SIG_LOST;
779 atm_info(usbatm, "ADSL line: channel analysis\n");
780 break;
781
782 case 4:
783 atm_dev->signal = ATM_PHY_SIG_LOST;
784 atm_info(usbatm, "ADSL line: exchange\n");
785 break;
786
787 case 5:
788 atm_dev->link_rate = buf[CXINF_DOWNSTREAM_RATE] * 1000 / 424;
789 atm_dev->signal = ATM_PHY_SIG_FOUND;
790
791 atm_info(usbatm, "ADSL line: up (%d kb/s down | %d kb/s up)\n",
792 buf[CXINF_DOWNSTREAM_RATE], buf[CXINF_UPSTREAM_RATE]);
793 break;
794
795 case 6:
796 atm_dev->signal = ATM_PHY_SIG_LOST;
797 atm_info(usbatm, "ADSL line: waiting\n");
798 break;
799
800 case 7:
801 atm_dev->signal = ATM_PHY_SIG_LOST;
802 atm_info(usbatm, "ADSL line: initializing\n");
803 break;
804
805 default:
806 atm_dev->signal = ATM_PHY_SIG_UNKNOWN;
807 atm_info(usbatm, "Unknown line state %02x\n", instance->line_status);
808 break;
809 }
810reschedule:
811
812 mutex_lock(&instance->poll_state_serialize);
813 if (instance->poll_state == CXPOLL_STOPPING &&
814 instance->adsl_status == 1 &&
815 instance->line_status == 0)
816 instance->poll_state = CXPOLL_STOPPED;
817
818 if (instance->poll_state == CXPOLL_STOPPED)
819 keep_polling = 0;
820 mutex_unlock(&instance->poll_state_serialize);
821
822 if (keep_polling)
823 schedule_delayed_work(&instance->poll_work,
824 round_jiffies_relative(POLL_INTERVAL*HZ));
825}
826
827static int cxacru_fw(struct usb_device *usb_dev, enum cxacru_fw_request fw,
828 u8 code1, u8 code2, u32 addr, const u8 *data, int size)
829{
830 int ret;
831 u8 *buf;
832 int offd, offb;
833 const int stride = CMD_PACKET_SIZE - 8;
834
835 buf = (u8 *) __get_free_page(GFP_KERNEL);
836 if (!buf)
837 return -ENOMEM;
838
839 offb = offd = 0;
840 do {
841 int l = min_t(int, stride, size - offd);
842 buf[offb++] = fw;
843 buf[offb++] = l;
844 buf[offb++] = code1;
845 buf[offb++] = code2;
846 put_unaligned(cpu_to_le32(addr), (__le32 *)(buf + offb));
847 offb += 4;
848 addr += l;
849 if(l)
850 memcpy(buf + offb, data + offd, l);
851 if (l < stride)
852 memset(buf + offb + l, 0, stride - l);
853 offb += stride;
854 offd += stride;
855 if ((offb >= PAGE_SIZE) || (offd >= size)) {
856 ret = usb_bulk_msg(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_CMD),
857 buf, offb, NULL, CMD_TIMEOUT);
858 if (ret < 0) {
859 dbg("sending fw %#x failed", fw);
860 goto cleanup;
861 }
862 offb = 0;
863 }
864 } while(offd < size);
865 dbg("sent fw %#x", fw);
866
867 ret = 0;
868
869cleanup:
870 free_page((unsigned long) buf);
871 return ret;
872}
873
874static void cxacru_upload_firmware(struct cxacru_data *instance,
875 const struct firmware *fw,
876 const struct firmware *bp,
877 const struct firmware *cf)
878{
879 int ret;
880 int off;
881 struct usbatm_data *usbatm = instance->usbatm;
882 struct usb_device *usb_dev = usbatm->usb_dev;
883 __le16 signature[] = { usb_dev->descriptor.idVendor,
884 usb_dev->descriptor.idProduct };
885 __le32 val;
886
887 dbg("cxacru_upload_firmware");
888
889
890 val = cpu_to_le32(instance->modem_type->pll_f_clk);
891 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, PLLFCLK_ADDR, (u8 *) &val, 4);
892 if (ret) {
893 usb_err(usbatm, "FirmwarePllFClkValue failed: %d\n", ret);
894 return;
895 }
896
897
898 val = cpu_to_le32(instance->modem_type->pll_b_clk);
899 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, PLLBCLK_ADDR, (u8 *) &val, 4);
900 if (ret) {
901 usb_err(usbatm, "FirmwarePllBClkValue failed: %d\n", ret);
902 return;
903 }
904
905
906 val = cpu_to_le32(SDRAM_ENA);
907 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, SDRAMEN_ADDR, (u8 *) &val, 4);
908 if (ret) {
909 usb_err(usbatm, "Enable SDRAM failed: %d\n", ret);
910 return;
911 }
912
913
914 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, FW_ADDR, fw->data, fw->size);
915 if (ret) {
916 usb_err(usbatm, "Firmware upload failed: %d\n", ret);
917 return;
918 }
919
920
921 if (instance->modem_type->boot_rom_patch) {
922 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, BR_ADDR, bp->data, bp->size);
923 if (ret) {
924 usb_err(usbatm, "Boot ROM patching failed: %d\n", ret);
925 return;
926 }
927 }
928
929
930 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, SIG_ADDR, (u8 *) signature, 4);
931 if (ret) {
932 usb_err(usbatm, "Signature storing failed: %d\n", ret);
933 return;
934 }
935
936 if (instance->modem_type->boot_rom_patch) {
937 val = cpu_to_le32(BR_ADDR);
938 ret = cxacru_fw(usb_dev, FW_WRITE_MEM, 0x2, 0x0, BR_STACK_ADDR, (u8 *) &val, 4);
939 }
940 else {
941 ret = cxacru_fw(usb_dev, FW_GOTO_MEM, 0x0, 0x0, FW_ADDR, NULL, 0);
942 }
943 if (ret) {
944 usb_err(usbatm, "Passing control to firmware failed: %d\n", ret);
945 return;
946 }
947
948
949 msleep_interruptible(1000);
950
951 usb_clear_halt(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_CMD));
952 usb_clear_halt(usb_dev, usb_rcvbulkpipe(usb_dev, CXACRU_EP_CMD));
953 usb_clear_halt(usb_dev, usb_sndbulkpipe(usb_dev, CXACRU_EP_DATA));
954 usb_clear_halt(usb_dev, usb_rcvbulkpipe(usb_dev, CXACRU_EP_DATA));
955
956 ret = cxacru_cm(instance, CM_REQUEST_CARD_GET_STATUS, NULL, 0, NULL, 0);
957 if (ret < 0) {
958 usb_err(usbatm, "modem failed to initialize: %d\n", ret);
959 return;
960 }
961
962
963 if (cf)
964 for (off = 0; off < cf->size / 4; ) {
965 __le32 buf[CMD_PACKET_SIZE / 4 - 1];
966 int i, len = min_t(int, cf->size / 4 - off, CMD_PACKET_SIZE / 4 / 2 - 1);
967 buf[0] = cpu_to_le32(len);
968 for (i = 0; i < len; i++, off++) {
969 buf[i * 2 + 1] = cpu_to_le32(off);
970 memcpy(buf + i * 2 + 2, cf->data + off * 4, 4);
971 }
972 ret = cxacru_cm(instance, CM_REQUEST_CARD_DATA_SET,
973 (u8 *) buf, len, NULL, 0);
974 if (ret < 0) {
975 usb_err(usbatm, "load config data failed: %d\n", ret);
976 return;
977 }
978 }
979
980 msleep_interruptible(4000);
981}
982
983static int cxacru_find_firmware(struct cxacru_data *instance,
984 char* phase, const struct firmware **fw_p)
985{
986 struct usbatm_data *usbatm = instance->usbatm;
987 struct device *dev = &usbatm->usb_intf->dev;
988 char buf[16];
989
990 sprintf(buf, "cxacru-%s.bin", phase);
991 dbg("cxacru_find_firmware: looking for %s", buf);
992
993 if (request_firmware(fw_p, buf, dev)) {
994 usb_dbg(usbatm, "no stage %s firmware found\n", phase);
995 return -ENOENT;
996 }
997
998 usb_info(usbatm, "found firmware %s\n", buf);
999
1000 return 0;
1001}
1002
1003static int cxacru_heavy_init(struct usbatm_data *usbatm_instance,
1004 struct usb_interface *usb_intf)
1005{
1006 const struct firmware *fw, *bp, *cf;
1007 struct cxacru_data *instance = usbatm_instance->driver_data;
1008
1009 int ret = cxacru_find_firmware(instance, "fw", &fw);
1010 if (ret) {
1011 usb_warn(usbatm_instance, "firmware (cxacru-fw.bin) unavailable (system misconfigured?)\n");
1012 return ret;
1013 }
1014
1015 if (instance->modem_type->boot_rom_patch) {
1016 ret = cxacru_find_firmware(instance, "bp", &bp);
1017 if (ret) {
1018 usb_warn(usbatm_instance, "boot ROM patch (cxacru-bp.bin) unavailable (system misconfigured?)\n");
1019 release_firmware(fw);
1020 return ret;
1021 }
1022 }
1023
1024 if (cxacru_find_firmware(instance, "cf", &cf))
1025 cf = NULL;
1026
1027 cxacru_upload_firmware(instance, fw, bp, cf);
1028
1029 if (cf)
1030 release_firmware(cf);
1031 if (instance->modem_type->boot_rom_patch)
1032 release_firmware(bp);
1033 release_firmware(fw);
1034
1035 ret = cxacru_card_status(instance);
1036 if (ret)
1037 dbg("modem initialisation failed");
1038 else
1039 dbg("done setting up the modem");
1040
1041 return ret;
1042}
1043
1044static int cxacru_bind(struct usbatm_data *usbatm_instance,
1045 struct usb_interface *intf, const struct usb_device_id *id)
1046{
1047 struct cxacru_data *instance;
1048 struct usb_device *usb_dev = interface_to_usbdev(intf);
1049 int ret;
1050
1051
1052 instance = kzalloc(sizeof(*instance), GFP_KERNEL);
1053 if (!instance) {
1054 dbg("cxacru_bind: no memory for instance data");
1055 return -ENOMEM;
1056 }
1057
1058 instance->usbatm = usbatm_instance;
1059 instance->modem_type = (struct cxacru_modem_type *) id->driver_info;
1060
1061 mutex_init(&instance->poll_state_serialize);
1062 instance->poll_state = CXPOLL_STOPPED;
1063 instance->line_status = -1;
1064 instance->adsl_status = -1;
1065
1066 mutex_init(&instance->adsl_state_serialize);
1067
1068 instance->rcv_buf = (u8 *) __get_free_page(GFP_KERNEL);
1069 if (!instance->rcv_buf) {
1070 dbg("cxacru_bind: no memory for rcv_buf");
1071 ret = -ENOMEM;
1072 goto fail;
1073 }
1074 instance->snd_buf = (u8 *) __get_free_page(GFP_KERNEL);
1075 if (!instance->snd_buf) {
1076 dbg("cxacru_bind: no memory for snd_buf");
1077 ret = -ENOMEM;
1078 goto fail;
1079 }
1080 instance->rcv_urb = usb_alloc_urb(0, GFP_KERNEL);
1081 if (!instance->rcv_urb) {
1082 dbg("cxacru_bind: no memory for rcv_urb");
1083 ret = -ENOMEM;
1084 goto fail;
1085 }
1086 instance->snd_urb = usb_alloc_urb(0, GFP_KERNEL);
1087 if (!instance->snd_urb) {
1088 dbg("cxacru_bind: no memory for snd_urb");
1089 ret = -ENOMEM;
1090 goto fail;
1091 }
1092
1093 usb_fill_int_urb(instance->rcv_urb,
1094 usb_dev, usb_rcvintpipe(usb_dev, CXACRU_EP_CMD),
1095 instance->rcv_buf, PAGE_SIZE,
1096 cxacru_blocking_completion, &instance->rcv_done, 1);
1097
1098 usb_fill_int_urb(instance->snd_urb,
1099 usb_dev, usb_sndintpipe(usb_dev, CXACRU_EP_CMD),
1100 instance->snd_buf, PAGE_SIZE,
1101 cxacru_blocking_completion, &instance->snd_done, 4);
1102
1103 mutex_init(&instance->cm_serialize);
1104
1105 INIT_DELAYED_WORK(&instance->poll_work, cxacru_poll_status);
1106
1107 usbatm_instance->driver_data = instance;
1108
1109 usbatm_instance->flags = (cxacru_card_status(instance) ? 0 : UDSL_SKIP_HEAVY_INIT);
1110
1111 return 0;
1112
1113 fail:
1114 free_page((unsigned long) instance->snd_buf);
1115 free_page((unsigned long) instance->rcv_buf);
1116 usb_free_urb(instance->snd_urb);
1117 usb_free_urb(instance->rcv_urb);
1118 kfree(instance);
1119
1120 return ret;
1121}
1122
1123static void cxacru_unbind(struct usbatm_data *usbatm_instance,
1124 struct usb_interface *intf)
1125{
1126 struct cxacru_data *instance = usbatm_instance->driver_data;
1127 int is_polling = 1;
1128
1129 dbg("cxacru_unbind entered");
1130
1131 if (!instance) {
1132 dbg("cxacru_unbind: NULL instance!");
1133 return;
1134 }
1135
1136 mutex_lock(&instance->poll_state_serialize);
1137 BUG_ON(instance->poll_state == CXPOLL_SHUTDOWN);
1138
1139
1140
1141 if (instance->poll_state == CXPOLL_STOPPED)
1142 is_polling = 0;
1143
1144
1145 instance->poll_state = CXPOLL_SHUTDOWN;
1146 mutex_unlock(&instance->poll_state_serialize);
1147
1148 if (is_polling)
1149 cancel_rearming_delayed_work(&instance->poll_work);
1150
1151 usb_kill_urb(instance->snd_urb);
1152 usb_kill_urb(instance->rcv_urb);
1153 usb_free_urb(instance->snd_urb);
1154 usb_free_urb(instance->rcv_urb);
1155
1156 free_page((unsigned long) instance->snd_buf);
1157 free_page((unsigned long) instance->rcv_buf);
1158
1159 kfree(instance);
1160
1161 usbatm_instance->driver_data = NULL;
1162}
1163
1164static const struct cxacru_modem_type cxacru_cafe = {
1165 .pll_f_clk = 0x02d874df,
1166 .pll_b_clk = 0x0196a51a,
1167 .boot_rom_patch = 1,
1168};
1169
1170static const struct cxacru_modem_type cxacru_cb00 = {
1171 .pll_f_clk = 0x5,
1172 .pll_b_clk = 0x3,
1173 .boot_rom_patch = 0,
1174};
1175
1176static const struct usb_device_id cxacru_usb_ids[] = {
1177 {
1178 USB_DEVICE(0x0572, 0xcafe), .driver_info = (unsigned long) &cxacru_cafe
1179 },
1180 {
1181 USB_DEVICE(0x0572, 0xcb00), .driver_info = (unsigned long) &cxacru_cb00
1182 },
1183 {
1184 USB_DEVICE(0x0572, 0xcb01), .driver_info = (unsigned long) &cxacru_cb00
1185 },
1186 {
1187 USB_DEVICE(0x0572, 0xcb02), .driver_info = (unsigned long) &cxacru_cb00
1188 },
1189 {
1190 USB_DEVICE(0x0572, 0xcb06), .driver_info = (unsigned long) &cxacru_cb00
1191 },
1192 {
1193 USB_DEVICE(0x0572, 0xcb07), .driver_info = (unsigned long) &cxacru_cb00
1194 },
1195 {
1196 USB_DEVICE(0x08e3, 0x0100), .driver_info = (unsigned long) &cxacru_cafe
1197 },
1198 {
1199 USB_DEVICE(0x08e3, 0x0102), .driver_info = (unsigned long) &cxacru_cb00
1200 },
1201 {
1202 USB_DEVICE(0x0eb0, 0x3457), .driver_info = (unsigned long) &cxacru_cafe
1203 },
1204 {
1205 USB_DEVICE(0x1803, 0x5510), .driver_info = (unsigned long) &cxacru_cb00
1206 },
1207 {
1208 USB_DEVICE(0x0675, 0x0200), .driver_info = (unsigned long) &cxacru_cb00
1209 },
1210 {
1211 USB_DEVICE(0x0586, 0x330a), .driver_info = (unsigned long) &cxacru_cb00
1212 },
1213 {
1214 USB_DEVICE(0x0586, 0x330b), .driver_info = (unsigned long) &cxacru_cb00
1215 },
1216 {
1217 USB_DEVICE(0x0659, 0x0020), .driver_info = (unsigned long) &cxacru_cb00
1218 },
1219 {
1220 USB_DEVICE(0x0509, 0x0812), .driver_info = (unsigned long) &cxacru_cb00
1221 },
1222 {
1223 USB_DEVICE(0x100d, 0xcb01), .driver_info = (unsigned long) &cxacru_cb00
1224 },
1225 {
1226 USB_DEVICE(0x100d, 0x3342), .driver_info = (unsigned long) &cxacru_cb00
1227 },
1228 {}
1229};
1230
1231MODULE_DEVICE_TABLE(usb, cxacru_usb_ids);
1232
1233static struct usbatm_driver cxacru_driver = {
1234 .driver_name = cxacru_driver_name,
1235 .bind = cxacru_bind,
1236 .heavy_init = cxacru_heavy_init,
1237 .unbind = cxacru_unbind,
1238 .atm_start = cxacru_atm_start,
1239 .atm_stop = cxacru_remove_device_files,
1240 .bulk_in = CXACRU_EP_DATA,
1241 .bulk_out = CXACRU_EP_DATA,
1242 .rx_padding = 3,
1243 .tx_padding = 11,
1244};
1245
1246static int cxacru_usb_probe(struct usb_interface *intf, const struct usb_device_id *id)
1247{
1248 return usbatm_usb_probe(intf, id, &cxacru_driver);
1249}
1250
1251static struct usb_driver cxacru_usb_driver = {
1252 .name = cxacru_driver_name,
1253 .probe = cxacru_usb_probe,
1254 .disconnect = usbatm_usb_disconnect,
1255 .id_table = cxacru_usb_ids
1256};
1257
1258static int __init cxacru_init(void)
1259{
1260 return usb_register(&cxacru_usb_driver);
1261}
1262
1263static void __exit cxacru_cleanup(void)
1264{
1265 usb_deregister(&cxacru_usb_driver);
1266}
1267
1268module_init(cxacru_init);
1269module_exit(cxacru_cleanup);
1270
1271MODULE_AUTHOR(DRIVER_AUTHOR);
1272MODULE_DESCRIPTION(DRIVER_DESC);
1273MODULE_LICENSE("GPL");
1274MODULE_VERSION(DRIVER_VERSION);
1275