michaelh/zephyr
1
0
Fork 0
Code Releases Activity

drivers: can: stm32: Implement timestamp for RX frames

Browse source 
This commit implements timestamps for receiving frames on
stm32 CAN driver.

Signed-off-by: Alexander Wachter <alexander.wachter@student.tugraz.at>
This commit is contained in:
Alexander Wachter 2019-07-24 15:38:11 +02:00 • committed by Jukka Rissanen
commit 9923cf2dda
1 changed files with 6 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

6
drivers/can/can_stm32.c
View file

@ -52,6 +52,9 @@ static void can_stm32_get_msg_fifo(CAN_FIFOMailBox_TypeDef *mbox,
msg->dlc = mbox->RDTR & (CAN_RDT0R_DLC >> CAN_RDT0R_DLC_Pos); msg->dlc = mbox->RDTR & (CAN_RDT0R_DLC >> CAN_RDT0R_DLC_Pos);
msg->data_32[0] = mbox->RDLR; msg->data_32[0] = mbox->RDLR;
msg->data_32[1] = mbox->RDHR; msg->data_32[1] = mbox->RDHR;
#ifdef CONFIG_CAN_RX_TIMESTAMP
msg->timestamp = ((mbox->RDTR & CAN_RDT0R_TIME) >> CAN_RDT0R_TIME_Pos);
#endif
} }
static inline static inline
@ -363,6 +366,9 @@ static int can_stm32_init(struct device *dev)
can->MCR |= CAN_MCR_TXFP; can->MCR |= CAN_MCR_TXFP;
can->MCR &= ~CAN_MCR_TTCM & ~CAN_MCR_TTCM & ~CAN_MCR_ABOM & can->MCR &= ~CAN_MCR_TTCM & ~CAN_MCR_TTCM & ~CAN_MCR_ABOM &
~CAN_MCR_AWUM & ~CAN_MCR_NART & ~CAN_MCR_RFLM; ~CAN_MCR_AWUM & ~CAN_MCR_NART & ~CAN_MCR_RFLM;
#ifdef CONFIG_CAN_RX_TIMESTAMP
can->MCR |= CAN_MCR_TTCM;
#endif
ret = can_stm32_runtime_configure(dev, CAN_NORMAL_MODE, 0); ret = can_stm32_runtime_configure(dev, CAN_NORMAL_MODE, 0);
if (ret) { if (ret) {