pcan_usb_fd.c 35 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279
  1. /*
  2. * CAN driver for PEAK System PCAN-USB FD / PCAN-USB Pro FD adapter
  3. *
  4. * Copyright (C) 2013-2014 Stephane Grosjean <s.grosjean@peak-system.com>
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License as published
  8. * by the Free Software Foundation; version 2 of the License.
  9. *
  10. * This program is distributed in the hope that it will be useful, but
  11. * WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13. * General Public License for more details.
  14. */
  15. #include <linux/netdevice.h>
  16. #include <linux/usb.h>
  17. #include <linux/module.h>
  18. #include <linux/can.h>
  19. #include <linux/can/dev.h>
  20. #include <linux/can/error.h>
  21. #include <linux/can/dev/peak_canfd.h>
  22. #include "pcan_usb_core.h"
  23. #include "pcan_usb_pro.h"
  24. MODULE_SUPPORTED_DEVICE("PEAK-System PCAN-USB FD adapter");
  25. MODULE_SUPPORTED_DEVICE("PEAK-System PCAN-USB Pro FD adapter");
  26. #define PCAN_USBPROFD_CHANNEL_COUNT 2
  27. #define PCAN_USBFD_CHANNEL_COUNT 1
  28. /* PCAN-USB Pro FD adapter internal clock (Hz) */
  29. #define PCAN_UFD_CRYSTAL_HZ 80000000
  30. #define PCAN_UFD_CMD_BUFFER_SIZE 512
  31. #define PCAN_UFD_LOSPD_PKT_SIZE 64
  32. /* PCAN-USB Pro FD command timeout (ms.) */
  33. #define PCAN_UFD_CMD_TIMEOUT_MS 1000
  34. /* PCAN-USB Pro FD rx/tx buffers size */
  35. #define PCAN_UFD_RX_BUFFER_SIZE 2048
  36. #define PCAN_UFD_TX_BUFFER_SIZE 512
  37. /* read some versions info from the hw devcie */
  38. struct __packed pcan_ufd_fw_info {
  39. __le16 size_of; /* sizeof this */
  40. __le16 type; /* type of this structure */
  41. u8 hw_type; /* Type of hardware (HW_TYPE_xxx) */
  42. u8 bl_version[3]; /* Bootloader version */
  43. u8 hw_version; /* Hardware version (PCB) */
  44. u8 fw_version[3]; /* Firmware version */
  45. __le32 dev_id[2]; /* "device id" per CAN */
  46. __le32 ser_no; /* S/N */
  47. __le32 flags; /* special functions */
  48. };
  49. /* handle device specific info used by the netdevices */
  50. struct 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. /* device information */
  58. struct pcan_usb_fd_device {
  59. struct peak_usb_device dev;
  60. struct can_berr_counter bec;
  61. struct pcan_usb_fd_if *usb_if;
  62. u8 *cmd_buffer_addr;
  63. };
  64. /* Extended USB commands (non uCAN commands) */
  65. /* Clock Modes command */
  66. #define PCAN_UFD_CMD_CLK_SET 0x80
  67. #define PCAN_UFD_CLK_80MHZ 0x0
  68. #define PCAN_UFD_CLK_60MHZ 0x1
  69. #define PCAN_UFD_CLK_40MHZ 0x2
  70. #define PCAN_UFD_CLK_30MHZ 0x3
  71. #define PCAN_UFD_CLK_24MHZ 0x4
  72. #define PCAN_UFD_CLK_20MHZ 0x5
  73. #define PCAN_UFD_CLK_DEF PCAN_UFD_CLK_80MHZ
  74. struct __packed pcan_ufd_clock {
  75. __le16 opcode_channel;
  76. u8 mode;
  77. u8 unused[5];
  78. };
  79. /* LED control command */
  80. #define PCAN_UFD_CMD_LED_SET 0x86
  81. #define PCAN_UFD_LED_DEV 0x00
  82. #define PCAN_UFD_LED_FAST 0x01
  83. #define PCAN_UFD_LED_SLOW 0x02
  84. #define PCAN_UFD_LED_ON 0x03
  85. #define PCAN_UFD_LED_OFF 0x04
  86. #define PCAN_UFD_LED_DEF PCAN_UFD_LED_DEV
  87. struct __packed pcan_ufd_led {
  88. __le16 opcode_channel;
  89. u8 mode;
  90. u8 unused[5];
  91. };
  92. /* Extended usage of uCAN commands CMD_xxx_xx_OPTION for PCAN-USB Pro FD */
  93. #define PCAN_UFD_FLTEXT_CALIBRATION 0x8000
  94. struct __packed pcan_ufd_options {
  95. __le16 opcode_channel;
  96. __le16 ucan_mask;
  97. u16 unused;
  98. __le16 usb_mask;
  99. };
  100. /* Extended usage of uCAN messages for PCAN-USB Pro FD */
  101. #define PCAN_UFD_MSG_CALIBRATION 0x100
  102. struct __packed pcan_ufd_ts_msg {
  103. __le16 size;
  104. __le16 type;
  105. __le32 ts_low;
  106. __le32 ts_high;
  107. __le16 usb_frame_index;
  108. u16 unused;
  109. };
  110. #define PCAN_UFD_MSG_OVERRUN 0x101
  111. #define PCAN_UFD_OVMSG_CHANNEL(o) ((o)->channel & 0xf)
  112. struct __packed pcan_ufd_ovr_msg {
  113. __le16 size;
  114. __le16 type;
  115. __le32 ts_low;
  116. __le32 ts_high;
  117. u8 channel;
  118. u8 unused[3];
  119. };
  120. static inline int pufd_omsg_get_channel(struct pcan_ufd_ovr_msg *om)
  121. {
  122. return om->channel & 0xf;
  123. }
  124. /* Clock mode frequency values */
  125. static const u32 pcan_usb_fd_clk_freq[6] = {
  126. [PCAN_UFD_CLK_80MHZ] = 80000000,
  127. [PCAN_UFD_CLK_60MHZ] = 60000000,
  128. [PCAN_UFD_CLK_40MHZ] = 40000000,
  129. [PCAN_UFD_CLK_30MHZ] = 30000000,
  130. [PCAN_UFD_CLK_24MHZ] = 24000000,
  131. [PCAN_UFD_CLK_20MHZ] = 20000000
  132. };
  133. /* return a device USB interface */
  134. static inline
  135. struct pcan_usb_fd_if *pcan_usb_fd_dev_if(struct peak_usb_device *dev)
  136. {
  137. struct pcan_usb_fd_device *pdev =
  138. container_of(dev, struct pcan_usb_fd_device, dev);
  139. return pdev->usb_if;
  140. }
  141. /* return a device USB commands buffer */
  142. static inline void *pcan_usb_fd_cmd_buffer(struct peak_usb_device *dev)
  143. {
  144. struct pcan_usb_fd_device *pdev =
  145. container_of(dev, struct pcan_usb_fd_device, dev);
  146. return pdev->cmd_buffer_addr;
  147. }
  148. /* send PCAN-USB Pro FD commands synchronously */
  149. static int pcan_usb_fd_send_cmd(struct peak_usb_device *dev, void *cmd_tail)
  150. {
  151. void *cmd_head = pcan_usb_fd_cmd_buffer(dev);
  152. int err = 0;
  153. u8 *packet_ptr;
  154. int i, n = 1, packet_len;
  155. ptrdiff_t cmd_len;
  156. /* usb device unregistered? */
  157. if (!(dev->state & PCAN_USB_STATE_CONNECTED))
  158. return 0;
  159. /* if a packet is not filled completely by commands, the command list
  160. * is terminated with an "end of collection" record.
  161. */
  162. cmd_len = cmd_tail - cmd_head;
  163. if (cmd_len <= (PCAN_UFD_CMD_BUFFER_SIZE - sizeof(u64))) {
  164. memset(cmd_tail, 0xff, sizeof(u64));
  165. cmd_len += sizeof(u64);
  166. }
  167. packet_ptr = cmd_head;
  168. /* firmware is not able to re-assemble 512 bytes buffer in full-speed */
  169. if ((dev->udev->speed != USB_SPEED_HIGH) &&
  170. (cmd_len > PCAN_UFD_LOSPD_PKT_SIZE)) {
  171. packet_len = PCAN_UFD_LOSPD_PKT_SIZE;
  172. n += cmd_len / packet_len;
  173. } else {
  174. packet_len = cmd_len;
  175. }
  176. for (i = 0; i < n; i++) {
  177. err = usb_bulk_msg(dev->udev,
  178. usb_sndbulkpipe(dev->udev,
  179. PCAN_USBPRO_EP_CMDOUT),
  180. packet_ptr, packet_len,
  181. NULL, PCAN_UFD_CMD_TIMEOUT_MS);
  182. if (err) {
  183. netdev_err(dev->netdev,
  184. "sending command failure: %d\n", err);
  185. break;
  186. }
  187. packet_ptr += packet_len;
  188. }
  189. return err;
  190. }
  191. /* build the commands list in the given buffer, to enter operational mode */
  192. static int pcan_usb_fd_build_restart_cmd(struct peak_usb_device *dev, u8 *buf)
  193. {
  194. struct pucan_wr_err_cnt *prc;
  195. struct pucan_command *cmd;
  196. u8 *pc = buf;
  197. /* 1st, reset error counters: */
  198. prc = (struct pucan_wr_err_cnt *)pc;
  199. prc->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  200. PUCAN_CMD_WR_ERR_CNT);
  201. /* select both counters */
  202. prc->sel_mask = cpu_to_le16(PUCAN_WRERRCNT_TE|PUCAN_WRERRCNT_RE);
  203. /* and reset their values */
  204. prc->tx_counter = 0;
  205. prc->rx_counter = 0;
  206. /* moves the pointer forward */
  207. pc += sizeof(struct pucan_wr_err_cnt);
  208. /* add command to switch from ISO to non-ISO mode, if fw allows it */
  209. if (dev->can.ctrlmode_supported & CAN_CTRLMODE_FD_NON_ISO) {
  210. struct pucan_options *puo = (struct pucan_options *)pc;
  211. puo->opcode_channel =
  212. (dev->can.ctrlmode & CAN_CTRLMODE_FD_NON_ISO) ?
  213. pucan_cmd_opcode_channel(dev->ctrl_idx,
  214. PUCAN_CMD_CLR_DIS_OPTION) :
  215. pucan_cmd_opcode_channel(dev->ctrl_idx,
  216. PUCAN_CMD_SET_EN_OPTION);
  217. puo->options = cpu_to_le16(PUCAN_OPTION_CANDFDISO);
  218. /* to be sure that no other extended bits will be taken into
  219. * account
  220. */
  221. puo->unused = 0;
  222. /* moves the pointer forward */
  223. pc += sizeof(struct pucan_options);
  224. }
  225. /* next, go back to operational mode */
  226. cmd = (struct pucan_command *)pc;
  227. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  228. (dev->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) ?
  229. PUCAN_CMD_LISTEN_ONLY_MODE :
  230. PUCAN_CMD_NORMAL_MODE);
  231. pc += sizeof(struct pucan_command);
  232. return pc - buf;
  233. }
  234. /* set CAN bus on/off */
  235. static int pcan_usb_fd_set_bus(struct peak_usb_device *dev, u8 onoff)
  236. {
  237. u8 *pc = pcan_usb_fd_cmd_buffer(dev);
  238. int l;
  239. if (onoff) {
  240. /* build the cmds list to enter operational mode */
  241. l = pcan_usb_fd_build_restart_cmd(dev, pc);
  242. } else {
  243. struct pucan_command *cmd = (struct pucan_command *)pc;
  244. /* build cmd to go back to reset mode */
  245. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  246. PUCAN_CMD_RESET_MODE);
  247. l = sizeof(struct pucan_command);
  248. }
  249. /* send the command */
  250. return pcan_usb_fd_send_cmd(dev, pc + l);
  251. }
  252. /* set filtering masks:
  253. *
  254. * idx in range [0..63] selects a row #idx, all rows otherwise
  255. * mask in range [0..0xffffffff] defines up to 32 CANIDs in the row(s)
  256. *
  257. * Each bit of this 64 x 32 bits array defines a CANID value:
  258. *
  259. * bit[i,j] = 1 implies that CANID=(i x 32)+j will be received, while
  260. * bit[i,j] = 0 implies that CANID=(i x 32)+j will be discarded.
  261. */
  262. static int pcan_usb_fd_set_filter_std(struct peak_usb_device *dev, int idx,
  263. u32 mask)
  264. {
  265. struct pucan_filter_std *cmd = pcan_usb_fd_cmd_buffer(dev);
  266. int i, n;
  267. /* select all rows when idx is out of range [0..63] */
  268. if ((idx < 0) || (idx >= (1 << PUCAN_FLTSTD_ROW_IDX_BITS))) {
  269. n = 1 << PUCAN_FLTSTD_ROW_IDX_BITS;
  270. idx = 0;
  271. /* select the row (and only the row) otherwise */
  272. } else {
  273. n = idx + 1;
  274. }
  275. for (i = idx; i < n; i++, cmd++) {
  276. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  277. PUCAN_CMD_FILTER_STD);
  278. cmd->idx = cpu_to_le16(i);
  279. cmd->mask = cpu_to_le32(mask);
  280. }
  281. /* send the command */
  282. return pcan_usb_fd_send_cmd(dev, cmd);
  283. }
  284. /* set/unset options
  285. *
  286. * onoff set(1)/unset(0) options
  287. * mask each bit defines a kind of options to set/unset
  288. */
  289. static int pcan_usb_fd_set_options(struct peak_usb_device *dev,
  290. bool onoff, u16 ucan_mask, u16 usb_mask)
  291. {
  292. struct pcan_ufd_options *cmd = pcan_usb_fd_cmd_buffer(dev);
  293. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  294. (onoff) ? PUCAN_CMD_SET_EN_OPTION :
  295. PUCAN_CMD_CLR_DIS_OPTION);
  296. cmd->ucan_mask = cpu_to_le16(ucan_mask);
  297. cmd->usb_mask = cpu_to_le16(usb_mask);
  298. /* send the command */
  299. return pcan_usb_fd_send_cmd(dev, ++cmd);
  300. }
  301. /* setup LED control */
  302. static int pcan_usb_fd_set_can_led(struct peak_usb_device *dev, u8 led_mode)
  303. {
  304. struct pcan_ufd_led *cmd = pcan_usb_fd_cmd_buffer(dev);
  305. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  306. PCAN_UFD_CMD_LED_SET);
  307. cmd->mode = led_mode;
  308. /* send the command */
  309. return pcan_usb_fd_send_cmd(dev, ++cmd);
  310. }
  311. /* set CAN clock domain */
  312. static int pcan_usb_fd_set_clock_domain(struct peak_usb_device *dev,
  313. u8 clk_mode)
  314. {
  315. struct pcan_ufd_clock *cmd = pcan_usb_fd_cmd_buffer(dev);
  316. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  317. PCAN_UFD_CMD_CLK_SET);
  318. cmd->mode = clk_mode;
  319. /* send the command */
  320. return pcan_usb_fd_send_cmd(dev, ++cmd);
  321. }
  322. /* set bittiming for CAN and CAN-FD header */
  323. static int pcan_usb_fd_set_bittiming_slow(struct peak_usb_device *dev,
  324. struct can_bittiming *bt)
  325. {
  326. struct pucan_timing_slow *cmd = pcan_usb_fd_cmd_buffer(dev);
  327. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  328. PUCAN_CMD_TIMING_SLOW);
  329. cmd->sjw_t = PUCAN_TSLOW_SJW_T(bt->sjw - 1,
  330. dev->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES);
  331. cmd->tseg2 = PUCAN_TSLOW_TSEG2(bt->phase_seg2 - 1);
  332. cmd->tseg1 = PUCAN_TSLOW_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
  333. cmd->brp = cpu_to_le16(PUCAN_TSLOW_BRP(bt->brp - 1));
  334. cmd->ewl = 96; /* default */
  335. /* send the command */
  336. return pcan_usb_fd_send_cmd(dev, ++cmd);
  337. }
  338. /* set CAN-FD bittiming for data */
  339. static int pcan_usb_fd_set_bittiming_fast(struct peak_usb_device *dev,
  340. struct can_bittiming *bt)
  341. {
  342. struct pucan_timing_fast *cmd = pcan_usb_fd_cmd_buffer(dev);
  343. cmd->opcode_channel = pucan_cmd_opcode_channel(dev->ctrl_idx,
  344. PUCAN_CMD_TIMING_FAST);
  345. cmd->sjw = PUCAN_TFAST_SJW(bt->sjw - 1);
  346. cmd->tseg2 = PUCAN_TFAST_TSEG2(bt->phase_seg2 - 1);
  347. cmd->tseg1 = PUCAN_TFAST_TSEG1(bt->prop_seg + bt->phase_seg1 - 1);
  348. cmd->brp = cpu_to_le16(PUCAN_TFAST_BRP(bt->brp - 1));
  349. /* send the command */
  350. return pcan_usb_fd_send_cmd(dev, ++cmd);
  351. }
  352. /* handle restart but in asynchronously way
  353. * (uses PCAN-USB Pro code to complete asynchronous request)
  354. */
  355. static int pcan_usb_fd_restart_async(struct peak_usb_device *dev,
  356. struct urb *urb, u8 *buf)
  357. {
  358. u8 *pc = buf;
  359. /* build the entire cmds list in the provided buffer, to go back into
  360. * operational mode.
  361. */
  362. pc += pcan_usb_fd_build_restart_cmd(dev, pc);
  363. /* add EOC */
  364. memset(pc, 0xff, sizeof(struct pucan_command));
  365. pc += sizeof(struct pucan_command);
  366. /* complete the URB */
  367. usb_fill_bulk_urb(urb, dev->udev,
  368. usb_sndbulkpipe(dev->udev, PCAN_USBPRO_EP_CMDOUT),
  369. buf, pc - buf,
  370. pcan_usb_pro_restart_complete, dev);
  371. /* and submit it. */
  372. return usb_submit_urb(urb, GFP_ATOMIC);
  373. }
  374. static int pcan_usb_fd_drv_loaded(struct peak_usb_device *dev, bool loaded)
  375. {
  376. struct pcan_usb_fd_device *pdev =
  377. container_of(dev, struct pcan_usb_fd_device, dev);
  378. pdev->cmd_buffer_addr[0] = 0;
  379. pdev->cmd_buffer_addr[1] = !!loaded;
  380. return pcan_usb_pro_send_req(dev,
  381. PCAN_USBPRO_REQ_FCT,
  382. PCAN_USBPRO_FCT_DRVLD,
  383. pdev->cmd_buffer_addr,
  384. PCAN_USBPRO_FCT_DRVLD_REQ_LEN);
  385. }
  386. static int pcan_usb_fd_decode_canmsg(struct pcan_usb_fd_if *usb_if,
  387. struct pucan_msg *rx_msg)
  388. {
  389. struct pucan_rx_msg *rm = (struct pucan_rx_msg *)rx_msg;
  390. struct peak_usb_device *dev = usb_if->dev[pucan_msg_get_channel(rm)];
  391. struct net_device *netdev = dev->netdev;
  392. struct canfd_frame *cfd;
  393. struct sk_buff *skb;
  394. const u16 rx_msg_flags = le16_to_cpu(rm->flags);
  395. if (rx_msg_flags & PUCAN_MSG_EXT_DATA_LEN) {
  396. /* CANFD frame case */
  397. skb = alloc_canfd_skb(netdev, &cfd);
  398. if (!skb)
  399. return -ENOMEM;
  400. if (rx_msg_flags & PUCAN_MSG_BITRATE_SWITCH)
  401. cfd->flags |= CANFD_BRS;
  402. if (rx_msg_flags & PUCAN_MSG_ERROR_STATE_IND)
  403. cfd->flags |= CANFD_ESI;
  404. cfd->len = can_dlc2len(get_canfd_dlc(pucan_msg_get_dlc(rm)));
  405. } else {
  406. /* CAN 2.0 frame case */
  407. skb = alloc_can_skb(netdev, (struct can_frame **)&cfd);
  408. if (!skb)
  409. return -ENOMEM;
  410. cfd->len = get_can_dlc(pucan_msg_get_dlc(rm));
  411. }
  412. cfd->can_id = le32_to_cpu(rm->can_id);
  413. if (rx_msg_flags & PUCAN_MSG_EXT_ID)
  414. cfd->can_id |= CAN_EFF_FLAG;
  415. if (rx_msg_flags & PUCAN_MSG_RTR)
  416. cfd->can_id |= CAN_RTR_FLAG;
  417. else
  418. memcpy(cfd->data, rm->d, cfd->len);
  419. peak_usb_netif_rx(skb, &usb_if->time_ref,
  420. le32_to_cpu(rm->ts_low), le32_to_cpu(rm->ts_high));
  421. netdev->stats.rx_packets++;
  422. netdev->stats.rx_bytes += cfd->len;
  423. return 0;
  424. }
  425. /* handle uCAN status message */
  426. static int pcan_usb_fd_decode_status(struct pcan_usb_fd_if *usb_if,
  427. struct pucan_msg *rx_msg)
  428. {
  429. struct pucan_status_msg *sm = (struct pucan_status_msg *)rx_msg;
  430. struct peak_usb_device *dev = usb_if->dev[pucan_stmsg_get_channel(sm)];
  431. struct pcan_usb_fd_device *pdev =
  432. container_of(dev, struct pcan_usb_fd_device, dev);
  433. enum can_state new_state = CAN_STATE_ERROR_ACTIVE;
  434. enum can_state rx_state, tx_state;
  435. struct net_device *netdev = dev->netdev;
  436. struct can_frame *cf;
  437. struct sk_buff *skb;
  438. /* nothing should be sent while in BUS_OFF state */
  439. if (dev->can.state == CAN_STATE_BUS_OFF)
  440. return 0;
  441. if (sm->channel_p_w_b & PUCAN_BUS_BUSOFF) {
  442. new_state = CAN_STATE_BUS_OFF;
  443. } else if (sm->channel_p_w_b & PUCAN_BUS_PASSIVE) {
  444. new_state = CAN_STATE_ERROR_PASSIVE;
  445. } else if (sm->channel_p_w_b & PUCAN_BUS_WARNING) {
  446. new_state = CAN_STATE_ERROR_WARNING;
  447. } else {
  448. /* no error bit (so, no error skb, back to active state) */
  449. dev->can.state = CAN_STATE_ERROR_ACTIVE;
  450. pdev->bec.txerr = 0;
  451. pdev->bec.rxerr = 0;
  452. return 0;
  453. }
  454. /* state hasn't changed */
  455. if (new_state == dev->can.state)
  456. return 0;
  457. /* handle bus state change */
  458. tx_state = (pdev->bec.txerr >= pdev->bec.rxerr) ? new_state : 0;
  459. rx_state = (pdev->bec.txerr <= pdev->bec.rxerr) ? new_state : 0;
  460. /* allocate an skb to store the error frame */
  461. skb = alloc_can_err_skb(netdev, &cf);
  462. if (skb)
  463. can_change_state(netdev, cf, tx_state, rx_state);
  464. /* things must be done even in case of OOM */
  465. if (new_state == CAN_STATE_BUS_OFF)
  466. can_bus_off(netdev);
  467. if (!skb)
  468. return -ENOMEM;
  469. peak_usb_netif_rx(skb, &usb_if->time_ref,
  470. le32_to_cpu(sm->ts_low), le32_to_cpu(sm->ts_high));
  471. netdev->stats.rx_packets++;
  472. netdev->stats.rx_bytes += cf->can_dlc;
  473. return 0;
  474. }
  475. /* handle uCAN error message */
  476. static int pcan_usb_fd_decode_error(struct pcan_usb_fd_if *usb_if,
  477. struct pucan_msg *rx_msg)
  478. {
  479. struct pucan_error_msg *er = (struct pucan_error_msg *)rx_msg;
  480. struct peak_usb_device *dev = usb_if->dev[pucan_ermsg_get_channel(er)];
  481. struct pcan_usb_fd_device *pdev =
  482. container_of(dev, struct pcan_usb_fd_device, dev);
  483. /* keep a trace of tx and rx error counters for later use */
  484. pdev->bec.txerr = er->tx_err_cnt;
  485. pdev->bec.rxerr = er->rx_err_cnt;
  486. return 0;
  487. }
  488. /* handle uCAN overrun message */
  489. static int pcan_usb_fd_decode_overrun(struct pcan_usb_fd_if *usb_if,
  490. struct pucan_msg *rx_msg)
  491. {
  492. struct pcan_ufd_ovr_msg *ov = (struct pcan_ufd_ovr_msg *)rx_msg;
  493. struct peak_usb_device *dev = usb_if->dev[pufd_omsg_get_channel(ov)];
  494. struct net_device *netdev = dev->netdev;
  495. struct can_frame *cf;
  496. struct sk_buff *skb;
  497. /* allocate an skb to store the error frame */
  498. skb = alloc_can_err_skb(netdev, &cf);
  499. if (!skb)
  500. return -ENOMEM;
  501. cf->can_id |= CAN_ERR_CRTL;
  502. cf->data[1] |= CAN_ERR_CRTL_RX_OVERFLOW;
  503. peak_usb_netif_rx(skb, &usb_if->time_ref,
  504. le32_to_cpu(ov->ts_low), le32_to_cpu(ov->ts_high));
  505. netdev->stats.rx_over_errors++;
  506. netdev->stats.rx_errors++;
  507. return 0;
  508. }
  509. /* handle USB calibration message */
  510. static void pcan_usb_fd_decode_ts(struct pcan_usb_fd_if *usb_if,
  511. struct pucan_msg *rx_msg)
  512. {
  513. struct pcan_ufd_ts_msg *ts = (struct pcan_ufd_ts_msg *)rx_msg;
  514. /* should wait until clock is stabilized */
  515. if (usb_if->cm_ignore_count > 0)
  516. usb_if->cm_ignore_count--;
  517. else
  518. peak_usb_set_ts_now(&usb_if->time_ref, le32_to_cpu(ts->ts_low));
  519. }
  520. /* callback for bulk IN urb */
  521. static int pcan_usb_fd_decode_buf(struct peak_usb_device *dev, struct urb *urb)
  522. {
  523. struct pcan_usb_fd_if *usb_if = pcan_usb_fd_dev_if(dev);
  524. struct net_device *netdev = dev->netdev;
  525. struct pucan_msg *rx_msg;
  526. u8 *msg_ptr, *msg_end;
  527. int err = 0;
  528. /* loop reading all the records from the incoming message */
  529. msg_ptr = urb->transfer_buffer;
  530. msg_end = urb->transfer_buffer + urb->actual_length;
  531. for (; msg_ptr < msg_end;) {
  532. u16 rx_msg_type, rx_msg_size;
  533. rx_msg = (struct pucan_msg *)msg_ptr;
  534. if (!rx_msg->size) {
  535. /* null packet found: end of list */
  536. break;
  537. }
  538. rx_msg_size = le16_to_cpu(rx_msg->size);
  539. rx_msg_type = le16_to_cpu(rx_msg->type);
  540. /* check if the record goes out of current packet */
  541. if (msg_ptr + rx_msg_size > msg_end) {
  542. netdev_err(netdev,
  543. "got frag rec: should inc usb rx buf sze\n");
  544. err = -EBADMSG;
  545. break;
  546. }
  547. switch (rx_msg_type) {
  548. case PUCAN_MSG_CAN_RX:
  549. err = pcan_usb_fd_decode_canmsg(usb_if, rx_msg);
  550. if (err < 0)
  551. goto fail;
  552. break;
  553. case PCAN_UFD_MSG_CALIBRATION:
  554. pcan_usb_fd_decode_ts(usb_if, rx_msg);
  555. break;
  556. case PUCAN_MSG_ERROR:
  557. err = pcan_usb_fd_decode_error(usb_if, rx_msg);
  558. if (err < 0)
  559. goto fail;
  560. break;
  561. case PUCAN_MSG_STATUS:
  562. err = pcan_usb_fd_decode_status(usb_if, rx_msg);
  563. if (err < 0)
  564. goto fail;
  565. break;
  566. case PCAN_UFD_MSG_OVERRUN:
  567. err = pcan_usb_fd_decode_overrun(usb_if, rx_msg);
  568. if (err < 0)
  569. goto fail;
  570. break;
  571. default:
  572. netdev_err(netdev,
  573. "unhandled msg type 0x%02x (%d): ignored\n",
  574. rx_msg_type, rx_msg_type);
  575. break;
  576. }
  577. msg_ptr += rx_msg_size;
  578. }
  579. fail:
  580. if (err)
  581. pcan_dump_mem("received msg",
  582. urb->transfer_buffer, urb->actual_length);
  583. return err;
  584. }
  585. /* CAN/CANFD frames encoding callback */
  586. static int pcan_usb_fd_encode_msg(struct peak_usb_device *dev,
  587. struct sk_buff *skb, u8 *obuf, size_t *size)
  588. {
  589. struct pucan_tx_msg *tx_msg = (struct pucan_tx_msg *)obuf;
  590. struct canfd_frame *cfd = (struct canfd_frame *)skb->data;
  591. u16 tx_msg_size, tx_msg_flags;
  592. u8 can_dlc;
  593. tx_msg_size = ALIGN(sizeof(struct pucan_tx_msg) + cfd->len, 4);
  594. tx_msg->size = cpu_to_le16(tx_msg_size);
  595. tx_msg->type = cpu_to_le16(PUCAN_MSG_CAN_TX);
  596. tx_msg_flags = 0;
  597. if (cfd->can_id & CAN_EFF_FLAG) {
  598. tx_msg_flags |= PUCAN_MSG_EXT_ID;
  599. tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_EFF_MASK);
  600. } else {
  601. tx_msg->can_id = cpu_to_le32(cfd->can_id & CAN_SFF_MASK);
  602. }
  603. if (can_is_canfd_skb(skb)) {
  604. /* considering a CANFD frame */
  605. can_dlc = can_len2dlc(cfd->len);
  606. tx_msg_flags |= PUCAN_MSG_EXT_DATA_LEN;
  607. if (cfd->flags & CANFD_BRS)
  608. tx_msg_flags |= PUCAN_MSG_BITRATE_SWITCH;
  609. if (cfd->flags & CANFD_ESI)
  610. tx_msg_flags |= PUCAN_MSG_ERROR_STATE_IND;
  611. } else {
  612. /* CAND 2.0 frames */
  613. can_dlc = cfd->len;
  614. if (cfd->can_id & CAN_RTR_FLAG)
  615. tx_msg_flags |= PUCAN_MSG_RTR;
  616. }
  617. tx_msg->flags = cpu_to_le16(tx_msg_flags);
  618. tx_msg->channel_dlc = PUCAN_MSG_CHANNEL_DLC(dev->ctrl_idx, can_dlc);
  619. memcpy(tx_msg->d, cfd->data, cfd->len);
  620. /* add null size message to tag the end (messages are 32-bits aligned)
  621. */
  622. tx_msg = (struct pucan_tx_msg *)(obuf + tx_msg_size);
  623. tx_msg->size = 0;
  624. /* set the whole size of the USB packet to send */
  625. *size = tx_msg_size + sizeof(u32);
  626. return 0;
  627. }
  628. /* start the interface (last chance before set bus on) */
  629. static int pcan_usb_fd_start(struct peak_usb_device *dev)
  630. {
  631. struct pcan_usb_fd_device *pdev =
  632. container_of(dev, struct pcan_usb_fd_device, dev);
  633. int err;
  634. /* set filter mode: all acceptance */
  635. err = pcan_usb_fd_set_filter_std(dev, -1, 0xffffffff);
  636. if (err)
  637. return err;
  638. /* opening first device: */
  639. if (pdev->usb_if->dev_opened_count == 0) {
  640. /* reset time_ref */
  641. peak_usb_init_time_ref(&pdev->usb_if->time_ref,
  642. &pcan_usb_pro_fd);
  643. /* enable USB calibration messages */
  644. err = pcan_usb_fd_set_options(dev, 1,
  645. PUCAN_OPTION_ERROR,
  646. PCAN_UFD_FLTEXT_CALIBRATION);
  647. }
  648. pdev->usb_if->dev_opened_count++;
  649. /* reset cached error counters */
  650. pdev->bec.txerr = 0;
  651. pdev->bec.rxerr = 0;
  652. return err;
  653. }
  654. /* socket callback used to copy berr counters values receieved through USB */
  655. static int pcan_usb_fd_get_berr_counter(const struct net_device *netdev,
  656. struct can_berr_counter *bec)
  657. {
  658. struct peak_usb_device *dev = netdev_priv(netdev);
  659. struct pcan_usb_fd_device *pdev =
  660. container_of(dev, struct pcan_usb_fd_device, dev);
  661. *bec = pdev->bec;
  662. /* must return 0 */
  663. return 0;
  664. }
  665. /* stop interface (last chance before set bus off) */
  666. static int pcan_usb_fd_stop(struct peak_usb_device *dev)
  667. {
  668. struct pcan_usb_fd_device *pdev =
  669. container_of(dev, struct pcan_usb_fd_device, dev);
  670. /* turn off special msgs for that interface if no other dev opened */
  671. if (pdev->usb_if->dev_opened_count == 1)
  672. pcan_usb_fd_set_options(dev, 0,
  673. PUCAN_OPTION_ERROR,
  674. PCAN_UFD_FLTEXT_CALIBRATION);
  675. pdev->usb_if->dev_opened_count--;
  676. return 0;
  677. }
  678. /* called when probing, to initialize a device object */
  679. static int pcan_usb_fd_init(struct peak_usb_device *dev)
  680. {
  681. struct pcan_usb_fd_device *pdev =
  682. container_of(dev, struct pcan_usb_fd_device, dev);
  683. int i, err = -ENOMEM;
  684. /* do this for 1st channel only */
  685. if (!dev->prev_siblings) {
  686. /* allocate netdevices common structure attached to first one */
  687. pdev->usb_if = kzalloc(sizeof(*pdev->usb_if), GFP_KERNEL);
  688. if (!pdev->usb_if)
  689. goto err_out;
  690. /* allocate command buffer once for all for the interface */
  691. pdev->cmd_buffer_addr = kmalloc(PCAN_UFD_CMD_BUFFER_SIZE,
  692. GFP_KERNEL);
  693. if (!pdev->cmd_buffer_addr)
  694. goto err_out_1;
  695. /* number of ts msgs to ignore before taking one into account */
  696. pdev->usb_if->cm_ignore_count = 5;
  697. err = pcan_usb_pro_send_req(dev, PCAN_USBPRO_REQ_INFO,
  698. PCAN_USBPRO_INFO_FW,
  699. &pdev->usb_if->fw_info,
  700. sizeof(pdev->usb_if->fw_info));
  701. if (err) {
  702. dev_err(dev->netdev->dev.parent,
  703. "unable to read %s firmware info (err %d)\n",
  704. dev->adapter->name, err);
  705. goto err_out_2;
  706. }
  707. /* explicit use of dev_xxx() instead of netdev_xxx() here:
  708. * information displayed are related to the device itself, not
  709. * to the canx (channel) device.
  710. */
  711. dev_info(dev->netdev->dev.parent,
  712. "PEAK-System %s v%u fw v%u.%u.%u (%u channels)\n",
  713. dev->adapter->name, pdev->usb_if->fw_info.hw_version,
  714. pdev->usb_if->fw_info.fw_version[0],
  715. pdev->usb_if->fw_info.fw_version[1],
  716. pdev->usb_if->fw_info.fw_version[2],
  717. dev->adapter->ctrl_count);
  718. /* check for ability to switch between ISO/non-ISO modes */
  719. if (pdev->usb_if->fw_info.fw_version[0] >= 2) {
  720. /* firmware >= 2.x supports ISO/non-ISO switching */
  721. dev->can.ctrlmode_supported |= CAN_CTRLMODE_FD_NON_ISO;
  722. } else {
  723. /* firmware < 2.x only supports fixed(!) non-ISO */
  724. dev->can.ctrlmode |= CAN_CTRLMODE_FD_NON_ISO;
  725. }
  726. /* tell the hardware the can driver is running */
  727. err = pcan_usb_fd_drv_loaded(dev, 1);
  728. if (err) {
  729. dev_err(dev->netdev->dev.parent,
  730. "unable to tell %s driver is loaded (err %d)\n",
  731. dev->adapter->name, err);
  732. goto err_out_2;
  733. }
  734. } else {
  735. /* otherwise, simply copy previous sibling's values */
  736. struct pcan_usb_fd_device *ppdev =
  737. container_of(dev->prev_siblings,
  738. struct pcan_usb_fd_device, dev);
  739. pdev->usb_if = ppdev->usb_if;
  740. pdev->cmd_buffer_addr = ppdev->cmd_buffer_addr;
  741. /* do a copy of the ctrlmode[_supported] too */
  742. dev->can.ctrlmode = ppdev->dev.can.ctrlmode;
  743. dev->can.ctrlmode_supported = ppdev->dev.can.ctrlmode_supported;
  744. }
  745. pdev->usb_if->dev[dev->ctrl_idx] = dev;
  746. dev->device_number =
  747. le32_to_cpu(pdev->usb_if->fw_info.dev_id[dev->ctrl_idx]);
  748. /* set clock domain */
  749. for (i = 0; i < ARRAY_SIZE(pcan_usb_fd_clk_freq); i++)
  750. if (dev->adapter->clock.freq == pcan_usb_fd_clk_freq[i])
  751. break;
  752. if (i >= ARRAY_SIZE(pcan_usb_fd_clk_freq)) {
  753. dev_warn(dev->netdev->dev.parent,
  754. "incompatible clock frequencies\n");
  755. err = -EINVAL;
  756. goto err_out_2;
  757. }
  758. pcan_usb_fd_set_clock_domain(dev, i);
  759. /* set LED in default state (end of init phase) */
  760. pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_DEF);
  761. return 0;
  762. err_out_2:
  763. kfree(pdev->cmd_buffer_addr);
  764. err_out_1:
  765. kfree(pdev->usb_if);
  766. err_out:
  767. return err;
  768. }
  769. /* called when driver module is being unloaded */
  770. static void pcan_usb_fd_exit(struct peak_usb_device *dev)
  771. {
  772. struct pcan_usb_fd_device *pdev =
  773. container_of(dev, struct pcan_usb_fd_device, dev);
  774. /* when rmmod called before unplug and if down, should reset things
  775. * before leaving
  776. */
  777. if (dev->can.state != CAN_STATE_STOPPED) {
  778. /* set bus off on the corresponding channel */
  779. pcan_usb_fd_set_bus(dev, 0);
  780. }
  781. /* switch off corresponding CAN LEDs */
  782. pcan_usb_fd_set_can_led(dev, PCAN_UFD_LED_OFF);
  783. /* if channel #0 (only) */
  784. if (dev->ctrl_idx == 0) {
  785. /* turn off calibration message if any device were opened */
  786. if (pdev->usb_if->dev_opened_count > 0)
  787. pcan_usb_fd_set_options(dev, 0,
  788. PUCAN_OPTION_ERROR,
  789. PCAN_UFD_FLTEXT_CALIBRATION);
  790. /* tell USB adapter that the driver is being unloaded */
  791. pcan_usb_fd_drv_loaded(dev, 0);
  792. }
  793. }
  794. /* called when the USB adapter is unplugged */
  795. static void pcan_usb_fd_free(struct peak_usb_device *dev)
  796. {
  797. /* last device: can free shared objects now */
  798. if (!dev->prev_siblings && !dev->next_siblings) {
  799. struct pcan_usb_fd_device *pdev =
  800. container_of(dev, struct pcan_usb_fd_device, dev);
  801. /* free commands buffer */
  802. kfree(pdev->cmd_buffer_addr);
  803. /* free usb interface object */
  804. kfree(pdev->usb_if);
  805. }
  806. }
  807. /* describes the PCAN-USB FD adapter */
  808. static const struct can_bittiming_const pcan_usb_fd_const = {
  809. .name = "pcan_usb_fd",
  810. .tseg1_min = 1,
  811. .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
  812. .tseg2_min = 1,
  813. .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
  814. .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
  815. .brp_min = 1,
  816. .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
  817. .brp_inc = 1,
  818. };
  819. static const struct can_bittiming_const pcan_usb_fd_data_const = {
  820. .name = "pcan_usb_fd",
  821. .tseg1_min = 1,
  822. .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
  823. .tseg2_min = 1,
  824. .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
  825. .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
  826. .brp_min = 1,
  827. .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
  828. .brp_inc = 1,
  829. };
  830. const struct peak_usb_adapter pcan_usb_fd = {
  831. .name = "PCAN-USB FD",
  832. .device_id = PCAN_USBFD_PRODUCT_ID,
  833. .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
  834. .ctrlmode_supported = CAN_CTRLMODE_FD |
  835. CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY,
  836. .clock = {
  837. .freq = PCAN_UFD_CRYSTAL_HZ,
  838. },
  839. .bittiming_const = &pcan_usb_fd_const,
  840. .data_bittiming_const = &pcan_usb_fd_data_const,
  841. /* size of device private data */
  842. .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
  843. /* timestamps usage */
  844. .ts_used_bits = 32,
  845. .ts_period = 1000000, /* calibration period in ts. */
  846. .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
  847. .us_per_ts_shift = 0,
  848. /* give here messages in/out endpoints */
  849. .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
  850. .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
  851. /* size of rx/tx usb buffers */
  852. .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
  853. .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
  854. /* device callbacks */
  855. .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
  856. .dev_init = pcan_usb_fd_init,
  857. .dev_exit = pcan_usb_fd_exit,
  858. .dev_free = pcan_usb_fd_free,
  859. .dev_set_bus = pcan_usb_fd_set_bus,
  860. .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
  861. .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
  862. .dev_decode_buf = pcan_usb_fd_decode_buf,
  863. .dev_start = pcan_usb_fd_start,
  864. .dev_stop = pcan_usb_fd_stop,
  865. .dev_restart_async = pcan_usb_fd_restart_async,
  866. .dev_encode_msg = pcan_usb_fd_encode_msg,
  867. .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
  868. };
  869. /* describes the PCAN-CHIP USB */
  870. static const struct can_bittiming_const pcan_usb_chip_const = {
  871. .name = "pcan_chip_usb",
  872. .tseg1_min = 1,
  873. .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
  874. .tseg2_min = 1,
  875. .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
  876. .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
  877. .brp_min = 1,
  878. .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
  879. .brp_inc = 1,
  880. };
  881. static const struct can_bittiming_const pcan_usb_chip_data_const = {
  882. .name = "pcan_chip_usb",
  883. .tseg1_min = 1,
  884. .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
  885. .tseg2_min = 1,
  886. .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
  887. .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
  888. .brp_min = 1,
  889. .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
  890. .brp_inc = 1,
  891. };
  892. const struct peak_usb_adapter pcan_usb_chip = {
  893. .name = "PCAN-Chip USB",
  894. .device_id = PCAN_USBCHIP_PRODUCT_ID,
  895. .ctrl_count = PCAN_USBFD_CHANNEL_COUNT,
  896. .ctrlmode_supported = CAN_CTRLMODE_FD |
  897. CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY,
  898. .clock = {
  899. .freq = PCAN_UFD_CRYSTAL_HZ,
  900. },
  901. .bittiming_const = &pcan_usb_chip_const,
  902. .data_bittiming_const = &pcan_usb_chip_data_const,
  903. /* size of device private data */
  904. .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
  905. /* timestamps usage */
  906. .ts_used_bits = 32,
  907. .ts_period = 1000000, /* calibration period in ts. */
  908. .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
  909. .us_per_ts_shift = 0,
  910. /* give here messages in/out endpoints */
  911. .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
  912. .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0},
  913. /* size of rx/tx usb buffers */
  914. .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
  915. .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
  916. /* device callbacks */
  917. .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
  918. .dev_init = pcan_usb_fd_init,
  919. .dev_exit = pcan_usb_fd_exit,
  920. .dev_free = pcan_usb_fd_free,
  921. .dev_set_bus = pcan_usb_fd_set_bus,
  922. .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
  923. .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
  924. .dev_decode_buf = pcan_usb_fd_decode_buf,
  925. .dev_start = pcan_usb_fd_start,
  926. .dev_stop = pcan_usb_fd_stop,
  927. .dev_restart_async = pcan_usb_fd_restart_async,
  928. .dev_encode_msg = pcan_usb_fd_encode_msg,
  929. .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
  930. };
  931. /* describes the PCAN-USB Pro FD adapter */
  932. static const struct can_bittiming_const pcan_usb_pro_fd_const = {
  933. .name = "pcan_usb_pro_fd",
  934. .tseg1_min = 1,
  935. .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
  936. .tseg2_min = 1,
  937. .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
  938. .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
  939. .brp_min = 1,
  940. .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
  941. .brp_inc = 1,
  942. };
  943. static const struct can_bittiming_const pcan_usb_pro_fd_data_const = {
  944. .name = "pcan_usb_pro_fd",
  945. .tseg1_min = 1,
  946. .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
  947. .tseg2_min = 1,
  948. .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
  949. .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
  950. .brp_min = 1,
  951. .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
  952. .brp_inc = 1,
  953. };
  954. const struct peak_usb_adapter pcan_usb_pro_fd = {
  955. .name = "PCAN-USB Pro FD",
  956. .device_id = PCAN_USBPROFD_PRODUCT_ID,
  957. .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
  958. .ctrlmode_supported = CAN_CTRLMODE_FD |
  959. CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY,
  960. .clock = {
  961. .freq = PCAN_UFD_CRYSTAL_HZ,
  962. },
  963. .bittiming_const = &pcan_usb_pro_fd_const,
  964. .data_bittiming_const = &pcan_usb_pro_fd_data_const,
  965. /* size of device private data */
  966. .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
  967. /* timestamps usage */
  968. .ts_used_bits = 32,
  969. .ts_period = 1000000, /* calibration period in ts. */
  970. .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
  971. .us_per_ts_shift = 0,
  972. /* give here messages in/out endpoints */
  973. .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
  974. .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
  975. /* size of rx/tx usb buffers */
  976. .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
  977. .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
  978. /* device callbacks */
  979. .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
  980. .dev_init = pcan_usb_fd_init,
  981. .dev_exit = pcan_usb_fd_exit,
  982. .dev_free = pcan_usb_fd_free,
  983. .dev_set_bus = pcan_usb_fd_set_bus,
  984. .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
  985. .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
  986. .dev_decode_buf = pcan_usb_fd_decode_buf,
  987. .dev_start = pcan_usb_fd_start,
  988. .dev_stop = pcan_usb_fd_stop,
  989. .dev_restart_async = pcan_usb_fd_restart_async,
  990. .dev_encode_msg = pcan_usb_fd_encode_msg,
  991. .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
  992. };
  993. /* describes the PCAN-USB X6 adapter */
  994. static const struct can_bittiming_const pcan_usb_x6_const = {
  995. .name = "pcan_usb_x6",
  996. .tseg1_min = 1,
  997. .tseg1_max = (1 << PUCAN_TSLOW_TSGEG1_BITS),
  998. .tseg2_min = 1,
  999. .tseg2_max = (1 << PUCAN_TSLOW_TSGEG2_BITS),
  1000. .sjw_max = (1 << PUCAN_TSLOW_SJW_BITS),
  1001. .brp_min = 1,
  1002. .brp_max = (1 << PUCAN_TSLOW_BRP_BITS),
  1003. .brp_inc = 1,
  1004. };
  1005. static const struct can_bittiming_const pcan_usb_x6_data_const = {
  1006. .name = "pcan_usb_x6",
  1007. .tseg1_min = 1,
  1008. .tseg1_max = (1 << PUCAN_TFAST_TSGEG1_BITS),
  1009. .tseg2_min = 1,
  1010. .tseg2_max = (1 << PUCAN_TFAST_TSGEG2_BITS),
  1011. .sjw_max = (1 << PUCAN_TFAST_SJW_BITS),
  1012. .brp_min = 1,
  1013. .brp_max = (1 << PUCAN_TFAST_BRP_BITS),
  1014. .brp_inc = 1,
  1015. };
  1016. const struct peak_usb_adapter pcan_usb_x6 = {
  1017. .name = "PCAN-USB X6",
  1018. .device_id = PCAN_USBX6_PRODUCT_ID,
  1019. .ctrl_count = PCAN_USBPROFD_CHANNEL_COUNT,
  1020. .ctrlmode_supported = CAN_CTRLMODE_FD |
  1021. CAN_CTRLMODE_3_SAMPLES | CAN_CTRLMODE_LISTENONLY,
  1022. .clock = {
  1023. .freq = PCAN_UFD_CRYSTAL_HZ,
  1024. },
  1025. .bittiming_const = &pcan_usb_x6_const,
  1026. .data_bittiming_const = &pcan_usb_x6_data_const,
  1027. /* size of device private data */
  1028. .sizeof_dev_private = sizeof(struct pcan_usb_fd_device),
  1029. /* timestamps usage */
  1030. .ts_used_bits = 32,
  1031. .ts_period = 1000000, /* calibration period in ts. */
  1032. .us_per_ts_scale = 1, /* us = (ts * scale) >> shift */
  1033. .us_per_ts_shift = 0,
  1034. /* give here messages in/out endpoints */
  1035. .ep_msg_in = PCAN_USBPRO_EP_MSGIN,
  1036. .ep_msg_out = {PCAN_USBPRO_EP_MSGOUT_0, PCAN_USBPRO_EP_MSGOUT_1},
  1037. /* size of rx/tx usb buffers */
  1038. .rx_buffer_size = PCAN_UFD_RX_BUFFER_SIZE,
  1039. .tx_buffer_size = PCAN_UFD_TX_BUFFER_SIZE,
  1040. /* device callbacks */
  1041. .intf_probe = pcan_usb_pro_probe, /* same as PCAN-USB Pro */
  1042. .dev_init = pcan_usb_fd_init,
  1043. .dev_exit = pcan_usb_fd_exit,
  1044. .dev_free = pcan_usb_fd_free,
  1045. .dev_set_bus = pcan_usb_fd_set_bus,
  1046. .dev_set_bittiming = pcan_usb_fd_set_bittiming_slow,
  1047. .dev_set_data_bittiming = pcan_usb_fd_set_bittiming_fast,
  1048. .dev_decode_buf = pcan_usb_fd_decode_buf,
  1049. .dev_start = pcan_usb_fd_start,
  1050. .dev_stop = pcan_usb_fd_stop,
  1051. .dev_restart_async = pcan_usb_fd_restart_async,
  1052. .dev_encode_msg = pcan_usb_fd_encode_msg,
  1053. .do_get_berr_counter = pcan_usb_fd_get_berr_counter,
  1054. };