Returned back filling of CAN messages timestamps for RT-Linux variant.

Used clock_gettime per Ismael's suggestion, needs more testing.

diff --git a/lincan/include/can_sysdep.h b/lincan/include/can_sysdep.h
index 6061542844165d6dbc8e22c0e3587c8f2d12d4bd..3966e8fc4d6c595479d1b07b846c5e96342fdee3 100644 (file)
--- a/lincan/include/can_sysdep.h
+++ b/lincan/include/can_sysdep.h
@@ -16,6 +16,7 @@
 #include <rtl_core.h>
 #include <rtl_mutex.h>
 #include <rtl_sched.h>
 #include <rtl_core.h>
 #include <rtl_mutex.h>
 #include <rtl_sched.h>

+#include <time.h>

 #endif /*CAN_WITH_RTL*/
 
 /*#define __NO_VERSION__*/
 #endif /*CAN_WITH_RTL*/
 
 /*#define __NO_VERSION__*/


@@ -205,7 +206,12 @@
 extern can_spinlock_t can_irq_manipulation_lock;
 
 /* CAN message timestamp source, it is called from interrupt context */
 extern can_spinlock_t can_irq_manipulation_lock;
 
 /* CAN message timestamp source, it is called from interrupt context */

-#define can_gettimeofday(ptr)      do { ;} while(0)
+#define can_gettimeofday(ptr) do {\
+         struct timespec temp_timespec;\
+         clock_gettime(CLOCK_REALTIME,&temp_timespec);\
+         ptr->tv_usec=temp_timespec.tv_nsec/1000;\
+         ptr->tv_sec=temp_timespec.tv_sec;\
+       } while(0)

 
 #endif /*CAN_WITH_RTL*/
 
 
 #endif /*CAN_WITH_RTL*/