Hi, You can use the positioning sensor, which returns the current position (X,Y,Z) and orientation (as a quaternion) of a robot. Try: argos3 -q positioning and have a look at the file https://github.com/ilpincy/argos3/blob/master/src/plugins/robots/generic/control_interface/ci_positioning_sensor.h ....