--- a/etherlab/plc_cia402node.c	Mon Apr 15 00:40:47 2013 +0200
+++ b/etherlab/plc_cia402node.c	Tue Apr 16 00:53:38 2013 +0200
@@ -153,12 +153,7 @@
 	}
 
 	// Default variables publish
-	if (__CIA402Node_%(location)s.axis->CSP && *(__CIA402Node_%(location)s.ModesOfOperationDisplay) == 0x08) {
-		*(__CIA402Node_%(location)s.TargetPosition) = USER_UNIT_TO_AXIS_UNIT(__CIA402Node_%(location)s.axis->PositionSetPoint);
-	}
-	else {
-		*(__CIA402Node_%(location)s.TargetPosition) = *(__CIA402Node_%(location)s.ActualPosition);
-	}
+	*(__CIA402Node_%(location)s.TargetPosition) = USER_UNIT_TO_AXIS_UNIT(__CIA402Node_%(location)s.axis->PositionSetPoint);
 
 	// Extra variables publish
 %(extra_variables_publish)s