1 // SPDX-License-Identifier: GPL-2.0-only
2 /* SocketCAN driver for Microchip CAN BUS Analyzer Tool
4 * Copyright (C) 2017 Mobica Limited
6 * This driver is inspired by the 4.6.2 version of net/can/usb/usb_8dev.c
9 #include <asm/unaligned.h>
10 #include <linux/can.h>
11 #include <linux/can/dev.h>
12 #include <linux/can/error.h>
13 #include <linux/can/led.h>
14 #include <linux/module.h>
15 #include <linux/netdevice.h>
16 #include <linux/signal.h>
17 #include <linux/slab.h>
18 #include <linux/usb.h>
20 /* vendor and product id */
21 #define MCBA_MODULE_NAME "mcba_usb"
22 #define MCBA_VENDOR_ID 0x04d8
23 #define MCBA_PRODUCT_ID 0x0a30
25 /* driver constants */
26 #define MCBA_MAX_RX_URBS 20
27 #define MCBA_MAX_TX_URBS 20
28 #define MCBA_CTX_FREE MCBA_MAX_TX_URBS
30 /* RX buffer must be bigger than msg size since at the
31 * beginning USB messages are stacked.
33 #define MCBA_USB_RX_BUFF_SIZE 64
34 #define MCBA_USB_TX_BUFF_SIZE (sizeof(struct mcba_usb_msg))
36 /* Microchip command id */
37 #define MBCA_CMD_RECEIVE_MESSAGE 0xE3
38 #define MBCA_CMD_I_AM_ALIVE_FROM_CAN 0xF5
39 #define MBCA_CMD_I_AM_ALIVE_FROM_USB 0xF7
40 #define MBCA_CMD_CHANGE_BIT_RATE 0xA1
41 #define MBCA_CMD_TRANSMIT_MESSAGE_EV 0xA3
42 #define MBCA_CMD_SETUP_TERMINATION_RESISTANCE 0xA8
43 #define MBCA_CMD_READ_FW_VERSION 0xA9
44 #define MBCA_CMD_NOTHING_TO_SEND 0xFF
45 #define MBCA_CMD_TRANSMIT_MESSAGE_RSP 0xE2
47 #define MCBA_VER_REQ_USB 1
48 #define MCBA_VER_REQ_CAN 2
50 #define MCBA_SIDL_EXID_MASK 0x8
51 #define MCBA_DLC_MASK 0xf
52 #define MCBA_DLC_RTR_MASK 0x40
54 #define MCBA_CAN_STATE_WRN_TH 95
55 #define MCBA_CAN_STATE_ERR_PSV_TH 127
57 #define MCBA_TERMINATION_DISABLED CAN_TERMINATION_DISABLED
58 #define MCBA_TERMINATION_ENABLED 120
61 struct mcba_priv *priv;
67 /* Structure to hold all of our device specific stuff */
69 struct can_priv can; /* must be the first member */
70 struct sk_buff *echo_skb[MCBA_MAX_TX_URBS];
71 struct mcba_usb_ctx tx_context[MCBA_MAX_TX_URBS];
72 struct usb_device *udev;
73 struct net_device *netdev;
74 struct usb_anchor tx_submitted;
75 struct usb_anchor rx_submitted;
76 struct can_berr_counter bec;
77 bool usb_ka_first_pass;
78 bool can_ka_first_pass;
80 atomic_t free_ctx_cnt;
81 void *rxbuf[MCBA_MAX_RX_URBS];
82 dma_addr_t rxbuf_dma[MCBA_MAX_RX_URBS];
88 struct __packed mcba_usb_msg_can {
99 struct __packed mcba_usb_msg {
104 struct __packed mcba_usb_msg_ka_usb {
106 u8 termination_state;
112 struct __packed mcba_usb_msg_ka_can {
129 struct __packed mcba_usb_msg_change_bitrate {
135 struct __packed mcba_usb_msg_termination {
141 struct __packed mcba_usb_msg_fw_ver {
147 static const struct usb_device_id mcba_usb_table[] = {
148 { USB_DEVICE(MCBA_VENDOR_ID, MCBA_PRODUCT_ID) },
149 {} /* Terminating entry */
152 MODULE_DEVICE_TABLE(usb, mcba_usb_table);
154 static const u16 mcba_termination[] = { MCBA_TERMINATION_DISABLED,
155 MCBA_TERMINATION_ENABLED };
157 static const u32 mcba_bitrate[] = { 20000, 33333, 50000, 80000, 83333,
158 100000, 125000, 150000, 175000, 200000,
159 225000, 250000, 275000, 300000, 500000,
160 625000, 800000, 1000000 };
162 static inline void mcba_init_ctx(struct mcba_priv *priv)
166 for (i = 0; i < MCBA_MAX_TX_URBS; i++) {
167 priv->tx_context[i].ndx = MCBA_CTX_FREE;
168 priv->tx_context[i].priv = priv;
171 atomic_set(&priv->free_ctx_cnt, ARRAY_SIZE(priv->tx_context));
174 static inline struct mcba_usb_ctx *mcba_usb_get_free_ctx(struct mcba_priv *priv,
175 struct can_frame *cf)
178 struct mcba_usb_ctx *ctx = NULL;
180 for (i = 0; i < MCBA_MAX_TX_URBS; i++) {
181 if (priv->tx_context[i].ndx == MCBA_CTX_FREE) {
182 ctx = &priv->tx_context[i];
187 ctx->dlc = cf->can_dlc;
193 atomic_dec(&priv->free_ctx_cnt);
198 if (!atomic_read(&priv->free_ctx_cnt))
199 /* That was the last free ctx. Slow down tx path */
200 netif_stop_queue(priv->netdev);
205 /* mcba_usb_free_ctx and mcba_usb_get_free_ctx are executed by different
206 * threads. The order of execution in below function is important.
208 static inline void mcba_usb_free_ctx(struct mcba_usb_ctx *ctx)
210 /* Increase number of free ctxs before freeing ctx */
211 atomic_inc(&ctx->priv->free_ctx_cnt);
213 ctx->ndx = MCBA_CTX_FREE;
215 /* Wake up the queue once ctx is marked free */
216 netif_wake_queue(ctx->priv->netdev);
219 static void mcba_usb_write_bulk_callback(struct urb *urb)
221 struct mcba_usb_ctx *ctx = urb->context;
222 struct net_device *netdev;
226 netdev = ctx->priv->netdev;
228 /* free up our allocated buffer */
229 usb_free_coherent(urb->dev, urb->transfer_buffer_length,
230 urb->transfer_buffer, urb->transfer_dma);
233 if (!netif_device_present(netdev))
236 netdev->stats.tx_packets++;
237 netdev->stats.tx_bytes += ctx->dlc;
239 can_led_event(netdev, CAN_LED_EVENT_TX);
240 can_get_echo_skb(netdev, ctx->ndx);
244 netdev_info(netdev, "Tx URB aborted (%d)\n", urb->status);
246 /* Release the context */
247 mcba_usb_free_ctx(ctx);
250 /* Send data to device */
251 static netdev_tx_t mcba_usb_xmit(struct mcba_priv *priv,
252 struct mcba_usb_msg *usb_msg,
253 struct mcba_usb_ctx *ctx)
259 /* create a URB, and a buffer for it, and copy the data to the URB */
260 urb = usb_alloc_urb(0, GFP_ATOMIC);
264 buf = usb_alloc_coherent(priv->udev, MCBA_USB_TX_BUFF_SIZE, GFP_ATOMIC,
271 memcpy(buf, usb_msg, MCBA_USB_TX_BUFF_SIZE);
273 usb_fill_bulk_urb(urb, priv->udev, priv->tx_pipe, buf, MCBA_USB_TX_BUFF_SIZE,
274 mcba_usb_write_bulk_callback, ctx);
276 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
277 usb_anchor_urb(urb, &priv->tx_submitted);
279 err = usb_submit_urb(urb, GFP_ATOMIC);
283 /* Release our reference to this URB, the USB core will eventually free
291 usb_unanchor_urb(urb);
292 usb_free_coherent(priv->udev, MCBA_USB_TX_BUFF_SIZE, buf,
296 netif_device_detach(priv->netdev);
298 netdev_warn(priv->netdev, "failed tx_urb %d\n", err);
306 /* Send data to device */
307 static netdev_tx_t mcba_usb_start_xmit(struct sk_buff *skb,
308 struct net_device *netdev)
310 struct mcba_priv *priv = netdev_priv(netdev);
311 struct can_frame *cf = (struct can_frame *)skb->data;
312 struct mcba_usb_ctx *ctx = NULL;
313 struct net_device_stats *stats = &priv->netdev->stats;
316 struct mcba_usb_msg_can usb_msg = {
317 .cmd_id = MBCA_CMD_TRANSMIT_MESSAGE_EV
320 if (can_dropped_invalid_skb(netdev, skb))
323 ctx = mcba_usb_get_free_ctx(priv, cf);
325 return NETDEV_TX_BUSY;
327 if (cf->can_id & CAN_EFF_FLAG) {
328 /* SIDH | SIDL | EIDH | EIDL
329 * 28 - 21 | 20 19 18 x x x 17 16 | 15 - 8 | 7 - 0
331 sid = MCBA_SIDL_EXID_MASK;
332 /* store 28-18 bits */
333 sid |= (cf->can_id & 0x1ffc0000) >> 13;
334 /* store 17-16 bits */
335 sid |= (cf->can_id & 0x30000) >> 16;
336 put_unaligned_be16(sid, &usb_msg.sid);
338 /* store 15-0 bits */
339 put_unaligned_be16(cf->can_id & 0xffff, &usb_msg.eid);
342 * 10 - 3 | 2 1 0 x x x x x
344 put_unaligned_be16((cf->can_id & CAN_SFF_MASK) << 5,
349 usb_msg.dlc = cf->can_dlc;
351 memcpy(usb_msg.data, cf->data, usb_msg.dlc);
353 if (cf->can_id & CAN_RTR_FLAG)
354 usb_msg.dlc |= MCBA_DLC_RTR_MASK;
356 can_put_echo_skb(skb, priv->netdev, ctx->ndx);
358 err = mcba_usb_xmit(priv, (struct mcba_usb_msg *)&usb_msg, ctx);
365 can_free_echo_skb(priv->netdev, ctx->ndx);
366 mcba_usb_free_ctx(ctx);
372 /* Send cmd to device */
373 static void mcba_usb_xmit_cmd(struct mcba_priv *priv,
374 struct mcba_usb_msg *usb_msg)
376 struct mcba_usb_ctx *ctx = NULL;
379 ctx = mcba_usb_get_free_ctx(priv, NULL);
381 netdev_err(priv->netdev,
382 "Lack of free ctx. Sending (%d) cmd aborted",
388 err = mcba_usb_xmit(priv, usb_msg, ctx);
390 netdev_err(priv->netdev, "Failed to send cmd (%d)",
394 static void mcba_usb_xmit_change_bitrate(struct mcba_priv *priv, u16 bitrate)
396 struct mcba_usb_msg_change_bitrate usb_msg = {
397 .cmd_id = MBCA_CMD_CHANGE_BIT_RATE
400 put_unaligned_be16(bitrate, &usb_msg.bitrate);
402 mcba_usb_xmit_cmd(priv, (struct mcba_usb_msg *)&usb_msg);
405 static void mcba_usb_xmit_read_fw_ver(struct mcba_priv *priv, u8 pic)
407 struct mcba_usb_msg_fw_ver usb_msg = {
408 .cmd_id = MBCA_CMD_READ_FW_VERSION,
412 mcba_usb_xmit_cmd(priv, (struct mcba_usb_msg *)&usb_msg);
415 static void mcba_usb_process_can(struct mcba_priv *priv,
416 struct mcba_usb_msg_can *msg)
418 struct can_frame *cf;
420 struct net_device_stats *stats = &priv->netdev->stats;
423 skb = alloc_can_skb(priv->netdev, &cf);
427 sid = get_unaligned_be16(&msg->sid);
429 if (sid & MCBA_SIDL_EXID_MASK) {
430 /* SIDH | SIDL | EIDH | EIDL
431 * 28 - 21 | 20 19 18 x x x 17 16 | 15 - 8 | 7 - 0
433 cf->can_id = CAN_EFF_FLAG;
435 /* store 28-18 bits */
436 cf->can_id |= (sid & 0xffe0) << 13;
437 /* store 17-16 bits */
438 cf->can_id |= (sid & 3) << 16;
439 /* store 15-0 bits */
440 cf->can_id |= get_unaligned_be16(&msg->eid);
443 * 10 - 3 | 2 1 0 x x x x x
445 cf->can_id = (sid & 0xffe0) >> 5;
448 if (msg->dlc & MCBA_DLC_RTR_MASK)
449 cf->can_id |= CAN_RTR_FLAG;
451 cf->can_dlc = get_can_dlc(msg->dlc & MCBA_DLC_MASK);
453 memcpy(cf->data, msg->data, cf->can_dlc);
456 stats->rx_bytes += cf->can_dlc;
458 can_led_event(priv->netdev, CAN_LED_EVENT_RX);
462 static void mcba_usb_process_ka_usb(struct mcba_priv *priv,
463 struct mcba_usb_msg_ka_usb *msg)
465 if (unlikely(priv->usb_ka_first_pass)) {
466 netdev_info(priv->netdev, "PIC USB version %hhu.%hhu\n",
467 msg->soft_ver_major, msg->soft_ver_minor);
469 priv->usb_ka_first_pass = false;
472 if (msg->termination_state)
473 priv->can.termination = MCBA_TERMINATION_ENABLED;
475 priv->can.termination = MCBA_TERMINATION_DISABLED;
478 static u32 convert_can2host_bitrate(struct mcba_usb_msg_ka_can *msg)
480 const u32 bitrate = get_unaligned_be16(&msg->can_bitrate);
482 if ((bitrate == 33) || (bitrate == 83))
483 return bitrate * 1000 + 333;
485 return bitrate * 1000;
488 static void mcba_usb_process_ka_can(struct mcba_priv *priv,
489 struct mcba_usb_msg_ka_can *msg)
491 if (unlikely(priv->can_ka_first_pass)) {
492 netdev_info(priv->netdev, "PIC CAN version %hhu.%hhu\n",
493 msg->soft_ver_major, msg->soft_ver_minor);
495 priv->can_ka_first_pass = false;
498 if (unlikely(priv->can_speed_check)) {
499 const u32 bitrate = convert_can2host_bitrate(msg);
501 priv->can_speed_check = false;
503 if (bitrate != priv->can.bittiming.bitrate)
506 "Wrong bitrate reported by the device (%u). Expected %u",
507 bitrate, priv->can.bittiming.bitrate);
510 priv->bec.txerr = msg->tx_err_cnt;
511 priv->bec.rxerr = msg->rx_err_cnt;
514 priv->can.state = CAN_STATE_BUS_OFF;
516 else if ((priv->bec.txerr > MCBA_CAN_STATE_ERR_PSV_TH) ||
517 (priv->bec.rxerr > MCBA_CAN_STATE_ERR_PSV_TH))
518 priv->can.state = CAN_STATE_ERROR_PASSIVE;
520 else if ((priv->bec.txerr > MCBA_CAN_STATE_WRN_TH) ||
521 (priv->bec.rxerr > MCBA_CAN_STATE_WRN_TH))
522 priv->can.state = CAN_STATE_ERROR_WARNING;
525 static void mcba_usb_process_rx(struct mcba_priv *priv,
526 struct mcba_usb_msg *msg)
528 switch (msg->cmd_id) {
529 case MBCA_CMD_I_AM_ALIVE_FROM_CAN:
530 mcba_usb_process_ka_can(priv,
531 (struct mcba_usb_msg_ka_can *)msg);
534 case MBCA_CMD_I_AM_ALIVE_FROM_USB:
535 mcba_usb_process_ka_usb(priv,
536 (struct mcba_usb_msg_ka_usb *)msg);
539 case MBCA_CMD_RECEIVE_MESSAGE:
540 mcba_usb_process_can(priv, (struct mcba_usb_msg_can *)msg);
543 case MBCA_CMD_NOTHING_TO_SEND:
544 /* Side effect of communication between PIC_USB and PIC_CAN.
545 * PIC_CAN is telling us that it has nothing to send
549 case MBCA_CMD_TRANSMIT_MESSAGE_RSP:
550 /* Transmission response from the device containing timestamp */
554 netdev_warn(priv->netdev, "Unsupported msg (0x%hhX)",
560 /* Callback for reading data from device
562 * Check urb status, call read function and resubmit urb read operation.
564 static void mcba_usb_read_bulk_callback(struct urb *urb)
566 struct mcba_priv *priv = urb->context;
567 struct net_device *netdev;
571 netdev = priv->netdev;
573 if (!netif_device_present(netdev))
576 switch (urb->status) {
577 case 0: /* success */
587 netdev_info(netdev, "Rx URB aborted (%d)\n", urb->status);
592 while (pos < urb->actual_length) {
593 struct mcba_usb_msg *msg;
595 if (pos + sizeof(struct mcba_usb_msg) > urb->actual_length) {
596 netdev_err(priv->netdev, "format error\n");
600 msg = (struct mcba_usb_msg *)(urb->transfer_buffer + pos);
601 mcba_usb_process_rx(priv, msg);
603 pos += sizeof(struct mcba_usb_msg);
608 usb_fill_bulk_urb(urb, priv->udev,
610 urb->transfer_buffer, MCBA_USB_RX_BUFF_SIZE,
611 mcba_usb_read_bulk_callback, priv);
613 retval = usb_submit_urb(urb, GFP_ATOMIC);
615 if (retval == -ENODEV)
616 netif_device_detach(netdev);
618 netdev_err(netdev, "failed resubmitting read bulk urb: %d\n",
622 /* Start USB device */
623 static int mcba_usb_start(struct mcba_priv *priv)
625 struct net_device *netdev = priv->netdev;
630 for (i = 0; i < MCBA_MAX_RX_URBS; i++) {
631 struct urb *urb = NULL;
635 /* create a URB, and a buffer for it */
636 urb = usb_alloc_urb(0, GFP_KERNEL);
642 buf = usb_alloc_coherent(priv->udev, MCBA_USB_RX_BUFF_SIZE,
643 GFP_KERNEL, &buf_dma);
645 netdev_err(netdev, "No memory left for USB buffer\n");
651 urb->transfer_dma = buf_dma;
653 usb_fill_bulk_urb(urb, priv->udev,
655 buf, MCBA_USB_RX_BUFF_SIZE,
656 mcba_usb_read_bulk_callback, priv);
657 urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP;
658 usb_anchor_urb(urb, &priv->rx_submitted);
660 err = usb_submit_urb(urb, GFP_KERNEL);
662 usb_unanchor_urb(urb);
663 usb_free_coherent(priv->udev, MCBA_USB_RX_BUFF_SIZE,
669 priv->rxbuf[i] = buf;
670 priv->rxbuf_dma[i] = buf_dma;
672 /* Drop reference, USB core will take care of freeing it */
676 /* Did we submit any URBs */
678 netdev_warn(netdev, "couldn't setup read URBs\n");
682 /* Warn if we've couldn't transmit all the URBs */
683 if (i < MCBA_MAX_RX_URBS)
684 netdev_warn(netdev, "rx performance may be slow\n");
686 mcba_usb_xmit_read_fw_ver(priv, MCBA_VER_REQ_USB);
687 mcba_usb_xmit_read_fw_ver(priv, MCBA_VER_REQ_CAN);
692 /* Open USB device */
693 static int mcba_usb_open(struct net_device *netdev)
695 struct mcba_priv *priv = netdev_priv(netdev);
699 err = open_candev(netdev);
703 priv->can_speed_check = true;
704 priv->can.state = CAN_STATE_ERROR_ACTIVE;
706 can_led_event(netdev, CAN_LED_EVENT_OPEN);
707 netif_start_queue(netdev);
712 static void mcba_urb_unlink(struct mcba_priv *priv)
716 usb_kill_anchored_urbs(&priv->rx_submitted);
718 for (i = 0; i < MCBA_MAX_RX_URBS; ++i)
719 usb_free_coherent(priv->udev, MCBA_USB_RX_BUFF_SIZE,
720 priv->rxbuf[i], priv->rxbuf_dma[i]);
722 usb_kill_anchored_urbs(&priv->tx_submitted);
725 /* Close USB device */
726 static int mcba_usb_close(struct net_device *netdev)
728 struct mcba_priv *priv = netdev_priv(netdev);
730 priv->can.state = CAN_STATE_STOPPED;
732 netif_stop_queue(netdev);
735 mcba_urb_unlink(priv);
737 close_candev(netdev);
738 can_led_event(netdev, CAN_LED_EVENT_STOP);
743 /* Set network device mode
745 * Maybe we should leave this function empty, because the device
746 * set mode variable with open command.
748 static int mcba_net_set_mode(struct net_device *netdev, enum can_mode mode)
753 static int mcba_net_get_berr_counter(const struct net_device *netdev,
754 struct can_berr_counter *bec)
756 struct mcba_priv *priv = netdev_priv(netdev);
758 bec->txerr = priv->bec.txerr;
759 bec->rxerr = priv->bec.rxerr;
764 static const struct net_device_ops mcba_netdev_ops = {
765 .ndo_open = mcba_usb_open,
766 .ndo_stop = mcba_usb_close,
767 .ndo_start_xmit = mcba_usb_start_xmit,
770 /* Microchip CANBUS has hardcoded bittiming values by default.
771 * This function sends request via USB to change the speed and align bittiming
772 * values for presentation purposes only
774 static int mcba_net_set_bittiming(struct net_device *netdev)
776 struct mcba_priv *priv = netdev_priv(netdev);
777 const u16 bitrate_kbps = priv->can.bittiming.bitrate / 1000;
779 mcba_usb_xmit_change_bitrate(priv, bitrate_kbps);
784 static int mcba_set_termination(struct net_device *netdev, u16 term)
786 struct mcba_priv *priv = netdev_priv(netdev);
787 struct mcba_usb_msg_termination usb_msg = {
788 .cmd_id = MBCA_CMD_SETUP_TERMINATION_RESISTANCE
791 if (term == MCBA_TERMINATION_ENABLED)
792 usb_msg.termination = 1;
794 usb_msg.termination = 0;
796 mcba_usb_xmit_cmd(priv, (struct mcba_usb_msg *)&usb_msg);
801 static int mcba_usb_probe(struct usb_interface *intf,
802 const struct usb_device_id *id)
804 struct net_device *netdev;
805 struct mcba_priv *priv;
807 struct usb_device *usbdev = interface_to_usbdev(intf);
808 struct usb_endpoint_descriptor *in, *out;
810 err = usb_find_common_endpoints(intf->cur_altsetting, &in, &out, NULL, NULL);
812 dev_err(&intf->dev, "Can't find endpoints\n");
816 netdev = alloc_candev(sizeof(struct mcba_priv), MCBA_MAX_TX_URBS);
818 dev_err(&intf->dev, "Couldn't alloc candev\n");
822 priv = netdev_priv(netdev);
825 priv->netdev = netdev;
826 priv->usb_ka_first_pass = true;
827 priv->can_ka_first_pass = true;
828 priv->can_speed_check = false;
830 init_usb_anchor(&priv->rx_submitted);
831 init_usb_anchor(&priv->tx_submitted);
833 usb_set_intfdata(intf, priv);
835 /* Init CAN device */
836 priv->can.state = CAN_STATE_STOPPED;
837 priv->can.termination_const = mcba_termination;
838 priv->can.termination_const_cnt = ARRAY_SIZE(mcba_termination);
839 priv->can.bitrate_const = mcba_bitrate;
840 priv->can.bitrate_const_cnt = ARRAY_SIZE(mcba_bitrate);
842 priv->can.do_set_termination = mcba_set_termination;
843 priv->can.do_set_mode = mcba_net_set_mode;
844 priv->can.do_get_berr_counter = mcba_net_get_berr_counter;
845 priv->can.do_set_bittiming = mcba_net_set_bittiming;
847 netdev->netdev_ops = &mcba_netdev_ops;
849 netdev->flags |= IFF_ECHO; /* we support local echo */
851 SET_NETDEV_DEV(netdev, &intf->dev);
853 err = register_candev(netdev);
855 netdev_err(netdev, "couldn't register CAN device: %d\n", err);
857 goto cleanup_free_candev;
860 priv->rx_pipe = usb_rcvbulkpipe(priv->udev, in->bEndpointAddress);
861 priv->tx_pipe = usb_sndbulkpipe(priv->udev, out->bEndpointAddress);
863 devm_can_led_init(netdev);
865 /* Start USB dev only if we have successfully registered CAN device */
866 err = mcba_usb_start(priv);
869 netif_device_detach(priv->netdev);
871 netdev_warn(netdev, "couldn't start device: %d\n", err);
873 goto cleanup_unregister_candev;
876 dev_info(&intf->dev, "Microchip CAN BUS Analyzer connected\n");
880 cleanup_unregister_candev:
881 unregister_candev(priv->netdev);
889 /* Called by the usb core when driver is unloaded or device is removed */
890 static void mcba_usb_disconnect(struct usb_interface *intf)
892 struct mcba_priv *priv = usb_get_intfdata(intf);
894 usb_set_intfdata(intf, NULL);
896 netdev_info(priv->netdev, "device disconnected\n");
898 unregister_candev(priv->netdev);
899 mcba_urb_unlink(priv);
900 free_candev(priv->netdev);
903 static struct usb_driver mcba_usb_driver = {
904 .name = MCBA_MODULE_NAME,
905 .probe = mcba_usb_probe,
906 .disconnect = mcba_usb_disconnect,
907 .id_table = mcba_usb_table,
910 module_usb_driver(mcba_usb_driver);
912 MODULE_AUTHOR("Remigiusz Kołłątaj <remigiusz.kollataj@mobica.com>");
913 MODULE_DESCRIPTION("SocketCAN driver for Microchip CAN BUS Analyzer Tool");
914 MODULE_LICENSE("GPL v2");