drivers/net/can/usb/peak_usb/pcan_usb_fd.c

   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 <[email protected]>
   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 */
  41 struct __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 */
  61 struct 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 */
  70 struct 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
  90 struct __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
 107 struct __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
 117 struct __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
 128 struct __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
 141 struct __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
 152 struct __packed pcan_ufd_device_id {
 153         __le16  opcode_channel;
 154
 155         u16     unused;
 156         __le32  device_id;
 157 };
 158
 159 static 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 */
 165 static 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 */
 175 static inline
 176 struct 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 */
 184 static 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 */
 192 static 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
 246 static 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 */
 256 static 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 */
 311 static 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  */
 342 static 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  */
 374 static 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 */
 391 static 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 */
 404 static 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 */
 418 static 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 */
 439 static 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 */
 456 static 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 */
 471 static 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  */
 486 static 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
 513 static 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
 528 static 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 */
 588 static 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 */
 650 static 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 */
 671 static 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 */
 704 static 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 */
 717 static 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
 787 fail:
 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 */
 795 static 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) */
 859 static 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 */
 892 static 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 */
 906 static 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) */
 915 static 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 */
 931 static 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
1049 err_out_2:
1050         kfree(pdev->cmd_buffer_addr);
1051 err_out_1:
1052         kfree(pdev->usb_if);
1053 err_out:
1054         return err;
1055 }
1056
1057 /* called when driver module is being unloaded */
1058 static 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 */
1088 static 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 */
1104 static 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
1124 static 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 */
1133 static 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
1145 static 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
1157 const 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 */
1209 static 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
1221 static 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
1233 const 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 */
1285 static 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
1297 static 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
1309 const 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 */
1361 static 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
1373 static 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
1385 const 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 };