Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * CAN driver for PEAK System PCAN-USB FD / PCAN-USB Pro FD adapter
4 *
5 * Copyright (C) 2013-2014 Stephane Grosjean <s.grosjean@peak-system.com>
6 */
7#include <linux/ethtool.h>
8#include <linux/module.h>
9#include <linux/netdevice.h>
10#include <linux/usb.h>
11
12#include <linux/can.h>
13#include <linux/can/dev.h>
14#include <linux/can/error.h>
15#include <linux/can/dev/peak_canfd.h>
16
17#include "pcan_usb_core.h"
18#include "pcan_usb_pro.h"
19
20#define PCAN_USBPROFD_CHANNEL_COUNT 2
21#define PCAN_USBFD_CHANNEL_COUNT 1
22
23/* PCAN-USB Pro FD adapter internal clock (Hz) */
24#define PCAN_UFD_CRYSTAL_HZ 80000000
25
26#define PCAN_UFD_CMD_BUFFER_SIZE 512
27#define PCAN_UFD_LOSPD_PKT_SIZE 64
28
29/* PCAN-USB Pro FD command timeout (ms.) */
30#define PCAN_UFD_CMD_TIMEOUT_MS 1000
31
32/* PCAN-USB Pro FD rx/tx buffers size */
33#define PCAN_UFD_RX_BUFFER_SIZE 2048
34#define PCAN_UFD_TX_BUFFER_SIZE 512
35
36/* struct pcan_ufd_fw_info::type */
37#define PCAN_USBFD_TYPE_STD 1
38#define PCAN_USBFD_TYPE_EXT 2 /* includes EP numbers */
39
40/* read some versions info from the hw device */
41struct __packed pcan_ufd_fw_info {
42 __le16 size_of; /* sizeof this */
43 __le16 type; /* type of this structure */
44 u8 hw_type; /* Type of hardware (HW_TYPE_xxx) */
45 u8 bl_version[3]; /* Bootloader version */
46 u8 hw_version; /* Hardware version (PCB) */
47 u8 fw_version[3]; /* Firmware version */
48 __le32 dev_id[2]; /* "device id" per CAN */
49 __le32 ser_no; /* S/N */
50 __le32 flags; /* special functions */
51
52 /* extended data when type == PCAN_USBFD_TYPE_EXT */
53 u8 cmd_out_ep; /* ep for cmd */
54 u8 cmd_in_ep; /* ep for replies */
55 u8 data_out_ep[2]; /* ep for CANx TX */
56 u8 data_in_ep; /* ep for CAN RX */
57 u8 dummy[3];
58};
59
60/* handle device specific info used by the netdevices */
61struct pcan_usb_fd_if {
62 struct peak_usb_device *dev[PCAN_USB_MAX_CHANNEL];
63 struct pcan_ufd_fw_info fw_info;
64 struct peak_time_ref time_ref;
65 int cm_ignore_count;
66 int dev_opened_count;
67};
68
69/* device information */
70struct pcan_usb_fd_device {
71 struct peak_usb_device dev;
72 struct can_berr_counter bec;
73 struct pcan_usb_fd_if *usb_if;
74 u8 *cmd_buffer_addr;
75};
76
77/* Extended USB commands (non uCAN commands) */
78
79/* Clock Modes command */
80#define PCAN_UFD_CMD_CLK_SET 0x80
81
82#define PCAN_UFD_CLK_80MHZ 0x0
83#define PCAN_UFD_CLK_60MHZ 0x1
84#define PCAN_UFD_CLK_40MHZ 0x2
85#define PCAN_UFD_CLK_30MHZ 0x3
86#define PCAN_UFD_CLK_24MHZ 0x4
87#define PCAN_UFD_CLK_20MHZ 0x5
88#define PCAN_UFD_CLK_DEF PCAN_UFD_CLK_80MHZ
89
90struct __packed pcan_ufd_clock {
91 __le16 opcode_channel;
92
93 u8 mode;
94 u8 unused[5];
95};
96
97/* LED control command */
98#define PCAN_UFD_CMD_LED_SET 0x86
99
100#define PCAN_UFD_LED_DEV 0x00
101#define PCAN_UFD_LED_FAST 0x01
102#define PCAN_UFD_LED_SLOW 0x02
103#define PCAN_UFD_LED_ON 0x03
104#define PCAN_UFD_LED_OFF 0x04
105#define PCAN_UFD_LED_DEF PCAN_UFD_LED_DEV
106
107struct __packed pcan_ufd_led {
108 __le16 opcode_channel;
109
110 u8 mode;
111 u8 unused[5];
112};
113
114/* Extended usage of uCAN commands CMD_xxx_xx_OPTION for PCAN-USB Pro FD */
115#define PCAN_UFD_FLTEXT_CALIBRATION 0x8000
116
117struct __packed pcan_ufd_options {
118 __le16 opcode_channel;
119
120 __le16 ucan_mask;
121 u16 unused;
122 __le16 usb_mask;
123};
124
125/* Extended usage of uCAN messages for PCAN-USB Pro FD */
126#define PCAN_UFD_MSG_CALIBRATION 0x100
127
128struct __packed pcan_ufd_ts_msg {
129 __le16 size;
130 __le16 type;
131 __le32 ts_low;
132 __le32 ts_high;
133 __le16 usb_frame_index;
134 u16 unused;
135};
136
137#define PCAN_UFD_MSG_OVERRUN 0x101
138
139#define PCAN_UFD_OVMSG_CHANNEL(o) ((o)->channel & 0xf)
140
141struct __packed pcan_ufd_ovr_msg {
142 __le16 size;
143 __le16 type;
144 __le32 ts_low;
145 __le32 ts_high;
146 u8 channel;
147 u8 unused[3];
148};
149
150#define PCAN_UFD_CMD_DEVID_SET 0x81
151
152struct __packed pcan_ufd_device_id {
153 __le16 opcode_channel;
154
155 u16 unused;
156 __le32 device_id;
157};
158
159static inline int pufd_omsg_get_channel(struct pcan_ufd_ovr_msg *om)
160{
161 return om->channel & 0xf;
162}
163
164/* Clock mode frequency values */
165static const u32 pcan_usb_fd_clk_freq[6] = {
166 [PCAN_UFD_CLK_80MHZ] = 80000000,
167 [PCAN_UFD_CLK_60MHZ] = 60000000,
168 [PCAN_UFD_CLK_40MHZ] = 40000000,
169 [PCAN_UFD_CLK_30MHZ] = 30000000,
170 [PCAN_UFD_CLK_24MHZ] = 24000000,
171 [PCAN_UFD_CLK_20MHZ] = 20000000
172};
173
174/* return a device USB interface */
175static inline
176struct pcan_usb_fd_if *pcan_usb_fd_dev_if(struct peak_usb_device *dev)
177{
178 struct pcan_usb_fd_device *pdev =
179 container_of(dev, struct pcan_usb_fd_device, dev);
180 return pdev->usb_if;
181}
182
183/* return a device USB commands buffer */
184static inline void *pcan_usb_fd_cmd_buffer(struct peak_usb_device *dev)
185{
186 struct pcan_usb_fd_device *pdev =
187 container_of(dev, struct pcan_usb_fd_device, dev);
188 return pdev->cmd_buffer_addr;
189}
190
191/* send PCAN-USB Pro FD commands synchronously */
192static int pcan_usb_fd_send_cmd(struct peak_usb_device *dev, void *cmd_tail)
193{
194 struct pcan_usb_fd_device *pdev =
195 container_of(dev, struct pcan_usb_fd_device, dev);
196 struct pcan_ufd_fw_info *fw_info = &pdev->usb_if->fw_info;
197 void *cmd_head = pcan_usb_fd_cmd_buffer(dev);
198 int err = 0;
199 u8 *packet_ptr;
200 int packet_len;
201 ptrdiff_t cmd_len;
202
203 /* usb device unregistered? */
204 if (!(dev->state & PCAN_USB_STATE_CONNECTED))
205 return 0;
206
207 /* if a packet is not filled completely by commands, the command list
208 * is terminated with an "end of collection" record.
209 */
210 cmd_len = cmd_tail - cmd_head;
211 if (cmd_len <= (PCAN_UFD_CMD_BUFFER_SIZE - sizeof(u64))) {
212 memset(cmd_tail, 0xff, sizeof(u64));
213 cmd_len += sizeof(u64);
214 }
215
216 packet_ptr = cmd_head;
217 packet_len = cmd_len;
218
219 /* firmware is not able to re-assemble 512 bytes buffer in full-speed */
220 if (unlikely(dev->udev->speed != USB_SPEED_HIGH))
221 packet_len = min(packet_len, PCAN_UFD_LOSPD_PKT_SIZE);
222
223 do {
224 err = usb_bulk_msg(dev->udev,
225 usb_sndbulkpipe(dev->udev,
226 fw_info->cmd_out_ep),
227 packet_ptr, packet_len,
228 NULL, PCAN_UFD_CMD_TIMEOUT_MS);
229 if (err) {
230 netdev_err(dev->netdev,
231 "sending command failure: %d\n", err);
232 break;
233 }
234
235 packet_ptr += packet_len;
236 cmd_len -= packet_len;
237
238 if (cmd_len < PCAN_UFD_LOSPD_PKT_SIZE)
239 packet_len = cmd_len;
240
241 } while (packet_len > 0);
242
243 return err;
244}
245
246static int pcan_usb_fd_read_fwinfo(struct peak_usb_device *dev,
247 struct pcan_ufd_fw_info *fw_info)
248{
249 return pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO,
250 PCAN_USBPRO_INFO_FW,
251 fw_info,
252 sizeof(*fw_info));
253}
254
255/* build the commands list in the given buffer, to enter operational mode */
256static int pcan_usb_fd_build_restart_cmd(struct peak_usb_device *dev, u8 *buf)
257{
258 struct pucan_wr_err_cnt *prc;
259 struct pucan_command *cmd;
260 u8 *pc = buf;
261
262 /* 1st, reset error counters: */
263 prc = (struct pucan_wr_err_cnt *)pc;
264 prc->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
265 PUCAN_CMD_WR_ERR_CNT);
266
267 /* select both counters */
268 prc->sel_mask = cpu_to_le16(PUCAN_WRERRCNT_TE|PUCAN_WRERRCNT_RE);
269
270 /* and reset their values */
271 prc->tx_counter = 0;
272 prc->rx_counter = 0;
273
274 /* moves the pointer forward */
275 pc += sizeof(struct pucan_wr_err_cnt);
276
277 /* add command to switch from ISO to non-ISO mode, if fw allows it */
278 if (dev->can.ctrlmode_supported & CAN_CTRLMODE_FD_NON_ISO) {
279 struct pucan_options *puo = (struct pucan_options *)pc;
280
281 puo->opcode_channel =
282 (dev->can.ctrlmode & CAN_CTRLMODE_FD_NON_ISO) ?
283 pucan_cmd_opcode_channel(dev->ctrl_idx,
284 PUCAN_CMD_CLR_DIS_OPTION) :
285 pucan_cmd_opcode_channel(dev->ctrl_idx,
286 PUCAN_CMD_SET_EN_OPTION);
287
288 puo->options = cpu_to_le16(PUCAN_OPTION_CANDFDISO);
289
290 /* to be sure that no other extended bits will be taken into
291 * account
292 */
293 puo->unused = 0;
294
295 /* moves the pointer forward */
296 pc += sizeof(struct pucan_options);
297 }
298
299 /* next, go back to operational mode */
300 cmd = (struct pucan_command *)pc;
301 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
302 (dev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) ?
303 PUCAN_CMD_LISTEN_ONLY_MODE :
304 PUCAN_CMD_NORMAL_MODE);
305 pc += sizeof(struct pucan_command);
306
307 return pc - buf;
308}
309
310/* set CAN bus on/off */
311static int pcan_usb_fd_set_bus(struct peak_usb_device *dev, u8 onoff)
312{
313 u8 *pc = pcan_usb_fd_cmd_buffer(dev);
314 int l;
315
316 if (onoff) {
317 /* build the cmds list to enter operational mode */
318 l = pcan_usb_fd_build_restart_cmd(dev, pc);
319 } else {
320 struct pucan_command *cmd = (struct pucan_command *)pc;
321
322 /* build cmd to go back to reset mode */
323 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
324 PUCAN_CMD_RESET_MODE);
325 l = sizeof(struct pucan_command);
326 }
327
328 /* send the command */
329 return pcan_usb_fd_send_cmd(dev, pc + l);
330}
331
332/* set filtering masks:
333 *
334 * idx in range [0..63] selects a row #idx, all rows otherwise
335 * mask in range [0..0xffffffff] defines up to 32 CANIDs in the row(s)
336 *
337 * Each bit of this 64 x 32 bits array defines a CANID value:
338 *
339 * bit[i,j] = 1 implies that CANID=(i x 32)+j will be received, while
340 * bit[i,j] = 0 implies that CANID=(i x 32)+j will be discarded.
341 */
342static int pcan_usb_fd_set_filter_std(struct peak_usb_device *dev, int idx,
343 u32 mask)
344{
345 struct pucan_filter_std *cmd = pcan_usb_fd_cmd_buffer(dev);
346 int i, n;
347
348 /* select all rows when idx is out of range [0..63] */
349 if ((idx < 0) || (idx >= (1 << PUCAN_FLTSTD_ROW_IDX_BITS))) {
350 n = 1 << PUCAN_FLTSTD_ROW_IDX_BITS;
351 idx = 0;
352
353 /* select the row (and only the row) otherwise */
354 } else {
355 n = idx + 1;
356 }
357
358 for (i = idx; i < n; i++, cmd++) {
359 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
360 PUCAN_CMD_FILTER_STD);
361 cmd->idx = cpu_to_le16(i);
362 cmd->mask = cpu_to_le32(mask);
363 }
364
365 /* send the command */
366 return pcan_usb_fd_send_cmd(dev, cmd);
367}
368
369/* set/unset options
370 *
371 * onoff set(1)/unset(0) options
372 * mask each bit defines a kind of options to set/unset
373 */
374static int pcan_usb_fd_set_options(struct peak_usb_device *dev,
375 bool onoff, u16 ucan_mask, u16 usb_mask)
376{
377 struct pcan_ufd_options *cmd = pcan_usb_fd_cmd_buffer(dev);
378
379 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
380 (onoff) ? PUCAN_CMD_SET_EN_OPTION :
381 PUCAN_CMD_CLR_DIS_OPTION);
382
383 cmd->ucan_mask = cpu_to_le16(ucan_mask);
384 cmd->usb_mask = cpu_to_le16(usb_mask);
385
386 /* send the command */
387 return pcan_usb_fd_send_cmd(dev, ++cmd);
388}
389
390/* setup LED control */
391static int pcan_usb_fd_set_can_led(struct peak_usb_device *dev, u8 led_mode)
392{
393 struct pcan_ufd_led *cmd = pcan_usb_fd_cmd_buffer(dev);
394
395 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
396 PCAN_UFD_CMD_LED_SET);
397 cmd->mode = led_mode;
398
399 /* send the command */
400 return pcan_usb_fd_send_cmd(dev, ++cmd);
401}
402
403/* set CAN clock domain */
404static int pcan_usb_fd_set_clock_domain(struct peak_usb_device *dev,
405 u8 clk_mode)
406{
407 struct pcan_ufd_clock *cmd = pcan_usb_fd_cmd_buffer(dev);
408
409 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
410 PCAN_UFD_CMD_CLK_SET);
411 cmd->mode = clk_mode;
412
413 /* send the command */
414 return pcan_usb_fd_send_cmd(dev, ++cmd);
415}
416
417/* set bittiming for CAN and CAN-FD header */
418static int pcan_usb_fd_set_bittiming_slow(struct peak_usb_device *dev,
419 struct can_bittiming *bt)
420{
421 struct pucan_timing_slow *cmd = pcan_usb_fd_cmd_buffer(dev);
422
423 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
424 PUCAN_CMD_TIMING_SLOW);
425 cmd->sjw_t = PUCAN_TSLOW_SJW_T(bt->sjw - 1,
426 dev->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES);
427
428 cmd->tseg2 = PUCAN_TSLOW_TSEG2(bt->phase_seg2 - 1);
429 cmd->tseg1 = PUCAN_TSLOW_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
430 cmd->brp = cpu_to_le16(PUCAN_TSLOW_BRP(bt->brp - 1));
431
432 cmd->ewl = 96; /* default */
433
434 /* send the command */
435 return pcan_usb_fd_send_cmd(dev, ++cmd);
436}
437
438/* set CAN-FD bittiming for data */
439static int pcan_usb_fd_set_bittiming_fast(struct peak_usb_device *dev,
440 struct can_bittiming *bt)
441{
442 struct pucan_timing_fast *cmd = pcan_usb_fd_cmd_buffer(dev);
443
444 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
445 PUCAN_CMD_TIMING_FAST);
446 cmd->sjw = PUCAN_TFAST_SJW(bt->sjw - 1);
447 cmd->tseg2 = PUCAN_TFAST_TSEG2(bt->phase_seg2 - 1);
448 cmd->tseg1 = PUCAN_TFAST_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
449 cmd->brp = cpu_to_le16(PUCAN_TFAST_BRP(bt->brp - 1));
450
451 /* send the command */
452 return pcan_usb_fd_send_cmd(dev, ++cmd);
453}
454
455/* read user CAN channel id from device */
456static int pcan_usb_fd_get_can_channel_id(struct peak_usb_device *dev,
457 u32 *can_ch_id)
458{
459 int err;
460 struct pcan_usb_fd_if *usb_if = pcan_usb_fd_dev_if(dev);
461
462 err = pcan_usb_fd_read_fwinfo(dev, &usb_if->fw_info);
463 if (err)
464 return err;
465
466 *can_ch_id = le32_to_cpu(usb_if->fw_info.dev_id[dev->ctrl_idx]);
467 return err;
468}
469
470/* set a new CAN channel id in the flash memory of the device */
471static int pcan_usb_fd_set_can_channel_id(struct peak_usb_device *dev, u32 can_ch_id)
472{
473 struct pcan_ufd_device_id *cmd = pcan_usb_fd_cmd_buffer(dev);
474
475 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
476 PCAN_UFD_CMD_DEVID_SET);
477 cmd->device_id = cpu_to_le32(can_ch_id);
478
479 /* send the command */
480 return pcan_usb_fd_send_cmd(dev, ++cmd);
481}
482
483/* handle restart but in asynchronously way
484 * (uses PCAN-USB Pro code to complete asynchronous request)
485 */
486static int pcan_usb_fd_restart_async(struct peak_usb_device *dev,
487 struct urb *urb, u8 *buf)
488{
489 struct pcan_usb_fd_device *pdev =
490 container_of(dev, struct pcan_usb_fd_device, dev);
491 struct pcan_ufd_fw_info *fw_info = &pdev->usb_if->fw_info;
492 u8 *pc = buf;
493
494 /* build the entire cmds list in the provided buffer, to go back into
495 * operational mode.
496 */
497 pc += pcan_usb_fd_build_restart_cmd(dev, pc);
498
499 /* add EOC */
500 memset(pc, 0xff, sizeof(struct pucan_command));
501 pc += sizeof(struct pucan_command);
502
503 /* complete the URB */
504 usb_fill_bulk_urb(urb, dev->udev,
505 usb_sndbulkpipe(dev->udev, fw_info->cmd_out_ep),
506 buf, pc - buf,
507 pcan_usb_pro_restart_complete, dev);
508
509 /* and submit it. */
510 return usb_submit_urb(urb, GFP_ATOMIC);
511}
512
513static int pcan_usb_fd_drv_loaded(struct peak_usb_device *dev, bool loaded)
514{
515 struct pcan_usb_fd_device *pdev =
516 container_of(dev, struct pcan_usb_fd_device, dev);
517
518 pdev->cmd_buffer_addr[0] = 0;
519 pdev->cmd_buffer_addr[1] = !!loaded;
520
521 return pcan_usb_pro_send_req(dev,
522 PCAN_USBPRO_REQ_FCT,
523 PCAN_USBPRO_FCT_DRVLD,
524 pdev->cmd_buffer_addr,
525 PCAN_USBPRO_FCT_DRVLD_REQ_LEN);
526}
527
528static int pcan_usb_fd_decode_canmsg(struct pcan_usb_fd_if *usb_if,
529 struct pucan_msg *rx_msg)
530{
531 struct pucan_rx_msg *rm = (struct pucan_rx_msg *)rx_msg;
532 struct peak_usb_device *dev;
533 struct net_device *netdev;
534 struct canfd_frame *cfd;
535 struct sk_buff *skb;
536 const u16 rx_msg_flags = le16_to_cpu(rm->flags);
537
538 if (pucan_msg_get_channel(rm) >= ARRAY_SIZE(usb_if->dev))
539 return -ENOMEM;
540
541 dev = usb_if->dev[pucan_msg_get_channel(rm)];
542 netdev = dev->netdev;
543
544 if (rx_msg_flags & PUCAN_MSG_EXT_DATA_LEN) {
545 /* CANFD frame case */
546 skb = alloc_canfd_skb(netdev, &cfd);
547 if (!skb)
548 return -ENOMEM;
549
550 if (rx_msg_flags & PUCAN_MSG_BITRATE_SWITCH)
551 cfd->flags |= CANFD_BRS;
552
553 if (rx_msg_flags & PUCAN_MSG_ERROR_STATE_IND)
554 cfd->flags |= CANFD_ESI;
555
556 cfd->len = can_fd_dlc2len(pucan_msg_get_dlc(rm));
557 } else {
558 /* CAN 2.0 frame case */
559 skb = alloc_can_skb(netdev, (struct can_frame **)&cfd);
560 if (!skb)
561 return -ENOMEM;
562
563 can_frame_set_cc_len((struct can_frame *)cfd,
564 pucan_msg_get_dlc(rm),
565 dev->can.ctrlmode);
566 }
567
568 cfd->can_id = le32_to_cpu(rm->can_id);
569
570 if (rx_msg_flags & PUCAN_MSG_EXT_ID)
571 cfd->can_id |= CAN_EFF_FLAG;
572
573 if (rx_msg_flags & PUCAN_MSG_RTR) {
574 cfd->can_id |= CAN_RTR_FLAG;
575 } else {
576 memcpy(cfd->data, rm->d, cfd->len);
577 netdev->stats.rx_bytes += cfd->len;
578 }
579 netdev->stats.rx_packets++;
580
581 peak_usb_netif_rx_64(skb, le32_to_cpu(rm->ts_low),
582 le32_to_cpu(rm->ts_high));
583
584 return 0;
585}
586
587/* handle uCAN status message */
588static int pcan_usb_fd_decode_status(struct pcan_usb_fd_if *usb_if,
589 struct pucan_msg *rx_msg)
590{
591 struct pucan_status_msg *sm = (struct pucan_status_msg *)rx_msg;
592 struct pcan_usb_fd_device *pdev;
593 enum can_state new_state = CAN_STATE_ERROR_ACTIVE;
594 enum can_state rx_state, tx_state;
595 struct peak_usb_device *dev;
596 struct net_device *netdev;
597 struct can_frame *cf;
598 struct sk_buff *skb;
599
600 if (pucan_stmsg_get_channel(sm) >= ARRAY_SIZE(usb_if->dev))
601 return -ENOMEM;
602
603 dev = usb_if->dev[pucan_stmsg_get_channel(sm)];
604 pdev = container_of(dev, struct pcan_usb_fd_device, dev);
605 netdev = dev->netdev;
606
607 /* nothing should be sent while in BUS_OFF state */
608 if (dev->can.state == CAN_STATE_BUS_OFF)
609 return 0;
610
611 if (sm->channel_p_w_b & PUCAN_BUS_BUSOFF) {
612 new_state = CAN_STATE_BUS_OFF;
613 } else if (sm->channel_p_w_b & PUCAN_BUS_PASSIVE) {
614 new_state = CAN_STATE_ERROR_PASSIVE;
615 } else if (sm->channel_p_w_b & PUCAN_BUS_WARNING) {
616 new_state = CAN_STATE_ERROR_WARNING;
617 } else {
618 /* back to (or still in) ERROR_ACTIVE state */
619 new_state = CAN_STATE_ERROR_ACTIVE;
620 pdev->bec.txerr = 0;
621 pdev->bec.rxerr = 0;
622 }
623
624 /* state hasn't changed */
625 if (new_state == dev->can.state)
626 return 0;
627
628 /* handle bus state change */
629 tx_state = (pdev->bec.txerr >= pdev->bec.rxerr) ? new_state : 0;
630 rx_state = (pdev->bec.txerr <= pdev->bec.rxerr) ? new_state : 0;
631
632 /* allocate an skb to store the error frame */
633 skb = alloc_can_err_skb(netdev, &cf);
634 can_change_state(netdev, cf, tx_state, rx_state);
635
636 /* things must be done even in case of OOM */
637 if (new_state == CAN_STATE_BUS_OFF)
638 can_bus_off(netdev);
639
640 if (!skb)
641 return -ENOMEM;
642
643 peak_usb_netif_rx_64(skb, le32_to_cpu(sm->ts_low),
644 le32_to_cpu(sm->ts_high));
645
646 return 0;
647}
648
649/* handle uCAN error message */
650static int pcan_usb_fd_decode_error(struct pcan_usb_fd_if *usb_if,
651 struct pucan_msg *rx_msg)
652{
653 struct pucan_error_msg *er = (struct pucan_error_msg *)rx_msg;
654 struct pcan_usb_fd_device *pdev;
655 struct peak_usb_device *dev;
656
657 if (pucan_ermsg_get_channel(er) >= ARRAY_SIZE(usb_if->dev))
658 return -EINVAL;
659
660 dev = usb_if->dev[pucan_ermsg_get_channel(er)];
661 pdev = container_of(dev, struct pcan_usb_fd_device, dev);
662
663 /* keep a trace of tx and rx error counters for later use */
664 pdev->bec.txerr = er->tx_err_cnt;
665 pdev->bec.rxerr = er->rx_err_cnt;
666
667 return 0;
668}
669
670/* handle uCAN overrun message */
671static int pcan_usb_fd_decode_overrun(struct pcan_usb_fd_if *usb_if,
672 struct pucan_msg *rx_msg)
673{
674 struct pcan_ufd_ovr_msg *ov = (struct pcan_ufd_ovr_msg *)rx_msg;
675 struct peak_usb_device *dev;
676 struct net_device *netdev;
677 struct can_frame *cf;
678 struct sk_buff *skb;
679
680 if (pufd_omsg_get_channel(ov) >= ARRAY_SIZE(usb_if->dev))
681 return -EINVAL;
682
683 dev = usb_if->dev[pufd_omsg_get_channel(ov)];
684 netdev = dev->netdev;
685
686 /* allocate an skb to store the error frame */
687 skb = alloc_can_err_skb(netdev, &cf);
688 if (!skb)
689 return -ENOMEM;
690
691 cf->can_id |= CAN_ERR_CRTL;
692 cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW;
693
694 peak_usb_netif_rx_64(skb, le32_to_cpu(ov->ts_low),
695 le32_to_cpu(ov->ts_high));
696
697 netdev->stats.rx_over_errors++;
698 netdev->stats.rx_errors++;
699
700 return 0;
701}
702
703/* handle USB calibration message */
704static void pcan_usb_fd_decode_ts(struct pcan_usb_fd_if *usb_if,
705 struct pucan_msg *rx_msg)
706{
707 struct pcan_ufd_ts_msg *ts = (struct pcan_ufd_ts_msg *)rx_msg;
708
709 /* should wait until clock is stabilized */
710 if (usb_if->cm_ignore_count > 0)
711 usb_if->cm_ignore_count--;
712 else
713 peak_usb_set_ts_now(&usb_if->time_ref, le32_to_cpu(ts->ts_low));
714}
715
716/* callback for bulk IN urb */
717static int pcan_usb_fd_decode_buf(struct peak_usb_device *dev, struct urb *urb)
718{
719 struct pcan_usb_fd_if *usb_if = pcan_usb_fd_dev_if(dev);
720 struct net_device *netdev = dev->netdev;
721 struct pucan_msg *rx_msg;
722 u8 *msg_ptr, *msg_end;
723 int err = 0;
724
725 /* loop reading all the records from the incoming message */
726 msg_ptr = urb->transfer_buffer;
727 msg_end = urb->transfer_buffer + urb->actual_length;
728 for (; msg_ptr < msg_end;) {
729 u16 rx_msg_type, rx_msg_size;
730
731 rx_msg = (struct pucan_msg *)msg_ptr;
732 if (!rx_msg->size) {
733 /* null packet found: end of list */
734 break;
735 }
736
737 rx_msg_size = le16_to_cpu(rx_msg->size);
738 rx_msg_type = le16_to_cpu(rx_msg->type);
739
740 /* check if the record goes out of current packet */
741 if (msg_ptr + rx_msg_size > msg_end) {
742 netdev_err(netdev,
743 "got frag rec: should inc usb rx buf sze\n");
744 err = -EBADMSG;
745 break;
746 }
747
748 switch (rx_msg_type) {
749 case PUCAN_MSG_CAN_RX:
750 err = pcan_usb_fd_decode_canmsg(usb_if, rx_msg);
751 if (err < 0)
752 goto fail;
753 break;
754
755 case PCAN_UFD_MSG_CALIBRATION:
756 pcan_usb_fd_decode_ts(usb_if, rx_msg);
757 break;
758
759 case PUCAN_MSG_ERROR:
760 err = pcan_usb_fd_decode_error(usb_if, rx_msg);
761 if (err < 0)
762 goto fail;
763 break;
764
765 case PUCAN_MSG_STATUS:
766 err = pcan_usb_fd_decode_status(usb_if, rx_msg);
767 if (err < 0)
768 goto fail;
769 break;
770
771 case PCAN_UFD_MSG_OVERRUN:
772 err = pcan_usb_fd_decode_overrun(usb_if, rx_msg);
773 if (err < 0)
774 goto fail;
775 break;
776
777 default:
778 netdev_err(netdev,
779 "unhandled msg type 0x%02x (%d): ignored\n",
780 rx_msg_type, rx_msg_type);
781 break;
782 }
783
784 msg_ptr += rx_msg_size;
785 }
786
787fail:
788 if (err)
789 pcan_dump_mem("received msg",
790 urb->transfer_buffer, urb->actual_length);
791 return err;
792}
793
794/* CAN/CANFD frames encoding callback */
795static int pcan_usb_fd_encode_msg(struct peak_usb_device *dev,
796 struct sk_buff *skb, u8 *obuf, size_t *size)
797{
798 struct pucan_tx_msg *tx_msg = (struct pucan_tx_msg *)obuf;
799 struct canfd_frame *cfd = (struct canfd_frame *)skb->data;
800 u16 tx_msg_size, tx_msg_flags;
801 u8 dlc;
802
803 if (cfd->len > CANFD_MAX_DLEN)
804 return -EINVAL;
805
806 tx_msg_size = ALIGN(sizeof(struct pucan_tx_msg) + cfd->len, 4);
807 tx_msg->size = cpu_to_le16(tx_msg_size);
808 tx_msg->type = cpu_to_le16(PUCAN_MSG_CAN_TX);
809
810 tx_msg_flags = 0;
811 if (cfd->can_id & CAN_EFF_FLAG) {
812 tx_msg_flags |= PUCAN_MSG_EXT_ID;
813 tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_EFF_MASK);
814 } else {
815 tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_SFF_MASK);
816 }
817
818 if (can_is_canfd_skb(skb)) {
819 /* considering a CANFD frame */
820 dlc = can_fd_len2dlc(cfd->len);
821
822 tx_msg_flags |= PUCAN_MSG_EXT_DATA_LEN;
823
824 if (cfd->flags & CANFD_BRS)
825 tx_msg_flags |= PUCAN_MSG_BITRATE_SWITCH;
826
827 if (cfd->flags & CANFD_ESI)
828 tx_msg_flags |= PUCAN_MSG_ERROR_STATE_IND;
829 } else {
830 /* CAND 2.0 frames */
831 dlc = can_get_cc_dlc((struct can_frame *)cfd,
832 dev->can.ctrlmode);
833
834 if (cfd->can_id & CAN_RTR_FLAG)
835 tx_msg_flags |= PUCAN_MSG_RTR;
836 }
837
838 /* Single-Shot frame */
839 if (dev->can.ctrlmode & CAN_CTRLMODE_ONE_SHOT)
840 tx_msg_flags |= PUCAN_MSG_SINGLE_SHOT;
841
842 tx_msg->flags = cpu_to_le16(tx_msg_flags);
843 tx_msg->channel_dlc = PUCAN_MSG_CHANNEL_DLC(dev->ctrl_idx, dlc);
844 memcpy(tx_msg->d, cfd->data, cfd->len);
845
846 /* add null size message to tag the end (messages are 32-bits aligned)
847 */
848 tx_msg = (struct pucan_tx_msg *)(obuf + tx_msg_size);
849
850 tx_msg->size = 0;
851
852 /* set the whole size of the USB packet to send */
853 *size = tx_msg_size + sizeof(u32);
854
855 return 0;
856}
857
858/* start the interface (last chance before set bus on) */
859static int pcan_usb_fd_start(struct peak_usb_device *dev)
860{
861 struct pcan_usb_fd_device *pdev =
862 container_of(dev, struct pcan_usb_fd_device, dev);
863 int err;
864
865 /* set filter mode: all acceptance */
866 err = pcan_usb_fd_set_filter_std(dev, -1, 0xffffffff);
867 if (err)
868 return err;
869
870 /* opening first device: */
871 if (pdev->usb_if->dev_opened_count == 0) {
872 /* reset time_ref */
873 peak_usb_init_time_ref(&pdev->usb_if->time_ref,
874 &pcan_usb_pro_fd);
875
876 /* enable USB calibration messages */
877 err = pcan_usb_fd_set_options(dev, 1,
878 PUCAN_OPTION_ERROR,
879 PCAN_UFD_FLTEXT_CALIBRATION);
880 }
881
882 pdev->usb_if->dev_opened_count++;
883
884 /* reset cached error counters */
885 pdev->bec.txerr = 0;
886 pdev->bec.rxerr = 0;
887
888 return err;
889}
890
891/* socket callback used to copy berr counters values received through USB */
892static int pcan_usb_fd_get_berr_counter(const struct net_device *netdev,
893 struct can_berr_counter *bec)
894{
895 struct peak_usb_device *dev = netdev_priv(netdev);
896 struct pcan_usb_fd_device *pdev =
897 container_of(dev, struct pcan_usb_fd_device, dev);
898
899 *bec = pdev->bec;
900
901 /* must return 0 */
902 return 0;
903}
904
905/* probe function for all PCAN-USB FD family usb interfaces */
906static int pcan_usb_fd_probe(struct usb_interface *intf)
907{
908 struct usb_host_interface *iface_desc = &intf->altsetting[0];
909
910 /* CAN interface is always interface #0 */
911 return iface_desc->desc.bInterfaceNumber;
912}
913
914/* stop interface (last chance before set bus off) */
915static int pcan_usb_fd_stop(struct peak_usb_device *dev)
916{
917 struct pcan_usb_fd_device *pdev =
918 container_of(dev, struct pcan_usb_fd_device, dev);
919
920 /* turn off special msgs for that interface if no other dev opened */
921 if (pdev->usb_if->dev_opened_count == 1)
922 pcan_usb_fd_set_options(dev, 0,
923 PUCAN_OPTION_ERROR,
924 PCAN_UFD_FLTEXT_CALIBRATION);
925 pdev->usb_if->dev_opened_count--;
926
927 return 0;
928}
929
930/* called when probing, to initialize a device object */
931static int pcan_usb_fd_init(struct peak_usb_device *dev)
932{
933 struct pcan_usb_fd_device *pdev =
934 container_of(dev, struct pcan_usb_fd_device, dev);
935 struct pcan_ufd_fw_info *fw_info;
936 int i, err = -ENOMEM;
937
938 /* do this for 1st channel only */
939 if (!dev->prev_siblings) {
940 /* allocate netdevices common structure attached to first one */
941 pdev->usb_if = kzalloc(sizeof(*pdev->usb_if), GFP_KERNEL);
942 if (!pdev->usb_if)
943 goto err_out;
944
945 /* allocate command buffer once for all for the interface */
946 pdev->cmd_buffer_addr = kzalloc(PCAN_UFD_CMD_BUFFER_SIZE,
947 GFP_KERNEL);
948 if (!pdev->cmd_buffer_addr)
949 goto err_out_1;
950
951 /* number of ts msgs to ignore before taking one into account */
952 pdev->usb_if->cm_ignore_count = 5;
953
954 fw_info = &pdev->usb_if->fw_info;
955
956 err = pcan_usb_fd_read_fwinfo(dev, fw_info);
957 if (err) {
958 dev_err(dev->netdev->dev.parent,
959 "unable to read %s firmware info (err %d)\n",
960 dev->adapter->name, err);
961 goto err_out_2;
962 }
963
964 /* explicit use of dev_xxx() instead of netdev_xxx() here:
965 * information displayed are related to the device itself, not
966 * to the canx (channel) device.
967 */
968 dev_info(dev->netdev->dev.parent,
969 "PEAK-System %s v%u fw v%u.%u.%u (%u channels)\n",
970 dev->adapter->name, fw_info->hw_version,
971 fw_info->fw_version[0],
972 fw_info->fw_version[1],
973 fw_info->fw_version[2],
974 dev->adapter->ctrl_count);
975
976 /* check for ability to switch between ISO/non-ISO modes */
977 if (fw_info->fw_version[0] >= 2) {
978 /* firmware >= 2.x supports ISO/non-ISO switching */
979 dev->can.ctrlmode_supported |= CAN_CTRLMODE_FD_NON_ISO;
980 } else {
981 /* firmware < 2.x only supports fixed(!) non-ISO */
982 dev->can.ctrlmode |= CAN_CTRLMODE_FD_NON_ISO;
983 }
984
985 /* if vendor rsp is of type 2, then it contains EP numbers to
986 * use for cmds pipes. If not, then default EP should be used.
987 */
988 if (fw_info->type != cpu_to_le16(PCAN_USBFD_TYPE_EXT)) {
989 fw_info->cmd_out_ep = PCAN_USBPRO_EP_CMDOUT;
990 fw_info->cmd_in_ep = PCAN_USBPRO_EP_CMDIN;
991 }
992
993 /* tell the hardware the can driver is running */
994 err = pcan_usb_fd_drv_loaded(dev, 1);
995 if (err) {
996 dev_err(dev->netdev->dev.parent,
997 "unable to tell %s driver is loaded (err %d)\n",
998 dev->adapter->name, err);
999 goto err_out_2;
1000 }
1001 } else {
1002 /* otherwise, simply copy previous sibling's values */
1003 struct pcan_usb_fd_device *ppdev =
1004 container_of(dev->prev_siblings,
1005 struct pcan_usb_fd_device, dev);
1006
1007 pdev->usb_if = ppdev->usb_if;
1008 pdev->cmd_buffer_addr = ppdev->cmd_buffer_addr;
1009
1010 /* do a copy of the ctrlmode[_supported] too */
1011 dev->can.ctrlmode = ppdev->dev.can.ctrlmode;
1012 dev->can.ctrlmode_supported = ppdev->dev.can.ctrlmode_supported;
1013
1014 fw_info = &pdev->usb_if->fw_info;
1015 }
1016
1017 pdev->usb_if->dev[dev->ctrl_idx] = dev;
1018 dev->can_channel_id =
1019 le32_to_cpu(pdev->usb_if->fw_info.dev_id[dev->ctrl_idx]);
1020
1021 /* if vendor rsp is of type 2, then it contains EP numbers to
1022 * use for data pipes. If not, then statically defined EP are used
1023 * (see peak_usb_create_dev()).
1024 */
1025 if (fw_info->type == cpu_to_le16(PCAN_USBFD_TYPE_EXT)) {
1026 dev->ep_msg_in = fw_info->data_in_ep;
1027 dev->ep_msg_out = fw_info->data_out_ep[dev->ctrl_idx];
1028 }
1029
1030 /* set clock domain */
1031 for (i = 0; i < ARRAY_SIZE(pcan_usb_fd_clk_freq); i++)
1032 if (dev->adapter->clock.freq == pcan_usb_fd_clk_freq[i])
1033 break;
1034
1035 if (i >= ARRAY_SIZE(pcan_usb_fd_clk_freq)) {
1036 dev_warn(dev->netdev->dev.parent,
1037 "incompatible clock frequencies\n");
1038 err = -EINVAL;
1039 goto err_out_2;
1040 }
1041
1042 pcan_usb_fd_set_clock_domain(dev, i);
1043
1044 /* set LED in default state (end of init phase) */
1045 pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_DEF);
1046
1047 return 0;
1048
1049err_out_2:
1050 kfree(pdev->cmd_buffer_addr);
1051err_out_1:
1052 kfree(pdev->usb_if);
1053err_out:
1054 return err;
1055}
1056
1057/* called when driver module is being unloaded */
1058static void pcan_usb_fd_exit(struct peak_usb_device *dev)
1059{
1060 struct pcan_usb_fd_device *pdev =
1061 container_of(dev, struct pcan_usb_fd_device, dev);
1062
1063 /* when rmmod called before unplug and if down, should reset things
1064 * before leaving
1065 */
1066 if (dev->can.state != CAN_STATE_STOPPED) {
1067 /* set bus off on the corresponding channel */
1068 pcan_usb_fd_set_bus(dev, 0);
1069 }
1070
1071 /* switch off corresponding CAN LEDs */
1072 pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_OFF);
1073
1074 /* if channel #0 (only) */
1075 if (dev->ctrl_idx == 0) {
1076 /* turn off calibration message if any device were opened */
1077 if (pdev->usb_if->dev_opened_count > 0)
1078 pcan_usb_fd_set_options(dev, 0,
1079 PUCAN_OPTION_ERROR,
1080 PCAN_UFD_FLTEXT_CALIBRATION);
1081
1082 /* tell USB adapter that the driver is being unloaded */
1083 pcan_usb_fd_drv_loaded(dev, 0);
1084 }
1085}
1086
1087/* called when the USB adapter is unplugged */
1088static void pcan_usb_fd_free(struct peak_usb_device *dev)
1089{
1090 /* last device: can free shared objects now */
1091 if (!dev->prev_siblings && !dev->next_siblings) {
1092 struct pcan_usb_fd_device *pdev =
1093 container_of(dev, struct pcan_usb_fd_device, dev);
1094
1095 /* free commands buffer */
1096 kfree(pdev->cmd_buffer_addr);
1097
1098 /* free usb interface object */
1099 kfree(pdev->usb_if);
1100 }
1101}
1102
1103/* blink LED's */
1104static int pcan_usb_fd_set_phys_id(struct net_device *netdev,
1105 enum ethtool_phys_id_state state)
1106{
1107 struct peak_usb_device *dev = netdev_priv(netdev);
1108 int err = 0;
1109
1110 switch (state) {
1111 case ETHTOOL_ID_ACTIVE:
1112 err = pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_FAST);
1113 break;
1114 case ETHTOOL_ID_INACTIVE:
1115 err = pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_DEF);
1116 break;
1117 default:
1118 break;
1119 }
1120
1121 return err;
1122}
1123
1124static const struct ethtool_ops pcan_usb_fd_ethtool_ops = {
1125 .set_phys_id = pcan_usb_fd_set_phys_id,
1126 .get_ts_info = pcan_get_ts_info,
1127 .get_eeprom_len = peak_usb_get_eeprom_len,
1128 .get_eeprom = peak_usb_get_eeprom,
1129 .set_eeprom = peak_usb_set_eeprom,
1130};
1131
1132/* describes the PCAN-USB FD adapter */
1133static const struct can_bittiming_const pcan_usb_fd_const = {
1134 .name = "pcan_usb_fd",
1135 .tseg1_min = 1,
1136 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1137 .tseg2_min = 1,
1138 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1139 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1140 .brp_min = 1,
1141 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1142 .brp_inc = 1,
1143};
1144
1145static const struct can_bittiming_const pcan_usb_fd_data_const = {
1146 .name = "pcan_usb_fd",
1147 .tseg1_min = 1,
1148 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1149 .tseg2_min = 1,
1150 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1151 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1152 .brp_min = 1,
1153 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1154 .brp_inc = 1,
1155};
1156
1157const struct peak_usb_adapter pcan_usb_fd = {
1158 .name = "PCAN-USB FD",
1159 .device_id = PCAN_USBFD_PRODUCT_ID,
1160 .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
1161 .ctrlmode_supported = CAN_CTRLMODE_FD |
1162 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1163 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1164 .clock = {
1165 .freq = PCAN_UFD_CRYSTAL_HZ,
1166 },
1167 .bittiming_const = &pcan_usb_fd_const,
1168 .data_bittiming_const = &pcan_usb_fd_data_const,
1169
1170 /* size of device private data */
1171 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1172
1173 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1174
1175 /* timestamps usage */
1176 .ts_used_bits = 32,
1177 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1178 .us_per_ts_shift = 0,
1179
1180 /* give here messages in/out endpoints */
1181 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1182 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
1183
1184 /* size of rx/tx usb buffers */
1185 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1186 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1187
1188 /* device callbacks */
1189 .intf_probe = pcan_usb_fd_probe,
1190 .dev_init = pcan_usb_fd_init,
1191
1192 .dev_exit = pcan_usb_fd_exit,
1193 .dev_free = pcan_usb_fd_free,
1194 .dev_set_bus = pcan_usb_fd_set_bus,
1195 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1196 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1197 .dev_get_can_channel_id = pcan_usb_fd_get_can_channel_id,
1198 .dev_set_can_channel_id = pcan_usb_fd_set_can_channel_id,
1199 .dev_decode_buf = pcan_usb_fd_decode_buf,
1200 .dev_start = pcan_usb_fd_start,
1201 .dev_stop = pcan_usb_fd_stop,
1202 .dev_restart_async = pcan_usb_fd_restart_async,
1203 .dev_encode_msg = pcan_usb_fd_encode_msg,
1204
1205 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1206};
1207
1208/* describes the PCAN-CHIP USB */
1209static const struct can_bittiming_const pcan_usb_chip_const = {
1210 .name = "pcan_chip_usb",
1211 .tseg1_min = 1,
1212 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1213 .tseg2_min = 1,
1214 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1215 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1216 .brp_min = 1,
1217 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1218 .brp_inc = 1,
1219};
1220
1221static const struct can_bittiming_const pcan_usb_chip_data_const = {
1222 .name = "pcan_chip_usb",
1223 .tseg1_min = 1,
1224 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1225 .tseg2_min = 1,
1226 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1227 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1228 .brp_min = 1,
1229 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1230 .brp_inc = 1,
1231};
1232
1233const struct peak_usb_adapter pcan_usb_chip = {
1234 .name = "PCAN-Chip USB",
1235 .device_id = PCAN_USBCHIP_PRODUCT_ID,
1236 .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
1237 .ctrlmode_supported = CAN_CTRLMODE_FD |
1238 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1239 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1240 .clock = {
1241 .freq = PCAN_UFD_CRYSTAL_HZ,
1242 },
1243 .bittiming_const = &pcan_usb_chip_const,
1244 .data_bittiming_const = &pcan_usb_chip_data_const,
1245
1246 /* size of device private data */
1247 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1248
1249 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1250
1251 /* timestamps usage */
1252 .ts_used_bits = 32,
1253 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1254 .us_per_ts_shift = 0,
1255
1256 /* give here messages in/out endpoints */
1257 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1258 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
1259
1260 /* size of rx/tx usb buffers */
1261 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1262 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1263
1264 /* device callbacks */
1265 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1266 .dev_init = pcan_usb_fd_init,
1267
1268 .dev_exit = pcan_usb_fd_exit,
1269 .dev_free = pcan_usb_fd_free,
1270 .dev_set_bus = pcan_usb_fd_set_bus,
1271 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1272 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1273 .dev_get_can_channel_id = pcan_usb_fd_get_can_channel_id,
1274 .dev_set_can_channel_id = pcan_usb_fd_set_can_channel_id,
1275 .dev_decode_buf = pcan_usb_fd_decode_buf,
1276 .dev_start = pcan_usb_fd_start,
1277 .dev_stop = pcan_usb_fd_stop,
1278 .dev_restart_async = pcan_usb_fd_restart_async,
1279 .dev_encode_msg = pcan_usb_fd_encode_msg,
1280
1281 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1282};
1283
1284/* describes the PCAN-USB Pro FD adapter */
1285static const struct can_bittiming_const pcan_usb_pro_fd_const = {
1286 .name = "pcan_usb_pro_fd",
1287 .tseg1_min = 1,
1288 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1289 .tseg2_min = 1,
1290 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1291 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1292 .brp_min = 1,
1293 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1294 .brp_inc = 1,
1295};
1296
1297static const struct can_bittiming_const pcan_usb_pro_fd_data_const = {
1298 .name = "pcan_usb_pro_fd",
1299 .tseg1_min = 1,
1300 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1301 .tseg2_min = 1,
1302 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1303 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1304 .brp_min = 1,
1305 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1306 .brp_inc = 1,
1307};
1308
1309const struct peak_usb_adapter pcan_usb_pro_fd = {
1310 .name = "PCAN-USB Pro FD",
1311 .device_id = PCAN_USBPROFD_PRODUCT_ID,
1312 .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
1313 .ctrlmode_supported = CAN_CTRLMODE_FD |
1314 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1315 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1316 .clock = {
1317 .freq = PCAN_UFD_CRYSTAL_HZ,
1318 },
1319 .bittiming_const = &pcan_usb_pro_fd_const,
1320 .data_bittiming_const = &pcan_usb_pro_fd_data_const,
1321
1322 /* size of device private data */
1323 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1324
1325 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1326
1327 /* timestamps usage */
1328 .ts_used_bits = 32,
1329 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1330 .us_per_ts_shift = 0,
1331
1332 /* give here messages in/out endpoints */
1333 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1334 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
1335
1336 /* size of rx/tx usb buffers */
1337 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1338 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1339
1340 /* device callbacks */
1341 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1342 .dev_init = pcan_usb_fd_init,
1343
1344 .dev_exit = pcan_usb_fd_exit,
1345 .dev_free = pcan_usb_fd_free,
1346 .dev_set_bus = pcan_usb_fd_set_bus,
1347 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1348 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1349 .dev_get_can_channel_id = pcan_usb_fd_get_can_channel_id,
1350 .dev_set_can_channel_id = pcan_usb_fd_set_can_channel_id,
1351 .dev_decode_buf = pcan_usb_fd_decode_buf,
1352 .dev_start = pcan_usb_fd_start,
1353 .dev_stop = pcan_usb_fd_stop,
1354 .dev_restart_async = pcan_usb_fd_restart_async,
1355 .dev_encode_msg = pcan_usb_fd_encode_msg,
1356
1357 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1358};
1359
1360/* describes the PCAN-USB X6 adapter */
1361static const struct can_bittiming_const pcan_usb_x6_const = {
1362 .name = "pcan_usb_x6",
1363 .tseg1_min = 1,
1364 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1365 .tseg2_min = 1,
1366 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1367 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1368 .brp_min = 1,
1369 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1370 .brp_inc = 1,
1371};
1372
1373static const struct can_bittiming_const pcan_usb_x6_data_const = {
1374 .name = "pcan_usb_x6",
1375 .tseg1_min = 1,
1376 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1377 .tseg2_min = 1,
1378 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1379 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1380 .brp_min = 1,
1381 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1382 .brp_inc = 1,
1383};
1384
1385const struct peak_usb_adapter pcan_usb_x6 = {
1386 .name = "PCAN-USB X6",
1387 .device_id = PCAN_USBX6_PRODUCT_ID,
1388 .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
1389 .ctrlmode_supported = CAN_CTRLMODE_FD |
1390 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1391 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1392 .clock = {
1393 .freq = PCAN_UFD_CRYSTAL_HZ,
1394 },
1395 .bittiming_const = &pcan_usb_x6_const,
1396 .data_bittiming_const = &pcan_usb_x6_data_const,
1397
1398 /* size of device private data */
1399 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1400
1401 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1402
1403 /* timestamps usage */
1404 .ts_used_bits = 32,
1405 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1406 .us_per_ts_shift = 0,
1407
1408 /* give here messages in/out endpoints */
1409 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1410 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
1411
1412 /* size of rx/tx usb buffers */
1413 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1414 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1415
1416 /* device callbacks */
1417 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1418 .dev_init = pcan_usb_fd_init,
1419
1420 .dev_exit = pcan_usb_fd_exit,
1421 .dev_free = pcan_usb_fd_free,
1422 .dev_set_bus = pcan_usb_fd_set_bus,
1423 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1424 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1425 .dev_get_can_channel_id = pcan_usb_fd_get_can_channel_id,
1426 .dev_set_can_channel_id = pcan_usb_fd_set_can_channel_id,
1427 .dev_decode_buf = pcan_usb_fd_decode_buf,
1428 .dev_start = pcan_usb_fd_start,
1429 .dev_stop = pcan_usb_fd_stop,
1430 .dev_restart_async = pcan_usb_fd_restart_async,
1431 .dev_encode_msg = pcan_usb_fd_encode_msg,
1432
1433 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1434};
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * CAN driver for PEAK System PCAN-USB FD / PCAN-USB Pro FD adapter
4 *
5 * Copyright (C) 2013-2014 Stephane Grosjean <s.grosjean@peak-system.com>
6 */
7#include <linux/netdevice.h>
8#include <linux/usb.h>
9#include <linux/module.h>
10#include <linux/ethtool.h>
11
12#include <linux/can.h>
13#include <linux/can/dev.h>
14#include <linux/can/error.h>
15#include <linux/can/dev/peak_canfd.h>
16
17#include "pcan_usb_core.h"
18#include "pcan_usb_pro.h"
19
20#define PCAN_USBPROFD_CHANNEL_COUNT 2
21#define PCAN_USBFD_CHANNEL_COUNT 1
22
23/* PCAN-USB Pro FD adapter internal clock (Hz) */
24#define PCAN_UFD_CRYSTAL_HZ 80000000
25
26#define PCAN_UFD_CMD_BUFFER_SIZE 512
27#define PCAN_UFD_LOSPD_PKT_SIZE 64
28
29/* PCAN-USB Pro FD command timeout (ms.) */
30#define PCAN_UFD_CMD_TIMEOUT_MS 1000
31
32/* PCAN-USB Pro FD rx/tx buffers size */
33#define PCAN_UFD_RX_BUFFER_SIZE 2048
34#define PCAN_UFD_TX_BUFFER_SIZE 512
35
36/* read some versions info from the hw device */
37struct __packed pcan_ufd_fw_info {
38 __le16 size_of; /* sizeof this */
39 __le16 type; /* type of this structure */
40 u8 hw_type; /* Type of hardware (HW_TYPE_xxx) */
41 u8 bl_version[3]; /* Bootloader version */
42 u8 hw_version; /* Hardware version (PCB) */
43 u8 fw_version[3]; /* Firmware version */
44 __le32 dev_id[2]; /* "device id" per CAN */
45 __le32 ser_no; /* S/N */
46 __le32 flags; /* special functions */
47};
48
49/* handle device specific info used by the netdevices */
50struct pcan_usb_fd_if {
51 struct peak_usb_device *dev[PCAN_USB_MAX_CHANNEL];
52 struct pcan_ufd_fw_info fw_info;
53 struct peak_time_ref time_ref;
54 int cm_ignore_count;
55 int dev_opened_count;
56};
57
58/* device information */
59struct pcan_usb_fd_device {
60 struct peak_usb_device dev;
61 struct can_berr_counter bec;
62 struct pcan_usb_fd_if *usb_if;
63 u8 *cmd_buffer_addr;
64};
65
66/* Extended USB commands (non uCAN commands) */
67
68/* Clock Modes command */
69#define PCAN_UFD_CMD_CLK_SET 0x80
70
71#define PCAN_UFD_CLK_80MHZ 0x0
72#define PCAN_UFD_CLK_60MHZ 0x1
73#define PCAN_UFD_CLK_40MHZ 0x2
74#define PCAN_UFD_CLK_30MHZ 0x3
75#define PCAN_UFD_CLK_24MHZ 0x4
76#define PCAN_UFD_CLK_20MHZ 0x5
77#define PCAN_UFD_CLK_DEF PCAN_UFD_CLK_80MHZ
78
79struct __packed pcan_ufd_clock {
80 __le16 opcode_channel;
81
82 u8 mode;
83 u8 unused[5];
84};
85
86/* LED control command */
87#define PCAN_UFD_CMD_LED_SET 0x86
88
89#define PCAN_UFD_LED_DEV 0x00
90#define PCAN_UFD_LED_FAST 0x01
91#define PCAN_UFD_LED_SLOW 0x02
92#define PCAN_UFD_LED_ON 0x03
93#define PCAN_UFD_LED_OFF 0x04
94#define PCAN_UFD_LED_DEF PCAN_UFD_LED_DEV
95
96struct __packed pcan_ufd_led {
97 __le16 opcode_channel;
98
99 u8 mode;
100 u8 unused[5];
101};
102
103/* Extended usage of uCAN commands CMD_xxx_xx_OPTION for PCAN-USB Pro FD */
104#define PCAN_UFD_FLTEXT_CALIBRATION 0x8000
105
106struct __packed pcan_ufd_options {
107 __le16 opcode_channel;
108
109 __le16 ucan_mask;
110 u16 unused;
111 __le16 usb_mask;
112};
113
114/* Extended usage of uCAN messages for PCAN-USB Pro FD */
115#define PCAN_UFD_MSG_CALIBRATION 0x100
116
117struct __packed pcan_ufd_ts_msg {
118 __le16 size;
119 __le16 type;
120 __le32 ts_low;
121 __le32 ts_high;
122 __le16 usb_frame_index;
123 u16 unused;
124};
125
126#define PCAN_UFD_MSG_OVERRUN 0x101
127
128#define PCAN_UFD_OVMSG_CHANNEL(o) ((o)->channel & 0xf)
129
130struct __packed pcan_ufd_ovr_msg {
131 __le16 size;
132 __le16 type;
133 __le32 ts_low;
134 __le32 ts_high;
135 u8 channel;
136 u8 unused[3];
137};
138
139static inline int pufd_omsg_get_channel(struct pcan_ufd_ovr_msg *om)
140{
141 return om->channel & 0xf;
142}
143
144/* Clock mode frequency values */
145static const u32 pcan_usb_fd_clk_freq[6] = {
146 [PCAN_UFD_CLK_80MHZ] = 80000000,
147 [PCAN_UFD_CLK_60MHZ] = 60000000,
148 [PCAN_UFD_CLK_40MHZ] = 40000000,
149 [PCAN_UFD_CLK_30MHZ] = 30000000,
150 [PCAN_UFD_CLK_24MHZ] = 24000000,
151 [PCAN_UFD_CLK_20MHZ] = 20000000
152};
153
154/* return a device USB interface */
155static inline
156struct pcan_usb_fd_if *pcan_usb_fd_dev_if(struct peak_usb_device *dev)
157{
158 struct pcan_usb_fd_device *pdev =
159 container_of(dev, struct pcan_usb_fd_device, dev);
160 return pdev->usb_if;
161}
162
163/* return a device USB commands buffer */
164static inline void *pcan_usb_fd_cmd_buffer(struct peak_usb_device *dev)
165{
166 struct pcan_usb_fd_device *pdev =
167 container_of(dev, struct pcan_usb_fd_device, dev);
168 return pdev->cmd_buffer_addr;
169}
170
171/* send PCAN-USB Pro FD commands synchronously */
172static int pcan_usb_fd_send_cmd(struct peak_usb_device *dev, void *cmd_tail)
173{
174 void *cmd_head = pcan_usb_fd_cmd_buffer(dev);
175 int err = 0;
176 u8 *packet_ptr;
177 int packet_len;
178 ptrdiff_t cmd_len;
179
180 /* usb device unregistered? */
181 if (!(dev->state & PCAN_USB_STATE_CONNECTED))
182 return 0;
183
184 /* if a packet is not filled completely by commands, the command list
185 * is terminated with an "end of collection" record.
186 */
187 cmd_len = cmd_tail - cmd_head;
188 if (cmd_len <= (PCAN_UFD_CMD_BUFFER_SIZE - sizeof(u64))) {
189 memset(cmd_tail, 0xff, sizeof(u64));
190 cmd_len += sizeof(u64);
191 }
192
193 packet_ptr = cmd_head;
194 packet_len = cmd_len;
195
196 /* firmware is not able to re-assemble 512 bytes buffer in full-speed */
197 if (unlikely(dev->udev->speed != USB_SPEED_HIGH))
198 packet_len = min(packet_len, PCAN_UFD_LOSPD_PKT_SIZE);
199
200 do {
201 err = usb_bulk_msg(dev->udev,
202 usb_sndbulkpipe(dev->udev,
203 PCAN_USBPRO_EP_CMDOUT),
204 packet_ptr, packet_len,
205 NULL, PCAN_UFD_CMD_TIMEOUT_MS);
206 if (err) {
207 netdev_err(dev->netdev,
208 "sending command failure: %d\n", err);
209 break;
210 }
211
212 packet_ptr += packet_len;
213 cmd_len -= packet_len;
214
215 if (cmd_len < PCAN_UFD_LOSPD_PKT_SIZE)
216 packet_len = cmd_len;
217
218 } while (packet_len > 0);
219
220 return err;
221}
222
223/* build the commands list in the given buffer, to enter operational mode */
224static int pcan_usb_fd_build_restart_cmd(struct peak_usb_device *dev, u8 *buf)
225{
226 struct pucan_wr_err_cnt *prc;
227 struct pucan_command *cmd;
228 u8 *pc = buf;
229
230 /* 1st, reset error counters: */
231 prc = (struct pucan_wr_err_cnt *)pc;
232 prc->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
233 PUCAN_CMD_WR_ERR_CNT);
234
235 /* select both counters */
236 prc->sel_mask = cpu_to_le16(PUCAN_WRERRCNT_TE|PUCAN_WRERRCNT_RE);
237
238 /* and reset their values */
239 prc->tx_counter = 0;
240 prc->rx_counter = 0;
241
242 /* moves the pointer forward */
243 pc += sizeof(struct pucan_wr_err_cnt);
244
245 /* add command to switch from ISO to non-ISO mode, if fw allows it */
246 if (dev->can.ctrlmode_supported & CAN_CTRLMODE_FD_NON_ISO) {
247 struct pucan_options *puo = (struct pucan_options *)pc;
248
249 puo->opcode_channel =
250 (dev->can.ctrlmode & CAN_CTRLMODE_FD_NON_ISO) ?
251 pucan_cmd_opcode_channel(dev->ctrl_idx,
252 PUCAN_CMD_CLR_DIS_OPTION) :
253 pucan_cmd_opcode_channel(dev->ctrl_idx,
254 PUCAN_CMD_SET_EN_OPTION);
255
256 puo->options = cpu_to_le16(PUCAN_OPTION_CANDFDISO);
257
258 /* to be sure that no other extended bits will be taken into
259 * account
260 */
261 puo->unused = 0;
262
263 /* moves the pointer forward */
264 pc += sizeof(struct pucan_options);
265 }
266
267 /* next, go back to operational mode */
268 cmd = (struct pucan_command *)pc;
269 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
270 (dev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) ?
271 PUCAN_CMD_LISTEN_ONLY_MODE :
272 PUCAN_CMD_NORMAL_MODE);
273 pc += sizeof(struct pucan_command);
274
275 return pc - buf;
276}
277
278/* set CAN bus on/off */
279static int pcan_usb_fd_set_bus(struct peak_usb_device *dev, u8 onoff)
280{
281 u8 *pc = pcan_usb_fd_cmd_buffer(dev);
282 int l;
283
284 if (onoff) {
285 /* build the cmds list to enter operational mode */
286 l = pcan_usb_fd_build_restart_cmd(dev, pc);
287 } else {
288 struct pucan_command *cmd = (struct pucan_command *)pc;
289
290 /* build cmd to go back to reset mode */
291 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
292 PUCAN_CMD_RESET_MODE);
293 l = sizeof(struct pucan_command);
294 }
295
296 /* send the command */
297 return pcan_usb_fd_send_cmd(dev, pc + l);
298}
299
300/* set filtering masks:
301 *
302 * idx in range [0..63] selects a row #idx, all rows otherwise
303 * mask in range [0..0xffffffff] defines up to 32 CANIDs in the row(s)
304 *
305 * Each bit of this 64 x 32 bits array defines a CANID value:
306 *
307 * bit[i,j] = 1 implies that CANID=(i x 32)+j will be received, while
308 * bit[i,j] = 0 implies that CANID=(i x 32)+j will be discarded.
309 */
310static int pcan_usb_fd_set_filter_std(struct peak_usb_device *dev, int idx,
311 u32 mask)
312{
313 struct pucan_filter_std *cmd = pcan_usb_fd_cmd_buffer(dev);
314 int i, n;
315
316 /* select all rows when idx is out of range [0..63] */
317 if ((idx < 0) || (idx >= (1 << PUCAN_FLTSTD_ROW_IDX_BITS))) {
318 n = 1 << PUCAN_FLTSTD_ROW_IDX_BITS;
319 idx = 0;
320
321 /* select the row (and only the row) otherwise */
322 } else {
323 n = idx + 1;
324 }
325
326 for (i = idx; i < n; i++, cmd++) {
327 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
328 PUCAN_CMD_FILTER_STD);
329 cmd->idx = cpu_to_le16(i);
330 cmd->mask = cpu_to_le32(mask);
331 }
332
333 /* send the command */
334 return pcan_usb_fd_send_cmd(dev, cmd);
335}
336
337/* set/unset options
338 *
339 * onoff set(1)/unset(0) options
340 * mask each bit defines a kind of options to set/unset
341 */
342static int pcan_usb_fd_set_options(struct peak_usb_device *dev,
343 bool onoff, u16 ucan_mask, u16 usb_mask)
344{
345 struct pcan_ufd_options *cmd = pcan_usb_fd_cmd_buffer(dev);
346
347 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
348 (onoff) ? PUCAN_CMD_SET_EN_OPTION :
349 PUCAN_CMD_CLR_DIS_OPTION);
350
351 cmd->ucan_mask = cpu_to_le16(ucan_mask);
352 cmd->usb_mask = cpu_to_le16(usb_mask);
353
354 /* send the command */
355 return pcan_usb_fd_send_cmd(dev, ++cmd);
356}
357
358/* setup LED control */
359static int pcan_usb_fd_set_can_led(struct peak_usb_device *dev, u8 led_mode)
360{
361 struct pcan_ufd_led *cmd = pcan_usb_fd_cmd_buffer(dev);
362
363 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
364 PCAN_UFD_CMD_LED_SET);
365 cmd->mode = led_mode;
366
367 /* send the command */
368 return pcan_usb_fd_send_cmd(dev, ++cmd);
369}
370
371/* set CAN clock domain */
372static int pcan_usb_fd_set_clock_domain(struct peak_usb_device *dev,
373 u8 clk_mode)
374{
375 struct pcan_ufd_clock *cmd = pcan_usb_fd_cmd_buffer(dev);
376
377 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
378 PCAN_UFD_CMD_CLK_SET);
379 cmd->mode = clk_mode;
380
381 /* send the command */
382 return pcan_usb_fd_send_cmd(dev, ++cmd);
383}
384
385/* set bittiming for CAN and CAN-FD header */
386static int pcan_usb_fd_set_bittiming_slow(struct peak_usb_device *dev,
387 struct can_bittiming *bt)
388{
389 struct pucan_timing_slow *cmd = pcan_usb_fd_cmd_buffer(dev);
390
391 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
392 PUCAN_CMD_TIMING_SLOW);
393 cmd->sjw_t = PUCAN_TSLOW_SJW_T(bt->sjw - 1,
394 dev->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES);
395
396 cmd->tseg2 = PUCAN_TSLOW_TSEG2(bt->phase_seg2 - 1);
397 cmd->tseg1 = PUCAN_TSLOW_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
398 cmd->brp = cpu_to_le16(PUCAN_TSLOW_BRP(bt->brp - 1));
399
400 cmd->ewl = 96; /* default */
401
402 /* send the command */
403 return pcan_usb_fd_send_cmd(dev, ++cmd);
404}
405
406/* set CAN-FD bittiming for data */
407static int pcan_usb_fd_set_bittiming_fast(struct peak_usb_device *dev,
408 struct can_bittiming *bt)
409{
410 struct pucan_timing_fast *cmd = pcan_usb_fd_cmd_buffer(dev);
411
412 cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
413 PUCAN_CMD_TIMING_FAST);
414 cmd->sjw = PUCAN_TFAST_SJW(bt->sjw - 1);
415 cmd->tseg2 = PUCAN_TFAST_TSEG2(bt->phase_seg2 - 1);
416 cmd->tseg1 = PUCAN_TFAST_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
417 cmd->brp = cpu_to_le16(PUCAN_TFAST_BRP(bt->brp - 1));
418
419 /* send the command */
420 return pcan_usb_fd_send_cmd(dev, ++cmd);
421}
422
423/* handle restart but in asynchronously way
424 * (uses PCAN-USB Pro code to complete asynchronous request)
425 */
426static int pcan_usb_fd_restart_async(struct peak_usb_device *dev,
427 struct urb *urb, u8 *buf)
428{
429 u8 *pc = buf;
430
431 /* build the entire cmds list in the provided buffer, to go back into
432 * operational mode.
433 */
434 pc += pcan_usb_fd_build_restart_cmd(dev, pc);
435
436 /* add EOC */
437 memset(pc, 0xff, sizeof(struct pucan_command));
438 pc += sizeof(struct pucan_command);
439
440 /* complete the URB */
441 usb_fill_bulk_urb(urb, dev->udev,
442 usb_sndbulkpipe(dev->udev, PCAN_USBPRO_EP_CMDOUT),
443 buf, pc - buf,
444 pcan_usb_pro_restart_complete, dev);
445
446 /* and submit it. */
447 return usb_submit_urb(urb, GFP_ATOMIC);
448}
449
450static int pcan_usb_fd_drv_loaded(struct peak_usb_device *dev, bool loaded)
451{
452 struct pcan_usb_fd_device *pdev =
453 container_of(dev, struct pcan_usb_fd_device, dev);
454
455 pdev->cmd_buffer_addr[0] = 0;
456 pdev->cmd_buffer_addr[1] = !!loaded;
457
458 return pcan_usb_pro_send_req(dev,
459 PCAN_USBPRO_REQ_FCT,
460 PCAN_USBPRO_FCT_DRVLD,
461 pdev->cmd_buffer_addr,
462 PCAN_USBPRO_FCT_DRVLD_REQ_LEN);
463}
464
465static int pcan_usb_fd_decode_canmsg(struct pcan_usb_fd_if *usb_if,
466 struct pucan_msg *rx_msg)
467{
468 struct pucan_rx_msg *rm = (struct pucan_rx_msg *)rx_msg;
469 struct peak_usb_device *dev;
470 struct net_device *netdev;
471 struct canfd_frame *cfd;
472 struct sk_buff *skb;
473 const u16 rx_msg_flags = le16_to_cpu(rm->flags);
474
475 if (pucan_msg_get_channel(rm) >= ARRAY_SIZE(usb_if->dev))
476 return -ENOMEM;
477
478 dev = usb_if->dev[pucan_msg_get_channel(rm)];
479 netdev = dev->netdev;
480
481 if (rx_msg_flags & PUCAN_MSG_EXT_DATA_LEN) {
482 /* CANFD frame case */
483 skb = alloc_canfd_skb(netdev, &cfd);
484 if (!skb)
485 return -ENOMEM;
486
487 if (rx_msg_flags & PUCAN_MSG_BITRATE_SWITCH)
488 cfd->flags |= CANFD_BRS;
489
490 if (rx_msg_flags & PUCAN_MSG_ERROR_STATE_IND)
491 cfd->flags |= CANFD_ESI;
492
493 cfd->len = can_fd_dlc2len(pucan_msg_get_dlc(rm));
494 } else {
495 /* CAN 2.0 frame case */
496 skb = alloc_can_skb(netdev, (struct can_frame **)&cfd);
497 if (!skb)
498 return -ENOMEM;
499
500 can_frame_set_cc_len((struct can_frame *)cfd,
501 pucan_msg_get_dlc(rm),
502 dev->can.ctrlmode);
503 }
504
505 cfd->can_id = le32_to_cpu(rm->can_id);
506
507 if (rx_msg_flags & PUCAN_MSG_EXT_ID)
508 cfd->can_id |= CAN_EFF_FLAG;
509
510 if (rx_msg_flags & PUCAN_MSG_RTR)
511 cfd->can_id |= CAN_RTR_FLAG;
512 else
513 memcpy(cfd->data, rm->d, cfd->len);
514
515 netdev->stats.rx_packets++;
516 netdev->stats.rx_bytes += cfd->len;
517
518 peak_usb_netif_rx(skb, &usb_if->time_ref, le32_to_cpu(rm->ts_low));
519
520 return 0;
521}
522
523/* handle uCAN status message */
524static int pcan_usb_fd_decode_status(struct pcan_usb_fd_if *usb_if,
525 struct pucan_msg *rx_msg)
526{
527 struct pucan_status_msg *sm = (struct pucan_status_msg *)rx_msg;
528 struct pcan_usb_fd_device *pdev;
529 enum can_state new_state = CAN_STATE_ERROR_ACTIVE;
530 enum can_state rx_state, tx_state;
531 struct peak_usb_device *dev;
532 struct net_device *netdev;
533 struct can_frame *cf;
534 struct sk_buff *skb;
535
536 if (pucan_stmsg_get_channel(sm) >= ARRAY_SIZE(usb_if->dev))
537 return -ENOMEM;
538
539 dev = usb_if->dev[pucan_stmsg_get_channel(sm)];
540 pdev = container_of(dev, struct pcan_usb_fd_device, dev);
541 netdev = dev->netdev;
542
543 /* nothing should be sent while in BUS_OFF state */
544 if (dev->can.state == CAN_STATE_BUS_OFF)
545 return 0;
546
547 if (sm->channel_p_w_b & PUCAN_BUS_BUSOFF) {
548 new_state = CAN_STATE_BUS_OFF;
549 } else if (sm->channel_p_w_b & PUCAN_BUS_PASSIVE) {
550 new_state = CAN_STATE_ERROR_PASSIVE;
551 } else if (sm->channel_p_w_b & PUCAN_BUS_WARNING) {
552 new_state = CAN_STATE_ERROR_WARNING;
553 } else {
554 /* back to (or still in) ERROR_ACTIVE state */
555 new_state = CAN_STATE_ERROR_ACTIVE;
556 pdev->bec.txerr = 0;
557 pdev->bec.rxerr = 0;
558 }
559
560 /* state hasn't changed */
561 if (new_state == dev->can.state)
562 return 0;
563
564 /* handle bus state change */
565 tx_state = (pdev->bec.txerr >= pdev->bec.rxerr) ? new_state : 0;
566 rx_state = (pdev->bec.txerr <= pdev->bec.rxerr) ? new_state : 0;
567
568 /* allocate an skb to store the error frame */
569 skb = alloc_can_err_skb(netdev, &cf);
570 if (skb)
571 can_change_state(netdev, cf, tx_state, rx_state);
572
573 /* things must be done even in case of OOM */
574 if (new_state == CAN_STATE_BUS_OFF)
575 can_bus_off(netdev);
576
577 if (!skb)
578 return -ENOMEM;
579
580 netdev->stats.rx_packets++;
581 netdev->stats.rx_bytes += cf->len;
582
583 peak_usb_netif_rx(skb, &usb_if->time_ref, le32_to_cpu(sm->ts_low));
584
585 return 0;
586}
587
588/* handle uCAN error message */
589static int pcan_usb_fd_decode_error(struct pcan_usb_fd_if *usb_if,
590 struct pucan_msg *rx_msg)
591{
592 struct pucan_error_msg *er = (struct pucan_error_msg *)rx_msg;
593 struct pcan_usb_fd_device *pdev;
594 struct peak_usb_device *dev;
595
596 if (pucan_ermsg_get_channel(er) >= ARRAY_SIZE(usb_if->dev))
597 return -EINVAL;
598
599 dev = usb_if->dev[pucan_ermsg_get_channel(er)];
600 pdev = container_of(dev, struct pcan_usb_fd_device, dev);
601
602 /* keep a trace of tx and rx error counters for later use */
603 pdev->bec.txerr = er->tx_err_cnt;
604 pdev->bec.rxerr = er->rx_err_cnt;
605
606 return 0;
607}
608
609/* handle uCAN overrun message */
610static int pcan_usb_fd_decode_overrun(struct pcan_usb_fd_if *usb_if,
611 struct pucan_msg *rx_msg)
612{
613 struct pcan_ufd_ovr_msg *ov = (struct pcan_ufd_ovr_msg *)rx_msg;
614 struct peak_usb_device *dev;
615 struct net_device *netdev;
616 struct can_frame *cf;
617 struct sk_buff *skb;
618
619 if (pufd_omsg_get_channel(ov) >= ARRAY_SIZE(usb_if->dev))
620 return -EINVAL;
621
622 dev = usb_if->dev[pufd_omsg_get_channel(ov)];
623 netdev = dev->netdev;
624
625 /* allocate an skb to store the error frame */
626 skb = alloc_can_err_skb(netdev, &cf);
627 if (!skb)
628 return -ENOMEM;
629
630 cf->can_id |= CAN_ERR_CRTL;
631 cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW;
632
633 peak_usb_netif_rx(skb, &usb_if->time_ref, le32_to_cpu(ov->ts_low));
634
635 netdev->stats.rx_over_errors++;
636 netdev->stats.rx_errors++;
637
638 return 0;
639}
640
641/* handle USB calibration message */
642static void pcan_usb_fd_decode_ts(struct pcan_usb_fd_if *usb_if,
643 struct pucan_msg *rx_msg)
644{
645 struct pcan_ufd_ts_msg *ts = (struct pcan_ufd_ts_msg *)rx_msg;
646
647 /* should wait until clock is stabilized */
648 if (usb_if->cm_ignore_count > 0)
649 usb_if->cm_ignore_count--;
650 else
651 peak_usb_set_ts_now(&usb_if->time_ref, le32_to_cpu(ts->ts_low));
652}
653
654/* callback for bulk IN urb */
655static int pcan_usb_fd_decode_buf(struct peak_usb_device *dev, struct urb *urb)
656{
657 struct pcan_usb_fd_if *usb_if = pcan_usb_fd_dev_if(dev);
658 struct net_device *netdev = dev->netdev;
659 struct pucan_msg *rx_msg;
660 u8 *msg_ptr, *msg_end;
661 int err = 0;
662
663 /* loop reading all the records from the incoming message */
664 msg_ptr = urb->transfer_buffer;
665 msg_end = urb->transfer_buffer + urb->actual_length;
666 for (; msg_ptr < msg_end;) {
667 u16 rx_msg_type, rx_msg_size;
668
669 rx_msg = (struct pucan_msg *)msg_ptr;
670 if (!rx_msg->size) {
671 /* null packet found: end of list */
672 break;
673 }
674
675 rx_msg_size = le16_to_cpu(rx_msg->size);
676 rx_msg_type = le16_to_cpu(rx_msg->type);
677
678 /* check if the record goes out of current packet */
679 if (msg_ptr + rx_msg_size > msg_end) {
680 netdev_err(netdev,
681 "got frag rec: should inc usb rx buf sze\n");
682 err = -EBADMSG;
683 break;
684 }
685
686 switch (rx_msg_type) {
687 case PUCAN_MSG_CAN_RX:
688 err = pcan_usb_fd_decode_canmsg(usb_if, rx_msg);
689 if (err < 0)
690 goto fail;
691 break;
692
693 case PCAN_UFD_MSG_CALIBRATION:
694 pcan_usb_fd_decode_ts(usb_if, rx_msg);
695 break;
696
697 case PUCAN_MSG_ERROR:
698 err = pcan_usb_fd_decode_error(usb_if, rx_msg);
699 if (err < 0)
700 goto fail;
701 break;
702
703 case PUCAN_MSG_STATUS:
704 err = pcan_usb_fd_decode_status(usb_if, rx_msg);
705 if (err < 0)
706 goto fail;
707 break;
708
709 case PCAN_UFD_MSG_OVERRUN:
710 err = pcan_usb_fd_decode_overrun(usb_if, rx_msg);
711 if (err < 0)
712 goto fail;
713 break;
714
715 default:
716 netdev_err(netdev,
717 "unhandled msg type 0x%02x (%d): ignored\n",
718 rx_msg_type, rx_msg_type);
719 break;
720 }
721
722 msg_ptr += rx_msg_size;
723 }
724
725fail:
726 if (err)
727 pcan_dump_mem("received msg",
728 urb->transfer_buffer, urb->actual_length);
729 return err;
730}
731
732/* CAN/CANFD frames encoding callback */
733static int pcan_usb_fd_encode_msg(struct peak_usb_device *dev,
734 struct sk_buff *skb, u8 *obuf, size_t *size)
735{
736 struct pucan_tx_msg *tx_msg = (struct pucan_tx_msg *)obuf;
737 struct canfd_frame *cfd = (struct canfd_frame *)skb->data;
738 u16 tx_msg_size, tx_msg_flags;
739 u8 dlc;
740
741 if (cfd->len > CANFD_MAX_DLEN)
742 return -EINVAL;
743
744 tx_msg_size = ALIGN(sizeof(struct pucan_tx_msg) + cfd->len, 4);
745 tx_msg->size = cpu_to_le16(tx_msg_size);
746 tx_msg->type = cpu_to_le16(PUCAN_MSG_CAN_TX);
747
748 tx_msg_flags = 0;
749 if (cfd->can_id & CAN_EFF_FLAG) {
750 tx_msg_flags |= PUCAN_MSG_EXT_ID;
751 tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_EFF_MASK);
752 } else {
753 tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_SFF_MASK);
754 }
755
756 if (can_is_canfd_skb(skb)) {
757 /* considering a CANFD frame */
758 dlc = can_fd_len2dlc(cfd->len);
759
760 tx_msg_flags |= PUCAN_MSG_EXT_DATA_LEN;
761
762 if (cfd->flags & CANFD_BRS)
763 tx_msg_flags |= PUCAN_MSG_BITRATE_SWITCH;
764
765 if (cfd->flags & CANFD_ESI)
766 tx_msg_flags |= PUCAN_MSG_ERROR_STATE_IND;
767 } else {
768 /* CAND 2.0 frames */
769 dlc = can_get_cc_dlc((struct can_frame *)cfd,
770 dev->can.ctrlmode);
771
772 if (cfd->can_id & CAN_RTR_FLAG)
773 tx_msg_flags |= PUCAN_MSG_RTR;
774 }
775
776 /* Single-Shot frame */
777 if (dev->can.ctrlmode & CAN_CTRLMODE_ONE_SHOT)
778 tx_msg_flags |= PUCAN_MSG_SINGLE_SHOT;
779
780 tx_msg->flags = cpu_to_le16(tx_msg_flags);
781 tx_msg->channel_dlc = PUCAN_MSG_CHANNEL_DLC(dev->ctrl_idx, dlc);
782 memcpy(tx_msg->d, cfd->data, cfd->len);
783
784 /* add null size message to tag the end (messages are 32-bits aligned)
785 */
786 tx_msg = (struct pucan_tx_msg *)(obuf + tx_msg_size);
787
788 tx_msg->size = 0;
789
790 /* set the whole size of the USB packet to send */
791 *size = tx_msg_size + sizeof(u32);
792
793 return 0;
794}
795
796/* start the interface (last chance before set bus on) */
797static int pcan_usb_fd_start(struct peak_usb_device *dev)
798{
799 struct pcan_usb_fd_device *pdev =
800 container_of(dev, struct pcan_usb_fd_device, dev);
801 int err;
802
803 /* set filter mode: all acceptance */
804 err = pcan_usb_fd_set_filter_std(dev, -1, 0xffffffff);
805 if (err)
806 return err;
807
808 /* opening first device: */
809 if (pdev->usb_if->dev_opened_count == 0) {
810 /* reset time_ref */
811 peak_usb_init_time_ref(&pdev->usb_if->time_ref,
812 &pcan_usb_pro_fd);
813
814 /* enable USB calibration messages */
815 err = pcan_usb_fd_set_options(dev, 1,
816 PUCAN_OPTION_ERROR,
817 PCAN_UFD_FLTEXT_CALIBRATION);
818 }
819
820 pdev->usb_if->dev_opened_count++;
821
822 /* reset cached error counters */
823 pdev->bec.txerr = 0;
824 pdev->bec.rxerr = 0;
825
826 return err;
827}
828
829/* socket callback used to copy berr counters values received through USB */
830static int pcan_usb_fd_get_berr_counter(const struct net_device *netdev,
831 struct can_berr_counter *bec)
832{
833 struct peak_usb_device *dev = netdev_priv(netdev);
834 struct pcan_usb_fd_device *pdev =
835 container_of(dev, struct pcan_usb_fd_device, dev);
836
837 *bec = pdev->bec;
838
839 /* must return 0 */
840 return 0;
841}
842
843/* stop interface (last chance before set bus off) */
844static int pcan_usb_fd_stop(struct peak_usb_device *dev)
845{
846 struct pcan_usb_fd_device *pdev =
847 container_of(dev, struct pcan_usb_fd_device, dev);
848
849 /* turn off special msgs for that interface if no other dev opened */
850 if (pdev->usb_if->dev_opened_count == 1)
851 pcan_usb_fd_set_options(dev, 0,
852 PUCAN_OPTION_ERROR,
853 PCAN_UFD_FLTEXT_CALIBRATION);
854 pdev->usb_if->dev_opened_count--;
855
856 return 0;
857}
858
859/* called when probing, to initialize a device object */
860static int pcan_usb_fd_init(struct peak_usb_device *dev)
861{
862 struct pcan_usb_fd_device *pdev =
863 container_of(dev, struct pcan_usb_fd_device, dev);
864 int i, err = -ENOMEM;
865
866 /* do this for 1st channel only */
867 if (!dev->prev_siblings) {
868 /* allocate netdevices common structure attached to first one */
869 pdev->usb_if = kzalloc(sizeof(*pdev->usb_if), GFP_KERNEL);
870 if (!pdev->usb_if)
871 goto err_out;
872
873 /* allocate command buffer once for all for the interface */
874 pdev->cmd_buffer_addr = kzalloc(PCAN_UFD_CMD_BUFFER_SIZE,
875 GFP_KERNEL);
876 if (!pdev->cmd_buffer_addr)
877 goto err_out_1;
878
879 /* number of ts msgs to ignore before taking one into account */
880 pdev->usb_if->cm_ignore_count = 5;
881
882 err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO,
883 PCAN_USBPRO_INFO_FW,
884 &pdev->usb_if->fw_info,
885 sizeof(pdev->usb_if->fw_info));
886 if (err) {
887 dev_err(dev->netdev->dev.parent,
888 "unable to read %s firmware info (err %d)\n",
889 dev->adapter->name, err);
890 goto err_out_2;
891 }
892
893 /* explicit use of dev_xxx() instead of netdev_xxx() here:
894 * information displayed are related to the device itself, not
895 * to the canx (channel) device.
896 */
897 dev_info(dev->netdev->dev.parent,
898 "PEAK-System %s v%u fw v%u.%u.%u (%u channels)\n",
899 dev->adapter->name, pdev->usb_if->fw_info.hw_version,
900 pdev->usb_if->fw_info.fw_version[0],
901 pdev->usb_if->fw_info.fw_version[1],
902 pdev->usb_if->fw_info.fw_version[2],
903 dev->adapter->ctrl_count);
904
905 /* check for ability to switch between ISO/non-ISO modes */
906 if (pdev->usb_if->fw_info.fw_version[0] >= 2) {
907 /* firmware >= 2.x supports ISO/non-ISO switching */
908 dev->can.ctrlmode_supported |= CAN_CTRLMODE_FD_NON_ISO;
909 } else {
910 /* firmware < 2.x only supports fixed(!) non-ISO */
911 dev->can.ctrlmode |= CAN_CTRLMODE_FD_NON_ISO;
912 }
913
914 /* tell the hardware the can driver is running */
915 err = pcan_usb_fd_drv_loaded(dev, 1);
916 if (err) {
917 dev_err(dev->netdev->dev.parent,
918 "unable to tell %s driver is loaded (err %d)\n",
919 dev->adapter->name, err);
920 goto err_out_2;
921 }
922 } else {
923 /* otherwise, simply copy previous sibling's values */
924 struct pcan_usb_fd_device *ppdev =
925 container_of(dev->prev_siblings,
926 struct pcan_usb_fd_device, dev);
927
928 pdev->usb_if = ppdev->usb_if;
929 pdev->cmd_buffer_addr = ppdev->cmd_buffer_addr;
930
931 /* do a copy of the ctrlmode[_supported] too */
932 dev->can.ctrlmode = ppdev->dev.can.ctrlmode;
933 dev->can.ctrlmode_supported = ppdev->dev.can.ctrlmode_supported;
934 }
935
936 pdev->usb_if->dev[dev->ctrl_idx] = dev;
937 dev->device_number =
938 le32_to_cpu(pdev->usb_if->fw_info.dev_id[dev->ctrl_idx]);
939
940 /* set clock domain */
941 for (i = 0; i < ARRAY_SIZE(pcan_usb_fd_clk_freq); i++)
942 if (dev->adapter->clock.freq == pcan_usb_fd_clk_freq[i])
943 break;
944
945 if (i >= ARRAY_SIZE(pcan_usb_fd_clk_freq)) {
946 dev_warn(dev->netdev->dev.parent,
947 "incompatible clock frequencies\n");
948 err = -EINVAL;
949 goto err_out_2;
950 }
951
952 pcan_usb_fd_set_clock_domain(dev, i);
953
954 /* set LED in default state (end of init phase) */
955 pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_DEF);
956
957 return 0;
958
959err_out_2:
960 kfree(pdev->cmd_buffer_addr);
961err_out_1:
962 kfree(pdev->usb_if);
963err_out:
964 return err;
965}
966
967/* called when driver module is being unloaded */
968static void pcan_usb_fd_exit(struct peak_usb_device *dev)
969{
970 struct pcan_usb_fd_device *pdev =
971 container_of(dev, struct pcan_usb_fd_device, dev);
972
973 /* when rmmod called before unplug and if down, should reset things
974 * before leaving
975 */
976 if (dev->can.state != CAN_STATE_STOPPED) {
977 /* set bus off on the corresponding channel */
978 pcan_usb_fd_set_bus(dev, 0);
979 }
980
981 /* switch off corresponding CAN LEDs */
982 pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_OFF);
983
984 /* if channel #0 (only) */
985 if (dev->ctrl_idx == 0) {
986 /* turn off calibration message if any device were opened */
987 if (pdev->usb_if->dev_opened_count > 0)
988 pcan_usb_fd_set_options(dev, 0,
989 PUCAN_OPTION_ERROR,
990 PCAN_UFD_FLTEXT_CALIBRATION);
991
992 /* tell USB adapter that the driver is being unloaded */
993 pcan_usb_fd_drv_loaded(dev, 0);
994 }
995}
996
997/* called when the USB adapter is unplugged */
998static void pcan_usb_fd_free(struct peak_usb_device *dev)
999{
1000 /* last device: can free shared objects now */
1001 if (!dev->prev_siblings && !dev->next_siblings) {
1002 struct pcan_usb_fd_device *pdev =
1003 container_of(dev, struct pcan_usb_fd_device, dev);
1004
1005 /* free commands buffer */
1006 kfree(pdev->cmd_buffer_addr);
1007
1008 /* free usb interface object */
1009 kfree(pdev->usb_if);
1010 }
1011}
1012
1013/* blink LED's */
1014static int pcan_usb_fd_set_phys_id(struct net_device *netdev,
1015 enum ethtool_phys_id_state state)
1016{
1017 struct peak_usb_device *dev = netdev_priv(netdev);
1018 int err = 0;
1019
1020 switch (state) {
1021 case ETHTOOL_ID_ACTIVE:
1022 err = pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_FAST);
1023 break;
1024 case ETHTOOL_ID_INACTIVE:
1025 err = pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_DEF);
1026 break;
1027 default:
1028 break;
1029 }
1030
1031 return err;
1032}
1033
1034static const struct ethtool_ops pcan_usb_fd_ethtool_ops = {
1035 .set_phys_id = pcan_usb_fd_set_phys_id,
1036};
1037
1038/* describes the PCAN-USB FD adapter */
1039static const struct can_bittiming_const pcan_usb_fd_const = {
1040 .name = "pcan_usb_fd",
1041 .tseg1_min = 1,
1042 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1043 .tseg2_min = 1,
1044 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1045 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1046 .brp_min = 1,
1047 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1048 .brp_inc = 1,
1049};
1050
1051static const struct can_bittiming_const pcan_usb_fd_data_const = {
1052 .name = "pcan_usb_fd",
1053 .tseg1_min = 1,
1054 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1055 .tseg2_min = 1,
1056 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1057 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1058 .brp_min = 1,
1059 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1060 .brp_inc = 1,
1061};
1062
1063const struct peak_usb_adapter pcan_usb_fd = {
1064 .name = "PCAN-USB FD",
1065 .device_id = PCAN_USBFD_PRODUCT_ID,
1066 .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
1067 .ctrlmode_supported = CAN_CTRLMODE_FD |
1068 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1069 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1070 .clock = {
1071 .freq = PCAN_UFD_CRYSTAL_HZ,
1072 },
1073 .bittiming_const = &pcan_usb_fd_const,
1074 .data_bittiming_const = &pcan_usb_fd_data_const,
1075
1076 /* size of device private data */
1077 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1078
1079 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1080
1081 /* timestamps usage */
1082 .ts_used_bits = 32,
1083 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1084 .us_per_ts_shift = 0,
1085
1086 /* give here messages in/out endpoints */
1087 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1088 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
1089
1090 /* size of rx/tx usb buffers */
1091 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1092 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1093
1094 /* device callbacks */
1095 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1096 .dev_init = pcan_usb_fd_init,
1097
1098 .dev_exit = pcan_usb_fd_exit,
1099 .dev_free = pcan_usb_fd_free,
1100 .dev_set_bus = pcan_usb_fd_set_bus,
1101 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1102 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1103 .dev_decode_buf = pcan_usb_fd_decode_buf,
1104 .dev_start = pcan_usb_fd_start,
1105 .dev_stop = pcan_usb_fd_stop,
1106 .dev_restart_async = pcan_usb_fd_restart_async,
1107 .dev_encode_msg = pcan_usb_fd_encode_msg,
1108
1109 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1110};
1111
1112/* describes the PCAN-CHIP USB */
1113static const struct can_bittiming_const pcan_usb_chip_const = {
1114 .name = "pcan_chip_usb",
1115 .tseg1_min = 1,
1116 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1117 .tseg2_min = 1,
1118 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1119 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1120 .brp_min = 1,
1121 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1122 .brp_inc = 1,
1123};
1124
1125static const struct can_bittiming_const pcan_usb_chip_data_const = {
1126 .name = "pcan_chip_usb",
1127 .tseg1_min = 1,
1128 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1129 .tseg2_min = 1,
1130 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1131 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1132 .brp_min = 1,
1133 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1134 .brp_inc = 1,
1135};
1136
1137const struct peak_usb_adapter pcan_usb_chip = {
1138 .name = "PCAN-Chip USB",
1139 .device_id = PCAN_USBCHIP_PRODUCT_ID,
1140 .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
1141 .ctrlmode_supported = CAN_CTRLMODE_FD |
1142 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1143 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1144 .clock = {
1145 .freq = PCAN_UFD_CRYSTAL_HZ,
1146 },
1147 .bittiming_const = &pcan_usb_chip_const,
1148 .data_bittiming_const = &pcan_usb_chip_data_const,
1149
1150 /* size of device private data */
1151 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1152
1153 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1154
1155 /* timestamps usage */
1156 .ts_used_bits = 32,
1157 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1158 .us_per_ts_shift = 0,
1159
1160 /* give here messages in/out endpoints */
1161 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1162 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
1163
1164 /* size of rx/tx usb buffers */
1165 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1166 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1167
1168 /* device callbacks */
1169 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1170 .dev_init = pcan_usb_fd_init,
1171
1172 .dev_exit = pcan_usb_fd_exit,
1173 .dev_free = pcan_usb_fd_free,
1174 .dev_set_bus = pcan_usb_fd_set_bus,
1175 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1176 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1177 .dev_decode_buf = pcan_usb_fd_decode_buf,
1178 .dev_start = pcan_usb_fd_start,
1179 .dev_stop = pcan_usb_fd_stop,
1180 .dev_restart_async = pcan_usb_fd_restart_async,
1181 .dev_encode_msg = pcan_usb_fd_encode_msg,
1182
1183 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1184};
1185
1186/* describes the PCAN-USB Pro FD adapter */
1187static const struct can_bittiming_const pcan_usb_pro_fd_const = {
1188 .name = "pcan_usb_pro_fd",
1189 .tseg1_min = 1,
1190 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1191 .tseg2_min = 1,
1192 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1193 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1194 .brp_min = 1,
1195 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1196 .brp_inc = 1,
1197};
1198
1199static const struct can_bittiming_const pcan_usb_pro_fd_data_const = {
1200 .name = "pcan_usb_pro_fd",
1201 .tseg1_min = 1,
1202 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1203 .tseg2_min = 1,
1204 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1205 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1206 .brp_min = 1,
1207 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1208 .brp_inc = 1,
1209};
1210
1211const struct peak_usb_adapter pcan_usb_pro_fd = {
1212 .name = "PCAN-USB Pro FD",
1213 .device_id = PCAN_USBPROFD_PRODUCT_ID,
1214 .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
1215 .ctrlmode_supported = CAN_CTRLMODE_FD |
1216 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1217 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1218 .clock = {
1219 .freq = PCAN_UFD_CRYSTAL_HZ,
1220 },
1221 .bittiming_const = &pcan_usb_pro_fd_const,
1222 .data_bittiming_const = &pcan_usb_pro_fd_data_const,
1223
1224 /* size of device private data */
1225 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1226
1227 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1228
1229 /* timestamps usage */
1230 .ts_used_bits = 32,
1231 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1232 .us_per_ts_shift = 0,
1233
1234 /* give here messages in/out endpoints */
1235 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1236 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
1237
1238 /* size of rx/tx usb buffers */
1239 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1240 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1241
1242 /* device callbacks */
1243 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1244 .dev_init = pcan_usb_fd_init,
1245
1246 .dev_exit = pcan_usb_fd_exit,
1247 .dev_free = pcan_usb_fd_free,
1248 .dev_set_bus = pcan_usb_fd_set_bus,
1249 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1250 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1251 .dev_decode_buf = pcan_usb_fd_decode_buf,
1252 .dev_start = pcan_usb_fd_start,
1253 .dev_stop = pcan_usb_fd_stop,
1254 .dev_restart_async = pcan_usb_fd_restart_async,
1255 .dev_encode_msg = pcan_usb_fd_encode_msg,
1256
1257 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1258};
1259
1260/* describes the PCAN-USB X6 adapter */
1261static const struct can_bittiming_const pcan_usb_x6_const = {
1262 .name = "pcan_usb_x6",
1263 .tseg1_min = 1,
1264 .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
1265 .tseg2_min = 1,
1266 .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
1267 .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
1268 .brp_min = 1,
1269 .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
1270 .brp_inc = 1,
1271};
1272
1273static const struct can_bittiming_const pcan_usb_x6_data_const = {
1274 .name = "pcan_usb_x6",
1275 .tseg1_min = 1,
1276 .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
1277 .tseg2_min = 1,
1278 .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
1279 .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
1280 .brp_min = 1,
1281 .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
1282 .brp_inc = 1,
1283};
1284
1285const struct peak_usb_adapter pcan_usb_x6 = {
1286 .name = "PCAN-USB X6",
1287 .device_id = PCAN_USBX6_PRODUCT_ID,
1288 .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
1289 .ctrlmode_supported = CAN_CTRLMODE_FD |
1290 CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY |
1291 CAN_CTRLMODE_ONE_SHOT | CAN_CTRLMODE_CC_LEN8_DLC,
1292 .clock = {
1293 .freq = PCAN_UFD_CRYSTAL_HZ,
1294 },
1295 .bittiming_const = &pcan_usb_x6_const,
1296 .data_bittiming_const = &pcan_usb_x6_data_const,
1297
1298 /* size of device private data */
1299 .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
1300
1301 .ethtool_ops = &pcan_usb_fd_ethtool_ops,
1302
1303 /* timestamps usage */
1304 .ts_used_bits = 32,
1305 .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
1306 .us_per_ts_shift = 0,
1307
1308 /* give here messages in/out endpoints */
1309 .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
1310 .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
1311
1312 /* size of rx/tx usb buffers */
1313 .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
1314 .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
1315
1316 /* device callbacks */
1317 .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
1318 .dev_init = pcan_usb_fd_init,
1319
1320 .dev_exit = pcan_usb_fd_exit,
1321 .dev_free = pcan_usb_fd_free,
1322 .dev_set_bus = pcan_usb_fd_set_bus,
1323 .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
1324 .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
1325 .dev_decode_buf = pcan_usb_fd_decode_buf,
1326 .dev_start = pcan_usb_fd_start,
1327 .dev_stop = pcan_usb_fd_stop,
1328 .dev_restart_async = pcan_usb_fd_restart_async,
1329 .dev_encode_msg = pcan_usb_fd_encode_msg,
1330
1331 .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
1332};