etherlab/plc_cia402node.c
changeset 2126 7b5e83c2c23d
parent 2125 f62eb0b2e57c
child 2128 c053f90229bc
equal deleted inserted replaced
2125:f62eb0b2e57c 2126:7b5e83c2c23d
   151 	    default:
   151 	    default:
   152 	    	break;
   152 	    	break;
   153 	}
   153 	}
   154 
   154 
   155 	// Default variables publish
   155 	// Default variables publish
   156 	*(__CIA402Node_%(location)s.TargetPosition) = USER_UNIT_TO_AXIS_UNIT(__CIA402Node_%(location)s.axis->PositionSetPoint);
   156 	if (__CIA402Node_%(location)s.axis->CSP && *(__CIA402Node_%(location)s.ModesOfOperationDisplay) == 0x08) {
       
   157 		*(__CIA402Node_%(location)s.TargetPosition) = USER_UNIT_TO_AXIS_UNIT(__CIA402Node_%(location)s.axis->PositionSetPoint);
       
   158 	}
       
   159 	else {
       
   160 		*(__CIA402Node_%(location)s.TargetPosition) = *(__CIA402Node_%(location)s.ActualPosition);
       
   161 	}
   157 
   162 
   158 	// Extra variables publish
   163 	// Extra variables publish
   159 %(extra_variables_publish)s
   164 %(extra_variables_publish)s
   160 }
   165 }