diff -r 314d0acc4b67 -r f452c93f7723 master/fsm_slave_config.c
--- a/master/fsm_slave_config.c	Fri May 07 15:16:14 2010 +0200
+++ b/master/fsm_slave_config.c	Fri May 07 15:25:55 2010 +0200
@@ -422,25 +422,25 @@
         ec_fsm_slave_config_t *fsm, /**< slave state machine */
         u64 system_time, /**< System time register. */
         u64 old_offset, /**< Time offset register. */
-        unsigned long jiffies_since_read /**< Jiffies for correction. */
-        )
-{
-    ec_slave_t *slave = fsm->slave;
-    u32 correction, system_time32, old_offset32, new_offset;
+        u64 correction /**< Correction. */
+        )
+{
+    ec_slave_t *slave = fsm->slave;
+    u32 correction32, system_time32, old_offset32, new_offset;
     s32 time_diff;
 
     system_time32 = (u32) system_time;
     old_offset32 = (u32) old_offset;
 
     // correct read system time by elapsed time since read operation
-    correction = jiffies_since_read * 1000 / HZ * 1000000;
-    system_time32 += correction;
+    correction32 = (u32)correction;
+    system_time32 -= correction32;
     time_diff = (u32) slave->master->app_time - system_time32;
 
     if (slave->master->debug_level)
         EC_DBG("Slave %u: system_time=%u (corrected with %u),"
                 " app_time=%u, diff=%i\n",
-                slave->ring_position, system_time32, correction,
+                slave->ring_position, system_time32, correction32,
                 (u32) slave->master->app_time, time_diff);
 
     if (EC_ABS(time_diff) > EC_SYSTEM_TIME_TOLERANCE_NS) {
@@ -465,16 +465,14 @@
         ec_fsm_slave_config_t *fsm, /**< slave state machine */
         u64 system_time, /**< System time register. */
         u64 old_offset, /**< Time offset register. */
-        unsigned long jiffies_since_read /**< Jiffies for correction. */
-        )
-{
-    ec_slave_t *slave = fsm->slave;
-    u64 new_offset, correction;
+        u64 correction /**< Correction. */
+        )
+{
+    ec_slave_t *slave = fsm->slave;
+    u64 new_offset;
     s64 time_diff;
 
-    // correct read system time by elapsed time since read operation
-    correction = (u64) (jiffies_since_read * 1000 / HZ) * 1000000;
-    system_time += correction;
+    system_time -= correction;
     time_diff = fsm->slave->master->app_time - system_time;
 
     if (slave->master->debug_level)
@@ -509,9 +507,7 @@
 {
     ec_datagram_t *datagram = fsm->datagram;
     ec_slave_t *slave = fsm->slave;
-    u64 system_time, old_offset, new_offset;
-    unsigned long jiffies_since_read;
-
+    u64 system_time, old_offset, new_offset, correction;
     if (datagram->state == EC_DATAGRAM_TIMED_OUT && fsm->retries--)
         return;
 
@@ -534,14 +530,25 @@
 
     system_time = EC_READ_U64(datagram->data);     // 0x0910
     old_offset = EC_READ_U64(datagram->data + 16); // 0x0920
-    jiffies_since_read = jiffies - datagram->jiffies_sent;
+    /* correct read system time by elapsed time since read operation
+       and the app_time set time */
+#ifdef EC_HAVE_CYCLES
+    correction =
+            (datagram->cycles_sent - slave->master->dc_cycles_app_time)
+            * 1000000LL;
+    do_div(correction,cpu_khz);
+#else
+    correction =
+            (u64) ((datagram->jiffies_sent-slave->master->dc_jiffies_app_time) * 1000 / HZ)
+            * 1000000;
+#endif
 
     if (slave->base_dc_range == EC_DC_32) {
         new_offset = ec_fsm_slave_config_dc_offset32(fsm,
-                system_time, old_offset, jiffies_since_read);
+                system_time, old_offset, correction);
     } else {
         new_offset = ec_fsm_slave_config_dc_offset64(fsm,
-                system_time, old_offset, jiffies_since_read);
+                system_time, old_offset, correction);
     }
 
     // set DC system time offset and transmission delay