X-Git-Url: http://rtime.felk.cvut.cz/gitweb/lincan.git/blobdiff_plain/b47c0a55a3721e635d5b28f61a46161f72894394..3a2bb63f0bb8de2aafb346b53b945c59b3f87a41:/lincan/src/sja1000p.c

diff --git a/lincan/src/sja1000p.c b/lincan/src/sja1000p.c
index dc15154..3087db5 100644
--- a/lincan/src/sja1000p.c
+++ b/lincan/src/sja1000p.c
@@ -267,6 +267,9 @@ void sja1000p_read(struct chip_t *chip, struct msgobj_t *obj) {
 			obj->rx_msg.data[i]=can_read_reg(chip,datastart+i);
 		}
 
+		/* fill CAN message timestamp */
+		can_filltimestamp(&obj->rx_msg.timestamp);
+
 		canque_filter_msg2edges(obj->qends, &obj->rx_msg);
 
 		can_write_reg(chip, sjaCMR_RRB, SJACMR);
@@ -559,6 +562,9 @@ void sja1000p_irq_write_handler(struct chip_t *chip, struct msgobj_t *obj)
 	if(obj->tx_slot){
 		/* Do local transmitted message distribution if enabled */
 		if (processlocal){
+			/* fill CAN message timestamp */
+			can_filltimestamp(&obj->tx_slot->msg.timestamp);
+			
 			obj->tx_slot->msg.flags |= MSG_LOCAL;
 			canque_filter_msg2edges(obj->qends, &obj->tx_slot->msg);
 		}