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
[3] = CAN_ERR_PROT_LOC_CRC_SEQ
;
407 case USB_8DEV_STATUSMSG_BIT0
:
408 cf
->data
[2] |= CAN_ERR_PROT_BIT0
;
411 case USB_8DEV_STATUSMSG_BIT1
:
412 cf
->data
[2] |= CAN_ERR_PROT_BIT1
;
415 case USB_8DEV_STATUSMSG_FORM
:
416 cf
->data
[2] |= CAN_ERR_PROT_FORM
;
419 case USB_8DEV_STATUSMSG_STUFF
:
420 cf
->data
[2] |= CAN_ERR_PROT_STUFF
;
423 case USB_8DEV_STATUSMSG_OVERRUN
:
424 cf
->data
[1] = CAN_ERR_CRTL_RX_OVERFLOW
;
425 stats
->rx_over_errors
++;
428 case USB_8DEV_STATUSMSG_BUSLIGHT
:
429 priv
->can
.state
= CAN_STATE_ERROR_WARNING
;
430 cf
->data
[1] = (txerr
> rxerr
) ?
431 CAN_ERR_CRTL_TX_WARNING
:
432 CAN_ERR_CRTL_RX_WARNING
;
433 priv
->can
.can_stats
.error_warning
++;
435 case USB_8DEV_STATUSMSG_BUSHEAVY
:
436 priv
->can
.state
= CAN_STATE_ERROR_PASSIVE
;
437 cf
->data
[1] = (txerr
> rxerr
) ?
438 CAN_ERR_CRTL_TX_PASSIVE
:
439 CAN_ERR_CRTL_RX_PASSIVE
;
440 priv
->can
.can_stats
.error_passive
++;
443 netdev_warn(priv
->netdev
,
444 "Unknown status/error message (%d)\n", state
);
449 cf
->data
[2] |= CAN_ERR_PROT_TX
;
459 priv
->bec
.txerr
= txerr
;
460 priv
->bec
.rxerr
= rxerr
;
463 stats
->rx_bytes
+= cf
->can_dlc
;
467 /* Read data and status frames */
468 static void usb_8dev_rx_can_msg(struct usb_8dev_priv
*priv
,
469 struct usb_8dev_rx_msg
*msg
)
471 struct can_frame
*cf
;
473 struct net_device_stats
*stats
= &priv
->netdev
->stats
;
475 if (msg
->type
== USB_8DEV_TYPE_ERROR_FRAME
&&
476 msg
->flags
== USB_8DEV_ERR_FLAG
) {
477 usb_8dev_rx_err_msg(priv
, msg
);
478 } else if (msg
->type
== USB_8DEV_TYPE_CAN_FRAME
) {
479 skb
= alloc_can_skb(priv
->netdev
, &cf
);
483 cf
->can_id
= be32_to_cpu(msg
->id
);
484 cf
->can_dlc
= get_can_dlc(msg
->dlc
& 0xF);
486 if (msg
->flags
& USB_8DEV_EXTID
)
487 cf
->can_id
|= CAN_EFF_FLAG
;
489 if (msg
->flags
& USB_8DEV_RTR
)
490 cf
->can_id
|= CAN_RTR_FLAG
;
492 memcpy(cf
->data
, msg
->data
, cf
->can_dlc
);
495 stats
->rx_bytes
+= cf
->can_dlc
;
498 can_led_event(priv
->netdev
, CAN_LED_EVENT_RX
);
500 netdev_warn(priv
->netdev
, "frame type %d unknown",
506 /* Callback for reading data from device
508 * Check urb status, call read function and resubmit urb read operation.
510 static void usb_8dev_read_bulk_callback(struct urb
*urb
)
512 struct usb_8dev_priv
*priv
= urb
->context
;
513 struct net_device
*netdev
;
517 netdev
= priv
->netdev
;
519 if (!netif_device_present(netdev
))
522 switch (urb
->status
) {
523 case 0: /* success */
531 netdev_info(netdev
, "Rx URB aborted (%d)\n",
536 while (pos
< urb
->actual_length
) {
537 struct usb_8dev_rx_msg
*msg
;
539 if (pos
+ sizeof(struct usb_8dev_rx_msg
) > urb
->actual_length
) {
540 netdev_err(priv
->netdev
, "format error\n");
544 msg
= (struct usb_8dev_rx_msg
*)(urb
->transfer_buffer
+ pos
);
545 usb_8dev_rx_can_msg(priv
, msg
);
547 pos
+= sizeof(struct usb_8dev_rx_msg
);
551 usb_fill_bulk_urb(urb
, priv
->udev
,
552 usb_rcvbulkpipe(priv
->udev
, USB_8DEV_ENDP_DATA_RX
),
553 urb
->transfer_buffer
, RX_BUFFER_SIZE
,
554 usb_8dev_read_bulk_callback
, priv
);
556 retval
= usb_submit_urb(urb
, GFP_ATOMIC
);
558 if (retval
== -ENODEV
)
559 netif_device_detach(netdev
);
562 "failed resubmitting read bulk urb: %d\n", retval
);
565 /* Callback handler for write operations
567 * Free allocated buffers, check transmit status and
568 * calculate statistic.
570 static void usb_8dev_write_bulk_callback(struct urb
*urb
)
572 struct usb_8dev_tx_urb_context
*context
= urb
->context
;
573 struct usb_8dev_priv
*priv
;
574 struct net_device
*netdev
;
578 priv
= context
->priv
;
579 netdev
= priv
->netdev
;
581 /* free up our allocated buffer */
582 usb_free_coherent(urb
->dev
, urb
->transfer_buffer_length
,
583 urb
->transfer_buffer
, urb
->transfer_dma
);
585 atomic_dec(&priv
->active_tx_urbs
);
587 if (!netif_device_present(netdev
))
591 netdev_info(netdev
, "Tx URB aborted (%d)\n",
594 netdev
->stats
.tx_packets
++;
595 netdev
->stats
.tx_bytes
+= context
->dlc
;
597 can_get_echo_skb(netdev
, context
->echo_index
);
599 can_led_event(netdev
, CAN_LED_EVENT_TX
);
601 /* Release context */
602 context
->echo_index
= MAX_TX_URBS
;
604 netif_wake_queue(netdev
);
607 /* Send data to device */
608 static netdev_tx_t
usb_8dev_start_xmit(struct sk_buff
*skb
,
609 struct net_device
*netdev
)
611 struct usb_8dev_priv
*priv
= netdev_priv(netdev
);
612 struct net_device_stats
*stats
= &netdev
->stats
;
613 struct can_frame
*cf
= (struct can_frame
*) skb
->data
;
614 struct usb_8dev_tx_msg
*msg
;
616 struct usb_8dev_tx_urb_context
*context
= NULL
;
619 size_t size
= sizeof(struct usb_8dev_tx_msg
);
621 if (can_dropped_invalid_skb(netdev
, skb
))
624 /* create a URB, and a buffer for it, and copy the data to the URB */
625 urb
= usb_alloc_urb(0, GFP_ATOMIC
);
629 buf
= usb_alloc_coherent(priv
->udev
, size
, GFP_ATOMIC
,
632 netdev_err(netdev
, "No memory left for USB buffer\n");
636 memset(buf
, 0, size
);
638 msg
= (struct usb_8dev_tx_msg
*)buf
;
639 msg
->begin
= USB_8DEV_DATA_START
;
642 if (cf
->can_id
& CAN_RTR_FLAG
)
643 msg
->flags
|= USB_8DEV_RTR
;
645 if (cf
->can_id
& CAN_EFF_FLAG
)
646 msg
->flags
|= USB_8DEV_EXTID
;
648 msg
->id
= cpu_to_be32(cf
->can_id
& CAN_ERR_MASK
);
649 msg
->dlc
= cf
->can_dlc
;
650 memcpy(msg
->data
, cf
->data
, cf
->can_dlc
);
651 msg
->end
= USB_8DEV_DATA_END
;
653 for (i
= 0; i
< MAX_TX_URBS
; i
++) {
654 if (priv
->tx_contexts
[i
].echo_index
== MAX_TX_URBS
) {
655 context
= &priv
->tx_contexts
[i
];
660 /* May never happen! When this happens we'd more URBs in flight as
661 * allowed (MAX_TX_URBS).
666 context
->priv
= priv
;
667 context
->echo_index
= i
;
668 context
->dlc
= cf
->can_dlc
;
670 usb_fill_bulk_urb(urb
, priv
->udev
,
671 usb_sndbulkpipe(priv
->udev
, USB_8DEV_ENDP_DATA_TX
),
672 buf
, size
, usb_8dev_write_bulk_callback
, context
);
673 urb
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
674 usb_anchor_urb(urb
, &priv
->tx_submitted
);
676 can_put_echo_skb(skb
, netdev
, context
->echo_index
);
678 atomic_inc(&priv
->active_tx_urbs
);
680 err
= usb_submit_urb(urb
, GFP_ATOMIC
);
683 else if (atomic_read(&priv
->active_tx_urbs
) >= MAX_TX_URBS
)
684 /* Slow down tx path */
685 netif_stop_queue(netdev
);
687 /* Release our reference to this URB, the USB core will eventually free
695 usb_free_coherent(priv
->udev
, size
, buf
, urb
->transfer_dma
);
698 netdev_warn(netdev
, "couldn't find free context");
700 return NETDEV_TX_BUSY
;
703 can_free_echo_skb(netdev
, context
->echo_index
);
705 usb_unanchor_urb(urb
);
706 usb_free_coherent(priv
->udev
, size
, buf
, urb
->transfer_dma
);
708 atomic_dec(&priv
->active_tx_urbs
);
711 netif_device_detach(netdev
);
713 netdev_warn(netdev
, "failed tx_urb %d\n", err
);
725 static int usb_8dev_get_berr_counter(const struct net_device
*netdev
,
726 struct can_berr_counter
*bec
)
728 struct usb_8dev_priv
*priv
= netdev_priv(netdev
);
730 bec
->txerr
= priv
->bec
.txerr
;
731 bec
->rxerr
= priv
->bec
.rxerr
;
736 /* Start USB device */
737 static int usb_8dev_start(struct usb_8dev_priv
*priv
)
739 struct net_device
*netdev
= priv
->netdev
;
742 for (i
= 0; i
< MAX_RX_URBS
; i
++) {
743 struct urb
*urb
= NULL
;
746 /* create a URB, and a buffer for it */
747 urb
= usb_alloc_urb(0, GFP_KERNEL
);
753 buf
= usb_alloc_coherent(priv
->udev
, RX_BUFFER_SIZE
, GFP_KERNEL
,
756 netdev_err(netdev
, "No memory left for USB buffer\n");
762 usb_fill_bulk_urb(urb
, priv
->udev
,
763 usb_rcvbulkpipe(priv
->udev
,
764 USB_8DEV_ENDP_DATA_RX
),
766 usb_8dev_read_bulk_callback
, priv
);
767 urb
->transfer_flags
|= URB_NO_TRANSFER_DMA_MAP
;
768 usb_anchor_urb(urb
, &priv
->rx_submitted
);
770 err
= usb_submit_urb(urb
, GFP_KERNEL
);
772 usb_unanchor_urb(urb
);
773 usb_free_coherent(priv
->udev
, RX_BUFFER_SIZE
, buf
,
779 /* Drop reference, USB core will take care of freeing it */
783 /* Did we submit any URBs */
785 netdev_warn(netdev
, "couldn't setup read URBs\n");
789 /* Warn if we've couldn't transmit all the URBs */
791 netdev_warn(netdev
, "rx performance may be slow\n");
793 err
= usb_8dev_cmd_open(priv
);
797 priv
->can
.state
= CAN_STATE_ERROR_ACTIVE
;
803 netif_device_detach(priv
->netdev
);
805 netdev_warn(netdev
, "couldn't submit control: %d\n", err
);
810 /* Open USB device */
811 static int usb_8dev_open(struct net_device
*netdev
)
813 struct usb_8dev_priv
*priv
= netdev_priv(netdev
);
817 err
= open_candev(netdev
);
821 can_led_event(netdev
, CAN_LED_EVENT_OPEN
);
823 /* finally start device */
824 err
= usb_8dev_start(priv
);
827 netif_device_detach(priv
->netdev
);
829 netdev_warn(netdev
, "couldn't start device: %d\n",
832 close_candev(netdev
);
837 netif_start_queue(netdev
);
842 static void unlink_all_urbs(struct usb_8dev_priv
*priv
)
846 usb_kill_anchored_urbs(&priv
->rx_submitted
);
848 usb_kill_anchored_urbs(&priv
->tx_submitted
);
849 atomic_set(&priv
->active_tx_urbs
, 0);
851 for (i
= 0; i
< MAX_TX_URBS
; i
++)
852 priv
->tx_contexts
[i
].echo_index
= MAX_TX_URBS
;
855 /* Close USB device */
856 static int usb_8dev_close(struct net_device
*netdev
)
858 struct usb_8dev_priv
*priv
= netdev_priv(netdev
);
861 /* Send CLOSE command to CAN controller */
862 err
= usb_8dev_cmd_close(priv
);
864 netdev_warn(netdev
, "couldn't stop device");
866 priv
->can
.state
= CAN_STATE_STOPPED
;
868 netif_stop_queue(netdev
);
871 unlink_all_urbs(priv
);
873 close_candev(netdev
);
875 can_led_event(netdev
, CAN_LED_EVENT_STOP
);
880 static const struct net_device_ops usb_8dev_netdev_ops
= {
881 .ndo_open
= usb_8dev_open
,
882 .ndo_stop
= usb_8dev_close
,
883 .ndo_start_xmit
= usb_8dev_start_xmit
,
884 .ndo_change_mtu
= can_change_mtu
,
887 static const struct can_bittiming_const usb_8dev_bittiming_const
= {
901 * Check device and firmware.
902 * Set supported modes and bittiming constants.
903 * Allocate some memory.
905 static int usb_8dev_probe(struct usb_interface
*intf
,
906 const struct usb_device_id
*id
)
908 struct net_device
*netdev
;
909 struct usb_8dev_priv
*priv
;
910 int i
, err
= -ENOMEM
;
913 struct usb_device
*usbdev
= interface_to_usbdev(intf
);
915 /* product id looks strange, better we also check iProduct string */
916 if (usb_string(usbdev
, usbdev
->descriptor
.iProduct
, buf
,
917 sizeof(buf
)) > 0 && strcmp(buf
, "USB2CAN converter")) {
918 dev_info(&usbdev
->dev
, "ignoring: not an USB2CAN converter\n");
922 netdev
= alloc_candev(sizeof(struct usb_8dev_priv
), MAX_TX_URBS
);
924 dev_err(&intf
->dev
, "Couldn't alloc candev\n");
928 priv
= netdev_priv(netdev
);
931 priv
->netdev
= netdev
;
933 priv
->can
.state
= CAN_STATE_STOPPED
;
934 priv
->can
.clock
.freq
= USB_8DEV_ABP_CLOCK
;
935 priv
->can
.bittiming_const
= &usb_8dev_bittiming_const
;
936 priv
->can
.do_set_mode
= usb_8dev_set_mode
;
937 priv
->can
.do_get_berr_counter
= usb_8dev_get_berr_counter
;
938 priv
->can
.ctrlmode_supported
= CAN_CTRLMODE_LOOPBACK
|
939 CAN_CTRLMODE_LISTENONLY
|
940 CAN_CTRLMODE_ONE_SHOT
;
942 netdev
->netdev_ops
= &usb_8dev_netdev_ops
;
944 netdev
->flags
|= IFF_ECHO
; /* we support local echo */
946 init_usb_anchor(&priv
->rx_submitted
);
948 init_usb_anchor(&priv
->tx_submitted
);
949 atomic_set(&priv
->active_tx_urbs
, 0);
951 for (i
= 0; i
< MAX_TX_URBS
; i
++)
952 priv
->tx_contexts
[i
].echo_index
= MAX_TX_URBS
;
954 priv
->cmd_msg_buffer
= devm_kzalloc(&intf
->dev
, sizeof(struct usb_8dev_cmd_msg
),
956 if (!priv
->cmd_msg_buffer
)
959 usb_set_intfdata(intf
, priv
);
961 SET_NETDEV_DEV(netdev
, &intf
->dev
);
963 mutex_init(&priv
->usb_8dev_cmd_lock
);
965 err
= register_candev(netdev
);
968 "couldn't register CAN device: %d\n", err
);
972 err
= usb_8dev_cmd_version(priv
, &version
);
974 netdev_err(netdev
, "can't get firmware version\n");
975 goto cleanup_unregister_candev
;
978 "firmware: %d.%d, hardware: %d.%d\n",
979 (version
>>24) & 0xff, (version
>>16) & 0xff,
980 (version
>>8) & 0xff, version
& 0xff);
983 devm_can_led_init(netdev
);
987 cleanup_unregister_candev
:
988 unregister_netdev(priv
->netdev
);
997 /* Called by the usb core when driver is unloaded or device is removed */
998 static void usb_8dev_disconnect(struct usb_interface
*intf
)
1000 struct usb_8dev_priv
*priv
= usb_get_intfdata(intf
);
1002 usb_set_intfdata(intf
, NULL
);
1005 netdev_info(priv
->netdev
, "device disconnected\n");
1007 unregister_netdev(priv
->netdev
);
1008 free_candev(priv
->netdev
);
1010 unlink_all_urbs(priv
);
1015 static struct usb_driver usb_8dev_driver
= {
1017 .probe
= usb_8dev_probe
,
1018 .disconnect
= usb_8dev_disconnect
,
1019 .id_table
= usb_8dev_table
,
1022 module_usb_driver(usb_8dev_driver
);
1024 MODULE_AUTHOR("Bernd Krumboeck <krumboeck@universalnet.at>");
1025 MODULE_DESCRIPTION("CAN driver for 8 devices USB2CAN interfaces");
1026 MODULE_LICENSE("GPL v2");