2 * CAN driver for "8 devices" USB2CAN converter
4 * Copyright (C) 2012 Bernd Krumboeck (krumboeck@universalnet.at)
6 * This program is free software; you can redistribute it and/or modify it
7 * under the terms of the GNU General Public License as published
8 * by the Free Software Foundation; version 2 of the License.
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
15 * You should have received a copy of the GNU General Public License along
18 * This driver is inspired by the 3.2.0 version of drivers/net/can/usb/ems_usb.c
19 * and drivers/net/can/usb/esd_usb2.c
21 * Many thanks to Gerhard Bertelsmann (info@gerhard-bertelsmann.de)
22 * for testing and fixing this driver. Also many thanks to "8 devices",
23 * who were very cooperative and answered my questions.
26 #include <linux/signal.h>
27 #include <linux/slab.h>
28 #include <linux/module.h>
29 #include <linux/netdevice.h>
30 #include <linux/usb.h>
32 #include <linux/can.h>
33 #include <linux/can/dev.h>
34 #include <linux/can/error.h>
35 #include <linux/can/led.h>
37 /* driver constants */
38 #define MAX_RX_URBS 20
39 #define MAX_TX_URBS 20
40 #define RX_BUFFER_SIZE 64
42 /* vendor and product id */
43 #define USB_8DEV_VENDOR_ID 0x0483
44 #define USB_8DEV_PRODUCT_ID 0x1234
47 enum usb_8dev_endpoint {
48 USB_8DEV_ENDP_DATA_RX = 1,
49 USB_8DEV_ENDP_DATA_TX,
54 /* device CAN clock */
55 #define USB_8DEV_ABP_CLOCK 32000000
58 #define USB_8DEV_SILENT 0x01
59 #define USB_8DEV_LOOPBACK 0x02
60 #define USB_8DEV_DISABLE_AUTO_RESTRANS 0x04
61 #define USB_8DEV_STATUS_FRAME 0x08
69 USB_8DEV_SET_MASK_FILTER,
71 USB_8DEV_GET_STATISTICS,
73 USB_8DEV_GET_SOFTW_VER,
74 USB_8DEV_GET_HARDW_VER,
75 USB_8DEV_RESET_TIMESTAMP,
76 USB_8DEV_GET_SOFTW_HARDW_VER
80 #define USB_8DEV_BAUD_MANUAL 0x09
81 #define USB_8DEV_CMD_START 0x11
82 #define USB_8DEV_CMD_END 0x22
84 #define USB_8DEV_CMD_SUCCESS 0
85 #define USB_8DEV_CMD_ERROR 255
87 #define USB_8DEV_CMD_TIMEOUT 1000
90 #define USB_8DEV_DATA_START 0x55
91 #define USB_8DEV_DATA_END 0xAA
93 #define USB_8DEV_TYPE_CAN_FRAME 0
94 #define USB_8DEV_TYPE_ERROR_FRAME 3
96 #define USB_8DEV_EXTID 0x01
97 #define USB_8DEV_RTR 0x02
98 #define USB_8DEV_ERR_FLAG 0x04
101 #define USB_8DEV_STATUSMSG_OK 0x00 /* Normal condition. */
102 #define USB_8DEV_STATUSMSG_OVERRUN 0x01 /* Overrun occured when sending */
103 #define USB_8DEV_STATUSMSG_BUSLIGHT 0x02 /* Error counter has reached 96 */
104 #define USB_8DEV_STATUSMSG_BUSHEAVY 0x03 /* Error count. has reached 128 */
105 #define USB_8DEV_STATUSMSG_BUSOFF 0x04 /* Device is in BUSOFF */
106 #define USB_8DEV_STATUSMSG_STUFF 0x20 /* Stuff Error */
107 #define USB_8DEV_STATUSMSG_FORM 0x21 /* Form Error */
108 #define USB_8DEV_STATUSMSG_ACK 0x23 /* Ack Error */
109 #define USB_8DEV_STATUSMSG_BIT0 0x24 /* Bit1 Error */
110 #define USB_8DEV_STATUSMSG_BIT1 0x25 /* Bit0 Error */
111 #define USB_8DEV_STATUSMSG_CRC 0x27 /* CRC Error */
113 #define USB_8DEV_RP_MASK 0x7F /* Mask for Receive Error Bit */
116 /* table of devices that work with this driver */
117 static const struct usb_device_id usb_8dev_table[] = {
118 { USB_DEVICE(USB_8DEV_VENDOR_ID, USB_8DEV_PRODUCT_ID) },
119 { } /* Terminating entry */
122 MODULE_DEVICE_TABLE(usb, usb_8dev_table);
124 struct usb_8dev_tx_urb_context {
125 struct usb_8dev_priv *priv;
131 /* Structure to hold all of our device specific stuff */
132 struct usb_8dev_priv {
133 struct can_priv can; /* must be the first member */
135 struct sk_buff *echo_skb[MAX_TX_URBS];
137 struct usb_device *udev;
138 struct net_device *netdev;
140 atomic_t active_tx_urbs;
141 struct usb_anchor tx_submitted;
142 struct usb_8dev_tx_urb_context tx_contexts[MAX_TX_URBS];
144 struct usb_anchor rx_submitted;
146 struct can_berr_counter bec;
150 struct mutex usb_8dev_cmd_lock;
155 struct __packed usb_8dev_tx_msg {
157 u8 flags; /* RTR and EXT_ID flag */
158 __be32 id; /* upper 3 bits not used */
159 u8 dlc; /* data length code 0-8 bytes */
160 u8 data[8]; /* 64-bit data */
165 struct __packed usb_8dev_rx_msg {
167 u8 type; /* frame type */
168 u8 flags; /* RTR and EXT_ID flag */
169 __be32 id; /* upper 3 bits not used */
170 u8 dlc; /* data length code 0-8 bytes */
171 u8 data[8]; /* 64-bit data */
172 __be32 timestamp; /* 32-bit timestamp */
177 struct __packed usb_8dev_cmd_msg {
179 u8 channel; /* unkown - always 0 */
180 u8 command; /* command to execute */
181 u8 opt1; /* optional parameter / return value */
182 u8 opt2; /* optional parameter 2 */
183 u8 data[10]; /* optional parameter and data */
187 static int usb_8dev_send_cmd_msg(struct usb_8dev_priv *priv, u8 *msg, int size)
191 return usb_bulk_msg(priv->udev,
192 usb_sndbulkpipe(priv->udev, USB_8DEV_ENDP_CMD_TX),
193 msg, size, &actual_length, USB_8DEV_CMD_TIMEOUT);
196 static int usb_8dev_wait_cmd_msg(struct usb_8dev_priv *priv, u8 *msg, int size,
199 return usb_bulk_msg(priv->udev,
200 usb_rcvbulkpipe(priv->udev, USB_8DEV_ENDP_CMD_RX),
201 msg, size, actual_length, USB_8DEV_CMD_TIMEOUT);
204 /* Send command to device and receive result.
205 * Command was successful when opt1 = 0.
207 static int usb_8dev_send_cmd(struct usb_8dev_priv *priv,
208 struct usb_8dev_cmd_msg *out,
209 struct usb_8dev_cmd_msg *in)
213 struct net_device *netdev;
215 netdev = priv->netdev;
217 out->begin = USB_8DEV_CMD_START;
218 out->end = USB_8DEV_CMD_END;
220 mutex_lock(&priv->usb_8dev_cmd_lock);
222 memcpy(priv->cmd_msg_buffer, out,
223 sizeof(struct usb_8dev_cmd_msg));
225 err = usb_8dev_send_cmd_msg(priv, priv->cmd_msg_buffer,
226 sizeof(struct usb_8dev_cmd_msg));
228 netdev_err(netdev, "sending command message failed\n");
232 err = usb_8dev_wait_cmd_msg(priv, priv->cmd_msg_buffer,
233 sizeof(struct usb_8dev_cmd_msg),
236 netdev_err(netdev, "no command message answer\n");
240 memcpy(in, priv->cmd_msg_buffer, sizeof(struct usb_8dev_cmd_msg));
242 if (in->begin != USB_8DEV_CMD_START || in->end != USB_8DEV_CMD_END ||
243 num_bytes_read != 16 || in->opt1 != 0)
247 mutex_unlock(&priv->usb_8dev_cmd_lock);
251 /* Send open command to device */
252 static int usb_8dev_cmd_open(struct usb_8dev_priv *priv)
254 struct can_bittiming *bt = &priv->can.bittiming;
255 struct usb_8dev_cmd_msg outmsg;
256 struct usb_8dev_cmd_msg inmsg;
257 u32 ctrlmode = priv->can.ctrlmode;
258 u32 flags = USB_8DEV_STATUS_FRAME;
262 memset(&outmsg, 0, sizeof(outmsg));
263 outmsg.command = USB_8DEV_OPEN;
264 outmsg.opt1 = USB_8DEV_BAUD_MANUAL;
265 outmsg.data[0] = bt->prop_seg + bt->phase_seg1;
266 outmsg.data[1] = bt->phase_seg2;
267 outmsg.data[2] = bt->sjw;
270 bebrp = cpu_to_be16((u16)bt->brp);
271 memcpy(&outmsg.data[3], &bebrp, sizeof(bebrp));
274 if (ctrlmode & CAN_CTRLMODE_LOOPBACK)
275 flags |= USB_8DEV_LOOPBACK;
276 if (ctrlmode & CAN_CTRLMODE_LISTENONLY)
277 flags |= USB_8DEV_SILENT;
278 if (ctrlmode & CAN_CTRLMODE_ONE_SHOT)
279 flags |= USB_8DEV_DISABLE_AUTO_RESTRANS;
281 beflags = cpu_to_be32(flags);
282 memcpy(&outmsg.data[5], &beflags, sizeof(beflags));
284 return usb_8dev_send_cmd(priv, &outmsg, &inmsg);
287 /* Send close command to device */
288 static int usb_8dev_cmd_close(struct usb_8dev_priv *priv)
290 struct usb_8dev_cmd_msg inmsg;
291 struct usb_8dev_cmd_msg outmsg = {
293 .command = USB_8DEV_CLOSE,
298 return usb_8dev_send_cmd(priv, &outmsg, &inmsg);
301 /* Get firmware and hardware version */
302 static int usb_8dev_cmd_version(struct usb_8dev_priv *priv, u32 *res)
304 struct usb_8dev_cmd_msg inmsg;
305 struct usb_8dev_cmd_msg outmsg = {
307 .command = USB_8DEV_GET_SOFTW_HARDW_VER,
312 int err = usb_8dev_send_cmd(priv, &outmsg, &inmsg);
316 *res = be32_to_cpup((__be32 *)inmsg.data);
321 /* Set network device mode
323 * Maybe we should leave this function empty, because the device
324 * set mode variable with open command.
326 static int usb_8dev_set_mode(struct net_device *netdev, enum can_mode mode)
328 struct usb_8dev_priv *priv = netdev_priv(netdev);
333 err = usb_8dev_cmd_open(priv);
335 netdev_warn(netdev, "couldn't start device");
345 /* Read error/status frames */
346 static void usb_8dev_rx_err_msg(struct usb_8dev_priv *priv,
347 struct usb_8dev_rx_msg *msg)
349 struct can_frame *cf;
351 struct net_device_stats *stats = &priv->netdev->stats;
355 * byte 1: bit 7: Receive Passive
356 * byte 1: bit 0-6: Receive Error Counter
357 * byte 2: Transmit Error Counter
358 * byte 3: Always 0 (maybe reserved for future use)
361 u8 state = msg->data[0];
362 u8 rxerr = msg->data[1] & USB_8DEV_RP_MASK;
363 u8 txerr = msg->data[2];
367 skb = alloc_can_err_skb(priv->netdev, &cf);
372 case USB_8DEV_STATUSMSG_OK:
373 priv->can.state = CAN_STATE_ERROR_ACTIVE;
374 cf->can_id |= CAN_ERR_PROT;
375 cf->data[2] = CAN_ERR_PROT_ACTIVE;
377 case USB_8DEV_STATUSMSG_BUSOFF:
378 priv->can.state = CAN_STATE_BUS_OFF;
379 cf->can_id |= CAN_ERR_BUSOFF;
380 priv->can.can_stats.bus_off++;
381 can_bus_off(priv->netdev);
383 case USB_8DEV_STATUSMSG_OVERRUN:
384 case USB_8DEV_STATUSMSG_BUSLIGHT:
385 case USB_8DEV_STATUSMSG_BUSHEAVY:
386 cf->can_id |= CAN_ERR_CRTL;
389 priv->can.state = CAN_STATE_ERROR_WARNING;
390 cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
391 priv->can.can_stats.bus_error++;
396 case USB_8DEV_STATUSMSG_OK:
397 case USB_8DEV_STATUSMSG_BUSOFF:
399 case USB_8DEV_STATUSMSG_ACK:
400 cf->can_id |= CAN_ERR_ACK;
403 case USB_8DEV_STATUSMSG_CRC:
404 cf->data[2] |= CAN_ERR_PROT_UNSPEC;
405 cf->data[3] |= CAN_ERR_PROT_LOC_CRC_SEQ |
406 CAN_ERR_PROT_LOC_CRC_DEL;
409 case USB_8DEV_STATUSMSG_BIT0:
410 cf->data[2] |= CAN_ERR_PROT_BIT0;
413 case USB_8DEV_STATUSMSG_BIT1:
414 cf->data[2] |= CAN_ERR_PROT_BIT1;
417 case USB_8DEV_STATUSMSG_FORM:
418 cf->data[2] |= CAN_ERR_PROT_FORM;
421 case USB_8DEV_STATUSMSG_STUFF:
422 cf->data[2] |= CAN_ERR_PROT_STUFF;
425 case USB_8DEV_STATUSMSG_OVERRUN:
426 cf->data[1] = CAN_ERR_CRTL_RX_OVERFLOW;
427 stats->rx_over_errors++;
430 case USB_8DEV_STATUSMSG_BUSLIGHT:
431 priv->can.state = CAN_STATE_ERROR_WARNING;
432 cf->data[1] = (txerr > rxerr) ?
433 CAN_ERR_CRTL_TX_WARNING :
434 CAN_ERR_CRTL_RX_WARNING;
435 priv->can.can_stats.error_warning++;
437 case USB_8DEV_STATUSMSG_BUSHEAVY:
438 priv->can.state = CAN_STATE_ERROR_PASSIVE;
439 cf->data[1] = (txerr > rxerr) ?
440 CAN_ERR_CRTL_TX_PASSIVE :
441 CAN_ERR_CRTL_RX_PASSIVE;
442 priv->can.can_stats.error_passive++;
445 netdev_warn(priv->netdev,
446 "Unknown status/error message (%d)\n", state);
451 cf->data[2] |= CAN_ERR_PROT_TX;
461 priv->bec.txerr = txerr;
462 priv->bec.rxerr = rxerr;
465 stats->rx_bytes += cf->can_dlc;
469 /* Read data and status frames */
470 static void usb_8dev_rx_can_msg(struct usb_8dev_priv *priv,
471 struct usb_8dev_rx_msg *msg)
473 struct can_frame *cf;
475 struct net_device_stats *stats = &priv->netdev->stats;
477 if (msg->type == USB_8DEV_TYPE_ERROR_FRAME &&
478 msg->flags == USB_8DEV_ERR_FLAG) {
479 usb_8dev_rx_err_msg(priv, msg);
480 } else if (msg->type == USB_8DEV_TYPE_CAN_FRAME) {
481 skb = alloc_can_skb(priv->netdev, &cf);
485 cf->can_id = be32_to_cpu(msg->id);
486 cf->can_dlc = get_can_dlc(msg->dlc & 0xF);
488 if (msg->flags & USB_8DEV_EXTID)
489 cf->can_id |= CAN_EFF_FLAG;
491 if (msg->flags & USB_8DEV_RTR)
492 cf->can_id |= CAN_RTR_FLAG;
494 memcpy(cf->data, msg->data, cf->can_dlc);
497 stats->rx_bytes += cf->can_dlc;
500 can_led_event(priv->netdev, CAN_LED_EVENT_RX);
502 netdev_warn(priv->netdev, "frame type %d unknown",
508 /* Callback for reading data from device
510 * Check urb status, call read function and resubmit urb read operation.
512 static void usb_8dev_read_bulk_callback(struct urb *urb)
514 struct usb_8dev_priv *priv = urb->context;
515 struct net_device *netdev;
519 netdev = priv->netdev;
521 if (!netif_device_present(netdev))
524 switch (urb->status) {
525 case 0: /* success */
533 netdev_info(netdev, "Rx URB aborted (%d)\n",
538 while (pos < urb->actual_length) {
539 struct usb_8dev_rx_msg *msg;
541 if (pos + sizeof(struct usb_8dev_rx_msg) > urb->actual_length) {
542 netdev_err(priv->netdev, "format error\n");
546 msg = (struct usb_8dev_rx_msg *)(urb->transfer_buffer + pos);
547 usb_8dev_rx_can_msg(priv, msg);
549 pos += sizeof(struct usb_8dev_rx_msg);
553 usb_fill_bulk_urb(urb, priv->udev,
554 usb_rcvbulkpipe(priv->udev, USB_8DEV_ENDP_DATA_RX),
555 urb->transfer_buffer, RX_BUFFER_SIZE,
556 usb_8dev_read_bulk_callback, priv);
558 retval = usb_submit_urb(urb, GFP_ATOMIC);
560 if (retval == -ENODEV)
561 netif_device_detach(netdev);
564 "failed resubmitting read bulk urb: %d\n", retval);
567 /* Callback handler for write operations
569 * Free allocated buffers, check transmit status and
570 * calculate statistic.
572 static void usb_8dev_write_bulk_callback(struct urb *urb)
574 struct usb_8dev_tx_urb_context *context = urb->context;
575 struct usb_8dev_priv *priv;
576 struct net_device *netdev;
580 priv = context->priv;
581 netdev = priv->netdev;
583 /* free up our allocated buffer */
584 usb_free_coherent(urb->dev, urb->transfer_buffer_length,
585 urb->transfer_buffer, urb->transfer_dma);
587 atomic_dec(&priv->active_tx_urbs);
589 if (!netif_device_present(netdev))
593 netdev_info(netdev, "Tx URB aborted (%d)\n",
596 netdev->stats.tx_packets++;
597 netdev->stats.tx_bytes += context->dlc;
599 can_get_echo_skb(netdev, context->echo_index);
601 can_led_event(netdev, CAN_LED_EVENT_TX);
603 /* Release context */
604 context->echo_index = MAX_TX_URBS;
606 netif_wake_queue(netdev);
609 /* Send data to device */
610 static netdev_tx_t usb_8dev_start_xmit(struct sk_buff *skb,
611 struct net_device *netdev)
613 struct usb_8dev_priv *priv = netdev_priv(netdev);
614 struct net_device_stats *stats = &netdev->stats;
615 struct can_frame *cf = (struct can_frame *) skb->data;
616 struct usb_8dev_tx_msg *msg;
618 struct usb_8dev_tx_urb_context *context = NULL;
621 size_t size = sizeof(struct usb_8dev_tx_msg);
623 if (can_dropped_invalid_skb(netdev, skb))
626 /* create a URB, and a buffer for it, and copy the data to the URB */
627 urb = usb_alloc_urb(0, GFP_ATOMIC);
629 netdev_err(netdev, "No memory left for URBs\n");
633 buf = usb_alloc_coherent(priv->udev, size, GFP_ATOMIC,
636 netdev_err(netdev, "No memory left for USB buffer\n");
640 memset(buf, 0, size);
642 msg = (struct usb_8dev_tx_msg *)buf;
643 msg->begin = USB_8DEV_DATA_START;
646 if (cf->can_id & CAN_RTR_FLAG)
647 msg->flags |= USB_8DEV_RTR;
649 if (cf->can_id & CAN_EFF_FLAG)
650 msg->flags |= USB_8DEV_EXTID;
652 msg->id = cpu_to_be32(cf->can_id & CAN_ERR_MASK);
653 msg->dlc = cf->can_dlc;
654 memcpy(msg->data, cf->data, cf->can_dlc);
655 msg->end = USB_8DEV_DATA_END;
657 for (i = 0; i < MAX_TX_URBS; i++) {
658 if (priv->tx_contexts[i].echo_index == MAX_TX_URBS) {
659 context = &priv->tx_contexts[i];
664 /* May never happen! When this happens we'd more URBs in flight as
665 * allowed (MAX_TX_URBS).
670 context->priv = priv;
671 context->echo_index = i;
672 context->dlc = cf->can_dlc;
674 usb_fill_bulk_urb(urb, priv->udev,
675 usb_sndbulkpipe(priv->udev, USB_8DEV_ENDP_DATA_TX),
676 buf, size, usb_8dev_write_bulk_callback, context);
677 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
678 usb_anchor_urb(urb, &priv->tx_submitted);
680 can_put_echo_skb(skb, netdev, context->echo_index);
682 atomic_inc(&priv->active_tx_urbs);
684 err = usb_submit_urb(urb, GFP_ATOMIC);
687 else if (atomic_read(&priv->active_tx_urbs) >= MAX_TX_URBS)
688 /* Slow down tx path */
689 netif_stop_queue(netdev);
691 /* Release our reference to this URB, the USB core will eventually free
699 usb_free_coherent(priv->udev, size, buf, urb->transfer_dma);
702 netdev_warn(netdev, "couldn't find free context");
704 return NETDEV_TX_BUSY;
707 can_free_echo_skb(netdev, context->echo_index);
709 usb_unanchor_urb(urb);
710 usb_free_coherent(priv->udev, size, buf, urb->transfer_dma);
712 atomic_dec(&priv->active_tx_urbs);
715 netif_device_detach(netdev);
717 netdev_warn(netdev, "failed tx_urb %d\n", err);
729 static int usb_8dev_get_berr_counter(const struct net_device *netdev,
730 struct can_berr_counter *bec)
732 struct usb_8dev_priv *priv = netdev_priv(netdev);
734 bec->txerr = priv->bec.txerr;
735 bec->rxerr = priv->bec.rxerr;
740 /* Start USB device */
741 static int usb_8dev_start(struct usb_8dev_priv *priv)
743 struct net_device *netdev = priv->netdev;
746 for (i = 0; i < MAX_RX_URBS; i++) {
747 struct urb *urb = NULL;
750 /* create a URB, and a buffer for it */
751 urb = usb_alloc_urb(0, GFP_KERNEL);
753 netdev_err(netdev, "No memory left for URBs\n");
758 buf = usb_alloc_coherent(priv->udev, RX_BUFFER_SIZE, GFP_KERNEL,
761 netdev_err(netdev, "No memory left for USB buffer\n");
767 usb_fill_bulk_urb(urb, priv->udev,
768 usb_rcvbulkpipe(priv->udev,
769 USB_8DEV_ENDP_DATA_RX),
771 usb_8dev_read_bulk_callback, priv);
772 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
773 usb_anchor_urb(urb, &priv->rx_submitted);
775 err = usb_submit_urb(urb, GFP_KERNEL);
777 usb_unanchor_urb(urb);
778 usb_free_coherent(priv->udev, RX_BUFFER_SIZE, buf,
784 /* Drop reference, USB core will take care of freeing it */
788 /* Did we submit any URBs */
790 netdev_warn(netdev, "couldn't setup read URBs\n");
794 /* Warn if we've couldn't transmit all the URBs */
796 netdev_warn(netdev, "rx performance may be slow\n");
798 err = usb_8dev_cmd_open(priv);
802 priv->can.state = CAN_STATE_ERROR_ACTIVE;
808 netif_device_detach(priv->netdev);
810 netdev_warn(netdev, "couldn't submit control: %d\n", err);
815 /* Open USB device */
816 static int usb_8dev_open(struct net_device *netdev)
818 struct usb_8dev_priv *priv = netdev_priv(netdev);
822 err = open_candev(netdev);
826 can_led_event(netdev, CAN_LED_EVENT_OPEN);
828 /* finally start device */
829 err = usb_8dev_start(priv);
832 netif_device_detach(priv->netdev);
834 netdev_warn(netdev, "couldn't start device: %d\n",
837 close_candev(netdev);
842 netif_start_queue(netdev);
847 static void unlink_all_urbs(struct usb_8dev_priv *priv)
851 usb_kill_anchored_urbs(&priv->rx_submitted);
853 usb_kill_anchored_urbs(&priv->tx_submitted);
854 atomic_set(&priv->active_tx_urbs, 0);
856 for (i = 0; i < MAX_TX_URBS; i++)
857 priv->tx_contexts[i].echo_index = MAX_TX_URBS;
860 /* Close USB device */
861 static int usb_8dev_close(struct net_device *netdev)
863 struct usb_8dev_priv *priv = netdev_priv(netdev);
866 /* Send CLOSE command to CAN controller */
867 err = usb_8dev_cmd_close(priv);
869 netdev_warn(netdev, "couldn't stop device");
871 priv->can.state = CAN_STATE_STOPPED;
873 netif_stop_queue(netdev);
876 unlink_all_urbs(priv);
878 close_candev(netdev);
880 can_led_event(netdev, CAN_LED_EVENT_STOP);
885 static const struct net_device_ops usb_8dev_netdev_ops = {
886 .ndo_open = usb_8dev_open,
887 .ndo_stop = usb_8dev_close,
888 .ndo_start_xmit = usb_8dev_start_xmit,
889 .ndo_change_mtu = can_change_mtu,
892 static const struct can_bittiming_const usb_8dev_bittiming_const = {
906 * Check device and firmware.
907 * Set supported modes and bittiming constants.
908 * Allocate some memory.
910 static int usb_8dev_probe(struct usb_interface *intf,
911 const struct usb_device_id *id)
913 struct net_device *netdev;
914 struct usb_8dev_priv *priv;
915 int i, err = -ENOMEM;
918 struct usb_device *usbdev = interface_to_usbdev(intf);
920 /* product id looks strange, better we also check iProduct string */
921 if (usb_string(usbdev, usbdev->descriptor.iProduct, buf,
922 sizeof(buf)) > 0 && strcmp(buf, "USB2CAN converter")) {
923 dev_info(&usbdev->dev, "ignoring: not an USB2CAN converter\n");
927 netdev = alloc_candev(sizeof(struct usb_8dev_priv), MAX_TX_URBS);
929 dev_err(&intf->dev, "Couldn't alloc candev\n");
933 priv = netdev_priv(netdev);
936 priv->netdev = netdev;
938 priv->can.state = CAN_STATE_STOPPED;
939 priv->can.clock.freq = USB_8DEV_ABP_CLOCK;
940 priv->can.bittiming_const = &usb_8dev_bittiming_const;
941 priv->can.do_set_mode = usb_8dev_set_mode;
942 priv->can.do_get_berr_counter = usb_8dev_get_berr_counter;
943 priv->can.ctrlmode_supported = CAN_CTRLMODE_LOOPBACK |
944 CAN_CTRLMODE_LISTENONLY |
945 CAN_CTRLMODE_ONE_SHOT;
947 netdev->netdev_ops = &usb_8dev_netdev_ops;
949 netdev->flags |= IFF_ECHO; /* we support local echo */
951 init_usb_anchor(&priv->rx_submitted);
953 init_usb_anchor(&priv->tx_submitted);
954 atomic_set(&priv->active_tx_urbs, 0);
956 for (i = 0; i < MAX_TX_URBS; i++)
957 priv->tx_contexts[i].echo_index = MAX_TX_URBS;
959 priv->cmd_msg_buffer = kzalloc(sizeof(struct usb_8dev_cmd_msg),
961 if (!priv->cmd_msg_buffer)
964 usb_set_intfdata(intf, priv);
966 SET_NETDEV_DEV(netdev, &intf->dev);
968 mutex_init(&priv->usb_8dev_cmd_lock);
970 err = register_candev(netdev);
973 "couldn't register CAN device: %d\n", err);
974 goto cleanup_cmd_msg_buffer;
977 err = usb_8dev_cmd_version(priv, &version);
979 netdev_err(netdev, "can't get firmware version\n");
980 goto cleanup_unregister_candev;
983 "firmware: %d.%d, hardware: %d.%d\n",
984 (version>>24) & 0xff, (version>>16) & 0xff,
985 (version>>8) & 0xff, version & 0xff);
988 devm_can_led_init(netdev);
992 cleanup_unregister_candev:
993 unregister_netdev(priv->netdev);
995 cleanup_cmd_msg_buffer:
996 kfree(priv->cmd_msg_buffer);
1005 /* Called by the usb core when driver is unloaded or device is removed */
1006 static void usb_8dev_disconnect(struct usb_interface *intf)
1008 struct usb_8dev_priv *priv = usb_get_intfdata(intf);
1010 usb_set_intfdata(intf, NULL);
1013 netdev_info(priv->netdev, "device disconnected\n");
1015 unregister_netdev(priv->netdev);
1016 free_candev(priv->netdev);
1018 unlink_all_urbs(priv);
1023 static struct usb_driver usb_8dev_driver = {
1025 .probe = usb_8dev_probe,
1026 .disconnect = usb_8dev_disconnect,
1027 .id_table = usb_8dev_table,
1030 module_usb_driver(usb_8dev_driver);
1032 MODULE_AUTHOR("Bernd Krumboeck <krumboeck@universalnet.at>");
1033 MODULE_DESCRIPTION("CAN driver for 8 devices USB2CAN interfaces");
1034 MODULE_LICENSE("GPL v2");